diff options
author | Chirayu Desai <cdesai@cyanogenmod.org> | 2012-03-09 16:37:06 +0530 |
---|---|---|
committer | Chirayu Desai <chirayudesai1@gmail.com> | 2013-05-05 10:47:19 +0530 |
commit | 939facfc7191b58c3d0fec275f93ed7d66a6c032 (patch) | |
tree | 29a52eb6fa4cfe32b4471076cb1ed7d0643dbdd5 /sound/soc | |
parent | f661100a75d28ad9ec0f3e9015794ffd69846f35 (diff) | |
download | kernel_samsung_aries-939facfc7191b58c3d0fec275f93ed7d66a6c032.zip kernel_samsung_aries-939facfc7191b58c3d0fec275f93ed7d66a6c032.tar.gz kernel_samsung_aries-939facfc7191b58c3d0fec275f93ed7d66a6c032.tar.bz2 |
add support for p1
Signed-off-by: Chirayu Desai <cdesai@cyanogenmod.org>
Signed-off-by: Humberto Borba <humberos@gmail.com>
Signed-off-by: Koudai Aono <koxudaxi@gmail.com>
Change-Id: I2dcbaee7f17852ed3ea4a5db2d103704027fe259
Diffstat (limited to 'sound/soc')
-rw-r--r-- | sound/soc/codecs/Kconfig | 8 | ||||
-rw-r--r-- | sound/soc/codecs/Makefile | 13 | ||||
-rw-r--r-- | sound/soc/codecs/wm8994.c | 3926 | ||||
-rw-r--r-- | sound/soc/codecs/wm8994.h | 147 | ||||
-rw-r--r-- | sound/soc/codecs/wm8994_extensions.c | 16 | ||||
-rw-r--r-- | sound/soc/codecs/wm8994_extensions.h | 2 | ||||
-rw-r--r-- | sound/soc/codecs/wm8994_p1.c | 4732 | ||||
-rw-r--r-- | sound/soc/samsung/Kconfig | 11 | ||||
-rw-r--r-- | sound/soc/samsung/Makefile | 4 | ||||
-rw-r--r-- | sound/soc/samsung/p1-wm8994.c | 357 |
10 files changed, 6419 insertions, 2797 deletions
diff --git a/sound/soc/codecs/Kconfig b/sound/soc/codecs/Kconfig index 9d2b5b8..8e32533 100644 --- a/sound/soc/codecs/Kconfig +++ b/sound/soc/codecs/Kconfig @@ -89,7 +89,7 @@ config SND_SOC_ALL_CODECS select SND_SOC_WM8990 if I2C select SND_SOC_WM8991 if I2C select SND_SOC_WM8993 if I2C - select SND_SOC_WM8994 if MFD_WM8994 + select SND_SOC_WM8994 if I2C && MACH_P1 select SND_SOC_WM8995 if SND_SOC_I2C_AND_SPI select SND_SOC_WM9081 if I2C select SND_SOC_WM9090 if I2C @@ -130,7 +130,7 @@ config SND_SOC_AD1980 config SND_SOC_AD73311 tristate - + config SND_SOC_ADS117X tristate @@ -392,7 +392,7 @@ config SND_SOC_WM9090 menuconfig SND_WM8994_EXTENSIONS bool "WM8994 Extensions" - depends on SND_SOC_SAMSUNG_HERRING_WM8994 + depends on SND_SOC_SAMSUNG_HERRING_WM8994 || SND_SOC_SAMSUNG_P1_WM8994 default y help With this option enabled, the kernel compile an additional driver @@ -409,7 +409,7 @@ config SND_WM8994_EXTENSIONS_HP_LEVEL_CONTROL config SND_WM8994_EXTENSIONS_HP_LEVEL int "default level at boot 0-62" depends on SND_WM8994_EXTENSIONS_HP_LEVEL_CONTROL - default 54 if MACH_HERRING=y || M110S=y + default 54 if MACH_HERRING=y || MACH_P1=y || M110S=y default 47 range 0 62 help diff --git a/sound/soc/codecs/Makefile b/sound/soc/codecs/Makefile index 3416290..dac6d79 100644 --- a/sound/soc/codecs/Makefile +++ b/sound/soc/codecs/Makefile @@ -73,12 +73,23 @@ snd-soc-wm8988-objs := wm8988.o snd-soc-wm8990-objs := wm8990.o snd-soc-wm8991-objs := wm8991.o snd-soc-wm8993-objs := wm8993.o -snd-soc-wm8994-objs := wm8994.o wm8994-tables.o wm8958-dsp2.o + +ifdef CONFIG_MACH_P1 +ifeq ($(CONFIG_SND_WM8994_EXTENSIONS),y) +snd-soc-wm8994-objs := wm8994.o wm8994_p1.o wm8994_extensions.o +else +snd-soc-wm8994-objs := wm8994.o wm8994_p1.o +endif +endif + +ifdef CONFIG_MACH_ARIES ifeq ($(CONFIG_SND_WM8994_EXTENSIONS),y) snd-soc-wm8994-samsung-objs := wm8994_samsung.o wm8994_herring.o wm8994_extensions.o else snd-soc-wm8994-samsung-objs := wm8994_samsung.o wm8994_herring.o endif +endif + snd-soc-wm8995-objs := wm8995.o snd-soc-wm9081-objs := wm9081.o snd-soc-wm9705-objs := wm9705.o diff --git a/sound/soc/codecs/wm8994.c b/sound/soc/codecs/wm8994.c index 1f7616d..13eb15b 100644 --- a/sound/soc/codecs/wm8994.c +++ b/sound/soc/codecs/wm8994.c @@ -1,1969 +1,1046 @@ -/* - * wm8994.c -- WM8994 ALSA SoC Audio driver +/* + * wm8994.c -- WM8994 ALSA Soc Audio driver * - * Copyright 2009 Wolfson Microelectronics plc + * Copyright 2010 Wolfson Microelectronics PLC. * - * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License as published by the + * Free Software Foundation; either version 2 of the License, or (at your + * option) any later version. * + * Notes: + * The WM8994 is a multichannel codec with S/PDIF support, featuring six + * DAC channels and two ADC channels. * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License version 2 as - * published by the Free Software Foundation. + * Currently only the primary audio interface is supported - S/PDIF and + * the secondary audio interfaces are not. */ #include <linux/module.h> #include <linux/moduleparam.h> +#include <linux/kernel.h> #include <linux/init.h> #include <linux/delay.h> #include <linux/pm.h> #include <linux/i2c.h> -#include <linux/platform_device.h> -#include <linux/pm_runtime.h> -#include <linux/regulator/consumer.h> #include <linux/slab.h> +#include <linux/platform_device.h> +#include <linux/clk.h> #include <sound/core.h> -#include <sound/jack.h> #include <sound/pcm.h> #include <sound/pcm_params.h> #include <sound/soc.h> -#include <sound/initval.h> +#include <sound/soc-dapm.h> #include <sound/tlv.h> -#include <trace/events/asoc.h> - -#include <linux/mfd/wm8994/core.h> -#include <linux/mfd/wm8994/registers.h> -#include <linux/mfd/wm8994/pdata.h> -#include <linux/mfd/wm8994/gpio.h> - +#include <sound/initval.h> +#include <asm/div64.h> +#include <asm/io.h> +#include <plat/map-base.h> +#include <mach/regs-clock.h> #include "wm8994.h" -#include "wm_hubs.h" -#define WM8994_NUM_DRC 3 -#define WM8994_NUM_EQ 3 +#ifdef CONFIG_SND_WM8994_EXTENSIONS +#include "wm8994_extensions.h" +#endif -static int wm8994_drc_base[] = { - WM8994_AIF1_DRC1_1, - WM8994_AIF1_DRC2_1, - WM8994_AIF2_DRC_1, -}; +#define WM8994_VERSION "0.1" +#define SUBJECT "wm8994.c" -static int wm8994_retune_mobile_base[] = { - WM8994_AIF1_DAC1_EQ_GAINS_1, - WM8994_AIF1_DAC2_EQ_GAINS_1, - WM8994_AIF2_EQ_GAINS_1, -}; +#if defined(CONFIG_VIDEO_TV20) && defined(CONFIG_SND_S5P_WM8994_MASTER) +#define HDMI_USE_AUDIO +#endif -static int wm8994_readable(struct snd_soc_codec *codec, unsigned int reg) -{ - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994 *control = codec->control_data; - - switch (reg) { - case WM8994_GPIO_1: - case WM8994_GPIO_2: - case WM8994_GPIO_3: - case WM8994_GPIO_4: - case WM8994_GPIO_5: - case WM8994_GPIO_6: - case WM8994_GPIO_7: - case WM8994_GPIO_8: - case WM8994_GPIO_9: - case WM8994_GPIO_10: - case WM8994_GPIO_11: - case WM8994_INTERRUPT_STATUS_1: - case WM8994_INTERRUPT_STATUS_2: - case WM8994_INTERRUPT_RAW_STATUS_2: - return 1; - - case WM8958_DSP2_PROGRAM: - case WM8958_DSP2_CONFIG: - case WM8958_DSP2_EXECCONTROL: - if (control->type == WM8958) - return 1; - else - return 0; +/* + *Definitions of clock related. +*/ - default: - break; - } +static struct { + int ratio; + int clk_sys_rate; +} clk_sys_rates[] = { + { 64, 0 }, + { 128, 1 }, + { 192, 2 }, + { 256, 3 }, + { 384, 4 }, + { 512, 5 }, + { 768, 6 }, + { 1024, 7 }, + { 1408, 8 }, + { 1536, 9 }, +}; - if (reg >= WM8994_CACHE_SIZE) - return 0; - return wm8994_access_masks[reg].readable != 0; -} +static struct { + int rate; + int sample_rate; +} sample_rates[] = { + { 8000, 0 }, + { 11025, 1 }, + { 12000, 2 }, + { 16000, 3 }, + { 22050, 4 }, + { 24000, 5 }, + { 32000, 6 }, + { 44100, 7 }, + { 48000, 8 }, + { 88200, 9 }, + { 96000, 10 }, +}; -static int wm8994_volatile(struct snd_soc_codec *codec, unsigned int reg) -{ - if (reg >= WM8994_CACHE_SIZE) - return 1; - - switch (reg) { - case WM8994_SOFTWARE_RESET: - case WM8994_CHIP_REVISION: - case WM8994_DC_SERVO_1: - case WM8994_DC_SERVO_READBACK: - case WM8994_RATE_STATUS: - case WM8994_LDO_1: - case WM8994_LDO_2: - case WM8958_DSP2_EXECCONTROL: - case WM8958_MIC_DETECT_3: - return 1; - default: - return 0; - } -} +static struct { + int div; + int bclk_div; +} bclk_divs[] = { + { 1, 0 }, + { 2, 1 }, + { 4, 2 }, + { 6, 3 }, + { 8, 4 }, + { 12, 5 }, + { 16, 6 }, + { 24, 7 }, + { 32, 8 }, + { 48, 9 }, +}; -static int wm8994_write(struct snd_soc_codec *codec, unsigned int reg, - unsigned int value) -{ - int ret; +/* + * Definitions of sound path + */ +select_route universal_wm8994_playback_paths[] = { + wm8994_set_off, wm8994_set_playback_receiver, + wm8994_set_playback_speaker, wm8994_set_playback_headset, + wm8994_set_playback_headset, wm8994_set_playback_bluetooth, + wm8994_set_playback_speaker_headset, wm8994_set_playback_extra_dock_speaker, + wm8994_set_playback_hdmi_tvout, + wm8994_set_playback_speaker_hdmitvout, + wm8994_set_playback_speakerheadset_hdmitvout +}; - BUG_ON(reg > WM8994_MAX_REGISTER); +select_route universal_wm8994_voicecall_paths[] = { + wm8994_set_off, wm8994_set_voicecall_receiver, + wm8994_set_voicecall_speaker, wm8994_set_voicecall_headset, + wm8994_set_voicecall_headphone, wm8994_set_voicecall_bluetooth, +}; - if (!wm8994_volatile(codec, reg)) { - ret = snd_soc_cache_write(codec, reg, value); - if (ret != 0) - dev_err(codec->dev, "Cache write to %x failed: %d\n", - reg, ret); - } +select_mic_route universal_wm8994_mic_paths[] = { + wm8994_record_main_mic, + wm8994_record_headset_mic, + wm8994_record_bluetooth, +}; - return wm8994_reg_write(codec->control_data, reg, value); -} -static unsigned int wm8994_read(struct snd_soc_codec *codec, - unsigned int reg) +/* + * Implementation of I2C functions + */ +static unsigned int wm8994_read_hw(struct snd_soc_codec *codec, u16 reg) { - unsigned int val; + struct i2c_msg xfer[2]; + u16 data; int ret; - - BUG_ON(reg > WM8994_MAX_REGISTER); - - if (!wm8994_volatile(codec, reg) && wm8994_readable(codec, reg) && - reg < codec->driver->reg_cache_size) { - ret = snd_soc_cache_read(codec, reg, &val); - if (ret >= 0) - return val; - else - dev_err(codec->dev, "Cache read from %x failed: %d\n", - reg, ret); - } - - return wm8994_reg_read(codec->control_data, reg); -} - -static int configure_aif_clock(struct snd_soc_codec *codec, int aif) -{ - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int rate; - int reg1 = 0; - int offset; - - if (aif) - offset = 4; - else - offset = 0; - - switch (wm8994->sysclk[aif]) { - case WM8994_SYSCLK_MCLK1: - rate = wm8994->mclk[0]; - break; - - case WM8994_SYSCLK_MCLK2: - reg1 |= 0x8; - rate = wm8994->mclk[1]; - break; - - case WM8994_SYSCLK_FLL1: - reg1 |= 0x10; - rate = wm8994->fll[0].out; - break; - - case WM8994_SYSCLK_FLL2: - reg1 |= 0x18; - rate = wm8994->fll[1].out; - break; - - default: - return -EINVAL; - } - - if (rate >= 13500000) { - rate /= 2; - reg1 |= WM8994_AIF1CLK_DIV; - - dev_dbg(codec->dev, "Dividing AIF%d clock to %dHz\n", - aif + 1, rate); + struct i2c_client *i2c = codec->control_data; + + data = ((reg & 0xff00) >> 8) | ((reg & 0xff) << 8); + + xfer[0].addr = i2c->addr; + xfer[0].flags = 0; + xfer[0].len = 2; + xfer[0].buf = (void *)&data; + + xfer[1].addr = i2c->addr; + xfer[1].flags = I2C_M_RD; + xfer[1].len = 2; + xfer[1].buf = (u8 *)&data; + ret = i2c_transfer(i2c->adapter, xfer, 2); + if (ret != 2) { + dev_err(codec->dev, "Failed to read 0x%x: %d\n", reg, ret); + return 0; } - if (rate && rate < 3000000) - dev_warn(codec->dev, "AIF%dCLK is %dHz, should be >=3MHz for optimal performance\n", - aif + 1, rate); - - wm8994->aifclk[aif] = rate; - - snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1 + offset, - WM8994_AIF1CLK_SRC_MASK | WM8994_AIF1CLK_DIV, - reg1); - - return 0; + return (data >> 8) | ((data & 0xff) << 8); } -static int configure_clock(struct snd_soc_codec *codec) +int wm8994_write(struct snd_soc_codec *codec, unsigned int reg, + unsigned int value) { - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int old, new; + u8 data[4]; + int ret; - /* Bring up the AIF clocks first */ - configure_aif_clock(codec, 0); - configure_aif_clock(codec, 1); +#ifdef CONFIG_SND_WM8994_EXTENSIONS + value = wm8994_extensions_write(codec, reg, value); +#endif - /* Then switch CLK_SYS over to the higher of them; a change - * can only happen as a result of a clocking change which can - * only be made outside of DAPM so we can safely redo the - * clocking. + /* data is + * D15..D9 WM8993 register offset + * D8...D0 register data */ + data[0] = (reg & 0xff00) >> 8; + data[1] = reg & 0x00ff; + data[2] = value >> 8; + data[3] = value & 0x00ff; + ret = codec->hw_write(codec->control_data, data, 4); - /* If they're equal it doesn't matter which is used */ - if (wm8994->aifclk[0] == wm8994->aifclk[1]) + if (ret == 4) return 0; - - if (wm8994->aifclk[0] < wm8994->aifclk[1]) - new = WM8994_SYSCLK_SRC; - else - new = 0; - - old = snd_soc_read(codec, WM8994_CLOCKING_1) & WM8994_SYSCLK_SRC; - - /* If there's no change then we're done. */ - if (old == new) - return 0; - - snd_soc_update_bits(codec, WM8994_CLOCKING_1, WM8994_SYSCLK_SRC, new); - - snd_soc_dapm_sync(&codec->dapm); - - return 0; + else { + pr_err("i2c write problem occured\n"); + return ret; + } } -static int check_clk_sys(struct snd_soc_dapm_widget *source, - struct snd_soc_dapm_widget *sink) +inline unsigned int wm8994_read(struct snd_soc_codec *codec, unsigned int reg) { - int reg = snd_soc_read(source->codec, WM8994_CLOCKING_1); - const char *clk; - - /* Check what we're currently using for CLK_SYS */ - if (reg & WM8994_SYSCLK_SRC) - clk = "AIF2CLK"; - else - clk = "AIF1CLK"; - - return strcmp(source->name, clk) == 0; + return wm8994_read_hw(codec, reg); } -static const char *sidetone_hpf_text[] = { - "2.7kHz", "1.35kHz", "675Hz", "370Hz", "180Hz", "90Hz", "45Hz" -}; - -static const struct soc_enum sidetone_hpf = - SOC_ENUM_SINGLE(WM8994_SIDETONE, 7, 7, sidetone_hpf_text); +/* + * Functions related volume. + */ +static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1); -static const char *adc_hpf_text[] = { - "HiFi", "Voice 1", "Voice 2", "Voice 3" -}; +static int wm899x_outpga_put_volsw_vu(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + int ret; + u16 val; -static const struct soc_enum aif1adc1_hpf = - SOC_ENUM_SINGLE(WM8994_AIF1_ADC1_FILTERS, 13, 4, adc_hpf_text); + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); + struct soc_mixer_control *mc = + (struct soc_mixer_control *)kcontrol->private_value; + int reg = mc->reg; + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); -static const struct soc_enum aif1adc2_hpf = - SOC_ENUM_SINGLE(WM8994_AIF1_ADC2_FILTERS, 13, 4, adc_hpf_text); + DEBUG_LOG(""); -static const struct soc_enum aif2adc_hpf = - SOC_ENUM_SINGLE(WM8994_AIF2_ADC_FILTERS, 13, 4, adc_hpf_text); + ret = snd_soc_put_volsw_2r(kcontrol, ucontrol); + if (ret < 0) + return ret; -static const DECLARE_TLV_DB_SCALE(aif_tlv, 0, 600, 0); -static const DECLARE_TLV_DB_SCALE(digital_tlv, -7200, 75, 1); -static const DECLARE_TLV_DB_SCALE(st_tlv, -3600, 300, 0); -static const DECLARE_TLV_DB_SCALE(wm8994_3d_tlv, -1600, 183, 0); -static const DECLARE_TLV_DB_SCALE(eq_tlv, -1200, 100, 0); + val = wm8994_read(codec, reg); -#define WM8994_DRC_SWITCH(xname, reg, shift) \ -{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ - .info = snd_soc_info_volsw, .get = snd_soc_get_volsw,\ - .put = wm8994_put_drc_sw, \ - .private_value = SOC_SINGLE_VALUE(reg, shift, 1, 0) } + return wm8994_write(codec, reg, val | 0x0100); +} -static int wm8994_put_drc_sw(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) +static int wm899x_inpga_put_volsw_vu(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { - struct soc_mixer_control *mc = - (struct soc_mixer_control *)kcontrol->private_value; struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); - int mask, ret; + struct soc_mixer_control *mc = + (struct soc_mixer_control *)kcontrol->private_value; + int reg = mc->reg; + int ret; + u16 val; - /* Can't enable both ADC and DAC paths simultaneously */ - if (mc->shift == WM8994_AIF1DAC1_DRC_ENA_SHIFT) - mask = WM8994_AIF1ADC1L_DRC_ENA_MASK | - WM8994_AIF1ADC1R_DRC_ENA_MASK; - else - mask = WM8994_AIF1DAC1_DRC_ENA_MASK; + ret = snd_soc_put_volsw(kcontrol, ucontrol); - ret = snd_soc_read(codec, mc->reg); if (ret < 0) return ret; - if (ret & mask) - return -EINVAL; - return snd_soc_put_volsw(kcontrol, ucontrol); -} + val = wm8994_read(codec, reg); -static void wm8994_set_drc(struct snd_soc_codec *codec, int drc) -{ - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994_pdata *pdata = wm8994->pdata; - int base = wm8994_drc_base[drc]; - int cfg = wm8994->drc_cfg[drc]; - int save, i; - - /* Save any enables; the configuration should clear them. */ - save = snd_soc_read(codec, base); - save &= WM8994_AIF1DAC1_DRC_ENA | WM8994_AIF1ADC1L_DRC_ENA | - WM8994_AIF1ADC1R_DRC_ENA; - - for (i = 0; i < WM8994_DRC_REGS; i++) - snd_soc_update_bits(codec, base + i, 0xffff, - pdata->drc_cfgs[cfg].regs[i]); - - snd_soc_update_bits(codec, base, WM8994_AIF1DAC1_DRC_ENA | - WM8994_AIF1ADC1L_DRC_ENA | - WM8994_AIF1ADC1R_DRC_ENA, save); -} + return wm8994_write(codec, reg, val | 0x0100); -/* Icky as hell but saves code duplication */ -static int wm8994_get_drc(const char *name) -{ - if (strcmp(name, "AIF1DRC1 Mode") == 0) - return 0; - if (strcmp(name, "AIF1DRC2 Mode") == 0) - return 1; - if (strcmp(name, "AIF2DRC Mode") == 0) - return 2; - return -EINVAL; } -static int wm8994_put_drc_enum(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) -{ - struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994_pdata *pdata = wm8994->pdata; - int drc = wm8994_get_drc(kcontrol->id.name); - int value = ucontrol->value.integer.value[0]; - - if (drc < 0) - return drc; - - if (value >= pdata->num_drc_cfgs) - return -EINVAL; - - wm8994->drc_cfg[drc] = value; +/* + * Implementation of sound path + */ +static const char *playback_path[] = { "OFF", "RCV", "SPK", "HP", "HP_NO_MIC", "BT", "SPK_HP", "RING_SPK", "RING_HP", "RING_NO_MIC", "RING_SPK_HP", "EXTRA_DOCK_SPEAKER", "TV_OUT", "HDMI_TV_OUT", "HDMI_SPK", "HDMI_DUAL" }; +static const char *voicecall_path[] = { "OFF", "RCV", "SPK", "HP", "HP_NO_MIC", "BT", }; +static const char *mic_path[] = {"Main Mic", "Hands Free Mic", "BT Sco Mic", "MIC OFF" }; +static const char *fmradio_path[] = { "FMR_OFF", "FMR_SPK", "FMR_HP", "FMR_SPK_MIX", "FMR_HP_MIX", "FMR_DUAL_MIX"}; +static const char *codec_tuning_control[] = {"OFF", "ON"}; +static const char *codec_status_control[] = {"FMR_VOL_0", "FMR_VOL_1", "FMR_OFF", "REC_OFF", "REC_ON"}; +static const char * voice_record_path[] = {"CALL_RECORDING_OFF", "CALL_RECORDING_MAIN", "CALL_RECORDING_SUB"}; +static const char * call_recording_channel[] ={"CH_OFF"," CH_UPLINK","CH_DOWNLINK","CH_UDLINK"}; - wm8994_set_drc(codec, drc); - return 0; -} -static int wm8994_get_drc_enum(struct snd_kcontrol *kcontrol, +static int wm8994_get_mic_path(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int drc = wm8994_get_drc(kcontrol->id.name); - ucontrol->value.enumerated.item[0] = wm8994->drc_cfg[drc]; + ucontrol->value.integer.value[0] = wm8994->rec_path; return 0; } -static void wm8994_set_retune_mobile(struct snd_soc_codec *codec, int block) +static int wm8994_set_mic_path(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994_pdata *pdata = wm8994->pdata; - int base = wm8994_retune_mobile_base[block]; - int iface, best, best_val, save, i, cfg; - if (!pdata || !wm8994->num_retune_mobile_texts) - return; + DEBUG_LOG(""); - switch (block) { + wm8994->codec_state |= CAPTURE_ACTIVE; + + switch (ucontrol->value.integer.value[0]) { case 0: + wm8994->rec_path = MAIN; + break; case 1: - iface = 0; + wm8994->rec_path = SUB; break; case 2: - iface = 1; + wm8994->rec_path = BT_REC; + wm8994->universal_mic_path[wm8994->rec_path](codec); break; + case 3: + wm8994_disable_rec_path(codec); + return 0; default: - return; + return -EINVAL; } - /* Find the version of the currently selected configuration - * with the nearest sample rate. */ - cfg = wm8994->retune_mobile_cfg[block]; - best = 0; - best_val = INT_MAX; - for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) { - if (strcmp(pdata->retune_mobile_cfgs[i].name, - wm8994->retune_mobile_texts[cfg]) == 0 && - abs(pdata->retune_mobile_cfgs[i].rate - - wm8994->dac_rates[iface]) < best_val) { - best = i; - best_val = abs(pdata->retune_mobile_cfgs[i].rate - - wm8994->dac_rates[iface]); - } + if(wm8994->rec_path == MAIN) + audio_ctrl_mic_bias_gpio(1); + else { //SUB + audio_ctrl_mic_bias_gpio(0); + audio_ctrl_earmic_bias_gpio(1); } - dev_dbg(codec->dev, "ReTune Mobile %d %s/%dHz for %dHz sample rate\n", - block, - pdata->retune_mobile_cfgs[best].name, - pdata->retune_mobile_cfgs[best].rate, - wm8994->dac_rates[iface]); - - /* The EQ will be disabled while reconfiguring it, remember the - * current configuration. - */ - save = snd_soc_read(codec, base); - save &= WM8994_AIF1DAC1_EQ_ENA; - - for (i = 0; i < WM8994_EQ_REGS; i++) - snd_soc_update_bits(codec, base + i, 0xffff, - pdata->retune_mobile_cfgs[best].regs[i]); + wm8994->universal_mic_path[wm8994->rec_path] (codec); - snd_soc_update_bits(codec, base, WM8994_AIF1DAC1_EQ_ENA, save); -} - -/* Icky as hell but saves code duplication */ -static int wm8994_get_retune_mobile_block(const char *name) -{ - if (strcmp(name, "AIF1.1 EQ Mode") == 0) - return 0; - if (strcmp(name, "AIF1.2 EQ Mode") == 0) - return 1; - if (strcmp(name, "AIF2 EQ Mode") == 0) - return 2; - return -EINVAL; + return 0; } -static int wm8994_put_retune_mobile_enum(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) +static int wm8994_get_path(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994_pdata *pdata = wm8994->pdata; - int block = wm8994_get_retune_mobile_block(kcontrol->id.name); - int value = ucontrol->value.integer.value[0]; - - if (block < 0) - return block; - if (value >= pdata->num_retune_mobile_cfgs) - return -EINVAL; - - wm8994->retune_mobile_cfg[block] = value; - - wm8994_set_retune_mobile(codec, block); + ucontrol->value.integer.value[0] = wm8994->cur_path; return 0; } -static int wm8994_get_retune_mobile_enum(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) +static int wm8994_set_path(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int block = wm8994_get_retune_mobile_block(kcontrol->id.name); - - ucontrol->value.enumerated.item[0] = wm8994->retune_mobile_cfg[block]; + int val; + int path_num = ucontrol->value.integer.value[0]; + + switch (path_num) { + case PLAYBACK_OFF: + DEBUG_LOG("Switching off output path\n"); + break; + case RCV: + case SPK: + case HP: + case HP_NO_MIC: + case BT: + case SPK_HP: + DEBUG_LOG("routing to %s\n", mc->texts[path_num]); + wm8994->ringtone_active = OFF; + break; + case RING_SPK: + case RING_HP: + case RING_NO_MIC: + DEBUG_LOG("routing to %s\n", mc->texts[path_num]); + wm8994->ringtone_active = ON; + path_num -= 5; + break; + case RING_SPK_HP: + DEBUG_LOG("routing to %s\n", mc->texts[path_num]); + wm8994->ringtone_active = ON; + path_num -= 4; + break; + case EXTRA_DOCK_SPEAKER: + case TV_OUT: + DEBUG_LOG("routing to %s\n", mc->texts[path_num]); + wm8994->ringtone_active = OFF; + path_num -= 4; + break; + case HDMI_TV_OUT: + case HDMI_SPK: + case HDMI_DUAL: + DEBUG_LOG("routing to %s\n", mc->texts[path_num]); + wm8994->ringtone_active = OFF; + path_num -= 5; + break; + default: + DEBUG_LOG_ERR("audio path[%d] does not exists!!\n", path_num); + return -ENODEV; + break; + } - return 0; -} + wm8994->codec_state |= PLAYBACK_ACTIVE; -static const char *aif_chan_src_text[] = { - "Left", "Right" -}; + if (wm8994->codec_state & FMRADIO_ACTIVE) { + wm8994->codec_state &= ~(FMRADIO_ACTIVE); + wm8994->fmr_mix_path = FMR_MIX_OFF; + wm8994->fmradio_path = FMR_OFF; + } -static const struct soc_enum aif1adcl_src = - SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_1, 15, 2, aif_chan_src_text); + if (wm8994->codec_state & CALL_ACTIVE) { + wm8994->codec_state &= ~(CALL_ACTIVE); -static const struct soc_enum aif1adcr_src = - SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_1, 14, 2, aif_chan_src_text); + val = wm8994_read(codec, WM8994_CLOCKING_1); + val &= ~(WM8994_DSP_FS2CLK_ENA_MASK | WM8994_SYSCLK_SRC_MASK); + wm8994_write(codec, WM8994_CLOCKING_1, val); + } -static const struct soc_enum aif2adcl_src = - SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_1, 15, 2, aif_chan_src_text); -static const struct soc_enum aif2adcr_src = - SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_1, 14, 2, aif_chan_src_text); + if (wm8994->testmode_config_flag == SEC_TEST_PBA_DUAL_SPK && + (path_num == HP || path_num == HP_NO_MIC)) { + DEBUG_LOG("SEC_TEST_PBA_DUAL_SPK : forced set path to SPK"); + path_num = SPK; + } -static const struct soc_enum aif1dacl_src = - SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_2, 15, 2, aif_chan_src_text); + wm8994->cur_path = path_num; + wm8994->universal_playback_path[wm8994->cur_path] (codec); -static const struct soc_enum aif1dacr_src = - SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_2, 14, 2, aif_chan_src_text); + return 0; +} -static const struct soc_enum aif2dacl_src = - SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_2, 15, 2, aif_chan_src_text); +static int wm8994_get_call_path(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + return 0; +} -static const struct soc_enum aif2dacr_src = - SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_2, 14, 2, aif_chan_src_text); +static int wm8994_set_call_path(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + struct soc_enum *mc = (struct soc_enum *)kcontrol->private_value; -static const char *osr_text[] = { - "Low Power", "High Performance", -}; + // Get path value + int path_num = ucontrol->value.integer.value[0]; -static const struct soc_enum dac_osr = - SOC_ENUM_SINGLE(WM8994_OVERSAMPLING, 0, 2, osr_text); + if(strcmp( mc->texts[path_num], voicecall_path[path_num]) ) + { + DEBUG_LOG_ERR("Unknown path %s", mc->texts[path_num] ); + return -ENODEV; + } -static const struct soc_enum adc_osr = - SOC_ENUM_SINGLE(WM8994_OVERSAMPLING, 1, 2, osr_text); + switch(path_num) + { + case PLAYBACK_OFF : + DEBUG_LOG("Switching off output path"); + break; -static const struct snd_kcontrol_new wm8994_snd_controls[] = { -SOC_DOUBLE_R_TLV("AIF1ADC1 Volume", WM8994_AIF1_ADC1_LEFT_VOLUME, - WM8994_AIF1_ADC1_RIGHT_VOLUME, - 1, 119, 0, digital_tlv), -SOC_DOUBLE_R_TLV("AIF1ADC2 Volume", WM8994_AIF1_ADC2_LEFT_VOLUME, - WM8994_AIF1_ADC2_RIGHT_VOLUME, - 1, 119, 0, digital_tlv), -SOC_DOUBLE_R_TLV("AIF2ADC Volume", WM8994_AIF2_ADC_LEFT_VOLUME, - WM8994_AIF2_ADC_RIGHT_VOLUME, - 1, 119, 0, digital_tlv), - -SOC_ENUM("AIF1ADCL Source", aif1adcl_src), -SOC_ENUM("AIF1ADCR Source", aif1adcr_src), -SOC_ENUM("AIF2ADCL Source", aif2adcl_src), -SOC_ENUM("AIF2ADCR Source", aif2adcr_src), - -SOC_ENUM("AIF1DACL Source", aif1dacl_src), -SOC_ENUM("AIF1DACR Source", aif1dacr_src), -SOC_ENUM("AIF2DACL Source", aif2dacl_src), -SOC_ENUM("AIF2DACR Source", aif2dacr_src), - -SOC_DOUBLE_R_TLV("AIF1DAC1 Volume", WM8994_AIF1_DAC1_LEFT_VOLUME, - WM8994_AIF1_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv), -SOC_DOUBLE_R_TLV("AIF1DAC2 Volume", WM8994_AIF1_DAC2_LEFT_VOLUME, - WM8994_AIF1_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv), -SOC_DOUBLE_R_TLV("AIF2DAC Volume", WM8994_AIF2_DAC_LEFT_VOLUME, - WM8994_AIF2_DAC_RIGHT_VOLUME, 1, 96, 0, digital_tlv), - -SOC_SINGLE_TLV("AIF1 Boost Volume", WM8994_AIF1_CONTROL_2, 10, 3, 0, aif_tlv), -SOC_SINGLE_TLV("AIF2 Boost Volume", WM8994_AIF2_CONTROL_2, 10, 3, 0, aif_tlv), - -SOC_SINGLE("AIF1DAC1 EQ Switch", WM8994_AIF1_DAC1_EQ_GAINS_1, 0, 1, 0), -SOC_SINGLE("AIF1DAC2 EQ Switch", WM8994_AIF1_DAC2_EQ_GAINS_1, 0, 1, 0), -SOC_SINGLE("AIF2 EQ Switch", WM8994_AIF2_EQ_GAINS_1, 0, 1, 0), - -WM8994_DRC_SWITCH("AIF1DAC1 DRC Switch", WM8994_AIF1_DRC1_1, 2), -WM8994_DRC_SWITCH("AIF1ADC1L DRC Switch", WM8994_AIF1_DRC1_1, 1), -WM8994_DRC_SWITCH("AIF1ADC1R DRC Switch", WM8994_AIF1_DRC1_1, 0), - -WM8994_DRC_SWITCH("AIF1DAC2 DRC Switch", WM8994_AIF1_DRC2_1, 2), -WM8994_DRC_SWITCH("AIF1ADC2L DRC Switch", WM8994_AIF1_DRC2_1, 1), -WM8994_DRC_SWITCH("AIF1ADC2R DRC Switch", WM8994_AIF1_DRC2_1, 0), - -WM8994_DRC_SWITCH("AIF2DAC DRC Switch", WM8994_AIF2_DRC_1, 2), -WM8994_DRC_SWITCH("AIF2ADCL DRC Switch", WM8994_AIF2_DRC_1, 1), -WM8994_DRC_SWITCH("AIF2ADCR DRC Switch", WM8994_AIF2_DRC_1, 0), - -SOC_SINGLE_TLV("DAC1 Right Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES, - 5, 12, 0, st_tlv), -SOC_SINGLE_TLV("DAC1 Left Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES, - 0, 12, 0, st_tlv), -SOC_SINGLE_TLV("DAC2 Right Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES, - 5, 12, 0, st_tlv), -SOC_SINGLE_TLV("DAC2 Left Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES, - 0, 12, 0, st_tlv), -SOC_ENUM("Sidetone HPF Mux", sidetone_hpf), -SOC_SINGLE("Sidetone HPF Switch", WM8994_SIDETONE, 6, 1, 0), - -SOC_ENUM("AIF1ADC1 HPF Mode", aif1adc1_hpf), -SOC_DOUBLE("AIF1ADC1 HPF Switch", WM8994_AIF1_ADC1_FILTERS, 12, 11, 1, 0), - -SOC_ENUM("AIF1ADC2 HPF Mode", aif1adc2_hpf), -SOC_DOUBLE("AIF1ADC2 HPF Switch", WM8994_AIF1_ADC2_FILTERS, 12, 11, 1, 0), - -SOC_ENUM("AIF2ADC HPF Mode", aif2adc_hpf), -SOC_DOUBLE("AIF2ADC HPF Switch", WM8994_AIF2_ADC_FILTERS, 12, 11, 1, 0), - -SOC_ENUM("ADC OSR", adc_osr), -SOC_ENUM("DAC OSR", dac_osr), - -SOC_DOUBLE_R_TLV("DAC1 Volume", WM8994_DAC1_LEFT_VOLUME, - WM8994_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv), -SOC_DOUBLE_R("DAC1 Switch", WM8994_DAC1_LEFT_VOLUME, - WM8994_DAC1_RIGHT_VOLUME, 9, 1, 1), - -SOC_DOUBLE_R_TLV("DAC2 Volume", WM8994_DAC2_LEFT_VOLUME, - WM8994_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv), -SOC_DOUBLE_R("DAC2 Switch", WM8994_DAC2_LEFT_VOLUME, - WM8994_DAC2_RIGHT_VOLUME, 9, 1, 1), - -SOC_SINGLE_TLV("SPKL DAC2 Volume", WM8994_SPKMIXL_ATTENUATION, - 6, 1, 1, wm_hubs_spkmix_tlv), -SOC_SINGLE_TLV("SPKL DAC1 Volume", WM8994_SPKMIXL_ATTENUATION, - 2, 1, 1, wm_hubs_spkmix_tlv), - -SOC_SINGLE_TLV("SPKR DAC2 Volume", WM8994_SPKMIXR_ATTENUATION, - 6, 1, 1, wm_hubs_spkmix_tlv), -SOC_SINGLE_TLV("SPKR DAC1 Volume", WM8994_SPKMIXR_ATTENUATION, - 2, 1, 1, wm_hubs_spkmix_tlv), - -SOC_SINGLE_TLV("AIF1DAC1 3D Stereo Volume", WM8994_AIF1_DAC1_FILTERS_2, - 10, 15, 0, wm8994_3d_tlv), -SOC_SINGLE("AIF1DAC1 3D Stereo Switch", WM8994_AIF1_DAC1_FILTERS_2, - 8, 1, 0), -SOC_SINGLE_TLV("AIF1DAC2 3D Stereo Volume", WM8994_AIF1_DAC2_FILTERS_2, - 10, 15, 0, wm8994_3d_tlv), -SOC_SINGLE("AIF1DAC2 3D Stereo Switch", WM8994_AIF1_DAC2_FILTERS_2, - 8, 1, 0), -SOC_SINGLE_TLV("AIF2DAC 3D Stereo Volume", WM8994_AIF2_DAC_FILTERS_2, - 10, 15, 0, wm8994_3d_tlv), -SOC_SINGLE("AIF2DAC 3D Stereo Switch", WM8994_AIF2_DAC_FILTERS_2, - 8, 1, 0), -}; + case SPK : + case RCV : + case HP: + case HP_NO_MIC: + case BT : + DEBUG_LOG("routing voice path to %s", mc->texts[path_num] ); + break; -static const struct snd_kcontrol_new wm8994_eq_controls[] = { -SOC_SINGLE_TLV("AIF1DAC1 EQ1 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 11, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC1 EQ2 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 6, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC1 EQ3 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 1, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC1 EQ4 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 11, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC1 EQ5 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 6, 31, 0, - eq_tlv), - -SOC_SINGLE_TLV("AIF1DAC2 EQ1 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 11, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC2 EQ2 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 6, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC2 EQ3 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 1, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC2 EQ4 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 11, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF1DAC2 EQ5 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 6, 31, 0, - eq_tlv), - -SOC_SINGLE_TLV("AIF2 EQ1 Volume", WM8994_AIF2_EQ_GAINS_1, 11, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF2 EQ2 Volume", WM8994_AIF2_EQ_GAINS_1, 6, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF2 EQ3 Volume", WM8994_AIF2_EQ_GAINS_1, 1, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF2 EQ4 Volume", WM8994_AIF2_EQ_GAINS_2, 11, 31, 0, - eq_tlv), -SOC_SINGLE_TLV("AIF2 EQ5 Volume", WM8994_AIF2_EQ_GAINS_2, 6, 31, 0, - eq_tlv), -}; + default: + DEBUG_LOG_ERR("The audio path[%d] does not exists!!", path_num); + return -ENODEV; + break; + } -static const struct snd_kcontrol_new wm8958_snd_controls[] = { -SOC_SINGLE_TLV("AIF3 Boost Volume", WM8958_AIF3_CONTROL_2, 10, 3, 0, aif_tlv), -}; + if(wm8994->cur_path != path_num || !(wm8994->codec_state & CALL_ACTIVE)) + { + wm8994->codec_state |= CALL_ACTIVE; + wm8994->cur_path = path_num; + wm8994->universal_voicecall_path[wm8994->cur_path](codec); + } + else + { + int val; -static int clk_sys_event(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) -{ - struct snd_soc_codec *codec = w->codec; + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE); + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + } - switch (event) { - case SND_SOC_DAPM_PRE_PMU: - return configure_clock(codec); + return 0; +} - case SND_SOC_DAPM_POST_PMD: - configure_clock(codec); - break; - } +static int wm8994_get_fmradio_path(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ return 0; } -static void wm8994_update_class_w(struct snd_soc_codec *codec) +static int wm8994_set_fmradio_path(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); + struct soc_enum *mc = (struct soc_enum *)kcontrol->private_value; struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int enable = 1; - int source = 0; /* GCC flow analysis can't track enable */ - int reg, reg_r; - - /* Only support direct DAC->headphone paths */ - reg = snd_soc_read(codec, WM8994_OUTPUT_MIXER_1); - if (!(reg & WM8994_DAC1L_TO_HPOUT1L)) { - dev_vdbg(codec->dev, "HPL connected to output mixer\n"); - enable = 0; - } - reg = snd_soc_read(codec, WM8994_OUTPUT_MIXER_2); - if (!(reg & WM8994_DAC1R_TO_HPOUT1R)) { - dev_vdbg(codec->dev, "HPR connected to output mixer\n"); - enable = 0; + int path_num = ucontrol->value.integer.value[0]; + + if (strcmp(mc->texts[path_num], fmradio_path[path_num])) + DEBUG_LOG("Unknown path %s\n", mc->texts[path_num]); + + if (path_num == wm8994->fmradio_path) { + int val; + + DEBUG_LOG("%s is already set. skip to set path..\n", + mc->texts[path_num]); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE); + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + + return 0; } - /* We also need the same setting for L/R and only one path */ - reg = snd_soc_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING); - switch (reg) { - case WM8994_AIF2DACL_TO_DAC1L: - dev_vdbg(codec->dev, "Class W source AIF2DAC\n"); - source = 2 << WM8994_CP_DYN_SRC_SEL_SHIFT; - break; - case WM8994_AIF1DAC2L_TO_DAC1L: - dev_vdbg(codec->dev, "Class W source AIF1DAC2\n"); - source = 1 << WM8994_CP_DYN_SRC_SEL_SHIFT; + wm8994->codec_state |= FMRADIO_ACTIVE; + + switch (path_num) { + case FMR_OFF: + DEBUG_LOG("Switching off output path"); + wm8994_disable_fmradio_path(codec); break; - case WM8994_AIF1DAC1L_TO_DAC1L: - dev_vdbg(codec->dev, "Class W source AIF1DAC1\n"); - source = 0 << WM8994_CP_DYN_SRC_SEL_SHIFT; + case FMR_SPK: + DEBUG_LOG("routing fmradio path to %s", mc->texts[path_num] ); + wm8994->fmr_mix_path = FMR_MIX_OFF; + wm8994_set_fmradio_speaker(codec); break; - default: - dev_vdbg(codec->dev, "DAC mixer setting: %x\n", reg); - enable = 0; + case FMR_HP: + DEBUG_LOG("routing fmradio path to %s\n", mc->texts[path_num]); + wm8994->fmr_mix_path = FMR_MIX_OFF; + wm8994_set_fmradio_headset(codec); break; - } - reg_r = snd_soc_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING); - if (reg_r != reg) { - dev_vdbg(codec->dev, "Left and right DAC mixers different\n"); - enable = 0; - } + case FMR_SPK_MIX: + DEBUG_LOG("routing fmradio path to %s", mc->texts[path_num]); - if (enable) { - dev_dbg(codec->dev, "Class W enabled\n"); - snd_soc_update_bits(codec, WM8994_CLASS_W_1, - WM8994_CP_DYN_PWR | - WM8994_CP_DYN_SRC_SEL_MASK, - source | WM8994_CP_DYN_PWR); - wm8994->hubs.class_w = true; - - } else { - dev_dbg(codec->dev, "Class W disabled\n"); - snd_soc_update_bits(codec, WM8994_CLASS_W_1, - WM8994_CP_DYN_PWR, 0); - wm8994->hubs.class_w = false; - } -} - -static int late_enable_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) -{ - struct snd_soc_codec *codec = w->codec; - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - - switch (event) { - case SND_SOC_DAPM_PRE_PMU: - if (wm8994->aif1clk_enable) { - snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1, - WM8994_AIF1CLK_ENA_MASK, - WM8994_AIF1CLK_ENA); - wm8994->aif1clk_enable = 0; - } - if (wm8994->aif2clk_enable) { - snd_soc_update_bits(codec, WM8994_AIF2_CLOCKING_1, - WM8994_AIF2CLK_ENA_MASK, - WM8994_AIF2CLK_ENA); - wm8994->aif2clk_enable = 0; + if (wm8994->fmr_mix_path != FMR_MIX_SPK) { + wm8994->fmr_mix_path = FMR_MIX_SPK; + wm8994_set_fmradio_speaker_mix(codec); + } else { + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1, WM8994_AIF1DAC1_UNMUTE); + DEBUG_LOG("FMR_MIX_SPK is already set!!! Skip path!!"); } break; - } - /* We may also have postponed startup of DSP, handle that. */ - wm8958_aif_ev(w, kcontrol, event); + case FMR_HP_MIX: + DEBUG_LOG("routing fmradio path to %s", mc->texts[path_num]); - return 0; -} + if (wm8994->fmr_mix_path != FMR_MIX_HP) { + wm8994->fmr_mix_path = FMR_MIX_HP; + wm8994_set_fmradio_headset_mix(codec); + } else { + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1, WM8994_AIF1DAC1_UNMUTE); + DEBUG_LOG("FMR_MIX_HP is already set!!! Skip path!!"); + } + break; -static int late_disable_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) -{ - struct snd_soc_codec *codec = w->codec; - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + case FMR_DUAL_MIX : + DEBUG_LOG("routing fmradio path to %s\n", mc->texts[path_num]); + wm8994->fmr_mix_path = FMR_DUAL_MIX; + wm8994_set_fmradio_speaker_headset_mix(codec); + break; - switch (event) { - case SND_SOC_DAPM_POST_PMD: - if (wm8994->aif1clk_disable) { - snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1, - WM8994_AIF1CLK_ENA_MASK, 0); - wm8994->aif1clk_disable = 0; - } - if (wm8994->aif2clk_disable) { - snd_soc_update_bits(codec, WM8994_AIF2_CLOCKING_1, - WM8994_AIF2CLK_ENA_MASK, 0); - wm8994->aif2clk_disable = 0; - } + default: + DEBUG_LOG("The audio path[%d] does not exists!!\n",path_num); + return -ENODEV; break; } return 0; } -static int aif1clk_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) +static int wm8994_get_codec_tuning(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { - struct snd_soc_codec *codec = w->codec; + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - switch (event) { - case SND_SOC_DAPM_PRE_PMU: - wm8994->aif1clk_enable = 1; - break; - case SND_SOC_DAPM_POST_PMD: - wm8994->aif1clk_disable = 1; - break; - } + DEBUG_LOG("Get testmode_config_flag = [%d]", wm8994->testmode_config_flag); + ucontrol->value.integer.value[0] = wm8994->testmode_config_flag; return 0; } -static int aif2clk_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) +static int wm8994_set_codec_tuning(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { - struct snd_soc_codec *codec = w->codec; + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - switch (event) { - case SND_SOC_DAPM_PRE_PMU: - wm8994->aif2clk_enable = 1; - break; - case SND_SOC_DAPM_POST_PMD: - wm8994->aif2clk_disable = 1; - break; - } + int control_flag = ucontrol->value.integer.value[0]; - return 0; -} + DEBUG_LOG("Set testmode_config_flag =[%d]", control_flag); -static int adc_mux_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) -{ - late_enable_ev(w, kcontrol, event); - return 0; -} + wm8994->testmode_config_flag = control_flag; -static int micbias_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) -{ - late_enable_ev(w, kcontrol, event); return 0; } -static int dac_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) +static int wm8994_get_codec_status(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { - struct snd_soc_codec *codec = w->codec; - unsigned int mask = 1 << w->shift; - - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_5, - mask, mask); return 0; } -static const char *hp_mux_text[] = { - "Mixer", - "DAC", -}; - -#define WM8994_HP_ENUM(xname, xenum) \ -{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ - .info = snd_soc_info_enum_double, \ - .get = snd_soc_dapm_get_enum_double, \ - .put = wm8994_put_hp_enum, \ - .private_value = (unsigned long)&xenum } +static void wm8994_shutdown_codec(struct snd_pcm_substream *substream, struct snd_soc_codec *codec); -static int wm8994_put_hp_enum(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) +static int wm8994_set_codec_status(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { - struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol); - struct snd_soc_dapm_widget *w = wlist->widgets[0]; - struct snd_soc_codec *codec = w->codec; - int ret; - - ret = snd_soc_dapm_put_enum_double(kcontrol, ucontrol); - - wm8994_update_class_w(codec); - - return ret; -} + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + struct snd_pcm_substream tempstream; -static const struct soc_enum hpl_enum = - SOC_ENUM_SINGLE(WM8994_OUTPUT_MIXER_1, 8, 2, hp_mux_text); + int control_data = ucontrol->value.integer.value[0]; -static const struct snd_kcontrol_new hpl_mux = - WM8994_HP_ENUM("Left Headphone Mux", hpl_enum); + DEBUG_LOG("Received control_data = [0x%X]", control_data); -static const struct soc_enum hpr_enum = - SOC_ENUM_SINGLE(WM8994_OUTPUT_MIXER_2, 8, 2, hp_mux_text); + switch (control_data) { + /* FM Radio Volume zero control */ + case CMD_FMR_INPUT_DEACTIVE: + case CMD_FMR_INPUT_ACTIVE: + if(wm8994->codec_state & FMRADIO_ACTIVE) + wm8994_set_fmradio_common(codec, control_data); + break; -static const struct snd_kcontrol_new hpr_mux = - WM8994_HP_ENUM("Right Headphone Mux", hpr_enum); + /* To remove pop up noise for FM radio */ + case CMD_FMR_FLAG_CLEAR: + DEBUG_LOG("FM Radio Flag is clear!!"); + wm8994->codec_state &= ~(FMRADIO_ACTIVE); + break; -static const char *adc_mux_text[] = { - "ADC", - "DMIC", -}; + case CMD_FMR_END: + DEBUG_LOG("Call shutdown function forcely for FM radio!!"); + wm8994->codec_state &= ~(FMRADIO_ACTIVE); + tempstream.stream = SNDRV_PCM_STREAM_PLAYBACK; + wm8994_shutdown_codec(&tempstream, codec); + break; -static const struct soc_enum adc_enum = - SOC_ENUM_SINGLE(0, 0, 2, adc_mux_text); + /* For voice recognition. */ + case CMD_RECOGNITION_DEACTIVE : + DEBUG_LOG("Recognition Gain is deactivated!!"); + wm8994->recognition_active = REC_OFF; + break; -static const struct snd_kcontrol_new adcl_mux = - SOC_DAPM_ENUM_VIRT("ADCL Mux", adc_enum); + case CMD_RECOGNITION_ACTIVE : + DEBUG_LOG("Recognition Gain is activated!!"); + wm8994->recognition_active = REC_ON; + break; -static const struct snd_kcontrol_new adcr_mux = - SOC_DAPM_ENUM_VIRT("ADCR Mux", adc_enum); + /* To remove pop up noise for Call. */ + case CMD_CALL_FLAG_CLEAR: + DEBUG_LOG("Call Flag is clear!!"); + wm8994->codec_state &= ~(CALL_ACTIVE); + break; -static const struct snd_kcontrol_new left_speaker_mixer[] = { -SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 9, 1, 0), -SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 7, 1, 0), -SOC_DAPM_SINGLE("IN1LP Switch", WM8994_SPEAKER_MIXER, 5, 1, 0), -SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 3, 1, 0), -SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 1, 1, 0), -}; + case CMD_CALL_END: + DEBUG_LOG("Call shutdown function forcely for call!!"); + wm8994->codec_state &= ~(CALL_ACTIVE); + tempstream.stream = SNDRV_PCM_STREAM_PLAYBACK; + wm8994_shutdown_codec(&tempstream, codec); + break; -static const struct snd_kcontrol_new right_speaker_mixer[] = { -SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 8, 1, 0), -SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 6, 1, 0), -SOC_DAPM_SINGLE("IN1RP Switch", WM8994_SPEAKER_MIXER, 4, 1, 0), -SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 2, 1, 0), -SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 0, 1, 0), -}; + default: + break; + } -/* Debugging; dump chip status after DAPM transitions */ -static int post_ev(struct snd_soc_dapm_widget *w, - struct snd_kcontrol *kcontrol, int event) -{ - struct snd_soc_codec *codec = w->codec; - dev_dbg(codec->dev, "SRC status: %x\n", - snd_soc_read(codec, - WM8994_RATE_STATUS)); return 0; } -static const struct snd_kcontrol_new aif1adc1l_mix[] = { -SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, - 1, 1, 0), -SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, - 0, 1, 0), -}; - -static const struct snd_kcontrol_new aif1adc1r_mix[] = { -SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING, - 1, 1, 0), -SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING, - 0, 1, 0), -}; - -static const struct snd_kcontrol_new aif1adc2l_mix[] = { -SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING, - 1, 1, 0), -SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING, - 0, 1, 0), -}; - -static const struct snd_kcontrol_new aif1adc2r_mix[] = { -SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING, - 1, 1, 0), -SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING, - 0, 1, 0), -}; - -static const struct snd_kcontrol_new aif2dac2l_mix[] = { -SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING, - 5, 1, 0), -SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING, - 4, 1, 0), -SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING, - 2, 1, 0), -SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING, - 1, 1, 0), -SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING, - 0, 1, 0), -}; - -static const struct snd_kcontrol_new aif2dac2r_mix[] = { -SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING, - 5, 1, 0), -SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING, - 4, 1, 0), -SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING, - 2, 1, 0), -SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING, - 1, 1, 0), -SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING, - 0, 1, 0), -}; - -#define WM8994_CLASS_W_SWITCH(xname, reg, shift, max, invert) \ -{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ - .info = snd_soc_info_volsw, \ - .get = snd_soc_dapm_get_volsw, .put = wm8994_put_class_w, \ - .private_value = SOC_SINGLE_VALUE(reg, shift, max, invert) } - -static int wm8994_put_class_w(struct snd_kcontrol *kcontrol, - struct snd_ctl_elem_value *ucontrol) +static int wm8994_get_voice_recording_ch(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) { - struct snd_soc_dapm_widget_list *wlist = snd_kcontrol_chip(kcontrol); - struct snd_soc_dapm_widget *w = wlist->widgets[0]; - struct snd_soc_codec *codec = w->codec; - int ret; - - ret = snd_soc_dapm_put_volsw(kcontrol, ucontrol); - - wm8994_update_class_w(codec); - - return ret; + return 0; } -static const struct snd_kcontrol_new dac1l_mix[] = { -WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING, - 5, 1, 0), -WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING, - 4, 1, 0), -WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING, - 2, 1, 0), -WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING, - 1, 1, 0), -WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING, - 0, 1, 0), -}; - -static const struct snd_kcontrol_new dac1r_mix[] = { -WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING, - 5, 1, 0), -WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING, - 4, 1, 0), -WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING, - 2, 1, 0), -WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING, - 1, 1, 0), -WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING, - 0, 1, 0), -}; - -static const char *sidetone_text[] = { - "ADC/DMIC1", "DMIC2", -}; - -static const struct soc_enum sidetone1_enum = - SOC_ENUM_SINGLE(WM8994_SIDETONE, 0, 2, sidetone_text); - -static const struct snd_kcontrol_new sidetone1_mux = - SOC_DAPM_ENUM("Left Sidetone Mux", sidetone1_enum); - -static const struct soc_enum sidetone2_enum = - SOC_ENUM_SINGLE(WM8994_SIDETONE, 1, 2, sidetone_text); - -static const struct snd_kcontrol_new sidetone2_mux = - SOC_DAPM_ENUM("Right Sidetone Mux", sidetone2_enum); - -static const char *aif1dac_text[] = { - "AIF1DACDAT", "AIF3DACDAT", -}; - -static const struct soc_enum aif1dac_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 0, 2, aif1dac_text); - -static const struct snd_kcontrol_new aif1dac_mux = - SOC_DAPM_ENUM("AIF1DAC Mux", aif1dac_enum); - -static const char *aif2dac_text[] = { - "AIF2DACDAT", "AIF3DACDAT", -}; - -static const struct soc_enum aif2dac_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 1, 2, aif2dac_text); - -static const struct snd_kcontrol_new aif2dac_mux = - SOC_DAPM_ENUM("AIF2DAC Mux", aif2dac_enum); - -static const char *aif2adc_text[] = { - "AIF2ADCDAT", "AIF3DACDAT", -}; - -static const struct soc_enum aif2adc_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 2, 2, aif2adc_text); - -static const struct snd_kcontrol_new aif2adc_mux = - SOC_DAPM_ENUM("AIF2ADC Mux", aif2adc_enum); - -static const char *aif3adc_text[] = { - "AIF1ADCDAT", "AIF2ADCDAT", "AIF2DACDAT", "Mono PCM", -}; - -static const struct soc_enum wm8994_aif3adc_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 3, 3, aif3adc_text); +static int wm8994_set_voice_recording_ch(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); -static const struct snd_kcontrol_new wm8994_aif3adc_mux = - SOC_DAPM_ENUM("AIF3ADC Mux", wm8994_aif3adc_enum); -static const struct soc_enum wm8958_aif3adc_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 3, 4, aif3adc_text); + int channel = ucontrol->value.integer.value[0]; -static const struct snd_kcontrol_new wm8958_aif3adc_mux = - SOC_DAPM_ENUM("AIF3ADC Mux", wm8958_aif3adc_enum); + wm8994 ->call_record_ch = channel; -static const char *mono_pcm_out_text[] = { - "None", "AIF2ADCL", "AIF2ADCR", -}; + DEBUG_LOG("control_data = [0x%X]", channel); -static const struct soc_enum mono_pcm_out_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 9, 3, mono_pcm_out_text); -static const struct snd_kcontrol_new mono_pcm_out_mux = - SOC_DAPM_ENUM("Mono PCM Out Mux", mono_pcm_out_enum); + switch (channel) { + case CH_OFF: + wm8994 ->call_record_path = CALL_RECORDING_OFF; + wm8994_set_voicecall_record_off(codec); + break; + case CH_UPLINK: + case CH_DOWNLINK: + case CH_UDLINK: + break; -static const char *aif2dac_src_text[] = { - "AIF2", "AIF3", -}; + default : + break; + } -/* Note that these two control shouldn't be simultaneously switched to AIF3 */ -static const struct soc_enum aif2dacl_src_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 7, 2, aif2dac_src_text); + return 0; +} -static const struct snd_kcontrol_new aif2dacl_src_mux = - SOC_DAPM_ENUM("AIF2DACL Mux", aif2dacl_src_enum); +static int wm8994_get_voice_call_recording(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + return 0; +} -static const struct soc_enum aif2dacr_src_enum = - SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 8, 2, aif2dac_src_text); +static int wm8994_set_voice_call_recording(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); -static const struct snd_kcontrol_new aif2dacr_src_mux = - SOC_DAPM_ENUM("AIF2DACR Mux", aif2dacr_src_enum); + int path_num = ucontrol->value.integer.value[0]; -static const struct snd_soc_dapm_widget wm8994_lateclk_revd_widgets[] = { -SND_SOC_DAPM_SUPPLY("AIF1CLK", SND_SOC_NOPM, 0, 0, aif1clk_ev, - SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), -SND_SOC_DAPM_SUPPLY("AIF2CLK", SND_SOC_NOPM, 0, 0, aif2clk_ev, - SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), + DEBUG_LOG("control_data = [0x%X]", path_num); -SND_SOC_DAPM_PGA_E("Late DAC1L Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0, - late_enable_ev, SND_SOC_DAPM_PRE_PMU), -SND_SOC_DAPM_PGA_E("Late DAC1R Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0, - late_enable_ev, SND_SOC_DAPM_PRE_PMU), -SND_SOC_DAPM_PGA_E("Late DAC2L Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0, - late_enable_ev, SND_SOC_DAPM_PRE_PMU), -SND_SOC_DAPM_PGA_E("Late DAC2R Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0, - late_enable_ev, SND_SOC_DAPM_PRE_PMU), + wm8994 ->call_record_path = path_num; -SND_SOC_DAPM_POST("Late Disable PGA", late_disable_ev) -}; + switch (path_num) { + case CALL_RECORDING_OFF : + break; + case CALL_RECORDING_MAIN : + case CALL_RECORDING_SUB : + wm8994_set_voicecall_record(codec, (int)wm8994 ->call_record_ch); + break; + default : + break; + } -static const struct snd_soc_dapm_widget wm8994_lateclk_widgets[] = { -SND_SOC_DAPM_SUPPLY("AIF1CLK", WM8994_AIF1_CLOCKING_1, 0, 0, NULL, 0), -SND_SOC_DAPM_SUPPLY("AIF2CLK", WM8994_AIF2_CLOCKING_1, 0, 0, NULL, 0) -}; + return 0; +} -static const struct snd_soc_dapm_widget wm8994_dac_revd_widgets[] = { -SND_SOC_DAPM_DAC_E("DAC2L", NULL, SND_SOC_NOPM, 3, 0, - dac_ev, SND_SOC_DAPM_PRE_PMU), -SND_SOC_DAPM_DAC_E("DAC2R", NULL, SND_SOC_NOPM, 2, 0, - dac_ev, SND_SOC_DAPM_PRE_PMU), -SND_SOC_DAPM_DAC_E("DAC1L", NULL, SND_SOC_NOPM, 1, 0, - dac_ev, SND_SOC_DAPM_PRE_PMU), -SND_SOC_DAPM_DAC_E("DAC1R", NULL, SND_SOC_NOPM, 0, 0, - dac_ev, SND_SOC_DAPM_PRE_PMU), -}; +void wm8994_set_off(struct snd_soc_codec *codec) +{ + DEBUG_LOG(""); + audio_power(0); +} -static const struct snd_soc_dapm_widget wm8994_dac_widgets[] = { -SND_SOC_DAPM_DAC("DAC2L", NULL, WM8994_POWER_MANAGEMENT_5, 3, 0), -SND_SOC_DAPM_DAC("DAC2R", NULL, WM8994_POWER_MANAGEMENT_5, 2, 0), -SND_SOC_DAPM_DAC("DAC1L", NULL, WM8994_POWER_MANAGEMENT_5, 1, 0), -SND_SOC_DAPM_DAC("DAC1R", NULL, WM8994_POWER_MANAGEMENT_5, 0, 0), +#define SOC_WM899X_OUTPGA_DOUBLE_R_TLV(xname, reg_left, reg_right,\ + xshift, xmax, xinvert, tlv_array) \ +{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\ + .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\ + SNDRV_CTL_ELEM_ACCESS_READWRITE,\ + .tlv.p = (tlv_array), \ + .info = snd_soc_info_volsw_2r, \ + .get = snd_soc_get_volsw_2r, .put = wm899x_outpga_put_volsw_vu, \ + .private_value = (unsigned long)&(struct soc_mixer_control) \ + {.reg = reg_left, .rreg = reg_right, .shift = xshift, \ + .max = xmax, .invert = xinvert} } + +#define SOC_WM899X_OUTPGA_SINGLE_R_TLV(xname, reg, shift, max, invert,\ + tlv_array) {\ + .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \ + .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\ + SNDRV_CTL_ELEM_ACCESS_READWRITE,\ + .tlv.p = (tlv_array), \ + .info = snd_soc_info_volsw, \ + .get = snd_soc_get_volsw, .put = wm899x_inpga_put_volsw_vu, \ + .private_value = SOC_SINGLE_VALUE(reg, shift, max, invert) } + +static const DECLARE_TLV_DB_SCALE(digital_tlv, -7162, 37, 1); +static const DECLARE_TLV_DB_LINEAR(digital_tlv_spkr, -5700, 600); +static const DECLARE_TLV_DB_LINEAR(digital_tlv_rcv, -5700, 600); +static const DECLARE_TLV_DB_LINEAR(digital_tlv_headphone, -5700, 600); +static const DECLARE_TLV_DB_LINEAR(digital_tlv_mic, -7162, 7162); + +static const struct soc_enum path_control_enum[] = { + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(playback_path), playback_path), + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(voicecall_path), voicecall_path), + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(mic_path), mic_path), + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(fmradio_path),fmradio_path), + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(codec_tuning_control), codec_tuning_control), + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(codec_status_control), codec_status_control), + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(voice_record_path), voice_record_path), + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(call_recording_channel), call_recording_channel), }; -static const struct snd_soc_dapm_widget wm8994_adc_revd_widgets[] = { -SND_SOC_DAPM_MUX_E("ADCL Mux", WM8994_POWER_MANAGEMENT_4, 1, 0, &adcl_mux, - adc_mux_ev, SND_SOC_DAPM_PRE_PMU), -SND_SOC_DAPM_MUX_E("ADCR Mux", WM8994_POWER_MANAGEMENT_4, 0, 0, &adcr_mux, - adc_mux_ev, SND_SOC_DAPM_PRE_PMU), -}; +static const struct snd_kcontrol_new wm8994_snd_controls[] = { + SOC_WM899X_OUTPGA_DOUBLE_R_TLV("Playback Volume", + WM8994_LEFT_OPGA_VOLUME, + WM8994_RIGHT_OPGA_VOLUME, 0, 0x3F, 0, + digital_tlv_rcv), + SOC_WM899X_OUTPGA_DOUBLE_R_TLV("Playback Spkr Volume", + WM8994_SPEAKER_VOLUME_LEFT, + WM8994_SPEAKER_VOLUME_RIGHT, 1, 0x3F, 0, + digital_tlv_spkr), + SOC_WM899X_OUTPGA_DOUBLE_R_TLV("Playback Headset Volume", + WM8994_LEFT_OUTPUT_VOLUME, + WM8994_RIGHT_OUTPUT_VOLUME, 1, 0x3F, 0, + digital_tlv_headphone), + SOC_WM899X_OUTPGA_SINGLE_R_TLV("Capture Volume", + WM8994_AIF1_ADC1_LEFT_VOLUME, + 0, 0xEF, 0, digital_tlv_mic), + /* Path Control */ + SOC_ENUM_EXT("Playback Path", path_control_enum[0], + wm8994_get_path, wm8994_set_path), + + SOC_ENUM_EXT("Voice Call Path", path_control_enum[1], + wm8994_get_call_path, wm8994_set_call_path), + + SOC_ENUM_EXT("Capture MIC Path", path_control_enum[2], + wm8994_get_mic_path, wm8994_set_mic_path), + + SOC_ENUM_EXT("FM Radio Path", path_control_enum[3], + wm8994_get_fmradio_path, wm8994_set_fmradio_path), + + SOC_ENUM_EXT("Codec Tuning", path_control_enum[4], + wm8994_get_codec_tuning, wm8994_set_codec_tuning), + + SOC_ENUM_EXT("Codec Status", path_control_enum[5], + wm8994_get_codec_status, wm8994_set_codec_status), + + SOC_ENUM_EXT("Voice Call Recording", path_control_enum[6], + wm8994_get_voice_call_recording, wm8994_set_voice_call_recording), + + SOC_ENUM_EXT("Recording Channel", path_control_enum[7], + wm8994_get_voice_recording_ch, wm8994_set_voice_recording_ch), -static const struct snd_soc_dapm_widget wm8994_adc_widgets[] = { -SND_SOC_DAPM_MUX("ADCL Mux", WM8994_POWER_MANAGEMENT_4, 1, 0, &adcl_mux), -SND_SOC_DAPM_MUX("ADCR Mux", WM8994_POWER_MANAGEMENT_4, 0, 0, &adcr_mux), }; +/* Add non-DAPM controls */ +static int wm8994_add_controls(struct snd_soc_codec *codec) +{ + return snd_soc_add_controls(codec, wm8994_snd_controls, + ARRAY_SIZE(wm8994_snd_controls)); +} static const struct snd_soc_dapm_widget wm8994_dapm_widgets[] = { -SND_SOC_DAPM_INPUT("DMIC1DAT"), -SND_SOC_DAPM_INPUT("DMIC2DAT"), -SND_SOC_DAPM_INPUT("Clock"), - -SND_SOC_DAPM_SUPPLY_S("MICBIAS Supply", 1, SND_SOC_NOPM, 0, 0, micbias_ev, - SND_SOC_DAPM_PRE_PMU), - -SND_SOC_DAPM_SUPPLY("CLK_SYS", SND_SOC_NOPM, 0, 0, clk_sys_event, - SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), - -SND_SOC_DAPM_SUPPLY("DSP1CLK", WM8994_CLOCKING_1, 3, 0, NULL, 0), -SND_SOC_DAPM_SUPPLY("DSP2CLK", WM8994_CLOCKING_1, 2, 0, NULL, 0), -SND_SOC_DAPM_SUPPLY("DSPINTCLK", WM8994_CLOCKING_1, 1, 0, NULL, 0), - -SND_SOC_DAPM_AIF_OUT("AIF1ADC1L", NULL, - 0, WM8994_POWER_MANAGEMENT_4, 9, 0), -SND_SOC_DAPM_AIF_OUT("AIF1ADC1R", NULL, - 0, WM8994_POWER_MANAGEMENT_4, 8, 0), -SND_SOC_DAPM_AIF_IN_E("AIF1DAC1L", NULL, 0, - WM8994_POWER_MANAGEMENT_5, 9, 0, wm8958_aif_ev, - SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), -SND_SOC_DAPM_AIF_IN_E("AIF1DAC1R", NULL, 0, - WM8994_POWER_MANAGEMENT_5, 8, 0, wm8958_aif_ev, - SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), - -SND_SOC_DAPM_AIF_OUT("AIF1ADC2L", NULL, - 0, WM8994_POWER_MANAGEMENT_4, 11, 0), -SND_SOC_DAPM_AIF_OUT("AIF1ADC2R", NULL, - 0, WM8994_POWER_MANAGEMENT_4, 10, 0), -SND_SOC_DAPM_AIF_IN_E("AIF1DAC2L", NULL, 0, - WM8994_POWER_MANAGEMENT_5, 11, 0, wm8958_aif_ev, - SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), -SND_SOC_DAPM_AIF_IN_E("AIF1DAC2R", NULL, 0, - WM8994_POWER_MANAGEMENT_5, 10, 0, wm8958_aif_ev, - SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), - -SND_SOC_DAPM_MIXER("AIF1ADC1L Mixer", SND_SOC_NOPM, 0, 0, - aif1adc1l_mix, ARRAY_SIZE(aif1adc1l_mix)), -SND_SOC_DAPM_MIXER("AIF1ADC1R Mixer", SND_SOC_NOPM, 0, 0, - aif1adc1r_mix, ARRAY_SIZE(aif1adc1r_mix)), - -SND_SOC_DAPM_MIXER("AIF1ADC2L Mixer", SND_SOC_NOPM, 0, 0, - aif1adc2l_mix, ARRAY_SIZE(aif1adc2l_mix)), -SND_SOC_DAPM_MIXER("AIF1ADC2R Mixer", SND_SOC_NOPM, 0, 0, - aif1adc2r_mix, ARRAY_SIZE(aif1adc2r_mix)), - -SND_SOC_DAPM_MIXER("AIF2DAC2L Mixer", SND_SOC_NOPM, 0, 0, - aif2dac2l_mix, ARRAY_SIZE(aif2dac2l_mix)), -SND_SOC_DAPM_MIXER("AIF2DAC2R Mixer", SND_SOC_NOPM, 0, 0, - aif2dac2r_mix, ARRAY_SIZE(aif2dac2r_mix)), - -SND_SOC_DAPM_MUX("Left Sidetone", SND_SOC_NOPM, 0, 0, &sidetone1_mux), -SND_SOC_DAPM_MUX("Right Sidetone", SND_SOC_NOPM, 0, 0, &sidetone2_mux), - -SND_SOC_DAPM_MIXER("DAC1L Mixer", SND_SOC_NOPM, 0, 0, - dac1l_mix, ARRAY_SIZE(dac1l_mix)), -SND_SOC_DAPM_MIXER("DAC1R Mixer", SND_SOC_NOPM, 0, 0, - dac1r_mix, ARRAY_SIZE(dac1r_mix)), - -SND_SOC_DAPM_AIF_OUT("AIF2ADCL", NULL, 0, - WM8994_POWER_MANAGEMENT_4, 13, 0), -SND_SOC_DAPM_AIF_OUT("AIF2ADCR", NULL, 0, - WM8994_POWER_MANAGEMENT_4, 12, 0), -SND_SOC_DAPM_AIF_IN_E("AIF2DACL", NULL, 0, - WM8994_POWER_MANAGEMENT_5, 13, 0, wm8958_aif_ev, - SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), -SND_SOC_DAPM_AIF_IN_E("AIF2DACR", NULL, 0, - WM8994_POWER_MANAGEMENT_5, 12, 0, wm8958_aif_ev, - SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), - -SND_SOC_DAPM_AIF_IN("AIF1DACDAT", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0), -SND_SOC_DAPM_AIF_IN("AIF2DACDAT", "AIF2 Playback", 0, SND_SOC_NOPM, 0, 0), -SND_SOC_DAPM_AIF_OUT("AIF1ADCDAT", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0), -SND_SOC_DAPM_AIF_OUT("AIF2ADCDAT", "AIF2 Capture", 0, SND_SOC_NOPM, 0, 0), - -SND_SOC_DAPM_MUX("AIF1DAC Mux", SND_SOC_NOPM, 0, 0, &aif1dac_mux), -SND_SOC_DAPM_MUX("AIF2DAC Mux", SND_SOC_NOPM, 0, 0, &aif2dac_mux), -SND_SOC_DAPM_MUX("AIF2ADC Mux", SND_SOC_NOPM, 0, 0, &aif2adc_mux), - -SND_SOC_DAPM_AIF_IN("AIF3DACDAT", "AIF3 Playback", 0, SND_SOC_NOPM, 0, 0), -SND_SOC_DAPM_AIF_OUT("AIF3ADCDAT", "AIF3 Capture", 0, SND_SOC_NOPM, 0, 0), - -SND_SOC_DAPM_SUPPLY("TOCLK", WM8994_CLOCKING_1, 4, 0, NULL, 0), - -SND_SOC_DAPM_ADC("DMIC2L", NULL, WM8994_POWER_MANAGEMENT_4, 5, 0), -SND_SOC_DAPM_ADC("DMIC2R", NULL, WM8994_POWER_MANAGEMENT_4, 4, 0), -SND_SOC_DAPM_ADC("DMIC1L", NULL, WM8994_POWER_MANAGEMENT_4, 3, 0), -SND_SOC_DAPM_ADC("DMIC1R", NULL, WM8994_POWER_MANAGEMENT_4, 2, 0), - -/* Power is done with the muxes since the ADC power also controls the - * downsampling chain, the chip will automatically manage the analogue - * specific portions. - */ -SND_SOC_DAPM_ADC("ADCL", NULL, SND_SOC_NOPM, 1, 0), -SND_SOC_DAPM_ADC("ADCR", NULL, SND_SOC_NOPM, 0, 0), - -SND_SOC_DAPM_MUX("Left Headphone Mux", SND_SOC_NOPM, 0, 0, &hpl_mux), -SND_SOC_DAPM_MUX("Right Headphone Mux", SND_SOC_NOPM, 0, 0, &hpr_mux), - -SND_SOC_DAPM_MIXER("SPKL", WM8994_POWER_MANAGEMENT_3, 8, 0, - left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer)), -SND_SOC_DAPM_MIXER("SPKR", WM8994_POWER_MANAGEMENT_3, 9, 0, - right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer)), - -SND_SOC_DAPM_POST("Debug log", post_ev), -}; - -static const struct snd_soc_dapm_widget wm8994_specific_dapm_widgets[] = { -SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8994_aif3adc_mux), -}; - -static const struct snd_soc_dapm_widget wm8958_dapm_widgets[] = { -SND_SOC_DAPM_MUX("Mono PCM Out Mux", SND_SOC_NOPM, 0, 0, &mono_pcm_out_mux), -SND_SOC_DAPM_MUX("AIF2DACL Mux", SND_SOC_NOPM, 0, 0, &aif2dacl_src_mux), -SND_SOC_DAPM_MUX("AIF2DACR Mux", SND_SOC_NOPM, 0, 0, &aif2dacr_src_mux), -SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8958_aif3adc_mux), -}; - -static const struct snd_soc_dapm_route intercon[] = { - { "CLK_SYS", NULL, "AIF1CLK", check_clk_sys }, - { "CLK_SYS", NULL, "AIF2CLK", check_clk_sys }, - - { "DSP1CLK", NULL, "CLK_SYS" }, - { "DSP2CLK", NULL, "CLK_SYS" }, - { "DSPINTCLK", NULL, "CLK_SYS" }, - - { "AIF1ADC1L", NULL, "AIF1CLK" }, - { "AIF1ADC1L", NULL, "DSP1CLK" }, - { "AIF1ADC1R", NULL, "AIF1CLK" }, - { "AIF1ADC1R", NULL, "DSP1CLK" }, - { "AIF1ADC1R", NULL, "DSPINTCLK" }, - - { "AIF1DAC1L", NULL, "AIF1CLK" }, - { "AIF1DAC1L", NULL, "DSP1CLK" }, - { "AIF1DAC1R", NULL, "AIF1CLK" }, - { "AIF1DAC1R", NULL, "DSP1CLK" }, - { "AIF1DAC1R", NULL, "DSPINTCLK" }, - - { "AIF1ADC2L", NULL, "AIF1CLK" }, - { "AIF1ADC2L", NULL, "DSP1CLK" }, - { "AIF1ADC2R", NULL, "AIF1CLK" }, - { "AIF1ADC2R", NULL, "DSP1CLK" }, - { "AIF1ADC2R", NULL, "DSPINTCLK" }, - - { "AIF1DAC2L", NULL, "AIF1CLK" }, - { "AIF1DAC2L", NULL, "DSP1CLK" }, - { "AIF1DAC2R", NULL, "AIF1CLK" }, - { "AIF1DAC2R", NULL, "DSP1CLK" }, - { "AIF1DAC2R", NULL, "DSPINTCLK" }, - - { "AIF2ADCL", NULL, "AIF2CLK" }, - { "AIF2ADCL", NULL, "DSP2CLK" }, - { "AIF2ADCR", NULL, "AIF2CLK" }, - { "AIF2ADCR", NULL, "DSP2CLK" }, - { "AIF2ADCR", NULL, "DSPINTCLK" }, - - { "AIF2DACL", NULL, "AIF2CLK" }, - { "AIF2DACL", NULL, "DSP2CLK" }, - { "AIF2DACR", NULL, "AIF2CLK" }, - { "AIF2DACR", NULL, "DSP2CLK" }, - { "AIF2DACR", NULL, "DSPINTCLK" }, - - { "DMIC1L", NULL, "DMIC1DAT" }, - { "DMIC1L", NULL, "CLK_SYS" }, - { "DMIC1R", NULL, "DMIC1DAT" }, - { "DMIC1R", NULL, "CLK_SYS" }, - { "DMIC2L", NULL, "DMIC2DAT" }, - { "DMIC2L", NULL, "CLK_SYS" }, - { "DMIC2R", NULL, "DMIC2DAT" }, - { "DMIC2R", NULL, "CLK_SYS" }, - - { "ADCL", NULL, "AIF1CLK" }, - { "ADCL", NULL, "DSP1CLK" }, - { "ADCL", NULL, "DSPINTCLK" }, - - { "ADCR", NULL, "AIF1CLK" }, - { "ADCR", NULL, "DSP1CLK" }, - { "ADCR", NULL, "DSPINTCLK" }, - - { "ADCL Mux", "ADC", "ADCL" }, - { "ADCL Mux", "DMIC", "DMIC1L" }, - { "ADCR Mux", "ADC", "ADCR" }, - { "ADCR Mux", "DMIC", "DMIC1R" }, - - { "DAC1L", NULL, "AIF1CLK" }, - { "DAC1L", NULL, "DSP1CLK" }, - { "DAC1L", NULL, "DSPINTCLK" }, - - { "DAC1R", NULL, "AIF1CLK" }, - { "DAC1R", NULL, "DSP1CLK" }, - { "DAC1R", NULL, "DSPINTCLK" }, - - { "DAC2L", NULL, "AIF2CLK" }, - { "DAC2L", NULL, "DSP2CLK" }, - { "DAC2L", NULL, "DSPINTCLK" }, - - { "DAC2R", NULL, "AIF2DACR" }, - { "DAC2R", NULL, "AIF2CLK" }, - { "DAC2R", NULL, "DSP2CLK" }, - { "DAC2R", NULL, "DSPINTCLK" }, - - { "TOCLK", NULL, "CLK_SYS" }, - - /* AIF1 outputs */ - { "AIF1ADC1L", NULL, "AIF1ADC1L Mixer" }, - { "AIF1ADC1L Mixer", "ADC/DMIC Switch", "ADCL Mux" }, - { "AIF1ADC1L Mixer", "AIF2 Switch", "AIF2DACL" }, - - { "AIF1ADC1R", NULL, "AIF1ADC1R Mixer" }, - { "AIF1ADC1R Mixer", "ADC/DMIC Switch", "ADCR Mux" }, - { "AIF1ADC1R Mixer", "AIF2 Switch", "AIF2DACR" }, - - { "AIF1ADC2L", NULL, "AIF1ADC2L Mixer" }, - { "AIF1ADC2L Mixer", "DMIC Switch", "DMIC2L" }, - { "AIF1ADC2L Mixer", "AIF2 Switch", "AIF2DACL" }, - - { "AIF1ADC2R", NULL, "AIF1ADC2R Mixer" }, - { "AIF1ADC2R Mixer", "DMIC Switch", "DMIC2R" }, - { "AIF1ADC2R Mixer", "AIF2 Switch", "AIF2DACR" }, - - /* Pin level routing for AIF3 */ - { "AIF1DAC1L", NULL, "AIF1DAC Mux" }, - { "AIF1DAC1R", NULL, "AIF1DAC Mux" }, - { "AIF1DAC2L", NULL, "AIF1DAC Mux" }, - { "AIF1DAC2R", NULL, "AIF1DAC Mux" }, - - { "AIF1DAC Mux", "AIF1DACDAT", "AIF1DACDAT" }, - { "AIF1DAC Mux", "AIF3DACDAT", "AIF3DACDAT" }, - { "AIF2DAC Mux", "AIF2DACDAT", "AIF2DACDAT" }, - { "AIF2DAC Mux", "AIF3DACDAT", "AIF3DACDAT" }, - { "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCL" }, - { "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCR" }, - { "AIF2ADC Mux", "AIF3DACDAT", "AIF3ADCDAT" }, - - /* DAC1 inputs */ - { "DAC1L Mixer", "AIF2 Switch", "AIF2DACL" }, - { "DAC1L Mixer", "AIF1.2 Switch", "AIF1DAC2L" }, - { "DAC1L Mixer", "AIF1.1 Switch", "AIF1DAC1L" }, - { "DAC1L Mixer", "Left Sidetone Switch", "Left Sidetone" }, - { "DAC1L Mixer", "Right Sidetone Switch", "Right Sidetone" }, - - { "DAC1R Mixer", "AIF2 Switch", "AIF2DACR" }, - { "DAC1R Mixer", "AIF1.2 Switch", "AIF1DAC2R" }, - { "DAC1R Mixer", "AIF1.1 Switch", "AIF1DAC1R" }, - { "DAC1R Mixer", "Left Sidetone Switch", "Left Sidetone" }, - { "DAC1R Mixer", "Right Sidetone Switch", "Right Sidetone" }, - - /* DAC2/AIF2 outputs */ - { "AIF2ADCL", NULL, "AIF2DAC2L Mixer" }, - { "AIF2DAC2L Mixer", "AIF2 Switch", "AIF2DACL" }, - { "AIF2DAC2L Mixer", "AIF1.2 Switch", "AIF1DAC2L" }, - { "AIF2DAC2L Mixer", "AIF1.1 Switch", "AIF1DAC1L" }, - { "AIF2DAC2L Mixer", "Left Sidetone Switch", "Left Sidetone" }, - { "AIF2DAC2L Mixer", "Right Sidetone Switch", "Right Sidetone" }, - - { "AIF2ADCR", NULL, "AIF2DAC2R Mixer" }, - { "AIF2DAC2R Mixer", "AIF2 Switch", "AIF2DACR" }, - { "AIF2DAC2R Mixer", "AIF1.2 Switch", "AIF1DAC2R" }, - { "AIF2DAC2R Mixer", "AIF1.1 Switch", "AIF1DAC1R" }, - { "AIF2DAC2R Mixer", "Left Sidetone Switch", "Left Sidetone" }, - { "AIF2DAC2R Mixer", "Right Sidetone Switch", "Right Sidetone" }, - - { "AIF1ADCDAT", NULL, "AIF1ADC1L" }, - { "AIF1ADCDAT", NULL, "AIF1ADC1R" }, - { "AIF1ADCDAT", NULL, "AIF1ADC2L" }, - { "AIF1ADCDAT", NULL, "AIF1ADC2R" }, - - { "AIF2ADCDAT", NULL, "AIF2ADC Mux" }, - - /* AIF3 output */ - { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC1L" }, - { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC1R" }, - { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC2L" }, - { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC2R" }, - { "AIF3ADCDAT", "AIF2ADCDAT", "AIF2ADCL" }, - { "AIF3ADCDAT", "AIF2ADCDAT", "AIF2ADCR" }, - { "AIF3ADCDAT", "AIF2DACDAT", "AIF2DACL" }, - { "AIF3ADCDAT", "AIF2DACDAT", "AIF2DACR" }, - - /* Sidetone */ - { "Left Sidetone", "ADC/DMIC1", "ADCL Mux" }, - { "Left Sidetone", "DMIC2", "DMIC2L" }, - { "Right Sidetone", "ADC/DMIC1", "ADCR Mux" }, - { "Right Sidetone", "DMIC2", "DMIC2R" }, - - /* Output stages */ - { "Left Output Mixer", "DAC Switch", "DAC1L" }, - { "Right Output Mixer", "DAC Switch", "DAC1R" }, - - { "SPKL", "DAC1 Switch", "DAC1L" }, - { "SPKL", "DAC2 Switch", "DAC2L" }, - - { "SPKR", "DAC1 Switch", "DAC1R" }, - { "SPKR", "DAC2 Switch", "DAC2R" }, - - { "Left Headphone Mux", "DAC", "DAC1L" }, - { "Right Headphone Mux", "DAC", "DAC1R" }, -}; - -static const struct snd_soc_dapm_route wm8994_lateclk_revd_intercon[] = { - { "DAC1L", NULL, "Late DAC1L Enable PGA" }, - { "Late DAC1L Enable PGA", NULL, "DAC1L Mixer" }, - { "DAC1R", NULL, "Late DAC1R Enable PGA" }, - { "Late DAC1R Enable PGA", NULL, "DAC1R Mixer" }, - { "DAC2L", NULL, "Late DAC2L Enable PGA" }, - { "Late DAC2L Enable PGA", NULL, "AIF2DAC2L Mixer" }, - { "DAC2R", NULL, "Late DAC2R Enable PGA" }, - { "Late DAC2R Enable PGA", NULL, "AIF2DAC2R Mixer" } -}; - -static const struct snd_soc_dapm_route wm8994_lateclk_intercon[] = { - { "DAC1L", NULL, "DAC1L Mixer" }, - { "DAC1R", NULL, "DAC1R Mixer" }, - { "DAC2L", NULL, "AIF2DAC2L Mixer" }, - { "DAC2R", NULL, "AIF2DAC2R Mixer" }, -}; - -static const struct snd_soc_dapm_route wm8994_revd_intercon[] = { - { "AIF1DACDAT", NULL, "AIF2DACDAT" }, - { "AIF2DACDAT", NULL, "AIF1DACDAT" }, - { "AIF1ADCDAT", NULL, "AIF2ADCDAT" }, - { "AIF2ADCDAT", NULL, "AIF1ADCDAT" }, - { "MICBIAS1", NULL, "CLK_SYS" }, - { "MICBIAS1", NULL, "MICBIAS Supply" }, - { "MICBIAS2", NULL, "CLK_SYS" }, - { "MICBIAS2", NULL, "MICBIAS Supply" }, -}; - -static const struct snd_soc_dapm_route wm8994_intercon[] = { - { "AIF2DACL", NULL, "AIF2DAC Mux" }, - { "AIF2DACR", NULL, "AIF2DAC Mux" }, -}; - -static const struct snd_soc_dapm_route wm8958_intercon[] = { - { "AIF2DACL", NULL, "AIF2DACL Mux" }, - { "AIF2DACR", NULL, "AIF2DACR Mux" }, - - { "AIF2DACL Mux", "AIF2", "AIF2DAC Mux" }, - { "AIF2DACL Mux", "AIF3", "AIF3DACDAT" }, - { "AIF2DACR Mux", "AIF2", "AIF2DAC Mux" }, - { "AIF2DACR Mux", "AIF3", "AIF3DACDAT" }, - - { "Mono PCM Out Mux", "AIF2ADCL", "AIF2ADCL" }, - { "Mono PCM Out Mux", "AIF2ADCR", "AIF2ADCR" }, - - { "AIF3ADC Mux", "Mono PCM", "Mono PCM Out Mux" }, }; -/* The size in bits of the FLL divide multiplied by 10 - * to allow rounding later */ -#define FIXED_FLL_SIZE ((1 << 16) * 10) - -struct fll_div { - u16 outdiv; - u16 n; - u16 k; - u16 clk_ref_div; - u16 fll_fratio; +static const struct snd_soc_dapm_route audio_map[] = { }; -static int wm8994_get_fll_config(struct fll_div *fll, - int freq_in, int freq_out) +static int wm8994_add_widgets(struct snd_soc_codec *codec) { - u64 Kpart; - unsigned int K, Ndiv, Nmod; - - pr_debug("FLL input=%dHz, output=%dHz\n", freq_in, freq_out); - - /* Scale the input frequency down to <= 13.5MHz */ - fll->clk_ref_div = 0; - while (freq_in > 13500000) { - fll->clk_ref_div++; - freq_in /= 2; - - if (fll->clk_ref_div > 3) - return -EINVAL; - } - pr_debug("CLK_REF_DIV=%d, Fref=%dHz\n", fll->clk_ref_div, freq_in); - - /* Scale the output to give 90MHz<=Fvco<=100MHz */ - fll->outdiv = 3; - while (freq_out * (fll->outdiv + 1) < 90000000) { - fll->outdiv++; - if (fll->outdiv > 63) - return -EINVAL; - } - freq_out *= fll->outdiv + 1; - pr_debug("OUTDIV=%d, Fvco=%dHz\n", fll->outdiv, freq_out); - - if (freq_in > 1000000) { - fll->fll_fratio = 0; - } else if (freq_in > 256000) { - fll->fll_fratio = 1; - freq_in *= 2; - } else if (freq_in > 128000) { - fll->fll_fratio = 2; - freq_in *= 4; - } else if (freq_in > 64000) { - fll->fll_fratio = 3; - freq_in *= 8; - } else { - fll->fll_fratio = 4; - freq_in *= 16; - } - pr_debug("FLL_FRATIO=%d, Fref=%dHz\n", fll->fll_fratio, freq_in); - - /* Now, calculate N.K */ - Ndiv = freq_out / freq_in; - - fll->n = Ndiv; - Nmod = freq_out % freq_in; - pr_debug("Nmod=%d\n", Nmod); - - /* Calculate fractional part - scale up so we can round. */ - Kpart = FIXED_FLL_SIZE * (long long)Nmod; - - do_div(Kpart, freq_in); - - K = Kpart & 0xFFFFFFFF; + snd_soc_dapm_new_controls(&codec->dapm, wm8994_dapm_widgets, + ARRAY_SIZE(wm8994_dapm_widgets)); - if ((K % 10) >= 5) - K += 5; - - /* Move down to proper range now rounding is done */ - fll->k = K / 10; - - pr_debug("N=%x K=%x\n", fll->n, fll->k); + snd_soc_dapm_add_routes(&codec->dapm, audio_map, ARRAY_SIZE(audio_map)); + snd_soc_dapm_new_widgets(&codec->dapm); return 0; } -static int _wm8994_set_fll(struct snd_soc_codec *codec, int id, int src, - unsigned int freq_in, unsigned int freq_out) +static int configure_clock(struct snd_soc_codec *codec) { struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int reg_offset, ret; - struct fll_div fll; - u16 reg, aif1, aif2; + unsigned int reg; - aif1 = snd_soc_read(codec, WM8994_AIF1_CLOCKING_1) - & WM8994_AIF1CLK_ENA; + DEBUG_LOG(""); - aif2 = snd_soc_read(codec, WM8994_AIF2_CLOCKING_1) - & WM8994_AIF2CLK_ENA; - - switch (id) { - case WM8994_FLL1: - reg_offset = 0; - id = 0; - break; - case WM8994_FLL2: - reg_offset = 0x20; - id = 1; - break; - default: - return -EINVAL; + if (wm8994->codec_state != DEACTIVE) { + DEBUG_LOG("Codec is already actvied. Skip clock setting."); + return 0; } - switch (src) { - case 0: - /* Allow no source specification when stopping */ - if (freq_out) - return -EINVAL; - src = wm8994->fll[id].src; - break; - case WM8994_FLL_SRC_MCLK1: - case WM8994_FLL_SRC_MCLK2: - case WM8994_FLL_SRC_LRCLK: - case WM8994_FLL_SRC_BCLK: - break; - default: - return -EINVAL; - } + reg = wm8994_read(codec, WM8994_AIF1_CLOCKING_1); + reg &= ~WM8994_AIF1CLK_ENA; + reg &= ~WM8994_AIF1CLK_SRC_MASK; + wm8994_write(codec, WM8994_AIF1_CLOCKING_1, reg); - /* Are we changing anything? */ - if (wm8994->fll[id].src == src && - wm8994->fll[id].in == freq_in && wm8994->fll[id].out == freq_out) - return 0; + switch (wm8994->sysclk_source) { + case WM8994_SYSCLK_MCLK: + dev_dbg(codec->dev, "Using %dHz MCLK\n", wm8994->mclk_rate); - /* If we're stopping the FLL redo the old config - no - * registers will actually be written but we avoid GCC flow - * analysis bugs spewing warnings. - */ - if (freq_out) - ret = wm8994_get_fll_config(&fll, freq_in, freq_out); - else - ret = wm8994_get_fll_config(&fll, wm8994->fll[id].in, - wm8994->fll[id].out); - if (ret < 0) - return ret; - - /* Gate the AIF clocks while we reclock */ - snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1, - WM8994_AIF1CLK_ENA, 0); - snd_soc_update_bits(codec, WM8994_AIF2_CLOCKING_1, - WM8994_AIF2CLK_ENA, 0); - - /* We always need to disable the FLL while reconfiguring */ - snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_1 + reg_offset, - WM8994_FLL1_ENA, 0); - - reg = (fll.outdiv << WM8994_FLL1_OUTDIV_SHIFT) | - (fll.fll_fratio << WM8994_FLL1_FRATIO_SHIFT); - snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_2 + reg_offset, - WM8994_FLL1_OUTDIV_MASK | - WM8994_FLL1_FRATIO_MASK, reg); - - snd_soc_write(codec, WM8994_FLL1_CONTROL_3 + reg_offset, fll.k); - - snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_4 + reg_offset, - WM8994_FLL1_N_MASK, - fll.n << WM8994_FLL1_N_SHIFT); - - snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_5 + reg_offset, - WM8994_FLL1_REFCLK_DIV_MASK | - WM8994_FLL1_REFCLK_SRC_MASK, - (fll.clk_ref_div << WM8994_FLL1_REFCLK_DIV_SHIFT) | - (src - 1)); - - /* Enable (with fractional mode if required) */ - if (freq_out) { - if (fll.k) - reg = WM8994_FLL1_ENA | WM8994_FLL1_FRAC; - else - reg = WM8994_FLL1_ENA; - snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_1 + reg_offset, - WM8994_FLL1_ENA | WM8994_FLL1_FRAC, - reg); - - msleep(5); - } - - wm8994->fll[id].in = freq_in; - wm8994->fll[id].out = freq_out; - wm8994->fll[id].src = src; + reg = wm8994_read(codec, WM8994_AIF1_CLOCKING_1); + reg &= ~WM8994_AIF1CLK_ENA; + wm8994_write(codec, WM8994_AIF1_CLOCKING_1, reg); - /* Enable any gated AIF clocks */ - snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1, - WM8994_AIF1CLK_ENA, aif1); - snd_soc_update_bits(codec, WM8994_AIF2_CLOCKING_1, - WM8994_AIF2CLK_ENA, aif2); + reg = wm8994_read(codec, WM8994_AIF1_CLOCKING_1); + reg &= 0x07; - configure_clock(codec); + if (wm8994->mclk_rate > 13500000) { + reg |= WM8994_AIF1CLK_DIV; + wm8994->sysclk_rate = wm8994->mclk_rate / 2; + } else { + reg &= ~WM8994_AIF1CLK_DIV; + wm8994->sysclk_rate = wm8994->mclk_rate; + } + reg |= WM8994_AIF1CLK_ENA; + wm8994_write(codec, WM8994_AIF1_CLOCKING_1, reg); + + /* Enable clocks to the Audio core and sysclk of wm8994 */ + reg = wm8994_read(codec, WM8994_CLOCKING_1); + reg &= ~(WM8994_SYSCLK_SRC_MASK | WM8994_DSP_FSINTCLK_ENA_MASK + | WM8994_DSP_FS1CLK_ENA_MASK); + reg |= (WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, reg); + break; + + case WM8994_SYSCLK_FLL: + switch (wm8994->fs) { + case 8000: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x2F00); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0x3126); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x0105); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; - return 0; -} + case 11025: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x1F00); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0x86C2); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x00E5); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; + case 12000: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x1F00); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0x3126); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x0105); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; -static int opclk_divs[] = { 10, 20, 30, 40, 55, 60, 80, 120, 160 }; + case 16000: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x1900); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0xE23E); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x0105); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; -static int wm8994_set_fll(struct snd_soc_dai *dai, int id, int src, - unsigned int freq_in, unsigned int freq_out) -{ - return _wm8994_set_fll(dai->codec, id, src, freq_in, freq_out); -} + case 22050: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x0F00); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0x86C2); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x00E5); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; -static int wm8994_set_dai_sysclk(struct snd_soc_dai *dai, - int clk_id, unsigned int freq, int dir) -{ - struct snd_soc_codec *codec = dai->codec; - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int i; + case 24000: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x0F00); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0x3126); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x0105); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; - switch (dai->id) { - case 1: - case 2: - break; + case 32000: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x0C00); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0xE23E); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x0105); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; - default: - /* AIF3 shares clocking with AIF1/2 */ - return -EINVAL; - } + case 44100: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x0700); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0x86C2); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x00E5); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; - switch (clk_id) { - case WM8994_SYSCLK_MCLK1: - wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK1; - wm8994->mclk[0] = freq; - dev_dbg(dai->dev, "AIF%d using MCLK1 at %uHz\n", - dai->id, freq); - break; + case 48000: + wm8994_write(codec, WM8994_FLL1_CONTROL_2, 0x0700); + wm8994_write(codec, WM8994_FLL1_CONTROL_3, 0x3126); + wm8994_write(codec, WM8994_FLL1_CONTROL_5, 0x0C88); + wm8994_write(codec, WM8994_FLL1_CONTROL_4, 0x0105); + wm8994_write(codec, WM8994_FLL1_CONTROL_1, + WM8994_FLL1_FRACN_ENA | WM8994_FLL1_ENA); + break; - case WM8994_SYSCLK_MCLK2: - /* TODO: Set GPIO AF */ - wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK2; - wm8994->mclk[1] = freq; - dev_dbg(dai->dev, "AIF%d using MCLK2 at %uHz\n", - dai->id, freq); - break; + default: + DEBUG_LOG_ERR("Unsupported Frequency\n"); + break; + } - case WM8994_SYSCLK_FLL1: - wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL1; - dev_dbg(dai->dev, "AIF%d using FLL1\n", dai->id); - break; + reg = wm8994_read(codec, WM8994_AIF1_CLOCKING_1); + reg |= WM8994_AIF1CLK_ENA; + reg |= WM8994_AIF1CLK_SRC_FLL1; + wm8994_write(codec, WM8994_AIF1_CLOCKING_1, reg); - case WM8994_SYSCLK_FLL2: - wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL2; - dev_dbg(dai->dev, "AIF%d using FLL2\n", dai->id); + /* Enable clocks to the Audio core and sysclk of wm8994*/ + reg = wm8994_read(codec, WM8994_CLOCKING_1); + reg &= ~(WM8994_SYSCLK_SRC_MASK | WM8994_DSP_FSINTCLK_ENA_MASK | + WM8994_DSP_FS1CLK_ENA_MASK); + reg |= (WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, reg); break; - case WM8994_SYSCLK_OPCLK: - /* Special case - a division (times 10) is given and - * no effect on main clocking. - */ - if (freq) { - for (i = 0; i < ARRAY_SIZE(opclk_divs); i++) - if (opclk_divs[i] == freq) - break; - if (i == ARRAY_SIZE(opclk_divs)) - return -EINVAL; - snd_soc_update_bits(codec, WM8994_CLOCKING_2, - WM8994_OPCLK_DIV_MASK, i); - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_2, - WM8994_OPCLK_ENA, WM8994_OPCLK_ENA); - } else { - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_2, - WM8994_OPCLK_ENA, 0); - } - default: + dev_err(codec->dev, "System clock not configured\n"); return -EINVAL; } - configure_clock(codec); + dev_dbg(codec->dev, "CLK_SYS is %dHz\n", wm8994->sysclk_rate); return 0; } -static int wm8994_set_bias_level(struct snd_soc_codec *codec, - enum snd_soc_bias_level level) +static int wm8994_set_sysclk(struct snd_soc_dai *codec_dai, + int clk_id, unsigned int freq, int dir) { - struct wm8994 *control = codec->control_data; + struct snd_soc_codec *codec = codec_dai->codec; struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - switch (level) { - case SND_SOC_BIAS_ON: - break; + DEBUG_LOG("clk_id =%d ", clk_id); - case SND_SOC_BIAS_PREPARE: - /* VMID=2x40k */ - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1, - WM8994_VMID_SEL_MASK, 0x2); + switch (clk_id) { + case WM8994_SYSCLK_MCLK: + wm8994->mclk_rate = freq; + wm8994->sysclk_source = clk_id; break; - - case SND_SOC_BIAS_STANDBY: - if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) { - pm_runtime_get_sync(codec->dev); - - switch (control->type) { - case WM8994: - if (wm8994->revision < 4) { - /* Tweak DC servo and DSP - * configuration for improved - * performance. */ - snd_soc_write(codec, 0x102, 0x3); - snd_soc_write(codec, 0x56, 0x3); - snd_soc_write(codec, 0x817, 0); - snd_soc_write(codec, 0x102, 0); - } - break; - - case WM8958: - if (wm8994->revision == 0) { - /* Optimise performance for rev A */ - snd_soc_write(codec, 0x102, 0x3); - snd_soc_write(codec, 0xcb, 0x81); - snd_soc_write(codec, 0x817, 0); - snd_soc_write(codec, 0x102, 0); - - snd_soc_update_bits(codec, - WM8958_CHARGE_PUMP_2, - WM8958_CP_DISCH, - WM8958_CP_DISCH); - } - break; - } - - /* Discharge LINEOUT1 & 2 */ - snd_soc_update_bits(codec, WM8994_ANTIPOP_1, - WM8994_LINEOUT1_DISCH | - WM8994_LINEOUT2_DISCH, - WM8994_LINEOUT1_DISCH | - WM8994_LINEOUT2_DISCH); - - /* Startup bias, VMID ramp & buffer */ - snd_soc_update_bits(codec, WM8994_ANTIPOP_2, - WM8994_STARTUP_BIAS_ENA | - WM8994_VMID_BUF_ENA | - WM8994_VMID_RAMP_MASK, - WM8994_STARTUP_BIAS_ENA | - WM8994_VMID_BUF_ENA | - (0x11 << WM8994_VMID_RAMP_SHIFT)); - - /* Main bias enable, VMID=2x40k */ - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1, - WM8994_BIAS_ENA | - WM8994_VMID_SEL_MASK, - WM8994_BIAS_ENA | 0x2); - - msleep(20); - } - - /* VMID=2x500k */ - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1, - WM8994_VMID_SEL_MASK, 0x4); - + case WM8994_SYSCLK_FLL: + wm8994->sysclk_rate = freq; + wm8994->sysclk_source = clk_id; break; - case SND_SOC_BIAS_OFF: - if (codec->dapm.bias_level == SND_SOC_BIAS_STANDBY) { - /* Switch over to startup biases */ - snd_soc_update_bits(codec, WM8994_ANTIPOP_2, - WM8994_BIAS_SRC | - WM8994_STARTUP_BIAS_ENA | - WM8994_VMID_BUF_ENA | - WM8994_VMID_RAMP_MASK, - WM8994_BIAS_SRC | - WM8994_STARTUP_BIAS_ENA | - WM8994_VMID_BUF_ENA | - (1 << WM8994_VMID_RAMP_SHIFT)); - - /* Disable main biases */ - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1, - WM8994_BIAS_ENA | - WM8994_VMID_SEL_MASK, 0); - - /* Discharge line */ - snd_soc_update_bits(codec, WM8994_ANTIPOP_1, - WM8994_LINEOUT1_DISCH | - WM8994_LINEOUT2_DISCH, - WM8994_LINEOUT1_DISCH | - WM8994_LINEOUT2_DISCH); - - msleep(5); - - /* Switch off startup biases */ - snd_soc_update_bits(codec, WM8994_ANTIPOP_2, - WM8994_BIAS_SRC | - WM8994_STARTUP_BIAS_ENA | - WM8994_VMID_BUF_ENA | - WM8994_VMID_RAMP_MASK, 0); - - wm8994->cur_fw = NULL; - - pm_runtime_put(codec->dev); - } - break; + default: + return -EINVAL; } - codec->dapm.bias_level = level; + return 0; } static int wm8994_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt) { struct snd_soc_codec *codec = dai->codec; - struct wm8994 *control = codec->control_data; - int ms_reg; - int aif1_reg; - int ms = 0; - int aif1 = 0; + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - switch (dai->id) { - case 1: - ms_reg = WM8994_AIF1_MASTER_SLAVE; - aif1_reg = WM8994_AIF1_CONTROL_1; - break; - case 2: - ms_reg = WM8994_AIF2_MASTER_SLAVE; - aif1_reg = WM8994_AIF2_CONTROL_1; - break; - default: - return -EINVAL; - } + unsigned int aif1 = wm8994_read(codec, WM8994_AIF1_CONTROL_1); + unsigned int aif2 = wm8994_read(codec, WM8994_AIF1_MASTER_SLAVE); + + DEBUG_LOG(""); + + aif1 &= ~(WM8994_AIF1_LRCLK_INV | WM8994_AIF1_BCLK_INV | + WM8994_AIF1_WL_MASK | WM8994_AIF1_FMT_MASK); + + aif2 &= ~(WM8994_AIF1_LRCLK_FRC_MASK | + WM8994_AIF1_CLK_FRC | WM8994_AIF1_MSTR); switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { case SND_SOC_DAIFMT_CBS_CFS: + wm8994->master = 0; + break; + case SND_SOC_DAIFMT_CBS_CFM: + aif2 |= (WM8994_AIF1_MSTR | WM8994_AIF1_LRCLK_FRC); + wm8994->master = 1; + break; + case SND_SOC_DAIFMT_CBM_CFS: + aif2 |= (WM8994_AIF1_MSTR | WM8994_AIF1_CLK_FRC); + wm8994->master = 1; break; case SND_SOC_DAIFMT_CBM_CFM: - ms = WM8994_AIF1_MSTR; + aif2 |= (WM8994_AIF1_MSTR | WM8994_AIF1_CLK_FRC | + WM8994_AIF1_LRCLK_FRC); + wm8994->master = 1; break; default: return -EINVAL; @@ -1990,7 +1067,6 @@ static int wm8994_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt) switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { case SND_SOC_DAIFMT_DSP_A: case SND_SOC_DAIFMT_DSP_B: - /* frame inversion not valid for DSP modes */ switch (fmt & SND_SOC_DAIFMT_INV_MASK) { case SND_SOC_DAIFMT_NB_NF: break; @@ -2025,254 +1101,156 @@ static int wm8994_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt) return -EINVAL; } - /* The AIF2 format configuration needs to be mirrored to AIF3 - * on WM8958 if it's in use so just do it all the time. */ - if (control->type == WM8958 && dai->id == 2) - snd_soc_update_bits(codec, WM8958_AIF3_CONTROL_1, - WM8994_AIF1_LRCLK_INV | - WM8958_AIF3_FMT_MASK, aif1); - - snd_soc_update_bits(codec, aif1_reg, - WM8994_AIF1_BCLK_INV | WM8994_AIF1_LRCLK_INV | - WM8994_AIF1_FMT_MASK, - aif1); - snd_soc_update_bits(codec, ms_reg, WM8994_AIF1_MSTR, - ms); + aif1 |= 0x4000; + wm8994_write(codec, WM8994_AIF1_CONTROL_1, aif1); + wm8994_write(codec, WM8994_AIF1_MASTER_SLAVE, aif2); + wm8994_write(codec, WM8994_AIF1_CONTROL_2, 0x4000); return 0; } -static struct { - int val, rate; -} srs[] = { - { 0, 8000 }, - { 1, 11025 }, - { 2, 12000 }, - { 3, 16000 }, - { 4, 22050 }, - { 5, 24000 }, - { 6, 32000 }, - { 7, 44100 }, - { 8, 48000 }, - { 9, 88200 }, - { 10, 96000 }, -}; - -static int fs_ratios[] = { - 64, 128, 192, 256, 348, 512, 768, 1024, 1408, 1536 -}; - -static int bclk_divs[] = { - 10, 15, 20, 30, 40, 50, 60, 80, 110, 120, 160, 220, 240, 320, 440, 480, - 640, 880, 960, 1280, 1760, 1920 -}; - static int wm8994_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) { struct snd_soc_codec *codec = dai->codec; - struct wm8994 *control = codec->control_data; struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int aif1_reg; - int aif2_reg; - int bclk_reg; - int lrclk_reg; - int rate_reg; - int aif1 = 0; - int aif2 = 0; - int bclk = 0; - int lrclk = 0; - int rate_val = 0; - int id = dai->id - 1; - - int i, cur_val, best_val, bclk_rate, best; - - switch (dai->id) { - case 1: - aif1_reg = WM8994_AIF1_CONTROL_1; - aif2_reg = WM8994_AIF1_CONTROL_2; - bclk_reg = WM8994_AIF1_BCLK; - rate_reg = WM8994_AIF1_RATE; - if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK || - wm8994->lrclk_shared[0]) { - lrclk_reg = WM8994_AIF1DAC_LRCLK; - } else { - lrclk_reg = WM8994_AIF1ADC_LRCLK; - dev_dbg(codec->dev, "AIF1 using split LRCLK\n"); - } - break; - case 2: - aif1_reg = WM8994_AIF2_CONTROL_1; - aif2_reg = WM8994_AIF2_CONTROL_2; - bclk_reg = WM8994_AIF2_BCLK; - rate_reg = WM8994_AIF2_RATE; - if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK || - wm8994->lrclk_shared[1]) { - lrclk_reg = WM8994_AIF2DAC_LRCLK; - } else { - lrclk_reg = WM8994_AIF2ADC_LRCLK; - dev_dbg(codec->dev, "AIF2 using split LRCLK\n"); - } - break; - case 3: - switch (control->type) { - case WM8958: - aif1_reg = WM8958_AIF3_CONTROL_1; - break; - default: - return 0; - } - default: - return -EINVAL; - } + int ret, i, best, best_val, cur_val; + unsigned int clocking1, clocking3, aif1, aif4, aif5; + + DEBUG_LOG(""); + + clocking1 = wm8994_read(codec, WM8994_AIF1_BCLK); + clocking1 &= ~WM8994_AIF1_BCLK_DIV_MASK; + + clocking3 = wm8994_read(codec, WM8994_AIF1_RATE); + clocking3 &= ~(WM8994_AIF1_SR_MASK | WM8994_AIF1CLK_RATE_MASK); + + aif1 = wm8994_read(codec, WM8994_AIF1_CONTROL_1); + aif1 &= ~WM8994_AIF1_WL_MASK; + aif4 = wm8994_read(codec, WM8994_AIF1ADC_LRCLK); + aif4 &= ~WM8994_AIF1ADC_LRCLK_DIR; + aif5 = wm8994_read(codec, WM8994_AIF1DAC_LRCLK); + aif5 &= ~WM8994_AIF1DAC_LRCLK_DIR_MASK; + + wm8994->fs = params_rate(params); + wm8994->bclk = 2 * wm8994->fs; - bclk_rate = params_rate(params) * 4; switch (params_format(params)) { case SNDRV_PCM_FORMAT_S16_LE: - bclk_rate *= 16; + wm8994->bclk *= 16; break; + case SNDRV_PCM_FORMAT_S20_3LE: - bclk_rate *= 20; - aif1 |= 0x20; + wm8994->bclk *= 20; + aif1 |= (0x01 << WM8994_AIF1_WL_SHIFT); break; + case SNDRV_PCM_FORMAT_S24_LE: - bclk_rate *= 24; - aif1 |= 0x40; + wm8994->bclk *= 24; + aif1 |= (0x10 << WM8994_AIF1_WL_SHIFT); break; + case SNDRV_PCM_FORMAT_S32_LE: - bclk_rate *= 32; - aif1 |= 0x60; + wm8994->bclk *= 32; + aif1 |= (0x11 << WM8994_AIF1_WL_SHIFT); break; + default: return -EINVAL; } - /* Try to find an appropriate sample rate; look for an exact match. */ - for (i = 0; i < ARRAY_SIZE(srs); i++) - if (srs[i].rate == params_rate(params)) - break; - if (i == ARRAY_SIZE(srs)) - return -EINVAL; - rate_val |= srs[i].val << WM8994_AIF1_SR_SHIFT; + ret = configure_clock(codec); + if (ret != 0) + return ret; - dev_dbg(dai->dev, "Sample rate is %dHz\n", srs[i].rate); - dev_dbg(dai->dev, "AIF%dCLK is %dHz, target BCLK %dHz\n", - dai->id, wm8994->aifclk[id], bclk_rate); + dev_dbg(codec->dev, "Target BCLK is %dHz\n", wm8994->bclk); - if (params_channels(params) == 1 && - (snd_soc_read(codec, aif1_reg) & 0x18) == 0x18) - aif2 |= WM8994_AIF1_MONO; + /* Select nearest CLK_SYS_RATE */ + if (wm8994->fs == 8000) + best = 3; + else { + best = 0; + best_val = abs((wm8994->sysclk_rate / clk_sys_rates[0].ratio) + - wm8994->fs); - if (wm8994->aifclk[id] == 0) { - dev_err(dai->dev, "AIF%dCLK not configured\n", dai->id); - return -EINVAL; + for (i = 1; i < ARRAY_SIZE(clk_sys_rates); i++) { + cur_val = abs((wm8994->sysclk_rate / + clk_sys_rates[i].ratio) - wm8994->fs); + + if (cur_val < best_val) { + best = i; + best_val = cur_val; + } + } + dev_dbg(codec->dev, "Selected CLK_SYS_RATIO of %d\n", + clk_sys_rates[best].ratio); } - /* AIFCLK/fs ratio; look for a close match in either direction */ + clocking3 |= (clk_sys_rates[best].clk_sys_rate + << WM8994_AIF1CLK_RATE_SHIFT); + + /* Sampling rate */ best = 0; - best_val = abs((fs_ratios[0] * params_rate(params)) - - wm8994->aifclk[id]); - for (i = 1; i < ARRAY_SIZE(fs_ratios); i++) { - cur_val = abs((fs_ratios[i] * params_rate(params)) - - wm8994->aifclk[id]); - if (cur_val >= best_val) - continue; - best = i; - best_val = cur_val; + best_val = abs(wm8994->fs - sample_rates[0].rate); + for (i = 1; i < ARRAY_SIZE(sample_rates); i++) { + cur_val = abs(wm8994->fs - sample_rates[i].rate); + if (cur_val < best_val) { + best = i; + best_val = cur_val; + } } - dev_dbg(dai->dev, "Selected AIF%dCLK/fs = %d\n", - dai->id, fs_ratios[best]); - rate_val |= best; - - /* We may not get quite the right frequency if using - * approximate clocks so look for the closest match that is - * higher than the target (we need to ensure that there enough - * BCLKs to clock out the samples). - */ + dev_dbg(codec->dev, "Selected SAMPLE_RATE of %dHz\n", + sample_rates[best].rate); + + clocking3 |= (sample_rates[best].sample_rate << WM8994_AIF1_SR_SHIFT); + + /* BCLK_DIV */ best = 0; + best_val = INT_MAX; for (i = 0; i < ARRAY_SIZE(bclk_divs); i++) { - cur_val = (wm8994->aifclk[id] * 10 / bclk_divs[i]) - bclk_rate; - if (cur_val < 0) /* BCLK table is sorted */ - break; - best = i; - } - bclk_rate = wm8994->aifclk[id] * 10 / bclk_divs[best]; - dev_dbg(dai->dev, "Using BCLK_DIV %d for actual BCLK %dHz\n", - bclk_divs[best], bclk_rate); - bclk |= best << WM8994_AIF1_BCLK_DIV_SHIFT; - - lrclk = bclk_rate / params_rate(params); - dev_dbg(dai->dev, "Using LRCLK rate %d for actual LRCLK %dHz\n", - lrclk, bclk_rate / lrclk); - - snd_soc_update_bits(codec, aif1_reg, WM8994_AIF1_WL_MASK, aif1); - snd_soc_update_bits(codec, aif2_reg, WM8994_AIF1_MONO, aif2); - snd_soc_update_bits(codec, bclk_reg, WM8994_AIF1_BCLK_DIV_MASK, bclk); - snd_soc_update_bits(codec, lrclk_reg, WM8994_AIF1DAC_RATE_MASK, - lrclk); - snd_soc_update_bits(codec, rate_reg, WM8994_AIF1_SR_MASK | - WM8994_AIF1CLK_RATE_MASK, rate_val); - - if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { - switch (dai->id) { - case 1: - wm8994->dac_rates[0] = params_rate(params); - wm8994_set_retune_mobile(codec, 0); - wm8994_set_retune_mobile(codec, 1); - break; - case 2: - wm8994->dac_rates[1] = params_rate(params); - wm8994_set_retune_mobile(codec, 2); + cur_val = ((wm8994->sysclk_rate) / bclk_divs[i].div) + - wm8994->bclk; + if (cur_val < 0) break; + if (cur_val < best_val) { + best = i; + best_val = cur_val; } } + wm8994->bclk = (wm8994->sysclk_rate) / bclk_divs[best].div; - return 0; -} + dev_dbg(codec->dev, "Selected BCLK_DIV of %d for %dHz BCLK\n", + bclk_divs[best].div, wm8994->bclk); -static int wm8994_aif3_hw_params(struct snd_pcm_substream *substream, - struct snd_pcm_hw_params *params, - struct snd_soc_dai *dai) -{ - struct snd_soc_codec *codec = dai->codec; - struct wm8994 *control = codec->control_data; - int aif1_reg; - int aif1 = 0; + clocking1 |= bclk_divs[best].bclk_div << WM8994_AIF1_BCLK_DIV_SHIFT; - switch (dai->id) { - case 3: - switch (control->type) { - case WM8958: - aif1_reg = WM8958_AIF3_CONTROL_1; - break; - default: - return 0; - } - default: - return 0; - } + /* LRCLK is a simple fraction of BCLK */ + dev_dbg(codec->dev, "LRCLK_RATE is %d\n", wm8994->bclk / wm8994->fs); - switch (params_format(params)) { - case SNDRV_PCM_FORMAT_S16_LE: - break; - case SNDRV_PCM_FORMAT_S20_3LE: - aif1 |= 0x20; - break; - case SNDRV_PCM_FORMAT_S24_LE: - aif1 |= 0x40; - break; - case SNDRV_PCM_FORMAT_S32_LE: - aif1 |= 0x60; - break; - default: - return -EINVAL; - } + aif4 |= wm8994->bclk / wm8994->fs; + aif5 |= wm8994->bclk / wm8994->fs; + +#ifdef HDMI_USE_AUDIO + /* set bclk to 32fs for 44.1kHz 16 bit playback.*/ + if (wm8994->fs == 44100) + wm8994_write(codec, WM8994_AIF1_BCLK, 0x70); +#endif + +//TODO...we need to set proper BCLK & LRCLK to support different frequency songs..In modifying +//BCLK & LRCLK , its giving noisy and improper frequency sound..this has to be checked +#ifndef CONFIG_SND_S5P_WM8994_MASTER + //wm8994_write(codec,WM8994_AIF1_BCLK, clocking1); + //wm8994_write(codec,WM8994_AIF1ADC_LRCLK, aif4); + //wm8994_write(codec,WM8994_AIF1DAC_LRCLK, aif5); +#endif + wm8994_write(codec, WM8994_AIF1_RATE, clocking3); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, aif1); - return snd_soc_update_bits(codec, aif1_reg, WM8994_AIF1_WL_MASK, aif1); + return 0; } -static int wm8994_aif_mute(struct snd_soc_dai *codec_dai, int mute) +static int wm8994_digital_mute(struct snd_soc_dai *codec_dai, int mute) { struct snd_soc_codec *codec = codec_dai->codec; int mute_reg; @@ -2299,904 +1277,374 @@ static int wm8994_aif_mute(struct snd_soc_dai *codec_dai, int mute) return 0; } -static int wm8994_set_tristate(struct snd_soc_dai *codec_dai, int tristate) +static int wm8994_startup(struct snd_pcm_substream *substream, + struct snd_soc_dai *codec_dai) { struct snd_soc_codec *codec = codec_dai->codec; - int reg, val, mask; - - switch (codec_dai->id) { - case 1: - reg = WM8994_AIF1_MASTER_SLAVE; - mask = WM8994_AIF1_TRI; - break; - case 2: - reg = WM8994_AIF2_MASTER_SLAVE; - mask = WM8994_AIF2_TRI; - break; - case 3: - reg = WM8994_POWER_MANAGEMENT_6; - mask = WM8994_AIF3_TRI; - break; - default: - return -EINVAL; - } + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - if (tristate) - val = mask; + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) + wm8994->stream_state |= PCM_STREAM_PLAYBACK; else - val = 0; + wm8994->stream_state |= PCM_STREAM_CAPTURE; + + + if (wm8994->power_state == CODEC_OFF) { + if (!get_audio_power_status()) { + DEBUG_LOG("Power on codec"); + audio_power(1); + } + + wm8994->power_state = CODEC_ON; + DEBUG_LOG("Turn on codec!! Power state =[%d]", + wm8994->power_state); - return snd_soc_update_bits(codec, reg, mask, val); + /* For initialize codec */ + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, + 0x3 << WM8994_VMID_SEL_SHIFT | WM8994_BIAS_ENA); + msleep(50); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, + WM8994_VMID_SEL_NORMAL | WM8994_BIAS_ENA); + wm8994_write(codec, WM8994_OVERSAMPLING, 0x0001); + } else + DEBUG_LOG("Already turned on codec!!"); + + return 0; } -#define WM8994_RATES SNDRV_PCM_RATE_8000_96000 +static void wm8994_shutdown(struct snd_pcm_substream *substream, + struct snd_soc_dai *codec_dai) +{ + wm8994_shutdown_codec(substream, codec_dai->codec); +} -#define WM8994_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ - SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) +static void wm8994_shutdown_codec(struct snd_pcm_substream *substream, + struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); -static struct snd_soc_dai_ops wm8994_aif1_dai_ops = { - .set_sysclk = wm8994_set_dai_sysclk, - .set_fmt = wm8994_set_dai_fmt, - .hw_params = wm8994_hw_params, - .digital_mute = wm8994_aif_mute, - .set_pll = wm8994_set_fll, - .set_tristate = wm8994_set_tristate, -}; + if (wm8994->testmode_config_flag == SEC_TEST_HWCODEC) { + DEBUG_LOG_ERR("SEC_TEST_HWCODEC is activated!! Don't shutdown(reset) sequence!!"); + return; + } -static struct snd_soc_dai_ops wm8994_aif2_dai_ops = { - .set_sysclk = wm8994_set_dai_sysclk, - .set_fmt = wm8994_set_dai_fmt, - .hw_params = wm8994_hw_params, - .digital_mute = wm8994_aif_mute, - .set_pll = wm8994_set_fll, - .set_tristate = wm8994_set_tristate, -}; + DEBUG_LOG("Stream_state = [0x%X], Codec State = [0x%X]", + wm8994->stream_state, wm8994->codec_state); + + if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { + wm8994->stream_state &= ~(PCM_STREAM_CAPTURE); + wm8994->codec_state &= ~(CAPTURE_ACTIVE); + } else { + wm8994->codec_state &= ~(PLAYBACK_ACTIVE); + wm8994->stream_state &= ~(PCM_STREAM_PLAYBACK); + } + + if ((wm8994->codec_state == DEACTIVE) && + (wm8994->stream_state == PCM_STREAM_DEACTIVE)) { + DEBUG_LOG("Turn off Codec!!"); + audio_ctrl_mic_bias_gpio(0); + wm8994->power_state = CODEC_OFF; + wm8994->cur_path = PLAYBACK_OFF; + wm8994->rec_path = MIC_OFF; + wm8994->fmradio_path = FMR_OFF; + wm8994->fmr_mix_path = FMR_MIX_OFF; + wm8994->ringtone_active = OFF; + wm8994->call_record_path = CALL_RECORDING_OFF; + wm8994->call_record_ch = CH_OFF; + wm8994_write(codec, WM8994_SOFTWARE_RESET, 0x0000); + return; + } + + DEBUG_LOG("Preserve codec state = [0x%X], Stream State = [0x%X]", + wm8994->codec_state, wm8994->stream_state); + + if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { + wm8994_disable_rec_path(codec); + wm8994->codec_state &= ~(CAPTURE_ACTIVE); + } else { + if (wm8994->codec_state & CALL_ACTIVE) { + int val; + + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK); + val |= (WM8994_AIF1DAC1_MUTE); + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + } else if(wm8994->codec_state & CAPTURE_ACTIVE) { + wm8994_disable_playback_path(codec); + } else if(wm8994->codec_state & FMRADIO_ACTIVE) { + // FM radio deactive + int val; + + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK); + val |= (WM8994_AIF1DAC1_MUTE); + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + } else { + // Playback deactive + } + } +} + +//static struct snd_soc_device *wm8994_socdev; +static struct snd_soc_codec *wm8994_codec; -static struct snd_soc_dai_ops wm8994_aif3_dai_ops = { - .hw_params = wm8994_aif3_hw_params, - .set_tristate = wm8994_set_tristate, +#define WM8994_RATES SNDRV_PCM_RATE_8000_96000 +#define WM8994_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ + SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) +static struct snd_soc_dai_ops wm8994_ops = { + .startup = wm8994_startup, + .shutdown = wm8994_shutdown, + .set_sysclk = wm8994_set_sysclk, + .set_fmt = wm8994_set_dai_fmt, + .hw_params = wm8994_hw_params, + .digital_mute = wm8994_digital_mute, }; -static struct snd_soc_dai_driver wm8994_dai[] = { +struct snd_soc_dai_driver wm8994_dai[] = { { - .name = "wm8994-aif1", - .id = 1, + .name = "WM8994 PAIFRX", .playback = { - .stream_name = "AIF1 Playback", + .stream_name = "Playback", .channels_min = 1, - .channels_max = 2, + .channels_max = 6, .rates = WM8994_RATES, .formats = WM8994_FORMATS, }, .capture = { - .stream_name = "AIF1 Capture", - .channels_min = 1, - .channels_max = 2, - .rates = WM8994_RATES, - .formats = WM8994_FORMATS, - }, - .ops = &wm8994_aif1_dai_ops, - }, - { - .name = "wm8994-aif2", - .id = 2, - .playback = { - .stream_name = "AIF2 Playback", + .stream_name = "Capture", .channels_min = 1, .channels_max = 2, .rates = WM8994_RATES, .formats = WM8994_FORMATS, }, - .capture = { - .stream_name = "AIF2 Capture", - .channels_min = 1, - .channels_max = 2, - .rates = WM8994_RATES, - .formats = WM8994_FORMATS, - }, - .ops = &wm8994_aif2_dai_ops, + .ops = &wm8994_ops, }, - { - .name = "wm8994-aif3", - .id = 3, - .playback = { - .stream_name = "AIF3 Playback", - .channels_min = 1, - .channels_max = 2, - .rates = WM8994_RATES, - .formats = WM8994_FORMATS, - }, - .capture = { - .stream_name = "AIF3 Capture", - .channels_min = 1, - .channels_max = 2, - .rates = WM8994_RATES, - .formats = WM8994_FORMATS, - }, - .ops = &wm8994_aif3_dai_ops, - } }; +//EXPORT_SYMBOL_GPL(wm8994_dai); -#ifdef CONFIG_PM -static int wm8994_suspend(struct snd_soc_codec *codec, pm_message_t state) -{ - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994 *control = codec->control_data; - int i, ret; - - switch (control->type) { - case WM8994: - snd_soc_update_bits(codec, WM8994_MICBIAS, WM8994_MICD_ENA, 0); - break; - case WM8958: - snd_soc_update_bits(codec, WM8958_MIC_DETECT_1, - WM8958_MICD_ENA, 0); - break; - } - - for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) { - memcpy(&wm8994->fll_suspend[i], &wm8994->fll[i], - sizeof(struct wm8994_fll_config)); - ret = _wm8994_set_fll(codec, i + 1, 0, 0, 0); - if (ret < 0) - dev_warn(codec->dev, "Failed to stop FLL%d: %d\n", - i + 1, ret); - } - - wm8994_set_bias_level(codec, SND_SOC_BIAS_OFF); - - return 0; -} - -static int wm8994_resume(struct snd_soc_codec *codec) +/* + * initialise the WM8994 driver + * register the mixer and dsp interfaces with the kernel + */ +static int wm8994_init(struct wm8994_priv *wm8994_private) { - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994 *control = codec->control_data; - int i, ret; - unsigned int val, mask; - - if (wm8994->revision < 4) { - /* force a HW read */ - val = wm8994_reg_read(codec->control_data, - WM8994_POWER_MANAGEMENT_5); - - /* modify the cache only */ - codec->cache_only = 1; - mask = WM8994_DAC1R_ENA | WM8994_DAC1L_ENA | - WM8994_DAC2R_ENA | WM8994_DAC2L_ENA; - val &= mask; - snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_5, - mask, val); - codec->cache_only = 0; - } - - /* Restore the registers */ - ret = snd_soc_cache_sync(codec); - if (ret != 0) - dev_err(codec->dev, "Failed to sync cache: %d\n", ret); - - wm8994_set_bias_level(codec, SND_SOC_BIAS_STANDBY); - - for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) { - if (!wm8994->fll_suspend[i].out) - continue; + struct snd_soc_codec *codec = wm8994_private->codec; + struct wm8994_priv *wm8994; + int ret = 0; + DEBUG_LOG(""); + wm8994 = kzalloc(sizeof(struct wm8994_priv), GFP_KERNEL); + if (wm8994 == NULL) + return -ENOMEM; - ret = _wm8994_set_fll(codec, i + 1, - wm8994->fll_suspend[i].src, - wm8994->fll_suspend[i].in, - wm8994->fll_suspend[i].out); - if (ret < 0) - dev_warn(codec->dev, "Failed to restore FLL%d: %d\n", - i + 1, ret); - } + snd_soc_codec_set_drvdata(codec, wm8994); - switch (control->type) { - case WM8994: - if (wm8994->micdet[0].jack || wm8994->micdet[1].jack) - snd_soc_update_bits(codec, WM8994_MICBIAS, - WM8994_MICD_ENA, WM8994_MICD_ENA); - break; - case WM8958: - if (wm8994->jack_cb) - snd_soc_update_bits(codec, WM8958_MIC_DETECT_1, - WM8958_MICD_ENA, WM8958_MICD_ENA); - break; +#if 0 + mutex_init(&codec->mutex); + INIT_LIST_HEAD(&codec->dapm_widgets); + INIT_LIST_HEAD(&codec->dapm_paths); + codec->name = "WM8994"; + codec->owner = THIS_MODULE; + codec->read = wm8994_read; + codec->write = wm8994_write; + //codec->set_bias_level = wm8994_set_bias_level; + codec->dai = &wm8994_dai; + codec->num_dai = 1;//ARRAY_SIZE(wm8994_dai); +#endif + wm8994->universal_playback_path = universal_wm8994_playback_paths; + wm8994->universal_voicecall_path = universal_wm8994_voicecall_paths; + wm8994->universal_mic_path = universal_wm8994_mic_paths; + wm8994->stream_state = PCM_STREAM_DEACTIVE; + wm8994->codec_state = DEACTIVE; + wm8994->cur_path = PLAYBACK_OFF; + wm8994->rec_path = MIC_OFF; + wm8994->call_record_path = CALL_RECORDING_OFF; + wm8994->call_record_ch = CH_OFF; + wm8994->fmradio_path = FMR_OFF; + wm8994->fmr_mix_path = FMR_MIX_OFF; + wm8994->testmode_config_flag = SEC_NORMAL; + wm8994->power_state = CODEC_OFF; + wm8994->recognition_active = REC_OFF; + wm8994->ringtone_active = OFF; + + + wm8994_write(codec, WM8994_SOFTWARE_RESET, 0x0000); + + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, 0x3 << WM8994_VMID_SEL_SHIFT | WM8994_BIAS_ENA); + msleep(50); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, WM8994_VMID_SEL_NORMAL | WM8994_BIAS_ENA); + + wm8994->hw_version = wm8994_read(codec, 0x100); + + //wm8994_socdev->card->codec = codec; + wm8994_codec = codec; + +#if 0 + ret = snd_soc_new_pcms(wm8994_socdev, SNDRV_DEFAULT_IDX1, + SNDRV_DEFAULT_STR1); + if (ret < 0) { + DEBUG_LOG_ERR("failed to create pcms\n"); + goto pcm_err; } - - return 0; -} -#else -#define wm8994_suspend NULL -#define wm8994_resume NULL #endif -static void wm8994_handle_retune_mobile_pdata(struct wm8994_priv *wm8994) -{ - struct snd_soc_codec *codec = wm8994->codec; - struct wm8994_pdata *pdata = wm8994->pdata; - struct snd_kcontrol_new controls[] = { - SOC_ENUM_EXT("AIF1.1 EQ Mode", - wm8994->retune_mobile_enum, - wm8994_get_retune_mobile_enum, - wm8994_put_retune_mobile_enum), - SOC_ENUM_EXT("AIF1.2 EQ Mode", - wm8994->retune_mobile_enum, - wm8994_get_retune_mobile_enum, - wm8994_put_retune_mobile_enum), - SOC_ENUM_EXT("AIF2 EQ Mode", - wm8994->retune_mobile_enum, - wm8994_get_retune_mobile_enum, - wm8994_put_retune_mobile_enum), - }; - int ret, i, j; - const char **t; - - /* We need an array of texts for the enum API but the number - * of texts is likely to be less than the number of - * configurations due to the sample rate dependency of the - * configurations. */ - wm8994->num_retune_mobile_texts = 0; - wm8994->retune_mobile_texts = NULL; - for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) { - for (j = 0; j < wm8994->num_retune_mobile_texts; j++) { - if (strcmp(pdata->retune_mobile_cfgs[i].name, - wm8994->retune_mobile_texts[j]) == 0) - break; - } - - if (j != wm8994->num_retune_mobile_texts) - continue; + wm8994_add_controls(codec); + wm8994_add_widgets(codec); - /* Expand the array... */ - t = krealloc(wm8994->retune_mobile_texts, - sizeof(char *) * - (wm8994->num_retune_mobile_texts + 1), - GFP_KERNEL); - if (t == NULL) - continue; - - /* ...store the new entry... */ - t[wm8994->num_retune_mobile_texts] = - pdata->retune_mobile_cfgs[i].name; - - /* ...and remember the new version. */ - wm8994->num_retune_mobile_texts++; - wm8994->retune_mobile_texts = t; - } - - dev_dbg(codec->dev, "Allocated %d unique ReTune Mobile names\n", - wm8994->num_retune_mobile_texts); + return ret; - wm8994->retune_mobile_enum.max = wm8994->num_retune_mobile_texts; - wm8994->retune_mobile_enum.texts = wm8994->retune_mobile_texts; +//card_err: + //snd_soc_free_pcms(wm8994_socdev); + //snd_soc_dapm_free(wm8994_socdev); +//pcm_err: - ret = snd_soc_add_controls(wm8994->codec, controls, - ARRAY_SIZE(controls)); - if (ret != 0) - dev_err(wm8994->codec->dev, - "Failed to add ReTune Mobile controls: %d\n", ret); + return ret; } -static void wm8994_handle_pdata(struct wm8994_priv *wm8994) -{ - struct snd_soc_codec *codec = wm8994->codec; - struct wm8994_pdata *pdata = wm8994->pdata; - int ret, i; - - if (!pdata) - return; +/* If the i2c layer weren't so broken, we could pass this kind of data + around */ - wm_hubs_handle_analogue_pdata(codec, pdata->lineout1_diff, - pdata->lineout2_diff, - pdata->lineout1fb, - pdata->lineout2fb, - pdata->jd_scthr, - pdata->jd_thr, - pdata->micbias1_lvl, - pdata->micbias2_lvl); - - dev_dbg(codec->dev, "%d DRC configurations\n", pdata->num_drc_cfgs); - - if (pdata->num_drc_cfgs) { - struct snd_kcontrol_new controls[] = { - SOC_ENUM_EXT("AIF1DRC1 Mode", wm8994->drc_enum, - wm8994_get_drc_enum, wm8994_put_drc_enum), - SOC_ENUM_EXT("AIF1DRC2 Mode", wm8994->drc_enum, - wm8994_get_drc_enum, wm8994_put_drc_enum), - SOC_ENUM_EXT("AIF2DRC Mode", wm8994->drc_enum, - wm8994_get_drc_enum, wm8994_put_drc_enum), - }; - - /* We need an array of texts for the enum API */ - wm8994->drc_texts = kmalloc(sizeof(char *) - * pdata->num_drc_cfgs, GFP_KERNEL); - if (!wm8994->drc_texts) { - dev_err(wm8994->codec->dev, - "Failed to allocate %d DRC config texts\n", - pdata->num_drc_cfgs); - return; - } - - for (i = 0; i < pdata->num_drc_cfgs; i++) - wm8994->drc_texts[i] = pdata->drc_cfgs[i].name; +static int wm8994_codec_probe(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994_priv; + int ret = -ENODEV; - wm8994->drc_enum.max = pdata->num_drc_cfgs; - wm8994->drc_enum.texts = wm8994->drc_texts; + DEBUG_LOG(""); + pr_info("WM8994 Audio Codec %s\n", WM8994_VERSION); - ret = snd_soc_add_controls(wm8994->codec, controls, - ARRAY_SIZE(controls)); - if (ret != 0) - dev_err(wm8994->codec->dev, - "Failed to add DRC mode controls: %d\n", ret); + wm8994_priv = kzalloc(sizeof(struct wm8994_priv), GFP_KERNEL); + if (wm8994_priv == NULL) + return -ENOMEM; - for (i = 0; i < WM8994_NUM_DRC; i++) - wm8994_set_drc(codec, i); - } + wm8994_priv->codec = codec; +#ifdef PM_DEBUG + pm_codec = codec; +#endif - dev_dbg(codec->dev, "%d ReTune Mobile configurations\n", - pdata->num_retune_mobile_cfgs); + codec->hw_write = (hw_write_t) i2c_master_send; + //i2c_set_clientdata(i2c, wm8994_priv); + //codec->control_data = i2c; + codec->control_data = to_i2c_client(codec->dev); + //codec->dev = &i2c->dev; - if (pdata->num_retune_mobile_cfgs) - wm8994_handle_retune_mobile_pdata(wm8994); - else - snd_soc_add_controls(wm8994->codec, wm8994_eq_controls, - ARRAY_SIZE(wm8994_eq_controls)); + ret = wm8994_init(wm8994_priv); +#ifdef CONFIG_SND_WM8994_EXTENSIONS + wm8994_extensions_pcm_probe(codec); +#endif + if (ret) + dev_err(codec->dev, "failed to initialize WM8994\n"); - for (i = 0; i < ARRAY_SIZE(pdata->micbias); i++) { - if (pdata->micbias[i]) { - snd_soc_write(codec, WM8958_MICBIAS1 + i, - pdata->micbias[i] & 0xffff); - } - } + return ret; } -/** - * wm8994_mic_detect - Enable microphone detection via the WM8994 IRQ - * - * @codec: WM8994 codec - * @jack: jack to report detection events on - * @micbias: microphone bias to detect on - * @det: value to report for presence detection - * @shrt: value to report for short detection - * - * Enable microphone detection via IRQ on the WM8994. If GPIOs are - * being used to bring out signals to the processor then only platform - * data configuration is needed for WM8994 and processor GPIOs should - * be configured using snd_soc_jack_add_gpios() instead. - * - * Configuration of detection levels is available via the micbias1_lvl - * and micbias2_lvl platform data members. - */ -int wm8994_mic_detect(struct snd_soc_codec *codec, struct snd_soc_jack *jack, - int micbias, int det, int shrt) +static int wm8994_codec_remove(struct snd_soc_codec *codec) { - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994_micdet *micdet; - struct wm8994 *control = codec->control_data; - int reg; - - if (control->type != WM8994) - return -EINVAL; - - switch (micbias) { - case 1: - micdet = &wm8994->micdet[0]; - break; - case 2: - micdet = &wm8994->micdet[1]; - break; - default: - return -EINVAL; - } - - dev_dbg(codec->dev, "Configuring microphone detection on %d: %x %x\n", - micbias, det, shrt); - - /* Store the configuration */ - micdet->jack = jack; - micdet->det = det; - micdet->shrt = shrt; - - /* If either of the jacks is set up then enable detection */ - if (wm8994->micdet[0].jack || wm8994->micdet[1].jack) - reg = WM8994_MICD_ENA; - else - reg = 0; - - snd_soc_update_bits(codec, WM8994_MICBIAS, WM8994_MICD_ENA, reg); - + struct wm8994_priv *wm8994_priv = snd_soc_codec_get_drvdata(codec); + kfree(wm8994_priv); return 0; } -EXPORT_SYMBOL_GPL(wm8994_mic_detect); -static irqreturn_t wm8994_mic_irq(int irq, void *data) +#if 0 +/* power down chip */ +static int wm8994_remove(struct platform_device *pdev) { - struct wm8994_priv *priv = data; - struct snd_soc_codec *codec = priv->codec; - int reg; - int report; + //struct snd_soc_device *socdev = platform_get_drvdata(pdev); + struct snd_soc_codec *codec = wm8994_codec; + + //snd_soc_free_pcms(socdev); + //snd_soc_dapm_free(socdev); -#ifndef CONFIG_SND_SOC_WM8994_MODULE - trace_snd_soc_jack_irq(dev_name(codec->dev)); +#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) + i2c_unregister_device(codec->control_data); + i2c_del_driver(&wm8994_i2c_driver); #endif - reg = snd_soc_read(codec, WM8994_INTERRUPT_RAW_STATUS_2); - if (reg < 0) { - dev_err(codec->dev, "Failed to read microphone status: %d\n", - reg); - return IRQ_HANDLED; - } + //kfree(codec->drvdata); - dev_dbg(codec->dev, "Microphone status: %x\n", reg); - - report = 0; - if (reg & WM8994_MIC1_DET_STS) - report |= priv->micdet[0].det; - if (reg & WM8994_MIC1_SHRT_STS) - report |= priv->micdet[0].shrt; - snd_soc_jack_report(priv->micdet[0].jack, report, - priv->micdet[0].det | priv->micdet[0].shrt); - - report = 0; - if (reg & WM8994_MIC2_DET_STS) - report |= priv->micdet[1].det; - if (reg & WM8994_MIC2_SHRT_STS) - report |= priv->micdet[1].shrt; - snd_soc_jack_report(priv->micdet[1].jack, report, - priv->micdet[1].det | priv->micdet[1].shrt); - - return IRQ_HANDLED; + return 0; } +#endif -/* Default microphone detection handler for WM8958 - the user can - * override this if they wish. - */ -static void wm8958_default_micdet(u16 status, void *data) +#ifdef CONFIG_PM +static int wm8994_suspend(struct snd_soc_codec *codec, pm_message_t state) { - struct snd_soc_codec *codec = data; struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - int report = 0; - /* If nothing present then clear our statuses */ - if (!(status & WM8958_MICD_STS)) - goto done; + DEBUG_LOG("Codec State = [0x%X], Stream State = [0x%X]", + wm8994->codec_state, wm8994->stream_state); - report = SND_JACK_MICROPHONE; + if (wm8994->testmode_config_flag == SEC_TEST_HWCODEC) { + DEBUG_LOG_ERR("SEC_TEST_HWCODEC is activated!! Skip suspend sequence!!"); + return 0; + } - /* Everything else is buttons; just assign slots */ - if (status & 0x1c) - report |= SND_JACK_BTN_0; + if (wm8994->codec_state == DEACTIVE && + wm8994->stream_state == PCM_STREAM_DEACTIVE) { + wm8994->power_state = CODEC_OFF; + wm8994_write(codec, WM8994_SOFTWARE_RESET, 0x0000); + audio_power(0); + } -done: - snd_soc_jack_report(wm8994->micdet[0].jack, report, - SND_JACK_BTN_0 | SND_JACK_MICROPHONE); + return 0; } -/** - * wm8958_mic_detect - Enable microphone detection via the WM8958 IRQ - * - * @codec: WM8958 codec - * @jack: jack to report detection events on - * - * Enable microphone detection functionality for the WM8958. By - * default simple detection which supports the detection of up to 6 - * buttons plus video and microphone functionality is supported. - * - * The WM8958 has an advanced jack detection facility which is able to - * support complex accessory detection, especially when used in - * conjunction with external circuitry. In order to provide maximum - * flexiblity a callback is provided which allows a completely custom - * detection algorithm. - */ -int wm8958_mic_detect(struct snd_soc_codec *codec, struct snd_soc_jack *jack, - wm8958_micdet_cb cb, void *cb_data) +static int wm8994_resume(struct snd_soc_codec *codec) { struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994 *control = codec->control_data; - if (control->type != WM8958) - return -EINVAL; - - if (jack) { - if (!cb) { - dev_dbg(codec->dev, "Using default micdet callback\n"); - cb = wm8958_default_micdet; - cb_data = codec; - } + DEBUG_LOG("%s..", __func__); + DEBUG_LOG_ERR("------WM8994 Revision = [%d]-------", + wm8994->hw_version); - wm8994->micdet[0].jack = jack; - wm8994->jack_cb = cb; - wm8994->jack_cb_data = cb_data; - - snd_soc_update_bits(codec, WM8958_MIC_DETECT_1, - WM8958_MICD_ENA, WM8958_MICD_ENA); - } else { - snd_soc_update_bits(codec, WM8958_MIC_DETECT_1, - WM8958_MICD_ENA, 0); + if (wm8994->testmode_config_flag == SEC_TEST_HWCODEC) { + DEBUG_LOG_ERR("SEC_TEST_HWCODEC is activated!! Skip resume sequence!!"); + return 0; } + if (wm8994->power_state == CODEC_OFF) { + // Turn on sequence by recommend Wolfson. + audio_power(1); + wm8994->power_state = CODEC_ON; + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, 0x3 << WM8994_VMID_SEL_SHIFT | WM8994_BIAS_ENA); + msleep(50); // Wait to setup PLL. + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, WM8994_VMID_SEL_NORMAL | WM8994_BIAS_ENA); + wm8994_write(codec,WM8994_OVERSAMPLING, 0x0000); + } return 0; } -EXPORT_SYMBOL_GPL(wm8958_mic_detect); - -static irqreturn_t wm8958_mic_irq(int irq, void *data) -{ - struct wm8994_priv *wm8994 = data; - struct snd_soc_codec *codec = wm8994->codec; - int reg; - - reg = snd_soc_read(codec, WM8958_MIC_DETECT_3); - if (reg < 0) { - dev_err(codec->dev, "Failed to read mic detect status: %d\n", - reg); - return IRQ_NONE; - } - - if (!(reg & WM8958_MICD_VALID)) { - dev_dbg(codec->dev, "Mic detect data not valid\n"); - goto out; - } - -#ifndef CONFIG_SND_SOC_WM8994_MODULE - trace_snd_soc_jack_irq(dev_name(codec->dev)); #endif - if (wm8994->jack_cb) - wm8994->jack_cb(reg, wm8994->jack_cb_data); - else - dev_warn(codec->dev, "Accessory detection with no callback\n"); - -out: - return IRQ_HANDLED; -} +#if 0 +struct snd_soc_codec_device soc_codec_dev_wm8994 = { + .probe = wm8994_probe, + .remove = wm8994_remove, +#ifdef CONFIG_PM + .suspend = wm8994_suspend, + .resume = wm8994_resume, +#endif +}; +#endif -static int wm8994_codec_probe(struct snd_soc_codec *codec) +#if 0 +static int __init wm8994_modinit(void) { - struct wm8994 *control; - struct wm8994_priv *wm8994; - struct snd_soc_dapm_context *dapm = &codec->dapm; - int ret, i; - - codec->control_data = dev_get_drvdata(codec->dev->parent); - control = codec->control_data; - - wm8994 = kzalloc(sizeof(struct wm8994_priv), GFP_KERNEL); - if (wm8994 == NULL) - return -ENOMEM; - snd_soc_codec_set_drvdata(codec, wm8994); - - wm8994->pdata = dev_get_platdata(codec->dev->parent); - wm8994->codec = codec; - - if (wm8994->pdata && wm8994->pdata->micdet_irq) - wm8994->micdet_irq = wm8994->pdata->micdet_irq; - else if (wm8994->pdata && wm8994->pdata->irq_base) - wm8994->micdet_irq = wm8994->pdata->irq_base + - WM8994_IRQ_MIC1_DET; - - pm_runtime_enable(codec->dev); - pm_runtime_resume(codec->dev); - - /* Read our current status back from the chip - we don't want to - * reset as this may interfere with the GPIO or LDO operation. */ - for (i = 0; i < WM8994_CACHE_SIZE; i++) { - if (!wm8994_readable(codec, i) || wm8994_volatile(codec, i)) - continue; - - ret = wm8994_reg_read(codec->control_data, i); - if (ret <= 0) - continue; - - ret = snd_soc_cache_write(codec, i, ret); - if (ret != 0) { - dev_err(codec->dev, - "Failed to initialise cache for 0x%x: %d\n", - i, ret); - goto err; - } - } - - /* Set revision-specific configuration */ - wm8994->revision = snd_soc_read(codec, WM8994_CHIP_REVISION); - switch (control->type) { - case WM8994: - switch (wm8994->revision) { - case 2: - case 3: - wm8994->hubs.dcs_codes = -5; - wm8994->hubs.hp_startup_mode = 1; - wm8994->hubs.dcs_readback_mode = 1; - break; - default: - wm8994->hubs.dcs_readback_mode = 1; - break; - } - - case WM8958: - wm8994->hubs.dcs_readback_mode = 1; - break; - - default: - break; - } - - switch (control->type) { - case WM8994: - if (wm8994->micdet_irq) { - ret = request_threaded_irq(wm8994->micdet_irq, NULL, - wm8994_mic_irq, - IRQF_TRIGGER_RISING, - "Mic1 detect", - wm8994); - if (ret != 0) - dev_warn(codec->dev, - "Failed to request Mic1 detect IRQ: %d\n", - ret); - } - - ret = wm8994_request_irq(codec->control_data, - WM8994_IRQ_MIC1_SHRT, - wm8994_mic_irq, "Mic 1 short", - wm8994); - if (ret != 0) - dev_warn(codec->dev, - "Failed to request Mic1 short IRQ: %d\n", - ret); - - ret = wm8994_request_irq(codec->control_data, - WM8994_IRQ_MIC2_DET, - wm8994_mic_irq, "Mic 2 detect", - wm8994); - if (ret != 0) - dev_warn(codec->dev, - "Failed to request Mic2 detect IRQ: %d\n", - ret); - - ret = wm8994_request_irq(codec->control_data, - WM8994_IRQ_MIC2_SHRT, - wm8994_mic_irq, "Mic 2 short", - wm8994); - if (ret != 0) - dev_warn(codec->dev, - "Failed to request Mic2 short IRQ: %d\n", - ret); - break; - - case WM8958: - if (wm8994->micdet_irq) { - ret = request_threaded_irq(wm8994->micdet_irq, NULL, - wm8958_mic_irq, - IRQF_TRIGGER_RISING, - "Mic detect", - wm8994); - if (ret != 0) - dev_warn(codec->dev, - "Failed to request Mic detect IRQ: %d\n", - ret); - } - } - - /* Remember if AIFnLRCLK is configured as a GPIO. This should be - * configured on init - if a system wants to do this dynamically - * at runtime we can deal with that then. - */ - ret = wm8994_reg_read(codec->control_data, WM8994_GPIO_1); - if (ret < 0) { - dev_err(codec->dev, "Failed to read GPIO1 state: %d\n", ret); - goto err_irq; - } - if ((ret & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) { - wm8994->lrclk_shared[0] = 1; - wm8994_dai[0].symmetric_rates = 1; - } else { - wm8994->lrclk_shared[0] = 0; - } - - ret = wm8994_reg_read(codec->control_data, WM8994_GPIO_6); - if (ret < 0) { - dev_err(codec->dev, "Failed to read GPIO6 state: %d\n", ret); - goto err_irq; - } - if ((ret & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) { - wm8994->lrclk_shared[1] = 1; - wm8994_dai[1].symmetric_rates = 1; - } else { - wm8994->lrclk_shared[1] = 0; - } - - wm8994_set_bias_level(codec, SND_SOC_BIAS_STANDBY); - - /* Latch volume updates (right only; we always do left then right). */ - snd_soc_update_bits(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, - WM8994_AIF1DAC1_VU, WM8994_AIF1DAC1_VU); - snd_soc_update_bits(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, - WM8994_AIF1DAC1_VU, WM8994_AIF1DAC1_VU); - snd_soc_update_bits(codec, WM8994_AIF1_DAC2_LEFT_VOLUME, - WM8994_AIF1DAC2_VU, WM8994_AIF1DAC2_VU); - snd_soc_update_bits(codec, WM8994_AIF1_DAC2_RIGHT_VOLUME, - WM8994_AIF1DAC2_VU, WM8994_AIF1DAC2_VU); - snd_soc_update_bits(codec, WM8994_AIF2_DAC_LEFT_VOLUME, - WM8994_AIF2DAC_VU, WM8994_AIF2DAC_VU); - snd_soc_update_bits(codec, WM8994_AIF2_DAC_RIGHT_VOLUME, - WM8994_AIF2DAC_VU, WM8994_AIF2DAC_VU); - snd_soc_update_bits(codec, WM8994_AIF1_ADC1_LEFT_VOLUME, - WM8994_AIF1ADC1_VU, WM8994_AIF1ADC1_VU); - snd_soc_update_bits(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME, - WM8994_AIF1ADC1_VU, WM8994_AIF1ADC1_VU); - snd_soc_update_bits(codec, WM8994_AIF1_ADC2_LEFT_VOLUME, - WM8994_AIF1ADC2_VU, WM8994_AIF1ADC2_VU); - snd_soc_update_bits(codec, WM8994_AIF1_ADC2_RIGHT_VOLUME, - WM8994_AIF1ADC2_VU, WM8994_AIF1ADC2_VU); - snd_soc_update_bits(codec, WM8994_AIF2_ADC_LEFT_VOLUME, - WM8994_AIF2ADC_VU, WM8994_AIF1ADC2_VU); - snd_soc_update_bits(codec, WM8994_AIF2_ADC_RIGHT_VOLUME, - WM8994_AIF2ADC_VU, WM8994_AIF1ADC2_VU); - snd_soc_update_bits(codec, WM8994_DAC1_LEFT_VOLUME, - WM8994_DAC1_VU, WM8994_DAC1_VU); - snd_soc_update_bits(codec, WM8994_DAC1_RIGHT_VOLUME, - WM8994_DAC1_VU, WM8994_DAC1_VU); - snd_soc_update_bits(codec, WM8994_DAC2_LEFT_VOLUME, - WM8994_DAC2_VU, WM8994_DAC2_VU); - snd_soc_update_bits(codec, WM8994_DAC2_RIGHT_VOLUME, - WM8994_DAC2_VU, WM8994_DAC2_VU); - - /* Set the low bit of the 3D stereo depth so TLV matches */ - snd_soc_update_bits(codec, WM8994_AIF1_DAC1_FILTERS_2, - 1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT, - 1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT); - snd_soc_update_bits(codec, WM8994_AIF1_DAC2_FILTERS_2, - 1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT, - 1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT); - snd_soc_update_bits(codec, WM8994_AIF2_DAC_FILTERS_2, - 1 << WM8994_AIF2DAC_3D_GAIN_SHIFT, - 1 << WM8994_AIF2DAC_3D_GAIN_SHIFT); - - /* Unconditionally enable AIF1 ADC TDM mode; it only affects - * behaviour on idle TDM clock cycles. */ - snd_soc_update_bits(codec, WM8994_AIF1_CONTROL_1, - WM8994_AIF1ADC_TDM, WM8994_AIF1ADC_TDM); - - wm8994_update_class_w(codec); - - wm8994_handle_pdata(wm8994); - - wm_hubs_add_analogue_controls(codec); - snd_soc_add_controls(codec, wm8994_snd_controls, - ARRAY_SIZE(wm8994_snd_controls)); - snd_soc_dapm_new_controls(dapm, wm8994_dapm_widgets, - ARRAY_SIZE(wm8994_dapm_widgets)); - - switch (control->type) { - case WM8994: - snd_soc_dapm_new_controls(dapm, wm8994_specific_dapm_widgets, - ARRAY_SIZE(wm8994_specific_dapm_widgets)); - if (wm8994->revision < 4) { - snd_soc_dapm_new_controls(dapm, wm8994_lateclk_revd_widgets, - ARRAY_SIZE(wm8994_lateclk_revd_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_adc_revd_widgets, - ARRAY_SIZE(wm8994_adc_revd_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_dac_revd_widgets, - ARRAY_SIZE(wm8994_dac_revd_widgets)); - } else { - snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets, - ARRAY_SIZE(wm8994_lateclk_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets, - ARRAY_SIZE(wm8994_adc_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets, - ARRAY_SIZE(wm8994_dac_widgets)); - } - break; - case WM8958: - snd_soc_add_controls(codec, wm8958_snd_controls, - ARRAY_SIZE(wm8958_snd_controls)); - snd_soc_dapm_new_controls(dapm, wm8958_dapm_widgets, - ARRAY_SIZE(wm8958_dapm_widgets)); - if (wm8994->revision < 1) { - snd_soc_dapm_new_controls(dapm, wm8994_lateclk_revd_widgets, - ARRAY_SIZE(wm8994_lateclk_revd_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_adc_revd_widgets, - ARRAY_SIZE(wm8994_adc_revd_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_dac_revd_widgets, - ARRAY_SIZE(wm8994_dac_revd_widgets)); - } else { - snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets, - ARRAY_SIZE(wm8994_lateclk_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets, - ARRAY_SIZE(wm8994_adc_widgets)); - snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets, - ARRAY_SIZE(wm8994_dac_widgets)); - } - break; - } - - - wm_hubs_add_analogue_routes(codec, 0, 0); - snd_soc_dapm_add_routes(dapm, intercon, ARRAY_SIZE(intercon)); - - switch (control->type) { - case WM8994: - snd_soc_dapm_add_routes(dapm, wm8994_intercon, - ARRAY_SIZE(wm8994_intercon)); - - if (wm8994->revision < 4) { - snd_soc_dapm_add_routes(dapm, wm8994_revd_intercon, - ARRAY_SIZE(wm8994_revd_intercon)); - snd_soc_dapm_add_routes(dapm, wm8994_lateclk_revd_intercon, - ARRAY_SIZE(wm8994_lateclk_revd_intercon)); - } else { - snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon, - ARRAY_SIZE(wm8994_lateclk_intercon)); - } - break; - case WM8958: - if (wm8994->revision < 1) { - snd_soc_dapm_add_routes(dapm, wm8994_revd_intercon, - ARRAY_SIZE(wm8994_revd_intercon)); - snd_soc_dapm_add_routes(dapm, wm8994_lateclk_revd_intercon, - ARRAY_SIZE(wm8994_lateclk_revd_intercon)); - } else { - snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon, - ARRAY_SIZE(wm8994_lateclk_intercon)); - snd_soc_dapm_add_routes(dapm, wm8958_intercon, - ARRAY_SIZE(wm8958_intercon)); - } - - wm8958_dsp2_init(codec); - break; - } - - return 0; + int ret; + ret = snd_soc_register_dai(&wm8994_dai); + if (ret) + pr_err("..dai registration failed..\n"); -err_irq: - wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC2_SHRT, wm8994); - wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC2_DET, wm8994); - wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_SHRT, wm8994); - if (wm8994->micdet_irq) - free_irq(wm8994->micdet_irq, wm8994); -err: - kfree(wm8994); return ret; } -static int wm8994_codec_remove(struct snd_soc_codec *codec) -{ - struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); - struct wm8994 *control = codec->control_data; - - wm8994_set_bias_level(codec, SND_SOC_BIAS_OFF); - - pm_runtime_disable(codec->dev); - - switch (control->type) { - case WM8994: - if (wm8994->micdet_irq) - free_irq(wm8994->micdet_irq, wm8994); - wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC2_DET, - wm8994); - wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_SHRT, - wm8994); - wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_DET, - wm8994); - break; - - case WM8958: - if (wm8994->micdet_irq) - free_irq(wm8994->micdet_irq, wm8994); - break; - } - if (wm8994->mbc) - release_firmware(wm8994->mbc); - if (wm8994->mbc_vss) - release_firmware(wm8994->mbc_vss); - if (wm8994->enh_eq) - release_firmware(wm8994->enh_eq); - kfree(wm8994->retune_mobile_texts); - kfree(wm8994->drc_texts); - kfree(wm8994); +module_init(wm8994_modinit); - return 0; +static void __exit wm8994_exit(void) +{ + snd_soc_unregister_dai(&wm8994_dai); } +module_exit(wm8994_exit); +#endif + static struct snd_soc_codec_driver soc_codec_dev_wm8994 = { .probe = wm8994_codec_probe, .remove = wm8994_codec_remove, @@ -3204,51 +1652,65 @@ static struct snd_soc_codec_driver soc_codec_dev_wm8994 = { .resume = wm8994_resume, .read = wm8994_read, .write = wm8994_write, - .readable_register = wm8994_readable, - .volatile_register = wm8994_volatile, - .set_bias_level = wm8994_set_bias_level, + //.readable_register = wm8994_readable, + //.volatile_register = wm8994_volatile, + //.set_bias_level = wm8994_set_bias_level, - .reg_cache_size = WM8994_CACHE_SIZE, - .reg_cache_default = wm8994_reg_defaults, + .reg_cache_size = WM8994_IRQ_POLARITY, + //.reg_cache_size = WM8994_CACHE_SIZE, + //.reg_cache_default = wm8994_reg_defaults, .reg_word_size = 2, .compress_type = SND_SOC_RBTREE_COMPRESSION, }; -static int __devinit wm8994_probe(struct platform_device *pdev) +static int wm8994_i2c_probe(struct i2c_client *client, + const struct i2c_device_id *id) { - return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_wm8994, + /* Board Specific Function */ + audio_init(); + audio_power(1); + msleep(10); + + return snd_soc_register_codec(&client->dev, &soc_codec_dev_wm8994, wm8994_dai, ARRAY_SIZE(wm8994_dai)); } -static int __devexit wm8994_remove(struct platform_device *pdev) +static int wm8994_i2c_remove(struct i2c_client *client) { - snd_soc_unregister_codec(&pdev->dev); + snd_soc_unregister_codec(&client->dev); return 0; } -static struct platform_driver wm8994_codec_driver = { + +static const struct i2c_device_id wm8994_i2c_id[] = { + {"wm8994-samsung", 0}, + {} +}; + +MODULE_DEVICE_TABLE(i2c, wm8994_i2c_id); + +static struct i2c_driver wm8994_i2c_driver = { .driver = { - .name = "wm8994-codec", + .name = "wm8994-samsung-codec", .owner = THIS_MODULE, }, - .probe = wm8994_probe, - .remove = __devexit_p(wm8994_remove), + .probe = wm8994_i2c_probe, + .remove = wm8994_i2c_remove, + .id_table = wm8994_i2c_id, }; -static __init int wm8994_init(void) +static __init int wm8994_driver_init(void) { - return platform_driver_register(&wm8994_codec_driver); + return i2c_add_driver(&wm8994_i2c_driver); } -module_init(wm8994_init); +module_init(wm8994_driver_init); -static __exit void wm8994_exit(void) +static __exit void wm8994_driver_exit(void) { - platform_driver_unregister(&wm8994_codec_driver); + i2c_del_driver(&wm8994_i2c_driver); } -module_exit(wm8994_exit); - +module_exit(wm8994_driver_exit); MODULE_DESCRIPTION("ASoC WM8994 driver"); -MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>"); +MODULE_AUTHOR("Shaju Abraham shaju.abraham@samsung.com"); MODULE_LICENSE("GPL"); -MODULE_ALIAS("platform:wm8994-codec"); diff --git a/sound/soc/codecs/wm8994.h b/sound/soc/codecs/wm8994.h index 13257dc..e97ad86 100644 --- a/sound/soc/codecs/wm8994.h +++ b/sound/soc/codecs/wm8994.h @@ -10,10 +10,7 @@ #define _WM8994_H
#include <sound/soc.h>
-
-extern struct snd_soc_codec_device soc_codec_dev_wm8994;
-// We don't use array - DW Shim.
-//extern struct snd_soc_dai wm8994_dai[];
+ /* Sources for AIF1/2 SYSCLK - use with set_dai_sysclk() */
#define WM8994_SYSCLK_MCLK1 1
@@ -24,30 +21,56 @@ extern struct snd_soc_codec_device soc_codec_dev_wm8994; #define WM8994_FLL1 1
#define WM8994_FLL2 2
-//-----------------------------------------------------------
-// Added belows codes by Samsung Electronics.
+/* Added belows codes by Samsung Electronics.*/ #include "wm8994_def.h"
-extern struct snd_soc_dai wm8994_dai;
-
#define WM8994_SYSCLK_MCLK 1
#define WM8994_SYSCLK_FLL 2
#define AUDIO_COMMON_DEBUG 0
-//#define WM8994_REGISTER_DUMP
-#if defined CONFIG_SND_SOC_WM8994_PCM
-#define ATTACH_ADDITINAL_PCM_DRIVER // for VT call.
-#endif
-//------------------------------------------------
-// Definitions of enum type
-//------------------------------------------------
-enum audio_path { OFF, RCV, SPK, HP, BT, SPK_HP};
-enum mic_path { MAIN, SUB, MIC_OFF};
-enum fmradio_audio_path { FMR_OFF, FMR_SPK, FMR_HP, FMR_SPK_MIX, FMR_HP_MIX, FMR_SPK_HP_MIX};
-enum call_state { DISCONNECT, CONNECT};
-enum power_state { CODEC_OFF, CODEC_ON };
-enum mic_state { MIC_NO_USE, MIC_USE};
+
+#define DEACTIVE 0x00
+#define PLAYBACK_ACTIVE 0x01
+#define CAPTURE_ACTIVE 0x02
+#define CALL_ACTIVE 0x04
+#define FMRADIO_ACTIVE 0x08
+
+#define PCM_STREAM_DEACTIVE 0x00
+#define PCM_STREAM_PLAYBACK 0x01
+#define PCM_STREAM_CAPTURE 0x02
+
+#define CMD_FMR_INPUT_DEACTIVE 0 // Codec Input PGA off for reducing white noise.
+#define CMD_FMR_INPUT_ACTIVE 1 // Codec Input PGA on
+#define CMD_FMR_FLAG_CLEAR 2 // Radio flag clear for shutdown - to reduce pop up noise.
+#define CMD_FMR_END 3 // Codec off in FM radio mode - to reduce pop up noise.
+#define CMD_RECOGNITION_DEACTIVE 4 // Distingush recognition gain. To use default MIC gain.
+#define CMD_RECOGNITION_ACTIVE 5 // Distingush recognition gain. To use MIC gain for recognition.
+#define CMD_CALL_FLAG_CLEAR 6 // Call flag clear for shutdown - to reduce pop up noise.
+#define CMD_CALL_END 7 // Codec off in call mode - to reduce pop up noise.
+
+#define HPAMP_OFF 0x00
+#define HPAMP_PLAYBACK 0x01
+#define HPAMP_CALL 0x02
+#define HPAMP_FMR 0x04
+#define HPAMP_CH_NORMAL 0x08
+
+#define CODEC_TURN_OFF 0x01 + +/* + * Definitions of enum type + */
+enum playback_path { PLAYBACK_OFF, RCV, SPK, HP, HP_NO_MIC, BT, SPK_HP,RING_SPK, RING_HP, RING_NO_MIC, RING_SPK_HP, EXTRA_DOCK_SPEAKER, TV_OUT, HDMI_TV_OUT, HDMI_SPK, HDMI_DUAL };
+enum mic_path { MAIN, SUB, BT_REC, MIC_OFF };
+enum fmradio_path { FMR_OFF, FMR_SPK, FMR_HP, FMR_SPK_MIX, FMR_HP_MIX, FMR_DUAL_MIX };
+enum fmradio_mix_path { FMR_MIX_OFF, FMR_MIX_HP, FMR_MIX_SPK, FMR_MIX_DUAL };
+enum power_state { CODEC_OFF, CODEC_ON };
+enum recognition { REC_OFF, REC_ON };
+enum state { OFF, ON };
+enum voice_record_path { CALL_RECORDING_OFF, CALL_RECORDING_MAIN, CALL_RECORDING_SUB};
+enum factory_test { SEC_NORMAL, SEC_TEST_HWCODEC , SEC_TEST_15MODE, SEC_TEST_PBA_LOOPBACK, SEC_TEST_PBA_DUAL_SPK, SEC_TEST_HQRL_LOOPBACK};
+enum call_recording_channel {CH_OFF, CH_UPLINK, CH_DOWNLINK, CH_UDLINK};
+
typedef void (*select_route)(struct snd_soc_codec *);
typedef void (*select_mic_route)(struct snd_soc_codec *);
@@ -55,66 +78,90 @@ typedef void (*select_mic_route)(struct snd_soc_codec *); struct wm8994_setup_data {
int i2c_bus;
unsigned short i2c_address;
-};
-
+}; + struct wm8994_priv {
- //u16 reg_cache[WM8994_REGISTER_COUNT];
- struct snd_soc_codec codec;
+ struct snd_soc_codec *codec; int master;
int sysclk_source;
unsigned int mclk_rate;
unsigned int sysclk_rate;
unsigned int fs;
- unsigned int bclk;
- unsigned int hw_version; // For wolfson H/W version. 1 = Rev B, 3 = Rev D
- enum audio_path cur_path;
+ unsigned int bclk; + unsigned int codec_state;
+ unsigned int stream_state;
+ enum playback_path cur_path;
enum mic_path rec_path;
- enum fmradio_audio_path fmradio_path;
- enum call_state call_state;
+ enum fmradio_path fmradio_path;
+ enum fmradio_mix_path fmr_mix_path;
enum power_state power_state;
- enum mic_state mic_state;
+ enum recognition recognition_active; // for control gain to voice recognition.
+ enum state ringtone_active;
+ enum voice_record_path call_record_path;
+ enum call_recording_channel call_record_ch;
select_route *universal_playback_path;
select_route *universal_voicecall_path;
- select_mic_route *universal_mic_path;
- int testmode_config_flag; // for testmode.
-};
+ select_mic_route *universal_mic_path; + int testmode_config_flag; // for testmode. + unsigned int hw_version;
+}; #if AUDIO_COMMON_DEBUG
-#define DEBUG_LOG(format,...)\
- printk ("[ "SUBJECT " (%s,%d) ] " format "\n", __func__, __LINE__, ## __VA_ARGS__);
+#define DEBUG_LOG(format, ...)\ + printk(KERN_INFO "[ "SUBJECT " (%s,%d) ] " format "\n", \ + __func__, __LINE__, ## __VA_ARGS__); #else
-#define DEBUG_LOG(format,...)
+#define DEBUG_LOG(format, ...) #endif
-#define DEBUG_LOG_ERR(format,...)\
- printk (KERN_ERR "[ "SUBJECT " (%s,%d) ] " format "\n", __func__, __LINE__, ## __VA_ARGS__);
+#define DEBUG_LOG_ERR(format, ...)\ + printk(KERN_ERR "[ "SUBJECT " (%s,%d) ] " format "\n", \ + __func__, __LINE__, ## __VA_ARGS__); -// Definitions of function prototype.
-inline unsigned int wm8994_read(struct snd_soc_codec *codec,unsigned int reg);
+/* Definitions of function prototype. */ +unsigned int wm8994_read(struct snd_soc_codec *codec,unsigned int reg); int wm8994_write(struct snd_soc_codec *codec, unsigned int reg, unsigned int value);
int audio_init(void);
-int audio_power(int en);
-void audio_ctrl_mic_bias_gpio(int enable);
+int audio_power(int en); +
void wm8994_set_off(struct snd_soc_codec *codec);
-void wm8994_disable_playback_path(struct snd_soc_codec *codec, enum audio_path path);
-void wm8994_disable_fmradio_path(struct snd_soc_codec *codec, enum fmradio_audio_path path);
-void wm8994_disable_rec_path(struct snd_soc_codec *codec,enum mic_path rec_path);
+void wm8994_disable_playback_path(struct snd_soc_codec *codec);
+void wm8994_disable_fmradio_path(struct snd_soc_codec *codec);
+void wm8994_disable_rec_path(struct snd_soc_codec *codec);
void wm8994_record_main_mic( struct snd_soc_codec *codec);
void wm8994_record_headset_mic( struct snd_soc_codec *codec);
+void wm8994_record_bluetooth(struct snd_soc_codec *codec);
void wm8994_set_playback_receiver(struct snd_soc_codec *codec);
void wm8994_set_playback_headset(struct snd_soc_codec *codec);
-void wm8994_set_playback_speaker(struct snd_soc_codec *codec);
+void wm8994_set_playback_speaker(struct snd_soc_codec *codec); void wm8994_set_playback_speaker_headset(struct snd_soc_codec *codec);
-void wm8994_set_voicecall_receiver(struct snd_soc_codec *codec);
+void wm8994_set_playback_bluetooth(struct snd_soc_codec *codec);
+void wm8994_set_playback_extra_dock_speaker(struct snd_soc_codec *codec);
+void wm8994_set_playback_hdmi_tvout(struct snd_soc_codec *codec);
+void wm8994_set_playback_speaker_hdmitvout(struct snd_soc_codec *codec);
+void wm8994_set_playback_speakerheadset_hdmitvout(struct snd_soc_codec *codec);
+void wm8994_set_voicecall_common_setting(struct snd_soc_codec *codec);
+void wm8994_set_voicecall_receiver(struct snd_soc_codec *codec); +void wm8994_set_voicecall_headphone(struct snd_soc_codec *codec);
void wm8994_set_voicecall_headset(struct snd_soc_codec *codec);
void wm8994_set_voicecall_speaker(struct snd_soc_codec *codec);
-void wm8994_set_voicecall_bluetooth(struct snd_soc_codec *codec);
+void wm8994_set_voicecall_bluetooth(struct snd_soc_codec *codec); +void wm8994_set_voicecall_record(struct snd_soc_codec *codec, int path_num);
+void wm8994_call_recording_change_path(struct snd_soc_codec *codec);
+void wm8994_set_voicecall_record_off(struct snd_soc_codec *codec);
+void wm8994_set_fmradio_common(struct snd_soc_codec *codec, int onoff);
void wm8994_set_fmradio_headset(struct snd_soc_codec *codec);
void wm8994_set_fmradio_speaker(struct snd_soc_codec *codec);
void wm8994_set_fmradio_headset_mix(struct snd_soc_codec *codec);
void wm8994_set_fmradio_speaker_mix(struct snd_soc_codec *codec);
-void wm8994_set_fmradio_speaker_headset_mix(struct snd_soc_codec *codec);
+void wm8994_set_fmradio_speaker_headset_mix(struct snd_soc_codec *codec); #if defined WM8994_REGISTER_DUMP
void wm8994_register_dump(struct snd_soc_codec *codec);
#endif
#endif
+
+void audio_ctrl_earmic_bias_gpio(int enable);
+void audio_ctrl_mic_bias_gpio(int enable); +
+int get_audio_power_status(void); +
diff --git a/sound/soc/codecs/wm8994_extensions.c b/sound/soc/codecs/wm8994_extensions.c index e6df363..5736e37 100644 --- a/sound/soc/codecs/wm8994_extensions.c +++ b/sound/soc/codecs/wm8994_extensions.c @@ -53,7 +53,7 @@ unsigned short origin_recgain; unsigned short origin_recgain_mixer; #endif -#ifdef NEXUS_S +#if defined(NEXUS_S) || defined(GALAXY_TAB) bool speaker_tuning = false; #endif @@ -519,7 +519,7 @@ bool is_path_media_or_fm_no_call_no_record() return false; } -#ifdef NEXUS_S +#if defined(NEXUS_S) || defined(GALAXY_TAB) void update_speaker_tuning(bool with_mute) { DECLARE_WM8994(codec); @@ -598,8 +598,8 @@ unsigned short osr128_get_value(unsigned short val) if (debug_log(LOG_INFOS)) printk("wm8994_extensions: %s %s %s %d\n", __func__, - dac_osr128 ? "dac_osr128" : "", - adc_osr128 ? "adc_osr128" : "", + dac_osr128 ? "dac_osr128" : "", + adc_osr128 ? "adc_osr128" : "", val); return val; @@ -1003,7 +1003,7 @@ static ssize_t name##_store(struct device *dev, struct device_attribute *attr, \ return size; \ } -#ifdef NEXUS_S +#if defined(NEXUS_S) || defined(GALAXY_TAB) DECLARE_BOOL_SHOW(speaker_tuning); DECLARE_BOOL_STORE_UPDATE_WITH_MUTE(speaker_tuning, update_speaker_tuning, @@ -1659,7 +1659,7 @@ static DEVICE_ATTR(headphone_amplifier_level, S_IRUGO | S_IWUGO, headphone_amplifier_level_store); #endif -#ifdef NEXUS_S +#if defined(NEXUS_S) || defined(GALAXY_TAB) static DEVICE_ATTR(speaker_tuning, S_IRUGO | S_IWUGO, speaker_tuning_show, speaker_tuning_store); @@ -1804,7 +1804,7 @@ static struct attribute *wm8994_extensions_attributes[] = { #ifdef CONFIG_SND_WM8994_EXTENSIONS_HP_LEVEL_CONTROL &dev_attr_headphone_amplifier_level.attr, #endif -#ifdef NEXUS_S +#if defined(NEXUS_S) || defined(GALAXY_TAB) &dev_attr_speaker_tuning.attr, #endif #ifdef CONFIG_SND_WM8994_EXTENSIONS_FM @@ -1944,7 +1944,7 @@ void wm8994_extensions_record_main_mic() } #endif -#ifdef NEXUS_S +#if defined(NEXUS_S) || defined(GALAXY_TAB) void wm8994_extensions_playback_speaker() { // global kill switch diff --git a/sound/soc/codecs/wm8994_extensions.h b/sound/soc/codecs/wm8994_extensions.h index 1d79768..4f1e35c 100644 --- a/sound/soc/codecs/wm8994_extensions.h +++ b/sound/soc/codecs/wm8994_extensions.h @@ -17,7 +17,7 @@ #define NEXUS_S #endif -#if defined(CONFIG_FB_S3C_AMS701KA) || defined(CONFIG_KOR_MODEL_M180S) +#if defined(CONFIG_FB_S3C_AMS701KA) || defined(CONFIG_KOR_MODEL_M180S) || defined (CONFIG_MACH_P1) #define GALAXY_TAB #endif diff --git a/sound/soc/codecs/wm8994_p1.c b/sound/soc/codecs/wm8994_p1.c new file mode 100644 index 0000000..d1d2fae --- /dev/null +++ b/sound/soc/codecs/wm8994_p1.c @@ -0,0 +1,4732 @@ +/* + * wm8994_p1.c -- WM8994 ALSA Soc Audio driver related Aries + * + * Copyright (C) 2010 Samsung Electronics. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License as published by the + * Free Software Foundation; either version 2 of the License, or (at your + * option) any later version. + * + */ + +#include <sound/soc.h> +#include <sound/soc-dapm.h> +#include <linux/delay.h> +#include <asm/io.h> +#include <asm/gpio.h> +#include <plat/gpio-cfg.h> +#include <plat/map-base.h> +#include <mach/regs-clock.h> +#include <mach/gpio-p1.h> +#include "wm8994.h" +#include "wm8994_def.h" + +#ifdef CONFIG_SND_WM8994_EXTENSIONS +#include "wm8994_extensions.h" +#endif + +/* + * Debug Feature + */ +#define SUBJECT "wm8994_p1.c" + +/* + * Definitions of tunning volumes for wm8994 + */ +// DAC +#define TUNING_DAC1L_VOL 0xC0 // 610h +#define TUNING_DAC1R_VOL 0xC0 // 611h +#define TUNING_DAC2L_VOL 0xC0 // 612h +#define TUNING_DAC2R_VOL 0xC0 // 613h + +// Speaker +#define TUNING_SPKL_VOL 0x3E // 26h +#define TUNING_SPKR_VOL 0x3E // 27h +#define TUNING_CLASSD_VOL 0x6 // 25h + +#define TUNING_SPKMIXL_ATTEN 0x0 // 22h +#define TUNING_SPKMIXR_ATTEN 0x0 // 23h + +#define TUNING_MP3_SPKR_VOL 0x3E // 27h +#define TUNING_MP3_SPKL_VOL 0x3E // 26h +#define TUNING_MP3_CLASSD_VOL 0x5 // 25h + +#define TUNING_FMRADIO_SPKL_VOL 0x3E // 26h +#define TUNING_FMRADIO_CLASSD_VOL 0x5 // 25h + +#define TUNING_CALL_CLASSD_VOL 0x24 // 25h +#define TUNING_CALL_SPKL_VOL 0x3E // 26h +#define TUNING_CALL_SPKR_VOL 0x3E // 27h + +// Headset +#define TUNING_EAR_OUTMIX5_VOL 0x0 // 31h +#define TUNING_EAR_OUTMIX6_VOL 0x0 // 32h + +#define TUNING_RING_OUTPUTL_VOL 0x36 // 1Ch +#define TUNING_RING_OUTPUTR_VOL 0x36 // 1Dh +#define TUNING_RING_OPGAL_VOL 0x39 // 20h +#define TUNING_RING_OPGAR_VOL 0x39 // 21h + +#define TUNING_MP3_OUTPUTL_VOL 0x36 // 1Ch +#define TUNING_MP3_OUTPUTR_VOL 0x36 // 1Dh +#define TUNING_MP3_OPGAL_VOL 0x39 // 20h +#define TUNING_MP3_OPGAR_VOL 0x39 // 21h + +// Dual +#define TUNING_MP3_DUAL_OUTPUTL_VOL 0x1E // 1Ch +#define TUNING_MP3_DUAL_OUTPUTR_VOL 0x1E // 1Dh + +// Extra_Dock_speaker +#define TUNING_MP3_EXTRA_DOCK_SPK_OPGAL_VOL 0x3D // 20h +#define TUNING_MP3_EXTRA_DOCK_SPK_OPGAR_VOL 0x3D // 21h + +#define TUNING_EXTRA_DOCK_SPK_OUTMIX5_VOL 0x2 // 31h +#define TUNING_EXTRA_DOCK_SPK_OUTMIX6_VOL 0x2 // 32h +#define TUNING_MP3_EXTRA_DOCK_SPK_VOL 0x0 //1Eh + + +#define TUNING_CALL_OUTPUTL_VOL 0x39 // 1Ch +#define TUNING_CALL_OUTPUTR_VOL 0x39 // 1Dh +#define TUNING_CALL_OPGAL_VOL 0x39 // 20h +#define TUNING_CALL_OPGAR_VOL 0x39 // 21h + +#define TUNING_FMRADIO_OUTPUTL_VOL 0x3D // 1Ch +#define TUNING_FMRADIO_OUTPUTR_VOL 0x3D // 1Dh +#define TUNING_FMRADIO_OPGAL_VOL 0x39 // 20h +#define TUNING_FMRADIO_OPGAR_VOL 0x39 // 21h + +#define TUNING_HPOUTMIX_VOL 0x0 + +// Dual +#define TUNING_DUAL_OUTPUTL_VOL 0x20 // 1Ch +#define TUNING_DUAL_OUTPUTR_VOL 0x20 // 1Dh + +//------------------------------------------------ +// Recording +// Main MIC +#if defined(CONFIG_PHONE_P1_GSM) +#define TUNING_RECORD_MAIN_INPUTLINE_VOL 0x17 // 18h +#define TUNING_RECORD_MAIN_AIF1ADCL_VOL 0xC0 // 400h +#define TUNING_RECORD_MAIN_AIF1ADCR_VOL 0xC0 // 401h +#elif defined(CONFIG_PHONE_P1_CDMA) +#define TUNING_RECORD_MAIN_INPUTLINE_VOL 0x15 // 18h +#define TUNING_RECORD_MAIN_AIF1ADCL_VOL 0xFF // 400h +#define TUNING_RECORD_MAIN_AIF1ADCR_VOL 0xFF // 401h +#endif + +#define TUNING_RECOGNITION_MAIN_INPUTLINE_VOL 0x0F // 18h +#define TUNING_RECOGNITION_MAIN_AIF1ADCL_VOL 0xC0 // 400h +#define TUNING_RECOGNITION_MAIN_AIF1ADCR_VOL 0xC0 // 401h + +// Ear MIC +#define TUNING_RECORD_SUB_INPUTMIX_VOL 0x15 // 1Ah +#define TUNING_RECORD_SUB_AIF1ADCL_VOL 0xC0 // 400h +#define TUNING_RECORD_SUB_AIF1ADCR_VOL 0xC0 // 401h + +#if defined(CONFIG_PHONE_P1_GSM) +#define TUNING_RECOGNITION_SUB_INPUTMIX_VOL 0x0A // 1Ah +#elif defined(CONFIG_PHONE_P1_CDMA) +#define TUNING_RECOGNITION_SUB_INPUTMIX_VOL 0x10 // 1Ah +#endif +#define TUNING_RECOGNITION_SUB_AIF1ADCL_VOL 0xC0 // 400h +#define TUNING_RECOGNITION_SUB_AIF1ADCR_VOL 0xC0 // 401h + +//BT MIC +#define TUNING_RECORD_BT_AIF2DACR_VOL 0xC0 //501h +#define TUNING_RECORD_BT_AIF2DACL_VOL 0xC0 //502h + +#define TUNING_RECORD_BT_AIF1ADC1L_VOL 0xC0 //400h +#define TUNING_RECORD_BT_AIF1ADC1R_VOL 0xC0 //401h + +#define TUNING_RECOGNITION_BT_AIF2DACL_VOL 0xC0 //501h +#define TUNING_RECOGNITION_BT_AIF2DACR_VOL 0xC0 //502h +#define TUNING_RECOGNITION_BT_AIF1ADC1L_VOL 0xB8 //400h +#define TUNING_RECOGNITION_BT_AIF1ADC1R_VOL 0xB8 //401h + +// Call Main MIC +#define TUNING_CALL_RCV_INPUTMIX_VOL 0x16 // 18h +#define TUNING_CALL_RCV_MIXER_VOL WM8994_IN1L_MIXINL_VOL // 29h 30dB +#define TUNING_CALL_SPK_INPUTMIX_VOL 0x17 // 18h + +#define TUNING_CALL_SPK_MIXER_VOL WM8994_IN1L_MIXINL_VOL // 29h 30dB + + +// Call Ear MIC +#define TUNING_CALL_EAR_INPUTMIX_VOL 0x1F // 1Ah + +// Receiver +#define TUNING_RCV_OUTMIX5_VOL 0x0 // 31h +#define TUNING_RCV_OUTMIX6_VOL 0x0 // 32h +#define TUNING_RCV_OPGAL_VOL 0x3D // 20h +#define TUNING_RCV_OPGAR_VOL 0x3D // 21h +#define TUNING_HPOUT2_VOL 0x0 // 1Fh + +//Input +#define TUNING_DAC1L_RADIO_VOL 0xA8 // 402h +#define TUNING_DAC1R_RADIO_VOL 0xA8 // 403h + +//Dual +#define TUNING_DUAL_DAC1L_RADIO_VOL 0x70 // 402h +#define TUNING_DUAL_DAC1R_RADIO_VOL 0x70 // 403h + +// FM Radio Input +#define TUNING_FMRADIO_EAR_INPUTMIXL_VOL 0x0B // 19h +#define TUNING_FMRADIO_EAR_INPUTMIXR_VOL 0x0B // 1Bh + +#define TUNING_FMRADIO_SPK_INPUTMIXL_VOL 0x0F // 19h +#define TUNING_FMRADIO_SPK_INPUTMIXR_VOL 0x0F // 1Bh + + +// ear loopback +#define TUNING_LOOPBACK_EAR_INPUTMIX_VOL 0x1D // 1Ah + +#define TUNING_LOOPBACK_OUTPUTL_VOL 0x37 // 1Ch +#define TUNING_LOOPBACK_OUTPUTR_VOL 0x37 // 1Dh +#define TUNING_LOOPBACK_OPGAL_VOL 0x39 // 20h +#define TUNING_LOOPBACK_OPGAR_VOL 0x39 // 21h + + +int audio_init(void) +{ + //CODEC LDO SETTING + if (gpio_is_valid(GPIO_CODEC_LDO_EN)) + { + if (gpio_request(GPIO_CODEC_LDO_EN, "CODEC_LDO_EN")) + { + DEBUG_LOG_ERR("Failed to request CODEC_LDO_EN!"); + } + + gpio_direction_output(GPIO_CODEC_LDO_EN, 0); + } + + s3c_gpio_setpull(GPIO_CODEC_LDO_EN, S3C_GPIO_PULL_NONE); + + s3c_gpio_slp_cfgpin(GPIO_CODEC_LDO_EN, S3C_GPIO_SLP_PREV); + s3c_gpio_slp_setpull_updown(GPIO_CODEC_LDO_EN, S3C_GPIO_PULL_NONE); + + + if (gpio_is_valid(GPIO_MICBIAS_EN)) + { + if (gpio_request(GPIO_MICBIAS_EN, "GPJ4")) + { + DEBUG_LOG_ERR("Failed to request GPIO_MICBIAS_EN!"); + } + + gpio_direction_output(GPIO_MICBIAS_EN, 0); + } + + s3c_gpio_setpull(GPIO_MICBIAS_EN, S3C_GPIO_PULL_NONE); + + s3c_gpio_slp_cfgpin(GPIO_MICBIAS_EN, S3C_GPIO_SLP_PREV); + s3c_gpio_slp_setpull_updown(GPIO_MICBIAS_EN, S3C_GPIO_PULL_NONE); + + DEBUG_LOG("MICBIAS Init"); + + return 0; +} + + +int codec_power_status = 0; + +int audio_power(int en) +{ + u32 val; + + + if(en) + { + // Forbid to turn off MCLK in sleep mode. + val = __raw_readl(S5P_SLEEP_CFG); + val |= (S5P_SLEEP_CFG_USBOSC_EN); + __raw_writel(val , S5P_SLEEP_CFG); + + // Turn on LDO for codec. + gpio_set_value(GPIO_CODEC_LDO_EN, 1); + + msleep(10); // Wait for warming up. + + // Turn on master clock. +#if (defined CONFIG_SND_S5P_WM8994_MASTER) + __raw_writel(__raw_readl(S5P_OTHERS) | (3<<8) , S5P_OTHERS); + //__raw_writel(__raw_readl(S5P_CLK_OUT) | (0x1) , S5P_CLK_OUT); +#endif + } + else + { + // Turn off LDO for codec. + gpio_set_value(GPIO_CODEC_LDO_EN, 0); + + msleep(125); // Wait to turn off codec entirely. + + // Turn off master clock. +#if (defined CONFIG_SND_S5P_WM8994_MASTER) + __raw_writel(__raw_readl(S5P_OTHERS) & (~(0x3<<8)) , S5P_OTHERS); + __raw_writel(__raw_readl(S5P_CLK_OUT) & (0xFFFFFFFE) , S5P_CLK_OUT); +#endif + + // Allow to turn off MCLK in sleep mode. + val = __raw_readl(S5P_SLEEP_CFG); + val &= ~(S5P_SLEEP_CFG_USBOSC_EN); + __raw_writel(val , S5P_SLEEP_CFG); + } + + codec_power_status = en; + DEBUG_LOG("AUDIO POWER COMPLETED : %d", en); + + return 0; +} + +int get_audio_power_status(void) +{ + return codec_power_status; +} + + +void audio_ctrl_mic_bias_gpio(int enable) +{ + //DEBUG_LOG("audio_ctrl_mic_bias_gpio = [%d]", enable); + + if(enable) + { + DEBUG_LOG("MICBIAS On"); + gpio_set_value(GPIO_MICBIAS_EN, 1); + } + else + { + DEBUG_LOG("MICBIAS Off"); + gpio_set_value(GPIO_MICBIAS_EN, 0); + } +} + +void audio_ctrl_earmic_bias_gpio(int enable) +{ + if(enable) + { + DEBUG_LOG("EAR_MICBIAS On"); + gpio_set_value(GPIO_EAR_MICBIAS0_EN, 1); + gpio_set_value(GPIO_EAR_MICBIAS_EN, 1); + } + else + { + DEBUG_LOG("EAR_MICBIAS Off"); + gpio_set_value(GPIO_EAR_MICBIAS0_EN, 0); + gpio_set_value(GPIO_EAR_MICBIAS_EN, 0); + } +} + + +/*Audio Routing routines for the universal board..wm8994 codec*/ +void wm8994_disable_playback_path(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + enum playback_path path = wm8994->rec_path; + + DEBUG_LOG("Path = [%d]", path); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + + switch(path) + { + case RCV: + //Disable the HPOUT2 + val &= ~(WM8994_HPOUT2_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + // Disable left MIXOUT + val = wm8994_read(codec,WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_MIXOUTL_MASK); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1,val); + + // Disable right MIXOUT + val = wm8994_read(codec,WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_MIXOUTR_MASK); + wm8994_write(codec,WM8994_OUTPUT_MIXER_2,val); + + // Disable HPOUT Mixer + val = wm8994_read(codec,WM8994_HPOUT2_MIXER); + val &= ~(WM8994_MIXOUTLVOL_TO_HPOUT2_MASK | WM8994_MIXOUTRVOL_TO_HPOUT2_MASK); + wm8994_write(codec,WM8994_HPOUT2_MIXER,val); + + // Disable mixout volume control + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_3,val); + break; + + case SPK: + //Disable the SPKOUTL & SPKOUTR + val &= ~(WM8994_SPKOUTL_ENA_MASK|WM8994_SPKOUTR_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + // Disable SPKLVOL + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_SPKLVOL_ENA_MASK | WM8994_SPKRVOL_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + // Disable SPKOUT mixer + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + //Mute Speaker mixer + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK | WM8994_DAC1R_TO_SPKMIXR_MASK); + wm8994_write(codec, WM8994_SPEAKER_MIXER ,val); + break; + + case HP: + case HP_NO_MIC: + //Disable the HPOUT1L & HPOUT1R + val &= ~(WM8994_HPOUT1L_ENA_MASK |WM8994_HPOUT1R_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + // Disable DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); + + // Disable DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + //Disable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, val); + + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + break; + + case BT : + ; //todo + break; + + case SPK_HP : + //Disable the HPOUT1L & HPOUT1R & SPKOUTL & SPKOUTR + val &= ~(WM8994_HPOUT1L_ENA_MASK |WM8994_HPOUT1R_ENA_MASK |WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + // ------------------ Ear path setting ------------------ + // Disable DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); + + // Disable DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + //Disable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, val); + + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + // ------------------ Spk path setting ------------------ + // Disable SPKLVOL + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_SPKLVOL_ENA_MASK | WM8994_SPKRVOL_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + // Disable SPKOUT mixer + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + //Mute Speaker mixer + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK | WM8994_DAC1R_TO_SPKMIXR_MASK); + wm8994_write(codec, WM8994_SPEAKER_MIXER ,val); + break; + + default: + DEBUG_LOG_ERR("Path[%d] is not invaild!", path); + return; + break; + } +} + +void wm8994_disable_rec_path(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + enum mic_path mic = wm8994->rec_path; + + wm8994->rec_path = MIC_OFF; + + if (!(wm8994->codec_state & CALL_ACTIVE)) + audio_ctrl_mic_bias_gpio(0); + + switch (mic) { + case MAIN: + DEBUG_LOG("Disabling MAIN Mic Path..\n"); + + if(!(wm8994->codec_state & CALL_ACTIVE)) // Normal case + { + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_2 ); + val &= ~( WM8994_IN1L_ENA_MASK | WM8994_MIXINL_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_2, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + /* Mute IN1L PGA, update volume */ + val = wm8994_read(codec, + WM8994_LEFT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1L_MUTE_MASK | WM8994_IN1L_VOL_MASK); + val |= (WM8994_IN1L_VU | WM8994_IN1L_MUTE); + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME, + val); + + /*Mute the PGA */ + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val &= ~(WM8994_IN1L_TO_MIXINL_MASK | + WM8994_IN1L_MIXINL_VOL_MASK | + WM8994_MIXOUTL_MIXINL_VOL_MASK); + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + } + + /* Disconnect IN1LN ans IN1LP to the inputs */ + val = wm8994_read(codec, WM8994_INPUT_MIXER_2); + val &= (WM8994_IN1LN_TO_IN1L_MASK | WM8994_IN1LP_TO_IN1L_MASK); + wm8994_write(codec, WM8994_INPUT_MIXER_2, val); + + //Digital Paths + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_ADCL_ENA_MASK |WM8994_AIF1ADC1L_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4, val); + } + else + { + //Digital Paths + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_AIF1ADC1L_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4, val); + } + + /* Disable timeslots */ + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_ADC1L_TO_AIF1ADC1L); + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, val); + break; + + case SUB: + DEBUG_LOG("Disbaling SUB Mic path.."); + + if(!(wm8994->codec_state & CALL_ACTIVE)) // Normal case + { + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_2); + val &= ~(WM8994_IN1R_ENA_MASK |WM8994_MIXINR_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_2,val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Disable volume,unmute Right Line + val = wm8994_read(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1R_MUTE_MASK | WM8994_IN1R_VOL_MASK); // Unmute IN1R + val |= (WM8994_IN1R_VU | WM8994_IN1R_MUTE); + wm8994_write(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME, val); + + // Mute right pga, set volume + val = wm8994_read(codec,WM8994_INPUT_MIXER_4); + val&= ~(WM8994_IN1R_TO_MIXINR_MASK | WM8994_IN1R_MIXINR_VOL_MASK | WM8994_MIXOUTR_MIXINR_VOL_MASK); + wm8994_write(codec,WM8994_INPUT_MIXER_4, val); + } + + //Disconnect in1rn to inr1 and in1rp to inrp + val = wm8994_read(codec,WM8994_INPUT_MIXER_2); + val &= ~(WM8994_IN1RN_TO_IN1R_MASK | WM8994_IN1RP_TO_IN1R_MASK); + wm8994_write(codec,WM8994_INPUT_MIXER_2, val); + + //Digital Paths + //Disable right ADC and time slot + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_ADCR_ENA_MASK | WM8994_AIF1ADC1R_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, val); + } + else + { + //Digital Paths + //Disable right ADC and time slot + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_AIF1ADC1R_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4, val); + + val = wm8994_read(codec, WM8994_AIF1_CONTROL_1); //605H : 0x0010 + val &= ~(WM8994_AIF1ADCL_SRC_MASK); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, val); + } + + /* ADC Right mixer routing */ + val = wm8994_read(codec, WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_ADC1R_TO_AIF1ADC1R_MASK); + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING, val); + break; + + case BT_REC: + if(!(wm8994->codec_state & CALL_ACTIVE)) // Normal case + { + //R1542(606h) - 0x0000 + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF2DACL_TO_AIF1ADC1L_MASK | WM8994_ADC1L_TO_AIF1ADC1L_MASK); + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, val); + + //R1543(607h) - 0x0000 + val = wm8994_read(codec, WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_AIF2DACR_TO_AIF1ADC1R_MASK | WM8994_ADC1R_TO_AIF1ADC1R_MASK); + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING, val); + + //R1312(520h) - 0x0200 + val = wm8994_read(codec, WM8994_AIF2_DAC_FILTERS_1); + val &= ~(WM8994_AIF2DAC_MUTE_MASK); + val |= (WM8994_AIF2DAC_MUTE); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, val); + } + break; + + default: + if((wm8994->codec_state & CALL_ACTIVE) && (wm8994->call_record_ch == CH_OFF)) + { + if(wm8994->call_record_path == CALL_RECORDING_MAIN) + { + DEBUG_LOG("Disabling MAIN Mic Path in call"); + //Digital Paths + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_AIF1ADC1L_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4, val); + + //Disable timeslots + val = wm8994_read(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_ADC1L_TO_AIF1ADC1L); + wm8994_write(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, val); + } + else if(wm8994->call_record_path == CALL_RECORDING_SUB) + { + DEBUG_LOG("Disbaling SUB Mic path in call"); + //Digital Paths + //Disable right ADC and time slot + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_AIF1ADC1R_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4, val); + + val = wm8994_read(codec, WM8994_AIF1_CONTROL_1); //605H : 0x0010 + val &= ~(WM8994_AIF1ADCL_SRC_MASK); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, val); + + //ADC Right mixer routing + val = wm8994_read(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_ADC1R_TO_AIF1ADC1R_MASK); + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING, val); + } + + wm8994->call_record_path = CALL_RECORDING_OFF; + } + else + { + DEBUG_LOG_ERR("Path[%d] is not invaild!", mic); + } + break; + } +} + +void wm8994_disable_fmradio_path(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + enum fmradio_path path = wm8994->rec_path; + + DEBUG_LOG("Turn off fmradio_path = [%d]", path); + + switch(path) + { + case FMR_OFF : + wm8994->fmradio_path = FMR_OFF; + + //--------------------------------------------------- + // Disable speaker setting for FM radio + if(wm8994->codec_state & CALL_ACTIVE) + { + + //disable the SPKOUTL + val =wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_SPKOUTL_ENA_MASK); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1 ,val); + + // Disable SPK Volume. + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_SPKRVOL_ENA_MASK | WM8994_SPKLVOL_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Mute the SPKMIXVOLUME + val = wm8994_read(codec, WM8994_SPKMIXL_ATTENUATION); + val &= ~(WM8994_SPKMIXL_VOL_MASK); + wm8994_write(codec, WM8994_SPKMIXL_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPKMIXR_ATTENUATION); + val &= ~(WM8994_SPKMIXR_VOL_MASK); + wm8994_write(codec, WM8994_SPKMIXR_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_LEFT); + val &= ~(WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_LEFT, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_RIGHT); + val &= ~(WM8994_SPKOUTR_MUTE_N_MASK | WM8994_SPKOUTR_VOL_MASK); + val |= (WM8994_SPKOUT_VU); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_RIGHT, val); + + val = wm8994_read(codec, WM8994_CLASSD); + val &= ~(WM8994_SPKOUTL_BOOST_MASK); + wm8994_write(codec, WM8994_CLASSD, val); + } + + /*Output MIxer-Output PGA*/ + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS ); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + // Output mixer setting + val = wm8994_read(codec, WM8994_SPEAKER_MIXER); + val &= ~(WM8994_MIXINL_TO_SPKMIXL_MASK | WM8994_MIXINR_TO_SPKMIXR_MASK); + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + //--------------------------------------------------- + // Disable earpath setting for FM radio + + //Disable end point for preventing pop up noise. + val =wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_HPOUT1L_ENA_MASK |WM8994_HPOUT1R_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + // Disable MIXOUT + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Output setting + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + } + + //Disable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, val); + + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + // Disable Output mixer setting + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_MIXINL_TO_MIXOUTL_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_MIXINR_TO_MIXOUTR_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + //--------------------------------------------------- + // Disable common setting for FM radio + + // Disable IN2 and MIXIN + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_2); + val &= ~(WM8994_TSHUT_ENA_MASK | WM8994_TSHUT_OPDIS_MASK | WM8994_OPCLK_ENA_MASK | + WM8994_MIXINL_ENA_MASK | WM8994_MIXINR_ENA_MASK | WM8994_IN2L_ENA_MASK | WM8994_IN2R_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, val); + + // Disable Input mixer setting + val = wm8994_read(codec, WM8994_INPUT_MIXER_2); + val &= ~(WM8994_IN2LN_TO_IN2L_MASK | WM8994_IN2RN_TO_IN2R_MASK); + wm8994_write(codec, WM8994_INPUT_MIXER_2, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Disable IN2L to MIXINL + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val &= ~(WM8994_IN2L_TO_MIXINL_MASK); + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + + //Disable IN2R to MIXINR + val = wm8994_read(codec, WM8994_INPUT_MIXER_4); + val &= ~(WM8994_IN2R_TO_MIXINR_MASK); + wm8994_write(codec, WM8994_INPUT_MIXER_4, val); + } + + // Mute IN2L PGA volume + val = wm8994_read(codec, WM8994_LEFT_LINE_INPUT_3_4_VOLUME); + val &= ~(WM8994_IN2L_VU_MASK | WM8994_IN2L_MUTE_MASK | WM8994_IN2L_VOL_MASK); + val |= (WM8994_IN2L_MUTE); + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_3_4_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_LINE_INPUT_3_4_VOLUME); + val &= ~(WM8994_IN2R_VU_MASK | WM8994_IN2R_MUTE_MASK | WM8994_IN2R_VOL_MASK); + val |= (WM8994_IN2R_VU |WM8994_IN2R_MUTE); + wm8994_write(codec, WM8994_RIGHT_LINE_INPUT_3_4_VOLUME, val); + + //--------------------------------------------------- + // Disable path setting for mixing + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK); + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + // Disable DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); + + // Disable DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + } + break; + + case FMR_SPK : + //disable the SPKOUTL + val =wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_SPKOUTL_ENA_MASK); +// wm8994_write(codec,WM8994_POWER_MANAGEMENT_1 ,val); + + // Disable SPK Volume. + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_SPKRVOL_ENA_MASK | WM8994_SPKLVOL_ENA_MASK); +// wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Mute the SPKMIXVOLUME + val = wm8994_read(codec, WM8994_SPKMIXL_ATTENUATION); + val &= ~(WM8994_SPKMIXL_VOL_MASK); + wm8994_write(codec, WM8994_SPKMIXL_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPKMIXR_ATTENUATION); + val &= ~(WM8994_SPKMIXR_VOL_MASK); + wm8994_write(codec, WM8994_SPKMIXR_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_LEFT); + val &= ~(WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_LEFT, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_RIGHT); + val &= ~(WM8994_SPKOUTR_MUTE_N_MASK | WM8994_SPKOUTR_VOL_MASK); + val |= (WM8994_SPKOUT_VU); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_RIGHT, val); + + val = wm8994_read(codec, WM8994_CLASSD); + val &= ~(WM8994_SPKOUTL_BOOST_MASK); + wm8994_write(codec, WM8994_CLASSD, val); + } + + /*Output MIxer-Output PGA*/ + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS ); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + // Output mixer setting + val = wm8994_read(codec, WM8994_SPEAKER_MIXER); + val &= ~(WM8994_MIXINL_TO_SPKMIXL_MASK | WM8994_MIXINR_TO_SPKMIXR_MASK); + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + break; + + case FMR_HP : + //Disable end point for preventing pop up noise. + val =wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_HPOUT1L_ENA_MASK |WM8994_HPOUT1R_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + // Disable MIXOUT + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Output setting + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + } + + //Disable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, val); + + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + // Disable Output mixer setting + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_MIXINL_TO_MIXOUTL_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_MIXINR_TO_MIXOUTR_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + break; + + case FMR_SPK_MIX : + //Mute the DAC path + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK); + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + break; + + case FMR_HP_MIX : + // Disable DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); + + // Disable DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + break; + + case FMR_DUAL_MIX : + //Mute the DAC path + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK); + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + // Disable DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); + + // Disable DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + break; + + default: + DEBUG_LOG_ERR("fmradio path[%d] is not invaild!", path); + return; + break; + } +} + +void wm8994_record_headset_mic(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + DEBUG_LOG("Recording through Headset Mic\n"); + +#if defined(CONFIG_PHONE_P1_GSM) + audio_ctrl_mic_bias_gpio(0); + audio_ctrl_earmic_bias_gpio(1); + + + if(!(wm8994->codec_state & CALL_ACTIVE)) // Normal case + { + // Disable FM radio path + val = wm8994_read(codec, WM8994_SPEAKER_MIXER); + val &= ~WM8994_MIXINL_TO_SPKMIXL_MASK; + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~WM8994_MIXINL_TO_MIXOUTL_MASK; + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~WM8994_MIXINR_TO_MIXOUTR_MASK; + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + val = wm8994_read(codec, WM8994_DAC2_LEFT_MIXER_ROUTING); //604H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2L_MASK); + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING); //605H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2R_MASK); + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, val); + + // Mixing left channel output to right channel. + val = wm8994_read(codec, WM8994_AIF1_CONTROL_1); //605H : 0x0010 + val &= ~(WM8994_AIF1ADCL_SRC_MASK | WM8994_AIF1ADCR_SRC_MASK); + val |= (WM8994_AIF1ADCL_SRC | WM8994_AIF1ADCR_SRC); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, val); + + wm8994_write(codec,WM8994_ANTIPOP_2,0x68); //Ear mic volume issue fix + + //Enable mic bias, vmid, bias generator + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); + + //Enable Right Input Mixer,Enable IN1R PGA - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 + //val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_2 ); + //val &= ~(WM8994_IN1R_ENA_MASK |WM8994_MIXINR_ENA_MASK ); + //val |= (WM8994_MIXINR_ENA | WM8994_IN1R_ENA ); + val = (WM8994_MIXINR_ENA | WM8994_IN1R_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_2,val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Enable volume,unmute Right Line + val = wm8994_read(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1R_MUTE_MASK | WM8994_IN1R_VOL_MASK); // Unmute IN1R + if(wm8994->recognition_active == REC_ON) + val |= (WM8994_IN1R_VU | TUNING_RECOGNITION_SUB_INPUTMIX_VOL); + else + val |= (WM8994_IN1R_VU | TUNING_RECORD_SUB_INPUTMIX_VOL); + wm8994_write(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME,val); + + // unmute right pga, set volume + val = wm8994_read(codec,WM8994_INPUT_MIXER_4 ); + val&= ~(WM8994_IN1R_TO_MIXINR_MASK | WM8994_IN1R_MIXINR_VOL_MASK | WM8994_MIXOUTR_MIXINR_VOL_MASK); + val |= (WM8994_IN1R_TO_MIXINR | WM8994_IN1R_MIXINR_VOL);//30db + wm8994_write(codec,WM8994_INPUT_MIXER_4 ,val); + } + + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1ADC1L_VOL_MASK); + if(wm8994->recognition_active == REC_ON) + val |= (TUNING_RECOGNITION_SUB_AIF1ADCL_VOL); + else + val |= (TUNING_RECORD_SUB_AIF1ADCL_VOL); // 0db + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1ADC1R_VOL_MASK); + if(wm8994->recognition_active == REC_ON) + val |= (WM8994_AIF1ADC1_VU | TUNING_RECOGNITION_SUB_AIF1ADCR_VOL); + else + val |= (WM8994_AIF1ADC1_VU | TUNING_RECORD_SUB_AIF1ADCR_VOL); // 0db + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME, val); + + //connect in1rn to inr1 and in1rp to inrp - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 + //val = wm8994_read(codec,WM8994_INPUT_MIXER_2); + //val &= ~( WM8994_IN1RN_TO_IN1R_MASK | WM8994_IN1RP_TO_IN1R_MASK); + //val |= (WM8994_IN1RN_TO_IN1R | WM8994_IN1RP_TO_IN1R) ; + val = (WM8994_IN1RN_TO_IN1R | WM8994_IN1RP_TO_IN1R) ; + wm8994_write(codec,WM8994_INPUT_MIXER_2,val); + } + else + { + // Mixing left channel output to right channel. + val = wm8994_read(codec, WM8994_AIF1_CONTROL_1); //605H : 0x0010 + val &= ~(WM8994_AIF1ADCL_SRC_MASK | WM8994_AIF1ADCR_SRC_MASK); + val |= (WM8994_AIF1ADCL_SRC | WM8994_AIF1ADCR_SRC); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, val); + } +#elif defined(CONFIG_PHONE_P1_CDMA) + audio_ctrl_mic_bias_gpio(1); + + //Enable mic bias, vmid, bias generator + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | WM8994_MICB1_ENA_MASK ); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL |WM8994_MICB1_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); + + //Enable Right Input Mixer,Enable IN1R PGA - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 +// val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_2 ); +// val &= ~(WM8994_IN1R_ENA_MASK |WM8994_MIXINR_ENA_MASK ); +// val |= (WM8994_MIXINR_ENA | WM8994_IN1R_ENA ); + val = (WM8994_MIXINR_ENA | WM8994_IN1R_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_2,val); + + // Mixing left channel output to right channel. + val = wm8994_read(codec, WM8994_AIF1_CONTROL_1); //605H : 0x0010 + val &= ~(WM8994_AIF1ADCL_SRC_MASK | WM8994_AIF1ADCR_SRC_MASK); + val |= (WM8994_AIF1ADCL_SRC | WM8994_AIF1ADCR_SRC); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, val); + + if(!wm8994->testmode_config_flag) + { + // Enable volume,unmute Right Line + val = wm8994_read(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME); + val &= ~WM8994_IN1R_MUTE_MASK; // Unmute IN1R + val |= (WM8994_IN1R_VU | TUNING_RECORD_SUB_INPUTMIX_VOL); + wm8994_write(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME,val); + + // unmute right pga, set volume + val = wm8994_read(codec,WM8994_INPUT_MIXER_4 ); + val&= ~(WM8994_IN1R_TO_MIXINR_MASK | WM8994_IN1R_MIXINR_VOL_MASK | WM8994_MIXOUTR_MIXINR_VOL_MASK); + val |= (WM8994_IN1R_TO_MIXINR);//0db + wm8994_write(codec,WM8994_INPUT_MIXER_4 ,val); + + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME, WM8994_AIF1ADC1_VU | TUNING_RECORD_SUB_AIF1ADCR_VOL); + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_VOLUME, TUNING_RECORD_SUB_AIF1ADCL_VOL); + } + + //connect in1rn to inr1 and in1rp to inrp - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 +// val = wm8994_read(codec,WM8994_INPUT_MIXER_2); +// val &= ~( WM8994_IN1RN_TO_IN1R_MASK | WM8994_IN1RP_TO_IN1R_MASK); +// val |= (WM8994_IN1RN_TO_IN1R | WM8994_IN1RP_TO_IN1R) ; + val = (WM8994_IN1RN_TO_IN1R | WM8994_IN1RP_TO_IN1R) ; + wm8994_write(codec,WM8994_INPUT_MIXER_2,val); +#endif + + //Digital Paths + //Enable right ADC and time slot + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_ADCR_ENA_MASK |WM8994_AIF1ADC1R_ENA_MASK ); + val |= (WM8994_AIF1ADC1R_ENA | WM8994_ADCR_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4 ,val); + + //ADC Right mixer routing + val = wm8994_read(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~( WM8994_ADC1R_TO_AIF1ADC1R_MASK); + val |= WM8994_ADC1R_TO_AIF1ADC1R; + wm8994_write(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,val); + + val = wm8994_read(codec, WM8994_AIF1_MASTER_SLAVE); + val |= (WM8994_AIF1_MSTR | WM8994_AIF1_CLK_FRC | WM8994_AIF1_LRCLK_FRC); // Master mode + wm8994_write(codec, WM8994_AIF1_MASTER_SLAVE, val); + + wm8994_write( codec, WM8994_GPIO_1, 0xA101 ); // GPIO1 is Input Enable +} + +void wm8994_record_main_mic(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + DEBUG_LOG("Recording through Main Mic\n"); + audio_ctrl_mic_bias_gpio(1); + +#if defined(CONFIG_PHONE_P1_GSM) + if(!(wm8994->codec_state & CALL_ACTIVE)) // Normal case + { + // Disable FM radio path + val = wm8994_read(codec, WM8994_SPEAKER_MIXER); + val &= ~WM8994_MIXINL_TO_SPKMIXL_MASK; + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~WM8994_MIXINL_TO_MIXOUTL_MASK; + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~WM8994_MIXINR_TO_MIXOUTR_MASK; + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + val = wm8994_read(codec, WM8994_DAC2_LEFT_MIXER_ROUTING); //604H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2L_MASK); + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING); //605H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2R_MASK); + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, val); + + // Mixing left channel output to right channel. + val = wm8994_read(codec, WM8994_AIF1_CONTROL_1); //605H : 0x0010 + val &= ~(WM8994_AIF1ADCL_SRC_MASK | WM8994_AIF1ADCR_SRC_MASK); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, val); + + wm8994_write(codec, WM8994_ANTIPOP_2, 0x68); //Main mic volume issue fix: requested H/W + + //Enable micbias,vmid,mic1 + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + //Enable left input mixer and IN1L PGA - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 + //val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_2 ); + //val &= ~( WM8994_IN1L_ENA_MASK | WM8994_MIXINL_ENA_MASK ); + //val |= (WM8994_MIXINL_ENA |WM8994_IN1L_ENA ); + val = (WM8994_MIXINL_ENA |WM8994_IN1L_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, val); + + //Enable HPF Filter for google voice search + if(wm8994->recognition_active == REC_ON + ){ + val = wm8994_read(codec, WM8994_AIF1_ADC1_FILTERS); + val &= ~(WM8994_AIF1ADC1L_HPF_MASK | WM8994_AIF1ADC1R_HPF_MASK); + val |= (WM8994_AIF1ADC1L_HPF | WM8994_AIF1ADC1R_HPF); + wm8994_write(codec, WM8994_AIF1_ADC1_FILTERS ,val); + } + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Unmute IN1L PGA, update volume + val = wm8994_read(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1L_MUTE_MASK | WM8994_IN1L_VOL_MASK); + + if(wm8994->recognition_active == REC_ON) + val |= (WM8994_IN1L_VU |TUNING_RECOGNITION_MAIN_INPUTLINE_VOL); //volume + else + val |= (WM8994_IN1L_VU |TUNING_RECORD_MAIN_INPUTLINE_VOL); //volume + + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME, val); + + //Unmute the PGA + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val&= ~(WM8994_IN1L_TO_MIXINL_MASK | WM8994_IN1L_MIXINL_VOL_MASK | WM8994_MIXOUTL_MIXINL_VOL_MASK); + val |= (WM8994_IN1L_TO_MIXINL | WM8994_IN1L_MIXINL_VOL); //30db + + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + } + + //Connect IN1LN ans IN1LP to the inputs - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 + //val = wm8994_read(codec,WM8994_INPUT_MIXER_2); + //val &= (WM8994_IN1LN_TO_IN1L_MASK | WM8994_IN1LP_TO_IN1L_MASK); + //val |= (WM8994_IN1LP_TO_IN1L | WM8994_IN1LN_TO_IN1L); + val = (WM8994_IN1LP_TO_IN1L | WM8994_IN1LN_TO_IN1L); + wm8994_write(codec, WM8994_INPUT_MIXER_2, val); + + //Digital Paths + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1ADC1L_VOL_MASK); + + if(wm8994->recognition_active == REC_ON) + val |= (TUNING_RECOGNITION_MAIN_AIF1ADCL_VOL); + else + val |= (TUNING_RECORD_MAIN_AIF1ADCL_VOL); // 0db + + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1ADC1R_VOL_MASK); + + if(wm8994->recognition_active == REC_ON) + val |= (WM8994_AIF1ADC1_VU | TUNING_RECOGNITION_MAIN_AIF1ADCR_VOL); + else + val |= (WM8994_AIF1ADC1_VU | TUNING_RECORD_MAIN_AIF1ADCR_VOL); // 0db + + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME, val); + } +#elif defined(CONFIG_PHONE_P1_CDMA) + + //Enable micbias,vmid,mic1 + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | WM8994_MICB1_ENA_MASK ); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL |WM8994_MICB1_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); + + //Enable left input mixer and IN1L PGA - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 +// val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_2 ); +// val &= ~( WM8994_IN1L_ENA_MASK | WM8994_MIXINL_ENA_MASK ); +// val |= (WM8994_MIXINL_ENA |WM8994_IN1L_ENA ); + val = (WM8994_MIXINL_ENA |WM8994_IN1L_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_2,val); + + if(!wm8994->testmode_config_flag) + { + // Unmute IN1L PGA, update volume + val = wm8994_read(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1L_MUTE_MASK | WM8994_IN1L_VOL_MASK); + val |= (WM8994_IN1L_VU |TUNING_RECORD_MAIN_INPUTLINE_VOL); //volume + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME, val); + + //Unmute the PGA + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val&= ~(WM8994_IN1L_TO_MIXINL_MASK | WM8994_IN1L_MIXINL_VOL_MASK | WM8994_MIXOUTL_MIXINL_VOL_MASK); + val |= (WM8994_IN1L_MIXINL_VOL | WM8994_IN1L_TO_MIXINL); //30db + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + } + + //Connect IN1LN ans IN1LP to the inputs - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 + val = wm8994_read(codec,WM8994_INPUT_MIXER_2 ); + val &= (WM8994_IN1LN_TO_IN1L_MASK | WM8994_IN1LP_TO_IN1L_MASK ); + val |= ( WM8994_IN1LP_TO_IN1L | WM8994_IN1LN_TO_IN1L ); + wm8994_write(codec, WM8994_INPUT_MIXER_2, val); +#endif + + //Digital Paths + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_ADCL_ENA_MASK | WM8994_AIF1ADC1L_ENA_MASK); + val |= (WM8994_AIF1ADC1L_ENA | WM8994_ADCL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, val); +
+ //Enable timeslots + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING); + val |=WM8994_ADC1L_TO_AIF1ADC1L; + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_AIF1_MASTER_SLAVE); + val |= (WM8994_AIF1_MSTR | WM8994_AIF1_CLK_FRC | WM8994_AIF1_LRCLK_FRC); // Master mode + wm8994_write(codec, WM8994_AIF1_MASTER_SLAVE, val); + + wm8994_write(codec, WM8994_GPIO_1, 0xA101); // GPIO1 is Input Enable + + // for stable pcm input when start google voice recognition + if(wm8994->recognition_active == REC_ON) + { + msleep(300); + } +#ifdef CONFIG_SND_WM8994_EXTENSIONS_RECORD_PRESETS + wm8994_extensions_record_main_mic(); +#endif +} + +void wm8994_record_bluetooth(struct snd_soc_codec *codec) +{ + u16 val; + + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + DEBUG_LOG("BT Record Path for Voice Command"); + + if(!(wm8994->codec_state & CALL_ACTIVE)) // Normal case + { + wm8994_set_voicecall_common_setting(codec); + + val = wm8994_read(codec, WM8994_DAC2_LEFT_MIXER_ROUTING); //604H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2L_MASK); + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING); //605H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2R_MASK); + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, val); + + //R1(1h) - 0x0003 -normal vmid + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + /*Digital Path Enables and Unmutes*/ + //R2(2h) - 0x0000 + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, 0x0000); + + //R3(3h) - 0x0000 + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, 0x0000); + + //R4(4h) - 0x0300 + //AIF1ADC1(Left/Right) Output + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_AIF1ADC1L_ENA_MASK |WM8994_AIF1ADC1R_ENA_MASK); + val |= ( WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC1R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4 , val); + + //R5(5h) - 0x3000 + //AIF2DAC(Left/Right) Input + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5); + val &= ~(WM8994_AIF2DACL_ENA_MASK | WM8994_AIF2DACR_ENA_MASK); + val |= (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + //R6(6h) - 0x0002 + //AIF2_DACDAT_SRC(GPIO8/DACDAT3) + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_6); + val &= ~(WM8994_AIF3_ADCDAT_SRC_MASK |WM8994_AIF2_DACDAT_SRC_MASK); + val |= (0x1 << WM8994_AIF3_ADCDAT_SRC_SHIFT | WM8994_AIF2_DACDAT_SRC); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_6, val); + + /*Un-Mute*/ + //R1312(520h) - 0x0000 + //AIF2DAC_MUTE(Un-mute) + val = wm8994_read(codec, WM8994_AIF2_DAC_FILTERS_1); + val &= ~(WM8994_AIF2DAC_MUTE_MASK); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, val); + + /*Mixer Routing*/ + //R1542(606h) - 0x0002 + //AIF2DACL_TO_AIF1ADC1L + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF2DACL_TO_AIF1ADC1L_MASK); + val |= (WM8994_AIF2DACL_TO_AIF1ADC1L); + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, val); + + //R1543(607h) - 0x0002 + //AIF2DACR_TO_AIF1ADC1R + val = wm8994_read(codec, WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_AIF2DACR_TO_AIF1ADC1R_MASK); + val |= (WM8994_AIF2DACR_TO_AIF1ADC1R); + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING, val); + + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); + + wm8994_write(codec, WM8994_OVERSAMPLING, 0X0000); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + //Digital Paths + //Enable HPF Filter for google voice search + if(wm8994->recognition_active == REC_ON + ){ + val = wm8994_read(codec,WM8994_AIF1_ADC1_FILTERS ); + val &= ~(WM8994_AIF1ADC1L_HPF_MASK | WM8994_AIF1ADC1R_HPF_MASK); + //val |= (WM8994_AIF1ADC1L_HPF | WM8994_AIF1ADC1R_HPF); //HPF off + wm8994_write(codec,WM8994_AIF1_ADC1_FILTERS ,val); + } + + //AIF1_ADC1 volume + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1ADC1L_VOL_MASK); + if(wm8994->recognition_active == REC_ON) + val |= (TUNING_RECOGNITION_BT_AIF1ADC1L_VOL); + else + val |= (TUNING_RECORD_BT_AIF1ADC1L_VOL); + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1ADC1R_VOL_MASK); + if(wm8994->recognition_active == REC_ON) + val |= (WM8994_AIF1ADC1_VU | TUNING_RECOGNITION_BT_AIF1ADC1R_VOL); + else + val |= (WM8994_AIF1ADC1_VU | TUNING_RECORD_BT_AIF1ADC1R_VOL); + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME, val); + + //AIF2DAC volume + val = wm8994_read(codec, WM8994_AIF2_DAC_LEFT_VOLUME); + val &= ~(WM8994_AIF2DACL_VOL_MASK); + if(wm8994->recognition_active == REC_ON) + val |= (TUNING_RECOGNITION_BT_AIF2DACL_VOL); + else + val |= (TUNING_RECORD_BT_AIF2DACL_VOL); + wm8994_write(codec, WM8994_AIF2_DAC_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF2_DAC_RIGHT_VOLUME); + val &= ~(WM8994_AIF2DACR_VOL_MASK); + if(wm8994->recognition_active == REC_ON) + val |= (WM8994_AIF2DAC_VU | TUNING_RECOGNITION_BT_AIF2DACR_VOL); + else + val |= (WM8994_AIF2DAC_VU | TUNING_RECORD_BT_AIF2DACR_VOL); + wm8994_write(codec, WM8994_AIF2_DAC_RIGHT_VOLUME, val); + } + else + { + //volume update (for HwCodec Tuning) + val = wm8994_read(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME); + val |= WM8994_AIF1ADC1_VU; + wm8994_write(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF2_DAC_RIGHT_VOLUME); + val |= WM8994_AIF2DAC_VU; + wm8994_write(codec, WM8994_AIF2_DAC_RIGHT_VOLUME, val); + } + + /*GPIO Configuration*/ + wm8994_write(codec, WM8994_GPIO_8, WM8994_GP8_DIR | WM8994_GP8_DB); + wm8994_write(codec, WM8994_GPIO_9, WM8994_GP9_DB); + wm8994_write(codec, WM8994_GPIO_10, WM8994_GP10_DB); + wm8994_write(codec, WM8994_GPIO_11, WM8994_GP11_DB); + } +} + +void wm8994_set_playback_receiver(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + DEBUG_LOG(""); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_5); + val &= ~(WM8994_DACL_MIXOUTL_VOL_MASK); + val |= TUNING_RCV_OUTMIX5_VOL << WM8994_DACL_MIXOUTL_VOL_SHIFT; + wm8994_write(codec,WM8994_OUTPUT_MIXER_5, val ); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_6); + val &= ~(WM8994_DACR_MIXOUTR_VOL_MASK); + val |= TUNING_RCV_OUTMIX6_VOL << WM8994_DACR_MIXOUTR_VOL_SHIFT; + wm8994_write(codec,WM8994_OUTPUT_MIXER_6, val ); + + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_RCV_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_RCV_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_HPOUT2_VOLUME); + val &= ~(WM8994_HPOUT2_MUTE_MASK | WM8994_HPOUT2_VOL_MASK); + val |= TUNING_HPOUT2_VOL << WM8994_HPOUT2_VOL_SHIFT; + wm8994_write(codec,WM8994_HPOUT2_VOLUME, val ); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + } + + val = wm8994_read(codec,WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_MIXOUTL_MASK); + val |= (WM8994_DAC1L_TO_MIXOUTL); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1,val); + + val = wm8994_read(codec,WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_MIXOUTR_MASK); + val |= (WM8994_DAC1R_TO_MIXOUTR); + wm8994_write(codec,WM8994_OUTPUT_MIXER_2,val); + + val = wm8994_read(codec,WM8994_HPOUT2_MIXER); + val &= ~(WM8994_MIXOUTLVOL_TO_HPOUT2_MASK | WM8994_MIXOUTRVOL_TO_HPOUT2_MASK); + val |= (WM8994_MIXOUTRVOL_TO_HPOUT2 | WM8994_MIXOUTLVOL_TO_HPOUT2); + wm8994_write(codec,WM8994_HPOUT2_MIXER,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_5); + val &= ~(WM8994_DAC1R_ENA_MASK | WM8994_DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK); + val |= (WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA | WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_5,val); + + val = wm8994_read(codec,WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK |WM8994_AIF1DAC1_MONO_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE | WM8994_AIF1DAC1_MONO); + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1,val); + + val = wm8994_read(codec,WM8994_DAC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK); + val |= (WM8994_AIF1DAC1L_TO_DAC1L); + wm8994_write(codec,WM8994_DAC1_LEFT_MIXER_ROUTING,val); + + val = wm8994_read(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK); + val |= (WM8994_AIF1DAC1R_TO_DAC1R); + wm8994_write(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING,val); + + val = wm8994_read(codec, WM8994_CLOCKING_1); + val &= ~(WM8994_DSP_FS1CLK_ENA_MASK | WM8994_DSP_FSINTCLK_ENA_MASK); + val |= (WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + val |= (WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTLVOL_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_3,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | WM8994_HPOUT2_ENA_MASK ); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_HPOUT2_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); +} + +void wm8994_set_playback_headset(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + u16 TestReturn1=0; + u16 TestReturn2=0; + u16 TestLow1=0; + u16 TestHigh1=0; + u8 TestLow=0; + u8 TestHigh=0; + + DEBUG_LOG(""); + + //Configuring the Digital Paths + + // Enable the Timeslot0 to DAC1L + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING ); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK); + val |= WM8994_AIF1DAC1L_TO_DAC1L; + wm8994_write(codec,WM8994_DAC1_LEFT_MIXER_ROUTING ,val); + + //Enable the Timeslot0 to DAC1R + val = wm8994_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING ); + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK); + val |= WM8994_AIF1DAC1R_TO_DAC1R; + wm8994_write(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING ,val); + + val = wm8994_read(codec, 0x102 ); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, 0x56 ); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x56,val); + + val = wm8994_read(codec, 0x102 ); + val &= ~(0x0000); + val = 0x0000; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, WM8994_CLASS_W_1 ); + val &= ~(0x0005); + val |= 0x0005; + wm8994_write(codec,WM8994_CLASS_W_1,val); + + // Headset Control + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + val = wm8994_read(codec,WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + if(wm8994->ringtone_active) + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_RING_OUTPUTL_VOL); + else + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_MP3_OUTPUTL_VOL); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + + val = wm8994_read(codec,WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + if(wm8994->ringtone_active) + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_RING_OUTPUTR_VOL); + else + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_MP3_OUTPUTR_VOL); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + + + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + if(wm8994->ringtone_active) + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_RING_OPGAL_VOL); + else + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_MP3_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + if(wm8994->ringtone_active) + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_RING_OPGAR_VOL); + else + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_MP3_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + } + + val = wm8994_read(codec, WM8994_DC_SERVO_2 ); + val &= ~(0x03E0); + val = 0x03E0; + wm8994_write(codec,WM8994_DC_SERVO_2,val); + + //Enable vmid,bias, hp left and right + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); +#if defined(CONFIG_PHONE_P1_GSM) + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK |WM8994_HPOUT1L_ENA_MASK |WM8994_HPOUT1R_ENA_MASK | WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK ); +#elif defined(CONFIG_PHONE_P1_CDMA) + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK |WM8994_HPOUT1L_ENA_MASK |WM8994_HPOUT1R_ENA_MASK); +#endif + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_HPOUT1R_ENA |WM8994_HPOUT1L_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); + + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1 ); + val &= ~(0x0022); + val = 0x0022; + wm8994_write(codec,WM8994_ANALOGUE_HP_1,val); + + //Enable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA | WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, val); + + msleep(5); + + //Enable Dac1 and DAC2 and the Timeslot0 for AIF1 + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5 ); + val &= ~(WM8994_DAC1R_ENA_MASK | WM8994_DAC1L_ENA_MASK|WM8994_AIF1DAC1R_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK ); + val |= (WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA | WM8994_DAC1L_ENA |WM8994_DAC1R_ENA ); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5 ,val); + + // Enable DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + val |= WM8994_DAC1L_TO_MIXOUTL ; + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); // Enable MIXOUT + + // Enable DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + val |= WM8994_DAC1R_TO_MIXOUTR; + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + val |= (WM8994_MIXOUTLVOL_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, 0x0030); + + val = wm8994_read(codec, WM8994_DC_SERVO_1 ); + val &= ~(0x0303); + val = 0x0303; + wm8994_write(codec,WM8994_DC_SERVO_1,val); + + msleep(160); // 160ms delay + + TestReturn1=wm8994_read(codec,WM8994_DC_SERVO_4); + + TestLow=(signed char)(TestReturn1 & 0xff); + TestHigh=(signed char)((TestReturn1>>8) & 0xff); + + TestLow1=((signed short)(TestLow-5))&0x00ff; + TestHigh1=(((signed short)(TestHigh-5)<<8)&0xff00); + TestReturn2=TestLow1|TestHigh1; + wm8994_write(codec,WM8994_DC_SERVO_4, TestReturn2); + + val = wm8994_read(codec, WM8994_DC_SERVO_1 ); + val &= ~(0x000F); + val = 0x000F; + wm8994_write(codec,WM8994_DC_SERVO_1,val); + + msleep(20); + + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + val = (WM8994_HPOUT1L_RMV_SHORT | WM8994_HPOUT1L_OUTP|WM8994_HPOUT1L_DLY |WM8994_HPOUT1R_RMV_SHORT | + WM8994_HPOUT1R_OUTP | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + // Unmute the AF1DAC1 + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1 ); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK | WM8994_AIF1DAC1_MONO_MASK); + val |= WM8994_AIF1DAC1_UNMUTE; + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1 ,val); +} + +void wm8994_set_playback_speaker(struct snd_soc_codec *codec) +{ + u16 val; + + DEBUG_LOG(""); + + //Disable end point for preventing pop up noise. + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); +#if defined(CONFIG_PHONE_P1_GSM) + val &= ~(WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK | WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK); +#elif defined(CONFIG_PHONE_P1_CDMA) + val &= ~(WM8994_SPKOUTL_ENA_MASK); +#endif + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~( WM8994_SPKLVOL_ENA_MASK | WM8994_SPKRVOL_ENA_MASK ); + val |= ( WM8994_SPKLVOL_ENA | WM8994_SPKRVOL_ENA ); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + // Speaker Volume Control + // Unmute the SPKMIXVOLUME + val = wm8994_read(codec, WM8994_SPKMIXL_ATTENUATION); + val &= ~(WM8994_SPKMIXL_VOL_MASK); + val |= TUNING_SPKMIXL_ATTEN; + wm8994_write(codec, WM8994_SPKMIXL_ATTENUATION, val); + + val = wm8994_read(codec,WM8994_SPKMIXR_ATTENUATION); + val &= ~(WM8994_SPKMIXR_VOL_MASK); + val |= TUNING_SPKMIXR_ATTEN; + wm8994_write(codec, WM8994_SPKMIXR_ATTENUATION, val); + + val = wm8994_read(codec,WM8994_SPEAKER_VOLUME_LEFT ); + val &= ~(WM8994_SPKOUT_VU_MASK | WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + val |=(WM8994_SPKOUT_VU | WM8994_SPKOUTL_MUTE_N | TUNING_MP3_SPKL_VOL ); + wm8994_write(codec,WM8994_SPEAKER_VOLUME_LEFT ,val); + + val = wm8994_read(codec,WM8994_SPEAKER_VOLUME_RIGHT ); + val &= ~(WM8994_SPKOUT_VU_MASK | WM8994_SPKOUTR_MUTE_N_MASK | WM8994_SPKOUTR_VOL_MASK); + val |=(WM8994_SPKOUT_VU | WM8994_SPKOUTR_MUTE_N | TUNING_MP3_SPKR_VOL ); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_RIGHT ,val); + + /* Tunning Mobile Parameteric Equalizer 2010.05.13 */ + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_GAINS_1, 0x3319); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_GAINS_2, 0x6300); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_1_A, 0x0F71); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_1_B, 0x0403); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_1_PG, 0x023C); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_A, 0x1EB5); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_B, 0xF145); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_C, 0x0B75); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_PG, 0x01C5); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_A, 0x1C58); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_B, 0xF373); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_C, 0x0A54); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_PG, 0x0558); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_A, 0x168E); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_B, 0xF829); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_C, 0x07AD); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_PG, 0x1103); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_5_A, 0xFA14); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_5_B, 0x0400); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_5_PG, 0x2850); + + val = wm8994_read(codec,WM8994_CLASSD ); + val &= ~(0x3F); + val |= 0x24; + wm8994_write(codec,WM8994_CLASSD ,val); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1L_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); +#if defined(CONFIG_PHONE_P1_GSM) + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); +#elif defined(CONFIG_PHONE_P1_CDMA) + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); +#endif + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + val |= (WM8994_SPKMIXL_TO_SPKOUTL | WM8994_SPKMIXR_TO_SPKOUTR ); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + //Unmute the DAC path + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK | WM8994_DAC1R_TO_SPKMIXR_MASK); + val |= (WM8994_DAC1L_TO_SPKMIXL | WM8994_DAC1R_TO_SPKMIXR ) ; + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + // Eable DAC1 Left and timeslot left + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_5); + val &= ~( WM8994_DAC1L_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK | WM8994_DAC1R_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK ); + val |= (WM8994_AIF1DAC1L_ENA | WM8994_DAC1L_ENA | WM8994_AIF1DAC1R_ENA | WM8994_DAC1R_ENA ); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + //Unmute + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK | WM8994_AIF1DAC1_MONO_MASK); + val |= WM8994_AIF1DAC1_UNMUTE; + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + + //enable timeslot0 to left dac + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK); + val |= WM8994_AIF1DAC1L_TO_DAC1L; + wm8994_write(codec, WM8994_DAC1_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING ); + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK ); + val |= WM8994_AIF1DAC1R_TO_DAC1R; + wm8994_write(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING ,val); + +#ifdef CONFIG_SND_WM8994_EXTENSIONS + wm8994_extensions_playback_speaker(); +#endif + + //Enbale bias,vmid and Left speaker + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK |WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK ); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_SPKOUTL_ENA | WM8994_SPKOUTR_ENA ); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); +} + + +void wm8994_set_playback_speaker_headset(struct snd_soc_codec *codec) +{ + + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + u16 nReadServo4Val = 0; + u16 ncompensationResult = 0; + u16 nCompensationResultLow=0; + u16 nCompensationResultHigh=0; + u8 nServo4Low = 0; + u8 nServo4High = 0; + + //------------------ Common Settings ------------------ + // Enable the Timeslot0 to DAC1L + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING ); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK); + val |= WM8994_AIF1DAC1L_TO_DAC1L; + wm8994_write(codec,WM8994_DAC1_LEFT_MIXER_ROUTING ,val); + + //Enable the Timeslot0 to DAC1R + val = wm8994_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING ); + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK); + val |= WM8994_AIF1DAC1R_TO_DAC1R; + wm8994_write(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING ,val); + + + /* Tunning Mobile Parameteric Equalizer 2010.05.13 */ + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_GAINS_1, 0x3319); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_GAINS_2, 0x6300); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_1_A, 0x0F71); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_1_B, 0x0403); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_1_PG, 0x023C); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_A, 0x1EB5); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_B, 0xF145); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_C, 0x0B75); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_2_PG, 0x01C5); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_A, 0x1C58); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_B, 0xF373); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_C, 0x0A54); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_3_PG, 0x0558); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_A, 0x168E); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_B, 0xF829); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_C, 0x07AD); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_4_PG, 0x1103); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_5_A, 0xFA14); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_5_B, 0x0400); + wm8994_write( codec,WM8994_AIF1_DAC1_EQ_BAND_5_PG, 0x2850); + + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU | TUNING_DAC1R_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + + //------------------ Speaker Path Settings ------------------ + + // Speaker Volume Control + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + val = wm8994_read(codec,WM8994_SPEAKER_VOLUME_LEFT); + val &= ~(WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + val |= (WM8994_SPKOUTL_MUTE_N | TUNING_MP3_SPKL_VOL); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_LEFT, val); + + val = wm8994_read(codec,WM8994_SPEAKER_VOLUME_RIGHT); + val &= ~(WM8994_SPKOUTR_MUTE_N_MASK | WM8994_SPKOUTR_VOL_MASK); + val |= (WM8994_SPKOUT_VU | WM8994_SPKOUTL_MUTE_N | TUNING_MP3_SPKL_VOL); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_RIGHT, val); + + val = wm8994_read(codec,WM8994_CLASSD ); + val &= ~(0x3F); + val |= 0x24; + wm8994_write(codec,WM8994_CLASSD ,val); + } + + + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS ); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + val |= WM8994_SPKMIXL_TO_SPKOUTL; + val |= WM8994_SPKMIXR_TO_SPKOUTR; + wm8994_write(codec,WM8994_SPKOUT_MIXERS,val ); + + //Unmute the DAC path + val = wm8994_read(codec,WM8994_SPEAKER_MIXER ); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK | WM8994_DAC1R_TO_SPKMIXR_MASK); + val |= ( WM8994_DAC1L_TO_SPKMIXL | WM8994_DAC1R_TO_SPKMIXR ); + wm8994_write(codec,WM8994_SPEAKER_MIXER ,val); + + //------------------ Ear Path Settings ------------------ + //Configuring the Digital Paths + val = wm8994_read(codec, 0x102); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, 0x56 ); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x56,val); + + val = wm8994_read(codec, 0x102 ); + val &= ~(0x0000); + val = 0x0000; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, WM8994_CLASS_W_1 ); + val &= ~(0x0005); + val = 0x0005; + wm8994_write(codec,WM8994_CLASS_W_1,val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + val = wm8994_read(codec,WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_MP3_DUAL_OUTPUTL_VOL); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec,WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_MP3_DUAL_OUTPUTR_VOL); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + } + + //* DC Servo Series Count + val = 0x03E0; + wm8994_write(codec, WM8994_DC_SERVO_2, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | +#if defined(CONFIG_PHONE_P1_GSM) + WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK | WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK ); +#elif defined(CONFIG_PHONE_P1_CDMA) + WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK | WM8994_SPKOUTL_ENA_MASK); +#endif + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | + WM8994_HPOUT1R_ENA | WM8994_HPOUT1L_ENA | WM8994_SPKOUTL_ENA | WM8994_SPKOUTR_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); + + val = (WM8994_HPOUT1L_DLY | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + //Enable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA | WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, val); + + msleep(5); + + //Enable DAC1 and DAC2 and the Timeslot0 for AIF1 + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_5 ); + val &= ~(WM8994_DAC1R_ENA_MASK | WM8994_DAC1L_ENA_MASK|WM8994_AIF1DAC1R_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK ); + val |= (WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA | WM8994_DAC1L_ENA |WM8994_DAC1R_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_5,val); + + // Enbale DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + val |= WM8994_DAC1L_TO_MIXOUTL; + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); + + // Enbale DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + val |= WM8994_DAC1R_TO_MIXOUTR; + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + //Enbale bias,vmid, hp left and right and Left speaker + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK | WM8994_SPKLVOL_ENA_MASK); + val |= (WM8994_MIXOUTLVOL_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA | WM8994_SPKLVOL_ENA | WM8994_SPKRVOL_ENA ); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3 ,val); + + //* DC Servo + val = (WM8994_DCS_TRIG_SERIES_1 | WM8994_DCS_TRIG_SERIES_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, 0x0303 ); + + msleep(160); + + nReadServo4Val=wm8994_read(codec,WM8994_DC_SERVO_4); + nServo4Low=(signed char)(nReadServo4Val & 0xff); + nServo4High=(signed char)((nReadServo4Val>>8) & 0xff); + + nCompensationResultLow=((signed short)nServo4Low -5)&0x00ff; + nCompensationResultHigh=((signed short)(nServo4High -5)<<8)&0xff00; + ncompensationResult=nCompensationResultLow|nCompensationResultHigh; + wm8994_write(codec,WM8994_DC_SERVO_4, ncompensationResult); + + val = (WM8994_DCS_TRIG_DAC_WR_1 | WM8994_DCS_TRIG_DAC_WR_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, val ); + + msleep(15); + + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + val |= (WM8994_HPOUT1L_RMV_SHORT | WM8994_HPOUT1L_OUTP|WM8994_HPOUT1L_DLY |WM8994_HPOUT1R_RMV_SHORT | + WM8994_HPOUT1R_OUTP | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + } + + //------------------ Common Settings ------------------ + // Unmute the AIF1DAC1 + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1 ); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK | WM8994_AIF1DAC1_MONO_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE | WM8994_AIF1DAC1_MONO); + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1 ,val); + + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Unmute the SPKMIXVOLUME + val = wm8994_read(codec, WM8994_SPKMIXL_ATTENUATION); + val &= ~(WM8994_SPKMIXL_VOL_MASK); + val |= TUNING_SPKMIXL_ATTEN; + wm8994_write(codec, WM8994_SPKMIXL_ATTENUATION, val); + + val = wm8994_read(codec,WM8994_SPKMIXR_ATTENUATION); + val &= ~(WM8994_SPKMIXR_VOL_MASK); + val |= TUNING_SPKMIXR_ATTEN; + wm8994_write(codec, WM8994_SPKMIXR_ATTENUATION, val); + } +} + + +void wm8994_set_playback_bluetooth(struct snd_soc_codec *codec) +{ + u16 val; + + DEBUG_LOG("BT Playback Path for Voice Command\n"); + + + wm8994_set_voicecall_common_setting(codec); + + //R1(1h) - 0x0003 -normal vmid + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + /*Digital Path Enables and Unmutes*/ + //R2(2h) - 0x0000 + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, 0x0000); + + //R3(3h) - 0x0000 + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, 0x0000); + + //R4(4h) - 0x3000 + //AIF2ADC(Left/Right) Output + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_4 ); + val &= ~(WM8994_AIF2ADCL_ENA_MASK |WM8994_AIF2ADCR_ENA_MASK); + val |= ( WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4 , val); + + //R5(5h) - 0x0300 + //AIF1DAC1(Left/Right) Input + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5); //05 : 3303 + val &= ~(WM8994_AIF2DACL_ENA_MASK | WM8994_AIF2DACR_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK + | WM8994_DAC1L_ENA_MASK | WM8994_DAC1R_ENA_MASK); + val |= (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA + | WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + //R6(6h) - 0x0008 + //AIF3_ADCDAT_SRC(AIF2ADCDAT2) + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_6); + val &= ~(WM8994_AIF3_ADCDAT_SRC_MASK); + val |= (0x0001 << WM8994_AIF3_ADCDAT_SRC_SHIFT); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_6, val); + + /*Un-Mute*/ + //R1056(420h) - 0x0000 + //AIF1DAC1_MUTE(Un-mute) + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK | WM8994_AIF1DAC1_MONO_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE); + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + + /*Mixer Routing*/ + //R1540(604h) - 0x0004 + //AIF2DACL_TO_DAC2L + val = wm8994_read(codec, WM8994_DAC2_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1L_TO_DAC2L_MASK); + val |= (WM8994_AIF1DAC1L_TO_DAC2L); + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, val); + + //R1541(605h) - 0x0004 + //AIF2DACR_TO_DAC2R + val = wm8994_read(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1R_TO_DAC2R_MASK); + val |= (WM8994_AIF1DAC1R_TO_DAC2R); + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, val); + + /*Volume*/ + wm8994_write(codec, WM8994_DAC2_LEFT_VOLUME, 0x01C0); + wm8994_write(codec, WM8994_DAC2_RIGHT_VOLUME, 0x01C0); + + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); + + wm8994_write(codec, WM8994_OVERSAMPLING, 0X0000); + + /*GPIO Configuration*/ + wm8994_write(codec, WM8994_GPIO_8, WM8994_GP8_DIR | WM8994_GP8_DB); + wm8994_write(codec, WM8994_GPIO_9, WM8994_GP9_DB); + wm8994_write(codec, WM8994_GPIO_10, WM8994_GP10_DB); + wm8994_write(codec, WM8994_GPIO_11, WM8994_GP11_DB); +} + +void wm8994_set_playback_extra_dock_speaker(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + DEBUG_LOG(""); + + wm8994_write(codec, WM8994_ANTIPOP_2, 0x0048); + + //OUTPUT mute + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_LINEOUT2N_ENA_MASK | WM8994_LINEOUT2P_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_5); + val &= ~(WM8994_DACL_MIXOUTL_VOL_MASK); + val |= TUNING_EXTRA_DOCK_SPK_OUTMIX5_VOL << WM8994_DACL_MIXOUTL_VOL_SHIFT; + wm8994_write(codec,WM8994_OUTPUT_MIXER_5, val ); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_6); + val &= ~(WM8994_DACR_MIXOUTR_VOL_MASK); + val |= TUNING_EXTRA_DOCK_SPK_OUTMIX6_VOL << WM8994_DACR_MIXOUTR_VOL_SHIFT; + wm8994_write(codec,WM8994_OUTPUT_MIXER_6, val ); + + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_MP3_EXTRA_DOCK_SPK_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_MP3_EXTRA_DOCK_SPK_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + + val = wm8994_read(codec,WM8994_LINE_OUTPUTS_VOLUME); + val &= ~(WM8994_LINEOUT2_VOL_MASK); + val |= (TUNING_MP3_EXTRA_DOCK_SPK_VOL << WM8994_LINEOUT2_VOL_SHIFT); + wm8994_write(codec,WM8994_LINE_OUTPUTS_VOLUME,val); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + } + + val = wm8994_read(codec,WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_MIXOUTL_MASK); + val |= (WM8994_DAC1L_TO_MIXOUTL); + wm8994_write(codec,WM8994_OUTPUT_MIXER_1,val); + + val = wm8994_read(codec,WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_MIXOUTR_MASK); + val |= (WM8994_DAC1R_TO_MIXOUTR); + wm8994_write(codec,WM8994_OUTPUT_MIXER_2,val); + + + val = wm8994_read(codec,WM8994_LINE_MIXER_2); + val &= ~(WM8994_MIXOUTR_TO_LINEOUT2N_MASK | WM8994_MIXOUTL_TO_LINEOUT2N_MASK | WM8994_LINEOUT2_MODE_MASK | WM8994_MIXOUTR_TO_LINEOUT2P_MASK); + val |= (WM8994_MIXOUTL_TO_LINEOUT2N | WM8994_LINEOUT2_MODE | WM8994_MIXOUTR_TO_LINEOUT2P); + wm8994_write(codec,WM8994_LINE_MIXER_2,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_5); + val &= ~(WM8994_DAC1R_ENA_MASK | WM8994_DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK); + val |= (WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA | WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_5,val); + + val = wm8994_read(codec,WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK |WM8994_AIF1DAC1_MONO_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE); + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1,val); + + val = wm8994_read(codec,WM8994_LINE_OUTPUTS_VOLUME); + val &= ~(WM8994_LINEOUT2N_MUTE_MASK | WM8994_LINEOUT2P_MUTE_MASK); + wm8994_write(codec,WM8994_LINE_OUTPUTS_VOLUME,val); + + val = wm8994_read(codec,WM8994_DAC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK); + val |= (WM8994_AIF1DAC1L_TO_DAC1L); + wm8994_write(codec,WM8994_DAC1_LEFT_MIXER_ROUTING,val); + + val = wm8994_read(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK); + val |= (WM8994_AIF1DAC1R_TO_DAC1R); + wm8994_write(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING,val); + + val = wm8994_read(codec, WM8994_CLOCKING_1); + val &= ~(WM8994_DSP_FS1CLK_ENA_MASK | WM8994_DSP_FSINTCLK_ENA_MASK); + val |= (WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_3); +#if defined(CONFIG_PHONE_P1_GSM) + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + val |= (WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTLVOL_ENA); +#elif defined(CONFIG_PHONE_P1_CDMA) + val &= ~(WM8994_LINEOUT2N_ENA_MASK | WM8994_LINEOUT2P_ENA_MASK | WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + val |= (WM8994_LINEOUT2N_ENA | WM8994_LINEOUT2P_ENA | WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTLVOL_ENA); +#endif + wm8994_write(codec,WM8994_POWER_MANAGEMENT_3,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); +#if defined(CONFIG_PHONE_P1_GSM) + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | WM8994_HPOUT2_ENA_MASK | WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK + | WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK); +#elif defined(CONFIG_PHONE_P1_CDMA) + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | WM8994_HPOUT2_ENA_MASK ); +#endif + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); + + /* To enhance THD, Ch Seperation Characteristic (2010.08.19, KDS)*/ + val = wm8994_read(codec,WM8994_ADDITIONAL_CONTROL ); + val &= ~(WM8994_LINEOUT1_FB_MASK | WM8994_LINEOUT2_FB_MASK ); + /* To tune THD, Power of each frequency (2010.09.15, KDS)*/ + // val |= WM8994_LINEOUT2_FB ; + wm8994_write(codec,WM8994_ADDITIONAL_CONTROL,val); + + /* To tune THD, Power of each frequency (2010.09.15, KDS)*/ + val = wm8994_read(codec,WM8994_ANTIPOP_1); + val &= ~(WM8994_LINEOUT_VMID_BUF_ENA_MASK | WM8994_HPOUT2_IN_ENA_MASK | WM8994_LINEOUT1_DISCH_MASK | WM8994_LINEOUT2_DISCH_MASK); + val |= WM8994_LINEOUT_VMID_BUF_ENA ; + wm8994_write(codec,WM8994_ANTIPOP_1,val); + +#if defined(CONFIG_PHONE_P1_GSM) + msleep(230); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_LINEOUT2N_ENA_MASK | WM8994_LINEOUT2P_ENA_MASK); + val |= (WM8994_LINEOUT2N_ENA | WM8994_LINEOUT2P_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); +#endif +} + + +void wm8994_set_playback_hdmi_tvout(struct snd_soc_codec *codec) +{ + int val; + + DEBUG_LOG(""); + + //Disable all output + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_HPOUT2_ENA_MASK | WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK + | WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_LINEOUT2N_ENA_MASK | WM8994_LINEOUT2P_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + wm8994_write(codec, WM8994_AIF1_BCLK, 0x70); +} + + +void wm8994_set_playback_speaker_hdmitvout(struct snd_soc_codec *codec) +{ + DEBUG_LOG(""); + + wm8994_write(codec, WM8994_AIF1_BCLK, 0x70); + + wm8994_set_playback_speaker(codec); +} + + +void wm8994_set_playback_speakerheadset_hdmitvout(struct snd_soc_codec *codec) +{ + DEBUG_LOG(""); + + wm8994_write(codec, WM8994_AIF1_BCLK, 0x70); + + wm8994_set_playback_speaker_headset(codec); +} + + +void wm8994_set_voicecall_common_setting(struct snd_soc_codec *codec) +{ + int val; + + /*GPIO Configuration*/ + wm8994_write(codec, WM8994_GPIO_1, 0xA101); + wm8994_write(codec, WM8994_GPIO_2, 0x8100); +#if defined(CONFIG_PHONE_P1_GSM) + wm8994_write(codec, WM8994_GPIO_3, 0x0100); + wm8994_write(codec, WM8994_GPIO_4, 0x0100); + wm8994_write(codec, WM8994_GPIO_5, 0x8100); +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec, WM8994_GPIO_3, 0x8100); // GPIO 3. Speech PCM Clock + wm8994_write(codec, WM8994_GPIO_4, 0x8100); // GPIO 4. Speech PCM Sync + wm8994_write(codec, WM8994_GPIO_5, 0x8100); // GPIO 5. Speech PCM Data Out +#endif + wm8994_write(codec, WM8994_GPIO_6, 0xA101); + wm8994_write(codec, WM8994_GPIO_7, 0x0100); // GPIO 7. Speech PCM Data Input + wm8994_write(codec, WM8994_GPIO_8, 0xA101); + wm8994_write(codec, WM8994_GPIO_9, 0xA101); + wm8994_write(codec, WM8994_GPIO_10, 0xA101); + wm8994_write(codec, WM8994_GPIO_11, 0xA101); + + /*FLL2 Setting*/ + wm8994_write(codec, WM8994_FLL2_CONTROL_2, 0x2F00); + wm8994_write(codec, WM8994_FLL2_CONTROL_3, 0x3126); + wm8994_write(codec, WM8994_FLL2_CONTROL_4, 0x0100); + wm8994_write(codec, WM8994_FLL2_CONTROL_5, 0x0C88); +// wm8994_write(codec, WM8994_FLL2_CONTROL_5, 0x0C89); // CP 24MHz + wm8994_write(codec, WM8994_FLL2_CONTROL_1, WM8994_FLL2_FRACN_ENA | WM8994_FLL2_ENA); +#if defined(CONFIG_PHONE_P1_GSM) + val = wm8994_read(codec, WM8994_AIF2_CLOCKING_1); + if(!(val & WM8994_AIF2CLK_ENA)) + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0018); +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); +#endif + wm8994_write(codec, WM8994_AIF2_RATE, 0x3 << WM8994_AIF2CLK_RATE_SHIFT); + + // AIF2 Interface - PCM Stereo mode + wm8994_write(codec, WM8994_AIF2_CONTROL_1, //Left Justified, BCLK invert, LRCLK Invert + WM8994_AIF2ADCR_SRC | WM8994_AIF2_BCLK_INV |0x18); + + wm8994_write(codec, WM8994_AIF2_BCLK, 0x70); + wm8994_write(codec, WM8994_AIF2_CONTROL_2, 0x0000); +#if defined(CONFIG_PHONE_P1_GSM) + wm8994_write(codec, WM8994_AIF2_MASTER_SLAVE, WM8994_AIF2_MSTR | WM8994_AIF2_CLK_FRC | WM8994_AIF2_LRCLK_FRC); //Master +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec, WM8994_AIF2_MASTER_SLAVE, 0x0000); +#endif + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5); //05 : 3303 + val &= ~(WM8994_AIF2DACL_ENA_MASK | WM8994_AIF2DACR_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK + | WM8994_DAC1L_ENA_MASK | WM8994_DAC1R_ENA_MASK); + val |= (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA + | WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + /*Clocking*/ + val = wm8994_read(codec, WM8994_CLOCKING_1); + val |= (WM8994_DSP_FS2CLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, val); + + wm8994_write(codec, WM8994_POWER_MANAGEMENT_6, 0x0); + +// wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, 0x0); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_3 ); + val &= ~( WM8994_SPKLVOL_ENA_MASK | WM8994_SPKRVOL_ENA_MASK ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_3 ,val); + + + val = wm8994_read(codec,WM8994_SPEAKER_MIXER ); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK | WM8994_DAC1R_TO_SPKMIXR_MASK); + wm8994_write(codec,WM8994_SPEAKER_MIXER ,val); + + + // AIF1 & AIF2 Output is connected to DAC1 + val = wm8994_read(codec,WM8994_DAC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK | WM8994_AIF2DACL_TO_DAC1L_MASK); + val |= (WM8994_AIF1DAC1L_TO_DAC1L | WM8994_AIF2DACL_TO_DAC1L); + wm8994_write(codec,WM8994_DAC1_LEFT_MIXER_ROUTING, val ); + + val = wm8994_read(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK | WM8994_AIF2DACR_TO_DAC1R_MASK); + val |= (WM8994_AIF1DAC1R_TO_DAC1R | WM8994_AIF2DACR_TO_DAC1R); + wm8994_write(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + + wm8994_write(codec, 0x6, 0x0); +} + +void wm8994_set_voicecall_receiver(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + int val; + + DEBUG_LOG("set_voicecall_receiver"); + + audio_ctrl_mic_bias_gpio(1); + + wm8994_set_voicecall_common_setting(codec); + + wm8994_write(codec, WM8994_CHARGE_PUMP_1, WM8994_CP_ENA_DEFAULT); // Turn off charge pump. + + // Analogue Input Configuration -Main MIC + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, + WM8994_TSHUT_ENA | WM8994_TSHUT_OPDIS | WM8994_MIXINL_ENA | WM8994_IN1L_ENA); + + wm8994_write(codec, WM8994_INPUT_MIXER_2, WM8994_IN1LP_TO_IN1L | WM8994_IN1LN_TO_IN1L); // differential(3) or single ended(1) + + /* Digital Path Enables and Unmutes*/ + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, WM8994_AIF2ADCL_ENA | WM8994_ADCL_ENA); +#if defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5 , + WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA | + WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_6, 0x0000); +#endif + + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1, 0x0000 ); //AIF1DAC1 Unmute, Mono Mix diable, Fast Ramp + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, 0x0000 ); //AIF2DAC Unmute, Mono Mix diable, Fast Ramp + + wm8994_write(codec, WM8994_DAC2_MIXER_VOLUMES, 0x000C); + wm8994_write(codec, WM8994_DAC2_LEFT_VOLUME, 0x01C0 ); + wm8994_write(codec, WM8994_DAC2_RIGHT_VOLUME, 0x01C0 ); + +#if defined(CONFIG_PHONE_P1_CDMA) + // AIF1 & AIF2 Output is connected to DAC1 + wm8994_write(codec, WM8994_DAC1_LEFT_MIXER_ROUTING, WM8994_AIF2DACL_TO_DAC1L | WM8994_AIF1DAC1L_TO_DAC1L); + wm8994_write(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING, WM8994_AIF2DACR_TO_DAC1R | WM8994_AIF1DAC1R_TO_DAC1R); +#endif + // Tx -> AIF2 Path + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, WM8994_ADC1_TO_DAC2L); + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, WM8994_ADC1_TO_DAC2R); + +#if defined(CONFIG_PHONE_P1_GSM) + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); +#endif + + if((wm8994->testmode_config_flag == SEC_NORMAL)
+ || (wm8994->testmode_config_flag == SEC_TEST_PBA_LOOPBACK)
+ ) + {
+ // Unmute IN1L PGA, update volume + val = wm8994_read(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1L_MUTE_MASK | WM8994_IN1L_VOL_MASK); + val |= (WM8994_IN1L_VU |TUNING_CALL_RCV_INPUTMIX_VOL); //volume + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME, val); + + //Unmute the PGA + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val&= ~(WM8994_IN1L_TO_MIXINL_MASK | WM8994_IN1L_MIXINL_VOL_MASK | WM8994_MIXOUTL_MIXINL_VOL_MASK); +#if defined(CONFIG_PHONE_P1_GSM) + val |= (WM8994_IN1L_TO_MIXINL |TUNING_CALL_RCV_MIXER_VOL);//30db +#elif defined(CONFIG_PHONE_P1_CDMA) + val |= (WM8994_IN1L_TO_MIXINL |WM8994_IN1L_MIXINL_VOL);//30db +#endif + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + + // Volume Control - Output + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_5); + val &= ~(WM8994_DACL_MIXOUTL_VOL_MASK); + val |= TUNING_RCV_OUTMIX5_VOL << WM8994_DACL_MIXOUTL_VOL_SHIFT; + wm8994_write(codec,WM8994_OUTPUT_MIXER_5, val ); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_6); + val &= ~(WM8994_DACR_MIXOUTR_VOL_MASK); + val |= TUNING_RCV_OUTMIX6_VOL << WM8994_DACR_MIXOUTR_VOL_SHIFT; + wm8994_write(codec,WM8994_OUTPUT_MIXER_6, val ); + + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); +#if defined(CONFIG_PHONE_P1_GSM) + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_RCV_OPGAL_VOL); +#elif defined(CONFIG_PHONE_P1_CDMA) + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTL_MUTE_N | TUNING_RCV_OPGAL_VOL); +#endif + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_RCV_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_HPOUT2_VOLUME); + val &= ~(WM8994_HPOUT2_MUTE_MASK | WM8994_HPOUT2_VOL_MASK); + val |= TUNING_HPOUT2_VOL << WM8994_HPOUT2_VOL_SHIFT; + wm8994_write(codec,WM8994_HPOUT2_VOLUME, val ); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); +#if defined(CONFIG_PHONE_P1_GSM) + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume +#elif defined(CONFIG_PHONE_P1_CDMA) + val |= TUNING_DAC1R_VOL; //0 db volume +#endif + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + } + + // Output Mixing + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, WM8994_DAC1L_TO_MIXOUTL); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, WM8994_DAC1R_TO_MIXOUTR ); + + // Analogue Output Configuration + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, + WM8994_MIXOUTLVOL_ENA | WM8994_MIXOUTRVOL_ENA |WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA); + wm8994_write(codec, WM8994_HPOUT2_MIXER, WM8994_MIXOUTLVOL_TO_HPOUT2 |WM8994_MIXOUTRVOL_TO_HPOUT2); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, + WM8994_HPOUT2_ENA | WM8994_VMID_SEL_NORMAL | WM8994_BIAS_ENA); + + // wm8994_write(codec, WM8994_INPUT_MIXER_4, 0x0000 ); +} + + +void wm8994_set_voicecall_headphone(struct snd_soc_codec *codec) +{ + + int val; + + u16 TestReturn1=0; + u16 TestReturn2=0; + u16 TestLow1=0; + u16 TestHigh1=0; + u8 TestLow=0; + u8 TestHigh=0; + + DEBUG_LOG(""); + + audio_ctrl_mic_bias_gpio(1); + + wm8994_set_voicecall_common_setting(codec); + + /*Digital Path Enables and Unmutes*/ + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, WM8994_ADC1_TO_DAC2L); + wm8994_write(codec,WM8994_DAC2_MIXER_VOLUMES, 0x000C ); + wm8994_write(codec,WM8994_SIDETONE, 0x01C0); + + /*Analogue Input Configuration*/ + wm8994_write(codec,WM8994_POWER_MANAGEMENT_2, 0x6240 ); + + { + wm8994_write(codec,WM8994_LEFT_LINE_INPUT_1_2_VOLUME,0x0111); + wm8994_write(codec,WM8994_INPUT_MIXER_3 ,0x0030); + } + + wm8994_write(codec,WM8994_INPUT_MIXER_2, 0x0030 ); + + /* Unmute*/ + { + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, 0x0071 ); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, 0x0171 ); + } + + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4, 0x3003 ); + + val = wm8994_read(codec, 0x102 ); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, 0x56 ); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x56,val); + + val = wm8994_read(codec, 0x102 ); + val &= ~(0x0000); + val = 0x0000; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, WM8994_CLASS_W_1 ); + val &= ~(0x0005); + val |= 0x0005; + wm8994_write(codec,WM8994_CLASS_W_1,val); + + { + val = wm8994_read(codec,WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_CALL_OUTPUTL_VOL); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec,WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_CALL_OUTPUTR_VOL); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + } + + val = wm8994_read(codec, WM8994_DC_SERVO_2 ); + val &= ~(0x03E0); + val = 0x03E0; + wm8994_write(codec,WM8994_DC_SERVO_2,val); + + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1, 0x0303 ); + + wm8994_write(codec,WM8994_ANALOGUE_HP_1, 0x0022 ); + wm8994_write(codec,WM8994_CHARGE_PUMP_1, 0x9F25 ); + + msleep(5); + + /*Analogue Output Configuration*/ + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, 0x0001 ); + wm8994_write(codec,WM8994_OUTPUT_MIXER_2, 0x0001 ); + + wm8994_write(codec,WM8994_POWER_MANAGEMENT_3, 0x0030 ); + + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); + + wm8994_write(codec,WM8994_DC_SERVO_1, 0x303); + + msleep(160); // 160ms delay + + TestReturn1=wm8994_read(codec,WM8994_DC_SERVO_4); + + TestLow=(signed char)(TestReturn1 & 0xff); + TestHigh=(signed char)((TestReturn1>>8) & 0xff); + + TestLow1=((signed short)TestLow-5)&0x00ff; + TestHigh1=(((signed short)(TestHigh-5)<<8)&0xff00); + TestReturn2=TestLow1|TestHigh1; + wm8994_write(codec,WM8994_DC_SERVO_4, TestReturn2); + + val = wm8994_read(codec, WM8994_DC_SERVO_1 ); + val &= ~(0x000F); + val = 0x000F; + wm8994_write(codec,WM8994_DC_SERVO_1,val); + + msleep(15); + + wm8994_write(codec,WM8994_ANALOGUE_HP_1, 0x00EE ); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + wm8994_write(codec,WM8994_DAC2_LEFT_VOLUME, 0x01C0 ); + + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1, 0x0000 ); + wm8994_write(codec,WM8994_AIF2_DAC_FILTERS_1, 0x0000 ); + + wm8994_call_recording_change_path(codec); + +} + +void wm8994_set_voicecall_headset(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + int val; + u16 TestReturn1=0; + u16 TestReturn2=0; + u16 TestLow1=0; + u16 TestHigh1=0; + u8 TestLow=0; + u8 TestHigh=0; + + DEBUG_LOG(""); + + audio_ctrl_mic_bias_gpio(0); + audio_ctrl_earmic_bias_gpio(1); + + wm8994_set_voicecall_common_setting(codec); + + /*Digital Path Enables and Unmutes*/ + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, WM8994_ADC2_TO_DAC2L);
+ wm8994_write(codec,WM8994_DAC2_MIXER_VOLUMES, 0x0180 );
+ wm8994_write(codec,WM8994_SIDETONE, 0x01C0);
+
+ /*Analogue Input Configuration*/ + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_2); + val &= ~(WM8994_TSHUT_ENA_MASK|WM8994_TSHUT_OPDIS_MASK|WM8994_MIXINR_ENA_MASK|WM8994_IN1R_ENA_MASK); + val |= (WM8994_TSHUT_ENA|WM8994_TSHUT_OPDIS|WM8994_MIXINR_ENA|WM8994_IN1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_2, 0x6110 ); + + if(wm8994->testmode_config_flag == SEC_NORMAL)
+ { + val = wm8994_read(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1R_MUTE_MASK | WM8994_IN1R_VOL_MASK); // Unmute IN1R + val |= (WM8994_IN1R_VU | TUNING_CALL_EAR_INPUTMIX_VOL); + wm8994_write(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME,val); + + // unmute right pga, set volume + val = wm8994_read(codec,WM8994_INPUT_MIXER_4 ); + val&= ~(WM8994_IN1R_TO_MIXINR_MASK | WM8994_IN1R_MIXINR_VOL_MASK | WM8994_MIXOUTR_MIXINR_VOL_MASK); + val |= (WM8994_IN1R_TO_MIXINR);//0db + wm8994_write(codec,WM8994_INPUT_MIXER_4 ,val); + } + + val = wm8994_read(codec,WM8994_INPUT_MIXER_2 ); + val&= ~(WM8994_IN1RP_TO_IN1R_MASK | WM8994_IN1RN_TO_IN1R_MASK); + val |= (WM8994_IN1RP_TO_IN1R|WM8994_IN1RN_TO_IN1R);//0db + wm8994_write(codec,WM8994_INPUT_MIXER_2, 0x0003 ); + + /* Unmute*/ + if(wm8994->testmode_config_flag == SEC_NORMAL)
+ { + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_CALL_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_CALL_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + } + + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4, 0x2001 ); + + val = wm8994_read(codec, 0x102 ); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, 0x56 ); + val &= ~(0x0003); + val = 0x0003; + wm8994_write(codec,0x56,val); + + val = wm8994_read(codec, 0x102 ); + val &= ~(0x0000); + val = 0x0000; + wm8994_write(codec,0x102,val); + + val = wm8994_read(codec, WM8994_CLASS_W_1 ); + val &= ~(0x0005); + val |= 0x0005; + wm8994_write(codec,WM8994_CLASS_W_1,val); + + if(wm8994->testmode_config_flag == SEC_NORMAL)
+ { + val = wm8994_read(codec,WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_CALL_OUTPUTL_VOL); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec,WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_CALL_OUTPUTR_VOL); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + } + + val = wm8994_read(codec, WM8994_DC_SERVO_2 ); + val &= ~(0x03E0); + val = 0x03E0; + wm8994_write(codec,WM8994_DC_SERVO_2,val); + + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1, 0x0303 ); + + wm8994_write(codec,WM8994_ANALOGUE_HP_1, 0x0022 ); + wm8994_write(codec,WM8994_CHARGE_PUMP_1, 0x9F25 ); + + msleep(5); + + /*Analogue Output Configuration*/ + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, 0x0001 ); + wm8994_write(codec,WM8994_OUTPUT_MIXER_2, 0x0001 ); + + wm8994_write(codec,WM8994_POWER_MANAGEMENT_3, 0x0030 ); + + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); + + wm8994_write(codec,WM8994_DC_SERVO_1, 0x303); + + msleep(160); // 160ms delay + + TestReturn1=wm8994_read(codec,WM8994_DC_SERVO_4); + + TestLow=(signed char)(TestReturn1 & 0xff); + TestHigh=(signed char)((TestReturn1>>8) & 0xff); + + TestLow1=((signed short)TestLow-5)&0x00ff; + TestHigh1=(((signed short)(TestHigh-5)<<8)&0xff00); + TestReturn2=TestLow1|TestHigh1; + wm8994_write(codec,WM8994_DC_SERVO_4, TestReturn2); + + val = wm8994_read(codec, WM8994_DC_SERVO_1 ); + val &= ~(0x000F); + val = 0x000F; + wm8994_write(codec,WM8994_DC_SERVO_1,val); + + msleep(15); + + wm8994_write(codec,WM8994_ANALOGUE_HP_1, 0x00EE ); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + wm8994_write(codec,WM8994_DAC2_LEFT_VOLUME, 0x01C0 ); + + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1, 0x0000 ); + wm8994_write(codec,WM8994_AIF2_DAC_FILTERS_1, 0x0000 ); + + if(wm8994->testmode_config_flag == SEC_TEST_PBA_LOOPBACK) + { + DEBUG_LOG("SEC_TEST_PBA_LOOPBACK"); + + val = wm8994_read(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME); + val &= ~(WM8994_IN1R_MUTE_MASK | WM8994_IN1R_VOL_MASK); // Unmute IN1R + val |= (WM8994_IN1R_VU | TUNING_LOOPBACK_EAR_INPUTMIX_VOL); +#if defined(CONFIG_PHONE_P1_GSM) + wm8994_write(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME,val); +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec,WM8994_RIGHT_LINE_INPUT_1_2_VOLUME,0x010B); +#endif + + // unmute right pga, set volume + val = wm8994_read(codec,WM8994_INPUT_MIXER_4 ); + val&= ~(WM8994_IN1R_TO_MIXINR_MASK | WM8994_IN1R_MIXINR_VOL_MASK | WM8994_MIXOUTR_MIXINR_VOL_MASK); + val |= (WM8994_IN1R_TO_MIXINR);//0db + wm8994_write(codec,WM8994_INPUT_MIXER_4 ,val); + + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_LOOPBACK_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_LOOPBACK_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + + val = wm8994_read(codec,WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_LOOPBACK_OUTPUTL_VOL); +#if defined(CONFIG_PHONE_P1_GSM) + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, 0x007F); +#endif + + val = wm8994_read(codec,WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_LOOPBACK_OUTPUTR_VOL); +#if defined(CONFIG_PHONE_P1_GSM) + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, 0x017F); +#endif + } + + + wm8994_call_recording_change_path(codec);
+ +
+} + +void wm8994_set_voicecall_speaker(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + int val; + + DEBUG_LOG(""); + + audio_ctrl_mic_bias_gpio(1); + + wm8994_set_voicecall_common_setting(codec); + + wm8994_write(codec,0x601, 0x0005 ); + wm8994_write(codec,0x602, 0x0005 ); + wm8994_write(codec,0x603, 0x000C ); + // Tx -> AIF2 Path + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, WM8994_ADC1_TO_DAC2L); + + /*Analogue Input Configuration*/ + wm8994_write(codec,0x02, 0x6240 );/*wm8994_write(codec,WM8994_POWER_MANAGEMENT_2, WM8994_TSHUT_ENA|WM8994_TSHUT_OPDIS|WM8994_MIXINL_ENA|WM8994_IN1L_ENA );*/ + wm8994_write(codec, WM8994_INPUT_MIXER_2, WM8994_IN1LP_TO_IN1L | WM8994_IN1LN_TO_IN1L); // differential(3) or single ended(1) + + if((wm8994->testmode_config_flag == SEC_NORMAL) + || (wm8994->testmode_config_flag == SEC_TEST_PBA_LOOPBACK)) + { + // Volume Control - Input + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val&= ~(WM8994_IN1L_TO_MIXINL_MASK | WM8994_IN1L_MIXINL_VOL_MASK | WM8994_MIXOUTL_MIXINL_VOL_MASK); + val |= (WM8994_IN1L_TO_MIXINL | TUNING_CALL_SPK_MIXER_VOL);//0db + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + + val = wm8994_read(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME ); + val &= ~(WM8994_IN1L_MUTE_MASK | WM8994_IN1L_VOL_MASK); // Unmute IN1L + val |= (WM8994_IN1L_VU | TUNING_CALL_SPK_INPUTMIX_VOL); + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME , val); + } + + /*Analogue Output Configuration*/ + wm8994_write(codec,0x03, 0x0300 ); + + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, WM8994_AIF2ADCL_ENA | WM8994_ADCL_ENA); + + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); + + if((wm8994->testmode_config_flag == SEC_NORMAL)
+ || (wm8994->testmode_config_flag == SEC_TEST_PBA_LOOPBACK)
+ )
+ { + // Volume Control - Output + // Unmute the SPKMIXVOLUME + val = wm8994_read(codec, WM8994_SPKMIXL_ATTENUATION); + val &= ~(WM8994_SPKMIXL_VOL_MASK); + val |= TUNING_SPKMIXL_ATTEN; + wm8994_write(codec, WM8994_SPKMIXL_ATTENUATION, val); + + val = wm8994_read(codec,WM8994_SPKMIXR_ATTENUATION); + val &= ~(WM8994_SPKMIXR_VOL_MASK); + val |= TUNING_SPKMIXR_ATTEN; + wm8994_write(codec, WM8994_SPKMIXR_ATTENUATION, val); + + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_3 ); + val &= ~( WM8994_SPKLVOL_ENA_MASK | WM8994_SPKRVOL_ENA_MASK ); + val |= WM8994_SPKLVOL_ENA | WM8994_SPKRVOL_ENA; + wm8994_write(codec,WM8994_POWER_MANAGEMENT_3 ,val); + + val = wm8994_read(codec,WM8994_SPEAKER_VOLUME_LEFT); + val &= ~(WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + val |= (WM8994_SPKOUTL_MUTE_N | TUNING_CALL_SPKL_VOL); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_LEFT, val); + + val = wm8994_read(codec,WM8994_SPEAKER_VOLUME_RIGHT); + val &= ~(WM8994_SPKOUTR_MUTE_N_MASK | WM8994_SPKOUTR_VOL_MASK); + val |= (WM8994_SPKOUT_VU | WM8994_SPKOUTR_MUTE_N | TUNING_CALL_SPKR_VOL); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_RIGHT, val); + + wm8994_write(codec, WM8994_CLASSD, TUNING_CALL_CLASSD_VOL); + } + + //Unmute the DAC path + val = wm8994_read(codec,WM8994_SPEAKER_MIXER ); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK | WM8994_DAC1R_TO_SPKMIXR_MASK); + val |= ( WM8994_DAC1L_TO_SPKMIXL | WM8994_DAC1R_TO_SPKMIXR ); + wm8994_write(codec,WM8994_SPEAKER_MIXER ,val); + + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS ); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + val |= WM8994_SPKMIXL_TO_SPKOUTL; + val |= WM8994_SPKMIXR_TO_SPKOUTR; + wm8994_write(codec,WM8994_SPKOUT_MIXERS,val ); + + wm8994_write(codec,0x36, 0x0003 ); + /* Digital Path Enables and Unmutes*/ + + wm8994_write(codec,WM8994_SIDETONE, 0x01C0 ); + + + wm8994_write(codec, WM8994_ANALOGUE_HP_1,0x0000); + wm8994_write(codec, WM8994_DC_SERVO_1,0x0000); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK |WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK); +#if defined(CONFIG_PHONE_P1_GSM) + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_SPKOUTL_ENA | WM8994_SPKOUTR_ENA); +#elif defined(CONFIG_PHONE_P1_CDMA) + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_SPKOUTL_ENA); +#endif + wm8994_write(codec,WM8994_POWER_MANAGEMENT_1,val); + + if((wm8994->testmode_config_flag == SEC_NORMAL)
+ || (wm8994->testmode_config_flag == SEC_TEST_PBA_LOOPBACK)
+ )
+ { + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL);
+ wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume
+ wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + } + + wm8994_write(codec,WM8994_DAC2_LEFT_VOLUME, 0x01C0 ); + wm8994_write(codec,WM8994_AIF2_DAC_FILTERS_1, WM8994_AIF1DAC1_UNMUTE ); + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1, WM8994_AIF1DAC2_UNMUTE ); + + wm8994_call_recording_change_path(codec); +} + +void wm8994_set_voicecall_bluetooth(struct snd_soc_codec *codec) +{ +#if defined(CONFIG_PHONE_P1_GSM) + int val; + + wm8994_set_voicecall_common_setting(codec); + + /*GPIO Configuration*/ + wm8994_write(codec, WM8994_GPIO_8, WM8994_GP8_DIR | WM8994_GP8_DB); + wm8994_write(codec, WM8994_GPIO_9, WM8994_GP9_DB); + wm8994_write(codec, WM8994_GPIO_10, WM8994_GP10_DB); + wm8994_write(codec, WM8994_GPIO_11, WM8994_GP11_DB); + + /*Digital Path Enables and Unmutes*/ + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_SPKOUTL_ENA_MASK | WM8994_SPKOUTR_ENA_MASK | WM8994_HPOUT2_ENA_MASK | WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, WM8994_AIF2ADCL_ENA | WM8994_ADCL_ENA); + + // If Input MIC is enabled, bluetooth Rx is muted. + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_1_2_VOLUME, WM8994_IN1L_MUTE); + wm8994_write(codec, WM8994_RIGHT_LINE_INPUT_1_2_VOLUME, WM8994_IN1R_MUTE); + wm8994_write(codec, WM8994_INPUT_MIXER_2, 0x00); + wm8994_write(codec, WM8994_INPUT_MIXER_3, 0x00); + wm8994_write(codec, WM8994_INPUT_MIXER_4, 0x00); + + //for BT DTMF Play + //Rx Path: AIF2ADCDAT2 select + //CP(CALL) Path:GPIO5/DACDAT2 select + //AP(DTMF) Path: DACDAT1 select + //Tx Path: GPIO8/DACDAT3 select + wm8994_write(codec, WM8994_POWER_MANAGEMENT_6, 0x000C); + + // AIF1 & AIF2 Output is connected to DAC1 + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, WM8994_AIF2DACL_TO_DAC2L | WM8994_AIF1DAC1L_TO_DAC2L); + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, WM8994_AIF2DACR_TO_DAC2R | WM8994_AIF1DAC1R_TO_DAC2R); + + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); + + wm8994_write(codec, WM8994_DAC2_MIXER_VOLUMES, 0x000C); + + wm8994_write(codec, WM8994_DAC2_LEFT_VOLUME, 0x01C0); + wm8994_write(codec, WM8994_DAC2_RIGHT_VOLUME, 0x01C0); + + wm8994_write(codec, WM8994_OVERSAMPLING, 0X0000); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, 0x0000); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, 0x0000); +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, 0x0007); //fast vmid + msleep(50); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, 0x0003); //normal vmid + + /*Digital Path Enables and Unmutes*/ + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, 0x00); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, 0x00); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, 0x3000); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, + WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA| WM8994_DAC2L_ENA | WM8994_DAC2R_ENA); + //for BT DTMF Play + //Rx Path: AIF2ADCDAT2 select + //CP(CALL) Path:GPIO5/DACDAT2 select + //AP(DTMF) Path: DACDAT1 select + //Tx Path: GPIO8/DACDAT3 select + wm8994_write(codec, WM8994_POWER_MANAGEMENT_6, 0x0003<<WM8994_AIF2_ADCDAT_SRC_SHIFT); + + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, 0x00 ); + + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, WM8994_AIF2DACL_TO_DAC2L | WM8994_AIF1DAC1L_TO_DAC2L); + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, WM8994_AIF2DACR_TO_DAC2R | WM8994_AIF1DAC1R_TO_DAC2R); + + wm8994_write(codec, WM8994_DAC2_LEFT_VOLUME, 0x1C0 ); + wm8994_write(codec, WM8994_DAC2_RIGHT_VOLUME, 0x1C0 ); + + /*Clocking*/ + wm8994_write(codec, WM8994_CLOCKING_1, WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FS2CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_AIF2_RATE, 0x0003<<WM8994_AIF2CLK_RATE_SHIFT); //8kHz + + /*AIF1Interface*/ + wm8994_write(codec, WM8994_AIF1_CONTROL_2, 0x0000); //Left & Right DAC receives left interface data + wm8994_write(codec, WM8994_AIF1_MASTER_SLAVE, WM8994_AIF1_MSTR | WM8994_AIF1_CLK_FRC | WM8994_AIF1_LRCLK_FRC); // Master mode + + /*AIF2 Interface*/ + wm8994_write(codec, WM8994_AIF2_CONTROL_2, 0x0000); //Left & Right DAC receives left interface data + wm8994_write(codec, WM8994_AIF2_MASTER_SLAVE, WM8994_AIF2_MSTR | WM8994_AIF2_CLK_FRC | WM8994_AIF2_LRCLK_FRC); // Master mode + wm8994_write(codec, WM8994_AIF2_CONTROL_1, //Left Justified, BCLK invert, LRCLK Invert + WM8994_AIF2ADCR_SRC | WM8994_AIF2_BCLK_INV |WM8994_AIF2_LRCLK_INV | 0x1 << WM8994_AIF2_FMT_SHIFT); + + wm8994_write(codec, WM8994_OVERSAMPLING, 0X0000); + + /*FLL2 Setting*/ + wm8994_write(codec, WM8994_FLL2_CONTROL_2, 0x2F00); // REG 221 FLL1 Cntr2, FLL1 Setting + wm8994_write(codec, WM8994_FLL2_CONTROL_3, 0x3126); // REG 222 FLL1 Cntr3, K Value + wm8994_write(codec, WM8994_FLL2_CONTROL_4, 0x0100); // REG 223 FLL1 Cntr4, N Value + wm8994_write(codec, WM8994_FLL2_CONTROL_5, 0x0C88); // REG 224 FLL1 Cntr5 + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, 0x0019); // REG 200 Enable AIF1 Clock, AIF1 Clock Source = FLL1 + wm8994_write(codec, WM8994_FLL2_CONTROL_1, WM8994_FLL2_FRACN_ENA | WM8994_FLL2_ENA); + + /*GPIO Configuration*/ + wm8994_write(codec, WM8994_GPIO_1, 0xA101); + wm8994_write(codec, WM8994_GPIO_3, WM8994_GP3_DIR | WM8994_GP3_DB); + wm8994_write(codec, WM8994_GPIO_4, WM8994_GP4_DIR | WM8994_GP4_DB); + wm8994_write(codec, WM8994_GPIO_5, WM8994_GP5_DIR | WM8994_GP5_DB); + wm8994_write(codec, WM8994_GPIO_6, WM8994_GP6_DIR | WM8994_GP6_PD | WM8994_GP6_DB |0x1 << WM8994_GP6_FN_SHIFT); + wm8994_write(codec, WM8994_GPIO_7, WM8994_GP7_DB); + wm8994_write(codec, WM8994_GPIO_8, WM8994_GP8_DIR | WM8994_GP8_DB); + wm8994_write(codec, WM8994_GPIO_9, WM8994_GP9_DB); + wm8994_write(codec, WM8994_GPIO_10, WM8994_GP10_DB); + wm8994_write(codec, WM8994_GPIO_11, WM8994_GP11_DB); +#endif +} + + +void wm8994_set_voicecall_record(struct snd_soc_codec *codec, int channel) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + u16 val; + + DEBUG_LOG("channel = [%d]", channel); + + + if(wm8994 ->call_record_path == CALL_RECORDING_MAIN ) + { + switch(channel) + { + case CH_UDLINK: //TxRx + val = wm8994_read(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING ); + val &= ~( WM8994_ADC1L_TO_AIF1ADC1L_MASK | WM8994_AIF2DACL_TO_AIF1ADC1L_MASK); + val |= (WM8994_ADC1L_TO_AIF1ADC1L | WM8994_AIF2DACL_TO_AIF1ADC1L ); + wm8994_write(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING ,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~( WM8994_AIF1ADC1L_ENA_MASK | WM8994_AIF1ADC1R_ENA_MASK); + val |= ( WM8994_AIF1ADC1L_ENA|WM8994_AIF1ADC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4,val); + + wm8994_write(codec,0x300,0x4010); + + wm8994_write(codec,0x400,0x00C0); // AIF1 INPUT VOLUME : 0x00C0:0db + break; + + case CH_UPLINK: //Tx only + val = wm8994_read(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING ); + val &= ~( WM8994_ADC1L_TO_AIF1ADC1L_MASK | WM8994_AIF2DACL_TO_AIF1ADC1L_MASK); + val |= (WM8994_ADC1L_TO_AIF1ADC1L); + wm8994_write(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING ,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~( WM8994_AIF1ADC1L_ENA_MASK | WM8994_AIF1ADC1R_ENA_MASK); + val |= ( WM8994_AIF1ADC1L_ENA|WM8994_AIF1ADC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4,val); + + wm8994_write(codec,0x300,0x4010); + + wm8994_write(codec,0x400,0x00C0); // AIF1 INPUT VOLUME : 0x00C0:0db + break; + + case CH_DOWNLINK: //Rx only + val = wm8994_read(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING ); + val &= ~( WM8994_ADC1L_TO_AIF1ADC1L_MASK | WM8994_AIF2DACL_TO_AIF1ADC1L_MASK); + val |= (WM8994_AIF2DACL_TO_AIF1ADC1L ); + wm8994_write(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING ,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~( WM8994_AIF1ADC1L_ENA_MASK | WM8994_AIF1ADC1R_ENA_MASK); + val |= ( WM8994_AIF1ADC1L_ENA|WM8994_AIF1ADC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4,val); + + wm8994_write(codec,0x300,0x4010); + + wm8994_write(codec,0x400,0x00C0); // AIF1 INPUT VOLUME : 0x00C0:0db + break; + + default: + DEBUG_LOG("Recording through Main Mic in call"); + audio_ctrl_mic_bias_gpio(1); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_ADCL_ENA_MASK |WM8994_AIF1ADC1L_ENA_MASK); + val |= (WM8994_AIF1ADC1L_ENA | WM8994_ADCL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, val); + + //Enable timeslots + val = wm8994_read(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING); + val |=WM8994_ADC1L_TO_AIF1ADC1L; + wm8994_write(codec, WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_AIF1_MASTER_SLAVE); + val |= (WM8994_AIF1_MSTR | WM8994_AIF1_CLK_FRC | WM8994_AIF1_LRCLK_FRC); // Master mode + wm8994_write(codec, WM8994_AIF1_MASTER_SLAVE, val); + + wm8994_write(codec, WM8994_GPIO_1, 0xA101); // GPIO1 is Input Enable + + // for stable pcm input when start google voice recognition + if(wm8994->recognition_active == REC_ON) + { + msleep(300); + } + break; + } + } + else if(wm8994 ->call_record_path == CALL_RECORDING_SUB) + { + switch(channel) + { + case CH_UDLINK: //TxRx + val = wm8994_read(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~( WM8994_ADC1R_TO_AIF1ADC1R_MASK | WM8994_AIF2DACR_TO_AIF1ADC1R_MASK); + val |= (WM8994_ADC1R_TO_AIF1ADC1R |WM8994_AIF2DACR_TO_AIF1ADC1R); + wm8994_write(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~( WM8994_AIF1ADC1L_ENA_MASK | WM8994_AIF1ADC1R_ENA_MASK); + val |= ( WM8994_AIF1ADC1L_ENA|WM8994_AIF1ADC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4,val); + + wm8994_write(codec,0x300,0xC010); + + wm8994_write(codec,0x401,0x00C0); // AIF1 INPUT VOLUME : 0x00C0:0db + break; + + case CH_UPLINK: //Tx only + val = wm8994_read(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~( WM8994_ADC1R_TO_AIF1ADC1R_MASK | WM8994_AIF2DACR_TO_AIF1ADC1R_MASK); + val |= (WM8994_ADC1R_TO_AIF1ADC1R ); + wm8994_write(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~( WM8994_AIF1ADC1L_ENA_MASK | WM8994_AIF1ADC1R_ENA_MASK); + val |= ( WM8994_AIF1ADC1L_ENA|WM8994_AIF1ADC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4,val); + + wm8994_write(codec,0x300,0xC010); + + wm8994_write(codec,0x401,0x00C0); // AIF1 INPUT VOLUME : 0x00C0:0db + break; + + case CH_DOWNLINK: //Rx only + val = wm8994_read(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~( WM8994_ADC1R_TO_AIF1ADC1R_MASK | WM8994_AIF2DACR_TO_AIF1ADC1R_MASK); + val |= (WM8994_AIF2DACR_TO_AIF1ADC1R); + wm8994_write(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,val); + + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~( WM8994_AIF1ADC1L_ENA_MASK | WM8994_AIF1ADC1R_ENA_MASK); + val |= ( WM8994_AIF1ADC1L_ENA|WM8994_AIF1ADC1R_ENA); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4,val); + + wm8994_write(codec,0x300,0xC010); + + wm8994_write(codec,0x401,0x00C0); // AIF1 INPUT VOLUME : 0x00C0:0db + break; + + default: + DEBUG_LOG("Recording through Headset Mic in call"); + + audio_ctrl_mic_bias_gpio(0); + audio_ctrl_earmic_bias_gpio(1); + + // Mixing left channel output to right channel. + val = wm8994_read(codec, WM8994_AIF1_CONTROL_1); //605H : 0x0010 + val &= ~(WM8994_AIF1ADCL_SRC_MASK | WM8994_AIF1ADCR_SRC_MASK); + val |= (WM8994_AIF1ADCL_SRC | WM8994_AIF1ADCR_SRC); + wm8994_write(codec, WM8994_AIF1_CONTROL_1, val); + + //Digital Paths + //Enable right ADC and time slot + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_4); + val &= ~(WM8994_ADCR_ENA_MASK |WM8994_AIF1ADC1R_ENA_MASK ); + val |= (WM8994_AIF1ADC1R_ENA | WM8994_ADCR_ENA ); + wm8994_write(codec,WM8994_POWER_MANAGEMENT_4 ,val); + + //ADC Right mixer routing + val = wm8994_read(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING); + val &= ~( WM8994_ADC1R_TO_AIF1ADC1R_MASK); + val |= WM8994_ADC1R_TO_AIF1ADC1R; + wm8994_write(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,val); + + val = wm8994_read(codec, WM8994_AIF1_MASTER_SLAVE); + val |= (WM8994_AIF1_MSTR | WM8994_AIF1_CLK_FRC | WM8994_AIF1_LRCLK_FRC); // Master mode + wm8994_write(codec, WM8994_AIF1_MASTER_SLAVE, val); + + wm8994_write( codec, WM8994_GPIO_1, 0xA101 ); // GPIO1 is Input Enable + break; + } + } +} + +void wm8994_call_recording_change_path(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + if(wm8994->rec_path == MAIN) + { + wm8994->call_record_path = CALL_RECORDING_MAIN; + DEBUG_LOG("Changing rec_path[%d] -> call_record_path [%d]", wm8994 ->rec_path, wm8994 ->call_record_path); + + wm8994->rec_path = MIC_OFF; + } + else if(wm8994->rec_path == SUB) + { + wm8994->call_record_path = CALL_RECORDING_SUB; + DEBUG_LOG("Changing rec_path[%d] -> call_record_path [%d]", wm8994 ->rec_path, wm8994 ->call_record_path); + + wm8994->rec_path = MIC_OFF; + } + + + if(wm8994 ->call_record_path != CALL_RECORDING_OFF) + { + DEBUG_LOG("wm8994 ->call_record_path = [%d]", wm8994 ->call_record_path); + wm8994_set_voicecall_record(codec, (int)wm8994 ->call_record_ch); + } +} + +void wm8994_set_voicecall_record_off(struct snd_soc_codec *codec) +{ + DEBUG_LOG(""); + + //codec off + wm8994_write(codec,WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING ,0x0000); + wm8994_write(codec,WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,0x0000); +} + +void wm8994_set_fmradio_common(struct snd_soc_codec *codec, int onoff) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + DEBUG_LOG("onoff = [%d]", onoff); + + wm8994_write(codec, 0x39, 0x8); //Cross Talk (H/W requested) + + if(onoff) + { + val = wm8994_read(codec, WM8994_LEFT_LINE_INPUT_3_4_VOLUME); + val &= ~(WM8994_IN2L_VU_MASK | WM8994_IN2L_MUTE_MASK | WM8994_IN2L_VOL_MASK); + if(wm8994->fmradio_path == FMR_HP) + val |= (TUNING_FMRADIO_EAR_INPUTMIXL_VOL); + else + val |= (TUNING_FMRADIO_SPK_INPUTMIXL_VOL); + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_3_4_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_LINE_INPUT_3_4_VOLUME); + val &= ~(WM8994_IN2R_VU_MASK | WM8994_IN2R_MUTE_MASK | WM8994_IN2R_VOL_MASK); + if(wm8994->fmradio_path == FMR_HP) + val |= (WM8994_IN2R_VU | TUNING_FMRADIO_EAR_INPUTMIXR_VOL); + else + val |= (WM8994_IN2R_VU | TUNING_FMRADIO_SPK_INPUTMIXR_VOL); + wm8994_write(codec, WM8994_RIGHT_LINE_INPUT_3_4_VOLUME, val); + + // Input mixer setting - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.02.25 + // val = wm8994_read(codec, WM8994_INPUT_MIXER_2); + // val &= ~(WM8994_IN2LN_TO_IN2L_MASK | WM8994_IN2RN_TO_IN2R_MASK); + // val |= (WM8994_IN2LN_TO_IN2L | WM8994_IN2RN_TO_IN2R); + val = (WM8994_IN2LN_TO_IN2L | WM8994_IN2RN_TO_IN2R); + wm8994_write(codec, WM8994_INPUT_MIXER_2, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // IN2L to MIXINL + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val &= ~(WM8994_IN2L_TO_MIXINL_MASK); + val |= WM8994_IN2L_TO_MIXINL; + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + + //IN2R to MIXINR + val = wm8994_read(codec, WM8994_INPUT_MIXER_4); + val &= ~(WM8994_IN2R_TO_MIXINR_MASK); + val |= WM8994_IN2R_TO_MIXINR; + wm8994_write(codec, WM8994_INPUT_MIXER_4, val); + } + + //DRC for Noise-gate (AIF2) + wm8994_write(codec, WM8994_AIF2_ADC_FILTERS, 0xF800); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, 0x0036); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_2, 0x0010); + wm8994_write(codec, WM8994_AIF2_DRC_2, 0x0840); + wm8994_write(codec, WM8994_AIF2_DRC_3, 0x2400); + wm8994_write(codec, WM8994_AIF2_DRC_4, 0x0000); + wm8994_write(codec, WM8994_AIF2_DRC_5, 0x0000); + wm8994_write(codec, WM8994_AIF2_DRC_1, 0x019C); + } + else + { + val = wm8994_read(codec, WM8994_LEFT_LINE_INPUT_3_4_VOLUME); + val &= ~(WM8994_IN2L_VU_MASK | WM8994_IN2L_MUTE_MASK | WM8994_IN2L_VOL_MASK); + val |= (WM8994_IN2L_MUTE); + wm8994_write(codec, WM8994_LEFT_LINE_INPUT_3_4_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_LINE_INPUT_3_4_VOLUME); + val &= ~(WM8994_IN2R_VU_MASK | WM8994_IN2R_MUTE_MASK | WM8994_IN2R_VOL_MASK); + val |= (WM8994_IN2R_VU | WM8994_IN2R_MUTE); + wm8994_write(codec, WM8994_RIGHT_LINE_INPUT_3_4_VOLUME, val); + + val = wm8994_read(codec, WM8994_INPUT_MIXER_2); + val &= ~(WM8994_IN2LN_TO_IN2L | WM8994_IN2RN_TO_IN2R); + wm8994_write(codec, WM8994_INPUT_MIXER_2, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // IN2L to MIXINL + val = wm8994_read(codec, WM8994_INPUT_MIXER_3); + val &= ~(WM8994_IN2L_TO_MIXINL_MASK); + wm8994_write(codec, WM8994_INPUT_MIXER_3, val); + + //IN2R to MIXINR + val = wm8994_read(codec, WM8994_INPUT_MIXER_4); + val &= ~(WM8994_IN2R_TO_MIXINR_MASK); + wm8994_write(codec, WM8994_INPUT_MIXER_4, val); + } + } +} + +void wm8994_set_fmradio_headset(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + +#if defined(CONFIG_PHONE_P1_GSM) + u16 nReadServo4Val = 0; + u16 ncompensationResult = 0; + u16 nCompensationResultLow=0; + u16 nCompensationResultHigh=0; + u8 nServo4Low = 0; + u8 nServo4High = 0; + + DEBUG_LOG("Routing ear path : FM Radio -> EAR Out"); + + wm8994->fmradio_path = FMR_HP; + + wm8994_disable_fmradio_path(codec); + + //DAC1 Setting + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING); //601H : 0x05 + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK | WM8994_AIF1DAC2L_TO_DAC1L_MASK | WM8994_AIF2DACL_TO_DAC1L_MASK); + val |= (WM8994_AIF2DACL_TO_DAC1L | WM8994_AIF1DAC1L_TO_DAC1L); + wm8994_write(codec, WM8994_DAC1_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING); //602H : 0x05 + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK | WM8994_AIF1DAC2R_TO_DAC1R_MASK | WM8994_AIF2DACR_TO_DAC1R_MASK); + val |= (WM8994_AIF1DAC1R_TO_DAC1R | WM8994_AIF2DACR_TO_DAC1R); + wm8994_write(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING, val); + + //* Headset + wm8994_write(codec, 0x102, 0x0003); + wm8994_write(codec, 0x56, 0x0003); + wm8994_write(codec, 0x102, 0x0000); + + wm8994_write(codec, WM8994_GPIO_3, 0x0100); + wm8994_write(codec, WM8994_GPIO_4, 0x0100); + wm8994_write(codec, WM8994_GPIO_5, 0x8100); + wm8994_write(codec, WM8994_GPIO_6, 0xA101); + wm8994_write(codec, WM8994_GPIO_7, 0x0100); + + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val = 0x0000; + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val = 0x0100; + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + + // Disable reg sync to MCLK + val = wm8994_read(codec, WM8994_AIF1_CLOCKING_1 ); + val &= ~(WM8994_AIF1CLK_ENA_MASK); + val |= WM8994_AIF1CLK_ENA; + wm8994_write(codec, WM8994_AIF1_CLOCKING_1, val ); + + + // Analogue Path Config + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_2 ); + val &= ~(WM8994_MIXINL_ENA_MASK | WM8994_MIXINR_ENA_MASK | WM8994_IN2L_ENA_MASK | WM8994_IN2R_ENA_MASK); + val |= (WM8994_MIXINL_ENA | WM8994_MIXINR_ENA| WM8994_IN2L_ENA| WM8994_IN2R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2 , val ); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_NORMAL); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1 , 0x0003); + + //* Unmutes + // Output setting + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_FMRADIO_OUTPUTL_VOL); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_FMRADIO_OUTPUTR_VOL); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_FMRADIO_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_FMRADIO_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_RADIO_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_RADIO_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + } + + wm8994_set_fmradio_common(codec, 1); + + //FLL2 Setting + val = wm8994_read(codec, WM8994_AIF2_CLOCKING_1); //204H : 0x0011 + val &= ~(WM8994_AIF2CLK_ENA_MASK | WM8994_AIF2CLK_SRC_MASK); + val |= (WM8994_AIF2CLK_ENA | 0x2 << WM8994_AIF2CLK_SRC_SHIFT); + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, val); + + val = wm8994_read(codec, WM8994_CLOCKING_1); //208H : 0xF -> 0xE + val &= ~(WM8994_SYSCLK_SRC_MASK | WM8994_DSP_FSINTCLK_ENA_MASK | WM8994_DSP_FS2CLK_ENA_MASK | WM8994_DSP_FS1CLK_ENA_MASK); + val |= (WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FS2CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_4); //04H + val &= ~(WM8994_AIF2ADCL_ENA_MASK | WM8994_AIF2ADCR_ENA_MASK | WM8994_ADCL_ENA_MASK | WM8994_ADCR_ENA_MASK); + val |= (WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA | WM8994_ADCL_ENA | WM8994_ADCR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, val); + + //DAC2 Setting + wm8994_write(codec, WM8994_DAC2_MIXER_VOLUMES, 0x018C); //603H : 0x018C + + val = wm8994_read(codec, WM8994_DAC2_LEFT_MIXER_ROUTING); //604H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2L_MASK); + val |= (WM8994_ADC1_TO_DAC2L); + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING); //605H : 0x0010 + val &= ~(WM8994_ADC2_TO_DAC2R_MASK); + val |= (WM8994_ADC2_TO_DAC2R); // Changed value to support stereo + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC2_LEFT_VOLUME); //612 : 1C0 + val &= ~(WM8994_DAC2L_MUTE_MASK | WM8994_DAC2L_VOL_MASK); + val |= (TUNING_DAC2L_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC2_LEFT_VOLUME,val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_VOLUME); //613 : 1C0 + val &= ~(WM8994_DAC2R_MUTE_MASK | WM8994_DAC2R_VOL_MASK); + val |= (WM8994_DAC2_VU | TUNING_DAC2R_VOL); //0 db volume + wm8994_write(codec, WM8994_DAC2_RIGHT_VOLUME, val); + + wm8994_write(codec, WM8994_AIF1_DAC1_EQ_GAINS_1, 0x0000); //480 : 0 + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); //03 : F + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + val |= (WM8994_MIXOUTLVOL_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + wm8994_write(codec, WM8994_OVERSAMPLING, 0x0000); + +//AIF2 Master/Slave , LOOPBACK, AIF2DAC Unmute + val = wm8994_read(codec, WM8994_AIF2_MASTER_SLAVE); //312 : 7000 + val &= ~(WM8994_AIF2_LRCLK_FRC_MASK | WM8994_AIF2_CLK_FRC_MASK | WM8994_AIF2_MSTR_MASK); + val |= (WM8994_AIF2_LRCLK_FRC | WM8994_AIF2_CLK_FRC | WM8994_AIF2_MSTR); + wm8994_write(codec, WM8994_AIF2_MASTER_SLAVE, val); + + val = wm8994_read(codec, WM8994_AIF2_CONTROL_2); //311 : 4001 + val &= ~(WM8994_AIF2_LOOPBACK_MASK); + val |= (WM8994_AIF2_LOOPBACK); + wm8994_write(codec, WM8994_AIF2_CONTROL_2, val); + + wm8994_write(codec, WM8994_SIDETONE, 0x01c0); + + //* DC Servo Series Count + val = 0x03E0; + wm8994_write(codec, WM8994_DC_SERVO_2, val); + + //* HP first and second stage + //Enable vmid,bias, hp left and right + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_HPOUT1R_ENA | WM8994_HPOUT1L_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + val = (WM8994_HPOUT1L_DLY | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + //Enable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA | WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, 0x9F25); + + msleep(5); + + //Digital Mixer setting + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5); //05 : 3303 + val &= ~(WM8994_AIF2DACL_ENA_MASK | WM8994_AIF2DACR_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK + | WM8994_DAC1L_ENA_MASK | WM8994_DAC1R_ENA_MASK); + val |= (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA + | WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); //2D : 1 + val &= ~(WM8994_DAC1L_TO_MIXOUTL_MASK); + val |= (WM8994_DAC1L_TO_MIXOUTL); + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); //2E : 1 + val &= ~(WM8994_DAC1R_TO_MIXOUTR_MASK); + val |= (WM8994_DAC1R_TO_MIXOUTR); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + //* DC Servo + val = (WM8994_DCS_TRIG_SERIES_1 | WM8994_DCS_TRIG_SERIES_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, 0x0303 ); + + msleep(160); + + nReadServo4Val=wm8994_read(codec,WM8994_DC_SERVO_4); + nServo4Low=(signed char)(nReadServo4Val & 0xff); + nServo4High=(signed char)((nReadServo4Val>>8) & 0xff); + + nCompensationResultLow=((signed short)nServo4Low -5)&0x00ff; + nCompensationResultHigh=((signed short)(nServo4High -5)<<8)&0xff00; + ncompensationResult=nCompensationResultLow|nCompensationResultHigh; + wm8994_write(codec,WM8994_DC_SERVO_4, ncompensationResult); + + val = (WM8994_DCS_TRIG_DAC_WR_1 | WM8994_DCS_TRIG_DAC_WR_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, val ); + + msleep(20); + + //* Headphone Output + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + val |= (WM8994_HPOUT1L_RMV_SHORT | WM8994_HPOUT1L_OUTP|WM8994_HPOUT1L_DLY |WM8994_HPOUT1R_RMV_SHORT | + WM8994_HPOUT1R_OUTP | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + //DAC1, DAC2 Volume Setting + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); //610H : 1C0 + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME); //611 : 1C0 + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + //DAC1 Unmute + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, 0x0000); + + val = wm8994_read(codec, WM8994_AIF2_DAC_FILTERS_1); //520 : 0 + val &= ~(WM8994_AIF2DAC_MUTE_MASK); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, val); +#elif defined(CONFIG_PHONE_P1_CDMA) + u16 nReadServo4Val = 0; + u16 ncompensationResult = 0; + u8 nCompensationResultLow=0; + u8 nCompensationResultHigh=0; + u16 nServo4Low = 0; + u16 nServo4High = 0; + + + DEBUG_LOG("Routing ear path : FM Radio -> EAR Out"); + + wm8994->fmradio_path = FMR_HP; + + // Disable reg sync to MCLK + val = wm8994_read(codec, WM8994_AIF1_CLOCKING_1 ); + val &= ~(WM8994_AIF1CLK_ENA_MASK); + val |= WM8994_AIF1CLK_ENA; + wm8994_write(codec, WM8994_AIF1_CLOCKING_1, val ); + + val = wm8994_read(codec, WM8994_CONTROL_INTERFACE ); + val &= ~(WM8994_AUTO_INC_MASK); + val |= WM8994_AUTO_INC; + wm8994_write(codec, WM8994_CONTROL_INTERFACE , val ); + + // Analogue Path Config + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_2 ); + val &= ~(WM8994_MIXINL_ENA_MASK | WM8994_MIXINR_ENA_MASK | WM8994_IN2L_ENA_MASK | WM8994_IN2R_ENA_MASK); + val |= (WM8994_MIXINL_ENA | WM8994_MIXINR_ENA| WM8994_IN2L_ENA| WM8994_IN2R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2 , val ); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_NORMAL); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1 , 0x0003); + + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val = 0x0000; + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val = 0x0000; + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + + wm8994_set_fmradio_common(codec, 1); + + // Output mixer setting + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_MIXINL_TO_MIXOUTL_MASK); + val |= (WM8994_MIXINL_TO_MIXOUTL); + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_MIXINR_TO_MIXOUTR_MASK); + val |= (WM8994_MIXINR_TO_MIXOUTR); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + + //* Headset + wm8994_write(codec, 0x102, 0x0003); + wm8994_write(codec, 0x56, 0x0003); + wm8994_write(codec, 0x102, 0x0000); + wm8994_write(codec, 0x5D, 0x0002); + + + //* DC Servo Series Count + val = 0x03E0; + wm8994_write(codec, WM8994_DC_SERVO_2, val); + + //* HP first and second stage + //Enable vmid,bias, hp left and right + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK | WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_HPOUT1R_ENA | WM8994_HPOUT1L_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + val = (WM8994_HPOUT1L_DLY | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + //Enable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA | WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, 0x9F25); + + msleep(5); + + //* DC Servo + val = (WM8994_DCS_TRIG_SERIES_1 | WM8994_DCS_TRIG_SERIES_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, 0x0303 ); + + msleep(160); + + nReadServo4Val=wm8994_read(codec,WM8994_DC_SERVO_4); + nServo4Low=(u8)(nReadServo4Val & 0xff); + nServo4High=(u8)((nReadServo4Val>>8) & 0xff); + + nCompensationResultLow=((u16)nServo4Low-4)&0x00ff; + nCompensationResultHigh=(((u16)nServo4High-4)<<8)&0xff00; + ncompensationResult=nCompensationResultLow|nCompensationResultHigh; + wm8994_write(codec,WM8994_DC_SERVO_4, ncompensationResult); + + val = (WM8994_DCS_TRIG_DAC_WR_1 | WM8994_DCS_TRIG_DAC_WR_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, val ); + + msleep(20); + + //* Headphone Output + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + val |= (WM8994_HPOUT1L_RMV_SHORT | WM8994_HPOUT1L_OUTP|WM8994_HPOUT1L_DLY |WM8994_HPOUT1R_RMV_SHORT | + WM8994_HPOUT1R_OUTP | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + // Enable MIXOUT + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK); + val |= (WM8994_MIXOUTLVOL_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + + //* Unmutes + // Output setting + if(!wm8994->testmode_config_flag) + { + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTL_MUTE_N | TUNING_FMRADIO_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_FMRADIO_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1L_MUTE_N | TUNING_FMRADIO_OUTPUTL_VOL); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_FMRADIO_OUTPUTR_VOL); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + } +#endif +} + +void wm8994_set_fmradio_speaker(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + DEBUG_LOG("Routing spk path : FM Radio -> SPK Out"); + +#if defined(CONFIG_PHONE_P1_GSM) + wm8994_disable_fmradio_path(codec); + + wm8994->fmradio_path = FMR_SPK; + + //Disable end point for preventing pop up noise. + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_SPKOUTL_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); //03 : 0100 + val &= ~(WM8994_SPKRVOL_ENA_MASK | WM8994_SPKLVOL_ENA_MASK); + val |= (WM8994_SPKLVOL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + // Unmute the SPKMIXVOLUME + val = wm8994_read(codec, WM8994_SPKMIXL_ATTENUATION); + val &= ~(WM8994_SPKMIXL_VOL_MASK); + val |= TUNING_SPKMIXL_ATTEN; + wm8994_write(codec, WM8994_SPKMIXL_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPKMIXR_ATTENUATION); + val &= ~(WM8994_SPKMIXR_VOL_MASK); + wm8994_write(codec, WM8994_SPKMIXR_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_LEFT); + val &= ~(WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + val |= (WM8994_SPKOUTL_MUTE_N | TUNING_FMRADIO_SPKL_VOL); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_LEFT, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_RIGHT); + val &= ~(WM8994_SPKOUTR_MUTE_N_MASK | WM8994_SPKOUTR_VOL_MASK); + val |= (WM8994_SPKOUT_VU); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_RIGHT, val); + + val = wm8994_read(codec, WM8994_CLASSD); + val &= ~(WM8994_SPKOUTL_BOOST_MASK); + val |= TUNING_FMRADIO_CLASSD_VOL << WM8994_SPKOUTL_BOOST_SHIFT; + wm8994_write(codec, WM8994_CLASSD, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + } + + wm8994_set_fmradio_common(codec, 1); + + wm8994_write(codec, WM8994_GPIO_3, 0x0100); //702 + wm8994_write(codec, WM8994_GPIO_4, 0x0100); //703 + wm8994_write(codec, WM8994_GPIO_5, 0x8100); //704 + wm8994_write(codec, WM8994_GPIO_6, 0xA101); //705 + wm8994_write(codec, WM8994_GPIO_7, 0x0100); //706 + + /*Output MIxer-Output PGA*/ + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS ); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + val |= (WM8994_SPKMIXL_TO_SPKOUTL); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + // Output mixer setting + val = wm8994_read(codec, WM8994_SPEAKER_MIXER); + val &= ~(WM8994_MIXINL_TO_SPKMIXL_MASK | WM8994_MIXINR_TO_SPKMIXR_MASK | WM8994_DAC1L_TO_SPKMIXL_MASK | WM8994_DAC1R_TO_SPKMIXR_MASK); + val |= (WM8994_DAC1L_TO_SPKMIXL); + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5); //05 : 3303 + val &= ~(WM8994_AIF2DACL_ENA_MASK | WM8994_AIF2DACR_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK + | WM8994_DAC1L_ENA_MASK | WM8994_DAC1R_ENA_MASK); + val |= (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA + | WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + // Enable IN2 and MIXIN - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 +// val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_2); +// val &= ~(WM8994_TSHUT_ENA_MASK | WM8994_TSHUT_OPDIS_MASK | WM8994_OPCLK_ENA_MASK | +// WM8994_MIXINL_ENA_MASK | WM8994_MIXINR_ENA_MASK | WM8994_IN2L_ENA_MASK | WM8994_IN2R_ENA_MASK); +// val |= (WM8994_TSHUT_ENA | WM8994_TSHUT_OPDIS | WM8994_OPCLK_ENA | WM8994_MIXINL_ENA | +// WM8994_MIXINR_ENA | WM8994_IN2L_ENA | WM8994_IN2R_ENA); + val = (WM8994_TSHUT_ENA | WM8994_TSHUT_OPDIS | WM8994_OPCLK_ENA | WM8994_MIXINL_ENA | + WM8994_MIXINR_ENA | WM8994_IN2L_ENA | WM8994_IN2R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, val); + + //AIF2 clock source <- FLL1 + val = wm8994_read(codec, WM8994_AIF2_CLOCKING_1); //204H : 0x0011 + val &= ~(WM8994_AIF2CLK_ENA_MASK | WM8994_AIF2CLK_SRC_MASK); + val |= (WM8994_AIF2CLK_ENA | 0x2 << WM8994_AIF2CLK_SRC_SHIFT); + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, val); + + val = wm8994_read(codec, WM8994_CLOCKING_1); //208H : 0xF -> 0xE + val &= ~(WM8994_SYSCLK_SRC_MASK | WM8994_DSP_FSINTCLK_ENA_MASK | WM8994_DSP_FS2CLK_ENA_MASK | WM8994_DSP_FS1CLK_ENA_MASK); + val |= (WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FS2CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_4); //04H + val &= ~(WM8994_AIF2ADCL_ENA_MASK | WM8994_AIF2ADCR_ENA_MASK | WM8994_ADCL_ENA_MASK | WM8994_ADCR_ENA_MASK); + val |= (WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA | WM8994_ADCL_ENA | WM8994_ADCR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, val); + + //DAC2 Setting + //ADCR_TO_DAC2 vol, ADCL_TO_DAC2 vol + wm8994_write(codec, WM8994_DAC2_MIXER_VOLUMES, 0x018C); //603H : 0x018C + + //ADCL_TO_DAC2L + val = wm8994_read(codec, WM8994_DAC2_LEFT_MIXER_ROUTING); //604H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2L_MASK); + val |= (WM8994_ADC1_TO_DAC2L); + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, val); + + //ADCR_TO_DAC2R + val = wm8994_read(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING); //605H : 0x0010 + val &= ~(WM8994_ADC2_TO_DAC2R_MASK); + val |= (WM8994_ADC2_TO_DAC2R); // Changed value to support stereo + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, val); + + //DAC block volume + //DAC1, DAC2 Volume Setting + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); //610H : 1C0 + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME); //611 : 1C0 + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + val = wm8994_read(codec, WM8994_DAC2_LEFT_VOLUME); //612 : 1C0 + val &= ~(WM8994_DAC2L_MUTE_MASK | WM8994_DAC2L_VOL_MASK); + val |= (TUNING_DAC2L_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC2_LEFT_VOLUME,val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_VOLUME); //613 : 1C0 + val &= ~(WM8994_DAC2R_MUTE_MASK | WM8994_DAC2R_VOL_MASK); + val |= (WM8994_DAC2_VU | TUNING_DAC2R_VOL); //0 db volume + wm8994_write(codec, WM8994_DAC2_RIGHT_VOLUME, val); + + wm8994_write(codec, WM8994_AIF1_DAC1_EQ_GAINS_1, 0x0000); //480 : 0 + +// wm8994_write(codec, 0x01, 0x1003); + + wm8994_write(codec, WM8994_OVERSAMPLING, 0x0000); + + //AIF2 Master/Slave , LOOPBACK, AIF2DAC Unmute + val = wm8994_read(codec, WM8994_AIF2_MASTER_SLAVE); //312 : 7000 + val &= ~(WM8994_AIF2_LRCLK_FRC_MASK | WM8994_AIF2_CLK_FRC_MASK | WM8994_AIF2_MSTR_MASK); + val |= (WM8994_AIF2_LRCLK_FRC | WM8994_AIF2_CLK_FRC | WM8994_AIF2_MSTR); + wm8994_write(codec, WM8994_AIF2_MASTER_SLAVE, val); + + val = wm8994_read(codec, WM8994_AIF2_CONTROL_2); //311 : 4001 + val &= ~(WM8994_AIF2_LOOPBACK_MASK); + val |= (WM8994_AIF2_LOOPBACK); + wm8994_write(codec, WM8994_AIF2_CONTROL_2, val); + + val = wm8994_read(codec, WM8994_AIF2_DAC_FILTERS_1); //520 : 0 + val &= ~(WM8994_AIF2DAC_MUTE_MASK); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, val); + + //Enbale bias,vmid and Left speaker + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK |WM8994_SPKOUTL_ENA_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_SPKOUTL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + //DAC Routing + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING); //601H : 0x05 + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK | WM8994_AIF1DAC2L_TO_DAC1L_MASK | WM8994_AIF2DACL_TO_DAC1L_MASK); + val |= (WM8994_AIF2DACL_TO_DAC1L | WM8994_AIF1DAC1L_TO_DAC1L); + wm8994_write(codec, WM8994_DAC1_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING); //602H : 0x05 + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK | WM8994_AIF1DAC2R_TO_DAC1R_MASK | WM8994_AIF2DACR_TO_DAC1R_MASK); + val |= (WM8994_AIF1DAC1R_TO_DAC1R | WM8994_AIF2DACR_TO_DAC1R); + wm8994_write(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING, val); + + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, 0x0000); +#elif defined(CONFIG_PHONE_P1_CDMA) + wm8994->fmradio_path = FMR_SPK; + + //Disable end point for preventing pop up noise. + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_SPKOUTL_ENA_MASK); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + // Enable IN2 and MIXIN - Temporary inserted for blocking MIC and FM radio mixing - DW Shim 2010.03.04 +// val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_2); +// val &= ~(WM8994_TSHUT_ENA_MASK | WM8994_TSHUT_OPDIS_MASK | WM8994_OPCLK_ENA_MASK | +// WM8994_MIXINL_ENA_MASK | WM8994_MIXINR_ENA_MASK | WM8994_IN2L_ENA_MASK | WM8994_IN2R_ENA_MASK); +// val |= (WM8994_TSHUT_ENA | WM8994_TSHUT_OPDIS | WM8994_OPCLK_ENA | WM8994_MIXINL_ENA | +// WM8994_MIXINR_ENA | WM8994_IN2L_ENA | WM8994_IN2R_ENA); + val = (WM8994_TSHUT_ENA | WM8994_TSHUT_OPDIS | WM8994_OPCLK_ENA | WM8994_MIXINL_ENA | + WM8994_MIXINR_ENA | WM8994_IN2L_ENA | WM8994_IN2R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2, val); + + wm8994_set_fmradio_common(codec, 1); + + if(!wm8994->testmode_config_flag) + { + // Unmute the SPKMIXVOLUME + val = wm8994_read(codec, WM8994_SPKMIXL_ATTENUATION); + val &= ~(WM8994_SPKMIXL_VOL_MASK); + val |= TUNING_SPKMIXL_ATTEN; + wm8994_write(codec, WM8994_SPKMIXL_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPKMIXR_ATTENUATION); + val &= ~(WM8994_SPKMIXR_VOL_MASK); + wm8994_write(codec, WM8994_SPKMIXR_ATTENUATION, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_LEFT); + val &= ~(WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + val |= (WM8994_SPKOUT_VU | WM8994_SPKOUTL_MUTE_N | TUNING_FMRADIO_SPKL_VOL); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_LEFT, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_RIGHT); + val &= ~(WM8994_SPKOUTR_MUTE_N_MASK | WM8994_SPKOUTR_VOL_MASK); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_RIGHT, val); + + val = wm8994_read(codec, WM8994_CLASSD); + val &= ~(WM8994_SPKOUTL_BOOST_MASK); + val |= TUNING_FMRADIO_CLASSD_VOL << WM8994_SPKOUTL_BOOST_SHIFT; + wm8994_write(codec, WM8994_CLASSD, val); + + } + + /*Output MIxer-Output PGA*/ + val = wm8994_read(codec,WM8994_SPKOUT_MIXERS ); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + val |= (WM8994_SPKMIXL_TO_SPKOUTL); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + // Output mixer setting + val = wm8994_read(codec, WM8994_SPEAKER_MIXER); + val &= ~(WM8994_MIXINL_TO_SPKMIXL_MASK | WM8994_MIXINR_TO_SPKMIXR_MASK); + val |= (WM8994_MIXINL_TO_SPKMIXL); + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + // Enable SPK Volume. + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); + val &= ~(WM8994_SPKRVOL_ENA_MASK | WM8994_SPKLVOL_ENA_MASK); + val |= (WM8994_SPKLVOL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + //Enbale bias,vmid and Left speaker + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK |WM8994_SPKOUTL_ENA_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_SPKOUTL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); +#endif +} + +void wm8994_set_fmradio_headset_mix(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + int val; + + DEBUG_LOG(""); + + if(wm8994->fmradio_path == FMR_SPK) + wm8994_set_playback_headset(codec); + else + { + // Unmute the AF1DAC1 + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1 ); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK | WM8994_AIF1DAC1_MONO_MASK); + val |= WM8994_AIF1DAC1_UNMUTE; + wm8994_write(codec,WM8994_AIF1_DAC1_FILTERS_1 ,val); + + // Enable the Timeslot0 to DAC1L + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING ); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK); + val |= WM8994_AIF1DAC1L_TO_DAC1L; + wm8994_write(codec,WM8994_DAC1_LEFT_MIXER_ROUTING ,val); + + //Enable the Timeslot0 to DAC1R + val = wm8994_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING ); + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK); + val |= WM8994_AIF1DAC1R_TO_DAC1R; + wm8994_write(codec,WM8994_DAC1_RIGHT_MIXER_ROUTING ,val); + + // Enable DAC1L to HPOUT1L path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); + val &= ~(WM8994_DAC1L_TO_HPOUT1L_MASK | WM8994_DAC1L_TO_MIXOUTL_MASK); + val |= WM8994_DAC1L_TO_MIXOUTL ; + wm8994_write(codec,WM8994_OUTPUT_MIXER_1, val); + + // Enable DAC1R to HPOUT1R path + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); + val &= ~(WM8994_DAC1R_TO_HPOUT1R_MASK | WM8994_DAC1R_TO_MIXOUTR_MASK); + val |= WM8994_DAC1R_TO_MIXOUTR; + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + //Enable Dac1 and DAC2 and the Timeslot0 for AIF1 + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5 ); + val &= ~(WM8994_DAC1R_ENA_MASK | WM8994_DAC1L_ENA_MASK|WM8994_AIF1DAC1R_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK ); + val |= (WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA | WM8994_DAC1L_ENA |WM8994_DAC1R_ENA ); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5 ,val); + + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_RADIO_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DAC1R_RADIO_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + } +} + +void wm8994_set_fmradio_speaker_mix(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + int val; + + DEBUG_LOG(""); + + if(wm8994->fmradio_path == FMR_HP) + wm8994_set_playback_speaker(codec); + else + { + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME ); + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + //Unmute the DAC path + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK); + val |= WM8994_DAC1L_TO_SPKMIXL; + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + // Eable DAC1 Left and timeslot left + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_5); + val &= ~( WM8994_DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK); + val |= (WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA | WM8994_DAC1L_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + //Unmute + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK | WM8994_AIF1DAC1_MONO_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE | WM8994_AIF1DAC1_MONO); + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + + //enable timeslot0 to left dac + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING); + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK); + val |= WM8994_AIF1DAC1L_TO_DAC1L; + wm8994_write(codec, WM8994_DAC1_LEFT_MIXER_ROUTING, val); + } + wm8994->fmradio_path = FMR_SPK_MIX; +} + +void wm8994_set_fmradio_speaker_headset_mix(struct snd_soc_codec *codec) +{ + struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec); + + u16 val; + + u16 nReadServo4Val = 0; + u16 ncompensationResult = 0; + u16 nServo4Low = 0; + u16 nServo4High = 0; + u8 nCompensationResultLow=0; + u8 nCompensationResultHigh=0; + + DEBUG_LOG(""); + + if(wm8994->fmradio_path == FMR_HP) + wm8994_disable_fmradio_path(codec); + else + wm8994_disable_fmradio_path(codec); + + wm8994->fmradio_path = FMR_DUAL_MIX; + + wm8994_write(codec, WM8994_GPIO_3, 0x0100); + wm8994_write(codec, WM8994_GPIO_4, 0x0100); + wm8994_write(codec, WM8994_GPIO_5, 0x8100); + wm8994_write(codec, WM8994_GPIO_6, 0xA101); + wm8994_write(codec, WM8994_GPIO_7, 0x0100); + + // Disable reg sync to MCLK + val = wm8994_read(codec, WM8994_AIF1_CLOCKING_1); + val &= ~(WM8994_AIF1CLK_ENA_MASK); + val |= WM8994_AIF1CLK_ENA; + wm8994_write(codec, WM8994_AIF1_CLOCKING_1, val); + + + // Analogue Path Config + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_2 ); + val &= ~(WM8994_MIXINL_ENA_MASK | WM8994_MIXINR_ENA_MASK | WM8994_IN2L_ENA_MASK | WM8994_IN2R_ENA_MASK); + val |= (WM8994_MIXINL_ENA | WM8994_MIXINR_ENA| WM8994_IN2L_ENA| WM8994_IN2R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_2 , val ); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_1); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_NORMAL); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1 , 0x0003); + + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val = 0x0000; + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val = 0x0100; + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + +// wm8994_set_fmradio_common(codec, 1); + + //FLL2 Setting + val = wm8994_read(codec, WM8994_AIF2_CLOCKING_1); //204H : 0x0011 + val &= ~(WM8994_AIF2CLK_ENA_MASK | WM8994_AIF2CLK_SRC_MASK); + val |= (WM8994_AIF2CLK_ENA | 0x2 << WM8994_AIF2CLK_SRC_SHIFT); + wm8994_write(codec, WM8994_AIF2_CLOCKING_1, val); + + val = wm8994_read(codec, WM8994_CLOCKING_1); //208H : 0xF -> 0xE + val &= ~(WM8994_SYSCLK_SRC_MASK | WM8994_DSP_FSINTCLK_ENA_MASK | WM8994_DSP_FS2CLK_ENA_MASK | WM8994_DSP_FS1CLK_ENA_MASK); + val |= (WM8994_DSP_FS1CLK_ENA | WM8994_DSP_FS2CLK_ENA | WM8994_DSP_FSINTCLK_ENA); + wm8994_write(codec, WM8994_CLOCKING_1, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_4); //04H + val &= ~(WM8994_AIF2ADCL_ENA_MASK | WM8994_AIF2ADCR_ENA_MASK | WM8994_ADCL_ENA_MASK | WM8994_ADCR_ENA_MASK); + val |= (WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA | WM8994_ADCL_ENA | WM8994_ADCR_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_4, val); + + //DAC2 Setting + wm8994_write(codec, WM8994_DAC2_MIXER_VOLUMES, 0x018C); //603H : 0x018C + + val = wm8994_read(codec, WM8994_DAC2_LEFT_MIXER_ROUTING); //604H : 0x0010 + val &= ~(WM8994_ADC1_TO_DAC2L_MASK); + val |= (WM8994_ADC1_TO_DAC2L); + wm8994_write(codec, WM8994_DAC2_LEFT_MIXER_ROUTING, val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING); //605H : 0x0010 + val &= ~(WM8994_ADC2_TO_DAC2R_MASK); + val |= (WM8994_ADC2_TO_DAC2R); // Changed value to support stereo + wm8994_write(codec, WM8994_DAC2_RIGHT_MIXER_ROUTING, val); + + //DRC for Noise-gate (AIF2) + wm8994_write(codec, 0x541, 0x0850); + wm8994_write(codec, 0x542, 0x0800); + wm8994_write(codec, 0x543, 0x0001); + wm8994_write(codec, 0x544, 0x0008); + wm8994_write(codec, 0x540, 0x01BC); + + //DAC1 Setting + val = wm8994_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING); //601H : 0x05 + val &= ~(WM8994_AIF1DAC1L_TO_DAC1L_MASK | WM8994_AIF1DAC2L_TO_DAC1L_MASK | WM8994_AIF2DACL_TO_DAC1L_MASK); + val |= (WM8994_AIF2DACL_TO_DAC1L | WM8994_AIF1DAC1L_TO_DAC1L); + wm8994_write(codec, WM8994_DAC1_LEFT_MIXER_ROUTING, val); + + + val = wm8994_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING); //602H : 0x05 + val &= ~(WM8994_AIF1DAC1R_TO_DAC1R_MASK | WM8994_AIF1DAC2R_TO_DAC1R_MASK | WM8994_AIF2DACR_TO_DAC1R_MASK); + val |= (WM8994_AIF1DAC1R_TO_DAC1R | WM8994_AIF2DACR_TO_DAC1R); + wm8994_write(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING, val); + + //DAC1, DAC2 Volume Setting + //Unmute DAC1 left + val = wm8994_read(codec,WM8994_DAC1_LEFT_VOLUME ); //610H : 1C0 + val &= ~(WM8994_DAC1L_MUTE_MASK | WM8994_DAC1L_VOL_MASK); + val |= (TUNING_DAC1L_VOL); + wm8994_write(codec,WM8994_DAC1_LEFT_VOLUME ,val); + + //Unmute and volume ctrl RightDAC + val = wm8994_read(codec, WM8994_DAC1_RIGHT_VOLUME); //611 : 1C0 + val &= ~(WM8994_DAC1R_MUTE_MASK | WM8994_DAC1R_VOL_MASK); + val |= (WM8994_DAC1_VU | TUNING_DAC1R_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC1_RIGHT_VOLUME,val); + + + val = wm8994_read(codec, WM8994_DAC2_LEFT_VOLUME); //612 : 1C0 + val &= ~(WM8994_DAC2L_MUTE_MASK | WM8994_DAC2L_VOL_MASK); + val |= (TUNING_DAC2L_VOL); //0 db volume + wm8994_write(codec,WM8994_DAC2_LEFT_VOLUME,val); + + val = wm8994_read(codec, WM8994_DAC2_RIGHT_VOLUME); //613 : 1C0 + val &= ~(WM8994_DAC2R_MUTE_MASK | WM8994_DAC2R_VOL_MASK); + val |= (WM8994_DAC2_VU | TUNING_DAC2R_VOL); //0 db volume + wm8994_write(codec, WM8994_DAC2_RIGHT_VOLUME, val); + + wm8994_write(codec, WM8994_AIF1_DAC1_EQ_GAINS_1, 0x0000); //480 : 0 + + //Digital Mixer setting + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_5); //05 : 3303 + val &= ~(WM8994_AIF2DACL_ENA_MASK | WM8994_AIF2DACR_ENA_MASK | WM8994_AIF1DAC1L_ENA_MASK | WM8994_AIF1DAC1R_ENA_MASK + | WM8994_DAC1L_ENA_MASK | WM8994_DAC1R_ENA_MASK); + val |= (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA + | WM8994_DAC1L_ENA | WM8994_DAC1R_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_5, val); + + val = wm8994_read(codec, WM8994_POWER_MANAGEMENT_3); //03 : F + val &= ~(WM8994_MIXOUTLVOL_ENA_MASK | WM8994_MIXOUTRVOL_ENA_MASK | WM8994_MIXOUTL_ENA_MASK | WM8994_MIXOUTR_ENA_MASK + |WM8994_SPKLVOL_ENA_MASK | WM8994_SPKRVOL_ENA_MASK); + val |= (WM8994_MIXOUTLVOL_ENA | WM8994_MIXOUTRVOL_ENA | WM8994_MIXOUTL_ENA | WM8994_MIXOUTR_ENA | WM8994_SPKLVOL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_3, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_1); //2D : 1 + val &= ~(WM8994_DAC1L_TO_MIXOUTL_MASK); + val |= (WM8994_DAC1L_TO_MIXOUTL); + wm8994_write(codec, WM8994_OUTPUT_MIXER_1, val); + + val = wm8994_read(codec, WM8994_OUTPUT_MIXER_2); //2E : 1 + val &= ~(WM8994_DAC1R_TO_MIXOUTR_MASK); + val |= (WM8994_DAC1R_TO_MIXOUTR); + wm8994_write(codec, WM8994_OUTPUT_MIXER_2, val); + + val = wm8994_read(codec, WM8994_SPKOUT_MIXERS ); + val &= ~(WM8994_SPKMIXL_TO_SPKOUTL_MASK | + WM8994_SPKMIXR_TO_SPKOUTL_MASK | WM8994_SPKMIXR_TO_SPKOUTR_MASK); + val |= (WM8994_SPKMIXL_TO_SPKOUTL); + wm8994_write(codec, WM8994_SPKOUT_MIXERS, val); + + //Unmute the DAC path + val = wm8994_read(codec,WM8994_SPEAKER_MIXER); + val &= ~(WM8994_DAC1L_TO_SPKMIXL_MASK); + val |= WM8994_DAC1L_TO_SPKMIXL; + wm8994_write(codec, WM8994_SPEAKER_MIXER, val); + + //AIF1 FLL Setting + wm8994_write(codec, WM8994_OVERSAMPLING, 0x0000); + + //AIF2 Master/Slave , LOOPBACK, AIF2DAC Unmute + val = wm8994_read(codec, WM8994_AIF2_MASTER_SLAVE); //312 : 7000 + val &= ~(WM8994_AIF2_LRCLK_FRC_MASK | WM8994_AIF2_CLK_FRC_MASK | WM8994_AIF2_MSTR_MASK); + val |= (WM8994_AIF2_LRCLK_FRC | WM8994_AIF2_CLK_FRC | WM8994_AIF2_MSTR); + wm8994_write(codec, WM8994_AIF2_MASTER_SLAVE, val); + + val = wm8994_read(codec, WM8994_AIF2_CONTROL_2); //311 : 4001 + val &= ~(WM8994_AIF2_LOOPBACK_MASK); + val |= (WM8994_AIF2_LOOPBACK); + wm8994_write(codec, WM8994_AIF2_CONTROL_2, val); + + //* Unmutes + // Output setting + if(wm8994->testmode_config_flag == SEC_NORMAL) + { + val = wm8994_read(codec, WM8994_LEFT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTL_MUTE_N_MASK | WM8994_MIXOUTL_VOL_MASK); + val |= (WM8994_MIXOUTL_MUTE_N | TUNING_FMRADIO_OPGAL_VOL); + wm8994_write(codec,WM8994_LEFT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_RIGHT_OPGA_VOLUME); + val &= ~(WM8994_MIXOUTR_MUTE_N_MASK | WM8994_MIXOUTR_VOL_MASK); + val |= (WM8994_MIXOUT_VU | WM8994_MIXOUTR_MUTE_N | TUNING_FMRADIO_OPGAR_VOL); + wm8994_write(codec,WM8994_RIGHT_OPGA_VOLUME, val ); + + val = wm8994_read(codec, WM8994_LEFT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1L_MUTE_N_MASK | WM8994_HPOUT1L_VOL_MASK); + val |= (WM8994_HPOUT1L_MUTE_N | TUNING_FMRADIO_OUTPUTL_VOL); + wm8994_write(codec, WM8994_LEFT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_RIGHT_OUTPUT_VOLUME); + val &= ~(WM8994_HPOUT1R_MUTE_N_MASK | WM8994_HPOUT1R_VOL_MASK); + val |= (WM8994_HPOUT1_VU | WM8994_HPOUT1R_MUTE_N | TUNING_FMRADIO_OUTPUTR_VOL); + wm8994_write(codec, WM8994_RIGHT_OUTPUT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_LEFT_VOLUME); + val &= ~(WM8994_AIF1DAC1L_VOL_MASK); + val |= (TUNING_DUAL_DAC1L_RADIO_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_LEFT_VOLUME, val); + + val = wm8994_read(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME); + val &= ~(WM8994_AIF1DAC1R_VOL_MASK); + val |= (WM8994_AIF1DAC1_VU |TUNING_DUAL_DAC1R_RADIO_VOL); + wm8994_write(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME, val); + + val = wm8994_read(codec, WM8994_CLASSD); + val &= ~(WM8994_SPKOUTL_BOOST_MASK); + val |= TUNING_FMRADIO_CLASSD_VOL << WM8994_SPKOUTL_BOOST_SHIFT; + wm8994_write(codec, WM8994_CLASSD, val); + + val = wm8994_read(codec, WM8994_SPEAKER_VOLUME_LEFT); + val &= ~(WM8994_SPKOUTL_MUTE_N_MASK | WM8994_SPKOUTL_VOL_MASK); + val |= (WM8994_SPKOUT_VU | WM8994_SPKOUTL_MUTE_N | TUNING_FMRADIO_SPKL_VOL); + wm8994_write(codec, WM8994_SPEAKER_VOLUME_LEFT, val); + } + //* Headset + wm8994_write(codec, 0x102, 0x0003); + wm8994_write(codec, 0x56, 0x0003); + wm8994_write(codec, 0x102, 0x0000); + wm8994_write(codec, 0x5D, 0x0002); + + + //* DC Servo Series Count + val = 0x03E0; + wm8994_write(codec, WM8994_DC_SERVO_2, val); + + //* HP first and second stage + //Enable vmid,bias, hp left and right + val = wm8994_read(codec,WM8994_POWER_MANAGEMENT_1 ); + val &= ~(WM8994_BIAS_ENA_MASK | WM8994_VMID_SEL_MASK |WM8994_HPOUT1L_ENA_MASK | WM8994_HPOUT1R_ENA_MASK | WM8994_SPKOUTR_ENA_MASK | WM8994_SPKOUTL_ENA_MASK); + val |= (WM8994_BIAS_ENA | WM8994_VMID_SEL_NORMAL | WM8994_HPOUT1R_ENA | WM8994_HPOUT1L_ENA | WM8994_SPKOUTL_ENA); + wm8994_write(codec, WM8994_POWER_MANAGEMENT_1, val); + + val = (WM8994_HPOUT1L_DLY | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + + //Enable Charge Pump + val = wm8994_read(codec, WM8994_CHARGE_PUMP_1); + val &= ~WM8994_CP_ENA_MASK ; + val |= WM8994_CP_ENA | WM8994_CP_ENA_DEFAULT ; // this is from wolfson + wm8994_write(codec, WM8994_CHARGE_PUMP_1, 0x9F25); + + msleep(5); + + //* DC Servo + val = (WM8994_DCS_TRIG_SERIES_1 | WM8994_DCS_TRIG_SERIES_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, 0x0303 ); + + msleep(160); + + nReadServo4Val=wm8994_read(codec,WM8994_DC_SERVO_4); + nServo4Low=(u8)(nReadServo4Val & 0xff); + nServo4High=(u8)((nReadServo4Val>>8) & 0xff); + + nCompensationResultLow=((u16)nServo4Low-5)&0x00ff; + nCompensationResultHigh=(((u16)nServo4High-5)<<8)&0xff00; + ncompensationResult=nCompensationResultLow|nCompensationResultHigh; + wm8994_write(codec,WM8994_DC_SERVO_4, ncompensationResult); + + val = (WM8994_DCS_TRIG_DAC_WR_1 | WM8994_DCS_TRIG_DAC_WR_0 | WM8994_DCS_ENA_CHAN_1 | WM8994_DCS_ENA_CHAN_0); + wm8994_write(codec,WM8994_DC_SERVO_1, val ); + + msleep(20); + + //* Headphone Output + // Intermediate HP settings + val = wm8994_read(codec, WM8994_ANALOGUE_HP_1); + val &= ~(WM8994_HPOUT1R_DLY_MASK |WM8994_HPOUT1R_OUTP_MASK |WM8994_HPOUT1R_RMV_SHORT_MASK | + WM8994_HPOUT1L_DLY_MASK |WM8994_HPOUT1L_OUTP_MASK | WM8994_HPOUT1L_RMV_SHORT_MASK); + val |= (WM8994_HPOUT1L_RMV_SHORT | WM8994_HPOUT1L_OUTP|WM8994_HPOUT1L_DLY |WM8994_HPOUT1R_RMV_SHORT | + WM8994_HPOUT1R_OUTP | WM8994_HPOUT1R_DLY); + wm8994_write(codec, WM8994_ANALOGUE_HP_1, val); + + //DAC1 Unmute + val = wm8994_read(codec, WM8994_AIF1_DAC1_FILTERS_1); + val &= ~(WM8994_AIF1DAC1_MUTE_MASK | WM8994_AIF1DAC1_MONO_MASK); + val |= (WM8994_AIF1DAC1_UNMUTE | WM8994_AIF1DAC1_MONO); + wm8994_write(codec, WM8994_AIF1_DAC1_FILTERS_1, val); + + val = wm8994_read(codec, WM8994_AIF2_DAC_FILTERS_1); //520 : 0 + val &= ~(WM8994_AIF2DAC_MUTE_MASK); + wm8994_write(codec, WM8994_AIF2_DAC_FILTERS_1, val); + +} + + +#if defined WM8994_REGISTER_DUMP +void wm8994_register_dump(struct snd_soc_codec *codec) +{ + int wm8994_register; + + for(wm8994_register = 0; wm8994_register <= 0x6; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x15, wm8994_read(codec, 0x15)); + + for(wm8994_register = 0x18; wm8994_register <= 0x3C; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x4C, wm8994_read(codec, 0x4C)); + + for(wm8994_register = 0x51; wm8994_register <= 0x5C; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x60, wm8994_read(codec, 0x60)); + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x101, wm8994_read(codec, 0x101)); + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x110, wm8994_read(codec, 0x110)); + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x111, wm8994_read(codec, 0x111)); + + for(wm8994_register = 0x200; wm8994_register <= 0x212; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x220; wm8994_register <= 0x224; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x240; wm8994_register <= 0x244; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x300; wm8994_register <= 0x317; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x400; wm8994_register <= 0x411; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x420; wm8994_register <= 0x423; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x440; wm8994_register <= 0x444; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x450; wm8994_register <= 0x454; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x480; wm8994_register <= 0x493; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x4A0; wm8994_register <= 0x4B3; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x500; wm8994_register <= 0x503; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x510, wm8994_read(codec, 0x510)); + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x520, wm8994_read(codec, 0x520)); + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x521, wm8994_read(codec, 0x521)); + + for(wm8994_register = 0x540; wm8994_register <= 0x544; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x580; wm8994_register <= 0x593; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + for(wm8994_register = 0x600; wm8994_register <= 0x614; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x620, wm8994_read(codec, 0x620)); + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", 0x621, wm8994_read(codec, 0x621)); + + for(wm8994_register = 0x700; wm8994_register <= 0x70A; wm8994_register++) + DEBUG_LOG_ERR("Register= [%X], Value = [%X]", wm8994_register, wm8994_read(codec, wm8994_register)); + +} +#endif diff --git a/sound/soc/samsung/Kconfig b/sound/soc/samsung/Kconfig index 2600074..9364395 100644 --- a/sound/soc/samsung/Kconfig +++ b/sound/soc/samsung/Kconfig @@ -145,6 +145,17 @@ config SND_SOC_SAMSUNG_HERRING_WM8994 Say Y if you want to add support for SoC audio on herring with the WM8994. +config SND_SOC_SAMSUNG_P1_WM8994 + tristate "SoC I2S Audio support for P1 - WM8994" + depends on SND_SOC_SAMSUNG && MACH_P1 + select SND_S5PC1XX_I2S + select SND_SOC_WM8994 + select S5P_INTERNAL_DMA + select SND_S5P_WM8994_MASTER + help + Say Y if you want to add support for SoC audio on P1 + with the WM8994. + config SND_SOC_SAMSUNG_RX1950_UDA1380 tristate "Audio support for the HP iPAQ RX1950" depends on SND_SOC_SAMSUNG && MACH_RX1950 diff --git a/sound/soc/samsung/Makefile b/sound/soc/samsung/Makefile index 98a007e..e10c2a7 100644 --- a/sound/soc/samsung/Makefile +++ b/sound/soc/samsung/Makefile @@ -1,5 +1,5 @@ # S3c24XX Platform Support -snd-soc-s3c24xx-objs := dma.o s3c-dma-wrapper.o +snd-soc-s3c24xx-objs := dma.o s3c-dma-wrapper.o snd-soc-s3c24xx-i2s-objs := s3c24xx-i2s.o snd-soc-s3c2412-i2s-objs := s3c2412-i2s.o snd-soc-s5pc1xx-i2s-objs := s5pc1xx-i2s.o @@ -40,6 +40,7 @@ snd-soc-herring-wm8994-objs := herring-wm8994.o snd-soc-smdk-spdif-objs := smdk_spdif.o snd-soc-smdk-wm8580pcm-objs := smdk_wm8580pcm.o snd-soc-speyside-objs := speyside.o +snd-soc-p1-wm8994-objs := p1-wm8994.o obj-$(CONFIG_SND_SOC_SAMSUNG_JIVE_WM8750) += snd-soc-jive-wm8750.o obj-$(CONFIG_SND_SOC_SAMSUNG_NEO1973_WM8753) += snd-soc-neo1973-wm8753.o @@ -51,6 +52,7 @@ obj-$(CONFIG_SND_SOC_SAMSUNG_SIMTEC_HERMES) += snd-soc-s3c24xx-simtec-hermes.o obj-$(CONFIG_SND_SOC_SAMSUNG_SIMTEC_TLV320AIC23) += snd-soc-s3c24xx-simtec-tlv320aic23.o obj-$(CONFIG_SND_SOC_SAMSUNG_H1940_UDA1380) += snd-soc-h1940-uda1380.o obj-$(CONFIG_SND_SOC_SAMSUNG_HERRING_WM8994) += snd-soc-herring-wm8994.o +obj-$(CONFIG_SND_SOC_SAMSUNG_P1_WM8994) += snd-soc-p1-wm8994.o obj-$(CONFIG_SND_SOC_SAMSUNG_RX1950_UDA1380) += snd-soc-rx1950-uda1380.o obj-$(CONFIG_SND_SOC_SAMSUNG_SMDK_WM8580) += snd-soc-smdk-wm8580.o obj-$(CONFIG_SND_SOC_SAMSUNG_SMDK_WM8994) += snd-soc-smdk-wm8994.o diff --git a/sound/soc/samsung/p1-wm8994.c b/sound/soc/samsung/p1-wm8994.c new file mode 100644 index 0000000..0ff6f68 --- /dev/null +++ b/sound/soc/samsung/p1-wm8994.c @@ -0,0 +1,357 @@ +/* + * p1_wm8994.c + * + * Copyright (C) 2010, Samsung Elect. Ltd. - + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License as published by the + * Free Software Foundation; either version 2 of the License, or (at your + * option) any later version. + */ + +#include <linux/platform_device.h> +#include <linux/clk.h> +#include <sound/core.h> +#include <sound/pcm.h> +#include <sound/pcm_params.h> +#include <sound/soc.h> +#include <sound/soc-dapm.h> +#include <mach/regs-clock.h> +#include <plat/regs-iis.h> +#include "../codecs/wm8994.h" +#include "s3c-dma.h" +#include "s5pc1xx-i2s.h" + +#include <linux/io.h> + +#define I2S_NUM 0 +#define SRC_CLK 66738000 + +/* #define CONFIG_SND_DEBUG */ +#ifdef CONFIG_SND_DEBUG +#define debug_msg(x...) printk(x) +#else +#define debug_msg(x...) +#endif + +/* BLC(bits-per-channel) --> BFS(bit clock shud be >= FS*(Bit-per-channel)*2)*/ +/* BFS --> RFS(must be a multiple of BFS) */ +/* RFS & SRC_CLK --> Prescalar Value(SRC_CLK / RFS_VAL / fs - 1) */ +int smdkc110_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params) +{ + 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 bfs, rfs, ret; + u32 ap_codec_clk; +#ifndef CONFIG_SND_S5P_WM8994_MASTER + struct clk *clk_out, *clk_epll; + int psr; +#endif + debug_msg("%s\n", __func__); + + /* Choose BFS and RFS values combination that is supported by + * both the WM8994 codec as well as the S5P AP + * + */ + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S8: + /* Can take any RFS value for AP */ + bfs = 16; + rfs = 256; + break; + case SNDRV_PCM_FORMAT_S16_LE: + /* Can take any RFS value for AP */ + bfs = 32; + rfs = 256; + break; + case SNDRV_PCM_FORMAT_S20_3LE: + case SNDRV_PCM_FORMAT_S24_LE: + bfs = 48; + rfs = 512; + break; + /* Impossible, as the AP doesn't support 64fs or more BFS */ + case SNDRV_PCM_FORMAT_S32_LE: + default: + return -EINVAL; + } + +#ifdef CONFIG_SND_S5P_WM8994_MASTER + /* Set the Codec DAI configuration */ + ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S | + SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM); + + if (ret < 0) { + printk(KERN_ERR "smdkc110_wm8994_hw_params :\ + Codec DAI configuration error!\n"); + return ret; + } + + /* Set the AP DAI configuration */ + ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S | + SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM); + + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params :\ + AP DAI configuration error!\n"); + return ret; + } + + /* Select the AP Sysclk */ + ret = snd_soc_dai_set_sysclk(cpu_dai, S3C64XX_CDCLKSRC_EXT, + params_rate(params), SND_SOC_CLOCK_IN); + + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params :\ + AP sys clock INT setting error!\n"); + return ret; + } + + ret = snd_soc_dai_set_sysclk(cpu_dai, S3C64XX_CLKSRC_I2SEXT, + params_rate(params), SND_SOC_CLOCK_IN); + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params :\ + AP sys clock I2SEXT setting error!\n"); + return ret; + } + + switch (params_rate(params)) { + + case 8000: + ap_codec_clk = 4096000; + break; + case 11025: + ap_codec_clk = 2822400; + break; + case 12000: + ap_codec_clk = 6144000; + break; + case 16000: + ap_codec_clk = 4096000; + break; + case 22050: + ap_codec_clk = 6144000; + break; + case 24000: + ap_codec_clk = 6144000; + break; + case 32000: + ap_codec_clk = 8192000; + break; + case 44100: + ap_codec_clk = 11289600; + break; + case 48000: + ap_codec_clk = 12288000; + break; + default: + ap_codec_clk = 11289600; + break; + } + + ret = snd_soc_dai_set_sysclk(codec_dai, WM8994_SYSCLK_FLL, + ap_codec_clk, 0); + if (ret < 0) + return ret; +#else + ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S | + SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS); + + if (ret < 0) + return ret; + ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S | + SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS); + + if (ret < 0) + + return ret; + ret = snd_soc_dai_set_sysclk(cpu_dai, S3C64XX_CLKSRC_CDCLK, + params_rate(params), SND_SOC_CLOCK_OUT); + if (ret < 0) + return ret; +#ifdef USE_CLKAUDIO + ret = snd_soc_dai_set_sysclk(cpu_dai, S3C_CLKSRC_CLKAUDIO, + params_rate(params), SND_SOC_CLOCK_OUT); + + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params : \ + AP sys clock setting error!\n"); + return ret; + } +#endif + clk_out = clk_get(NULL, "clk_out"); + if (IS_ERR(clk_out)) { + printk(KERN_ERR + "failed to get CLK_OUT\n"); + return -EBUSY; + } + + clk_epll = clk_get(NULL, "fout_epll"); + if (IS_ERR(clk_epll)) { + printk(KERN_ERR + "failed to get fout_epll\n"); + clk_put(clk_out); + return -EBUSY; + } + + if (clk_set_parent(clk_out, clk_epll)) { + printk(KERN_ERR + "failed to set CLK_EPLL as parent of CLK_OUT\n"); + clk_put(clk_out); + clk_put(clk_epll); + return -EBUSY; + } + + + switch (params_rate(params)) { + case 8000: + case 16000: + case 32000: + case 48000: + case 64000: + case 96000: + clk_set_rate(clk_out, 12288000); + ap_codec_clk = SRC_CLK/4; + break; + case 11025: + case 22050: + case 44100: + case 88200: + default: + clk_set_rate(clk_out, 11289600); + ap_codec_clk = SRC_CLK/6; + break; + } + + ret = snd_soc_dai_set_sysclk(codec_dai, WM8994_SYSCLK_MCLK, + ap_codec_clk, 0); + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params : \ + Codec sys clock setting error!\n"); + return ret; + } + + /* Calculate Prescalare/PLL values for supported Rates */ + psr = SRC_CLK / rfs / params_rate(params); + ret = SRC_CLK / rfs - psr * params_rate(params); + /* round off */ + if (ret >= params_rate(params)/2) + psr += 1; + + psr -= 1; + printk(KERN_INFO + "SRC_CLK=%d PSR=%d RFS=%d BFS=%d\n", SRC_CLK, psr, rfs, bfs); + + /* Set the AP Prescalar/Pll */ + ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C_I2SV2_DIV_PRESCALER, psr); + + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params :\ + AP prescalar setting error!\n"); + return ret; + } + + /* Set the AP RFS */ + ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C_I2SV2_DIV_RCLK, rfs); + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params : AP RFS setting error!\n"); + return ret; + } + + /* Set the AP BFS */ + ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C_I2SV2_DIV_BCLK, bfs); + + if (ret < 0) { + printk(KERN_ERR + "smdkc110_wm8994_hw_params : AP BCLK setting error!\n"); + return ret; + } + + clk_put(clk_epll); + clk_put(clk_out); +#endif + return 0; + +} + +/* machine stream operations */ +static struct snd_soc_ops smdkc110_ops = { + .hw_params = smdkc110_hw_params, +}; + +/* digital audio interface glue - connects codec <--> CPU */ +static struct snd_soc_dai_link smdkc1xx_dai = { + .name = "WM8994", + .stream_name = "WM8994 HiFi Playback", + .cpu_dai_name = "samsung-i2s.0", + .codec_dai_name = "WM8994 PAIFRX", + .platform_name = "samsung-audio", + .codec_name = "wm8994-samsung-codec.4-001a", + .ops = &smdkc110_ops, +}; + +static struct snd_soc_card smdkc100 = { + .name = "smdkc110", + .dai_link = &smdkc1xx_dai, + .num_links = 1, +}; + +#if 0 +static struct wm8994_setup_data smdkc110_wm8994_setup = { + /* + The I2C address of the WM89940 is 0x34. To the I2C driver + the address is a 7-bit number hence the right shift . + */ + .i2c_address = 0x34, + .i2c_bus = 4, +}; + +/* audio subsystem */ +static struct snd_soc_device smdkc1xx_snd_devdata = { + .card = &smdkc100, + .codec_dev = &soc_codec_dev_wm8994, + .codec_data = &smdkc110_wm8994_setup, +}; +#endif + +static struct platform_device *smdkc1xx_snd_device; +static int __init smdkc110_audio_init(void) +{ + int ret; + + debug_msg("%s\n", __func__); + + smdkc1xx_snd_device = platform_device_alloc("soc-audio", 0); + if (!smdkc1xx_snd_device) + return -ENOMEM; + + platform_set_drvdata(smdkc1xx_snd_device, &smdkc100); + ret = platform_device_add(smdkc1xx_snd_device); + + if (ret) + platform_device_put(smdkc1xx_snd_device); + + return ret; +} + +static void __exit smdkc110_audio_exit(void) +{ + debug_msg("%s\n", __func__); + + platform_device_unregister(smdkc1xx_snd_device); +} + +module_init(smdkc110_audio_init); +module_exit(smdkc110_audio_exit); + +/* Module information */ +MODULE_DESCRIPTION("ALSA SoC SMDKC110 WM8994"); +MODULE_LICENSE("GPL"); |