-/*\r
- * rt5631.c -- RT5631 ALSA Soc Audio driver\r
- *\r
- * Copyright 2011 Realtek Microelectronics\r
- *\r
- * Author: flove <flove@realtek.com>\r
- *\r
- * Based on WM8753.c\r
- *\r
- * This program is free software; you can redistribute it and/or modify\r
- * it under the terms of the GNU General Public License version 2 as\r
- * published by the Free Software Foundation.\r
- *\r
- */\r
-#include <linux/module.h>\r
-#include <linux/moduleparam.h>\r
-#include <linux/init.h>\r
-#include <linux/delay.h>\r
-#include <linux/pm.h>\r
-#include <linux/i2c.h>\r
-#include <linux/platform_device.h>\r
-#include <linux/spi/spi.h>\r
-#include <sound/core.h>\r
-#include <sound/pcm.h>\r
-#include <sound/pcm_params.h>\r
-#include <sound/soc.h>\r
-#include <sound/soc-dapm.h>\r
-#include <sound/initval.h>\r
-\r
-#include "rt5631.h"\r
-#include <linux/timer.h>\r
-\r
-#if 0\r
-#define DBG(x...) printk(x)\r
-#else\r
-#define DBG(x...)\r
-#endif\r
-#define RT5631_VERSION "0.01 alsa 1.0.24"\r
-\r
-#define RT5631_ALC_DAC_FUNC_ENA 1 //ALC functio for DAC\r
-#define RT5631_ALC_ADC_FUNC_ENA 1 //ALC function for ADC\r
-#define RT5631_SPK_TIMER 0 //if enable this, MUST enable RT5631_EQ_FUNC_ENA first!\r
-\r
-struct rt5631_priv {\r
- int codec_version;\r
- int master;\r
- int sysclk;\r
- int dmic_used_flag;\r
- int eq_mode;\r
- int pll_used_flag;\r
-};\r
-#if (RT5631_SPK_TIMER == 1)\r
-static struct timer_list spk_timer;\r
-struct work_struct spk_work;\r
-static bool last_is_spk = false; // need modify.\r
-#endif\r
-\r
-static struct snd_soc_codec *rt5631_codec;\r
-static const u16 rt5631_reg[0x80];\r
-static int timesofbclk = 32;\r
-bool isPlaybackon = false, isCaptureon = false;\r
-\r
-module_param(timesofbclk, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);\r
-MODULE_PARM_DESC(timeofbclk, "relationship between bclk and fs");\r
-\r
-\r
-static inline int rt5631_write(struct snd_soc_codec *codec,\r
- unsigned int reg, unsigned int val)\r
-{\r
- return snd_soc_write(codec, reg, val);\r
-}\r
-\r
-static inline unsigned int rt5631_read(struct snd_soc_codec *codec,\r
- unsigned int reg)\r
-{\r
- return snd_soc_read(codec, reg);\r
-}\r
-\r
-static int rt5631_write_mask(struct snd_soc_codec *codec,\r
- unsigned int reg, unsigned int value, unsigned int mask)\r
-{\r
- unsigned int reg_val;\r
- int ret = 0;\r
-\r
- if (!mask)\r
- return 0;\r
-\r
- if (mask != 0xffff) {\r
- reg_val = rt5631_read(codec, reg);\r
- reg_val &= ~mask;\r
- reg_val |= (value & mask);\r
- ret = rt5631_write(codec, reg, reg_val);\r
- } else {\r
- ret = rt5631_write(codec, reg, value);\r
- }\r
-\r
- return ret;\r
-}\r
-\r
-static void rt5631_write_index(struct snd_soc_codec *codec,\r
- unsigned int reg, unsigned int value)\r
-{\r
- rt5631_write(codec, RT5631_INDEX_ADD, reg);\r
- rt5631_write(codec, RT5631_INDEX_DATA, value);\r
- return;\r
-}\r
-\r
-static unsigned int rt5631_read_index(struct snd_soc_codec *codec,\r
- unsigned int reg)\r
-{\r
- unsigned int value;\r
-\r
- rt5631_write(codec, RT5631_INDEX_ADD, reg);\r
- value = rt5631_read(codec, RT5631_INDEX_DATA);\r
-\r
- return value;\r
-}\r
-\r
-static void rt5631_write_index_mask(struct snd_soc_codec *codec,\r
- unsigned int reg, unsigned int value, unsigned int mask)\r
-{\r
- unsigned int reg_val;\r
-\r
- if (!mask)\r
- return;\r
-\r
- if (mask != 0xffff) {\r
- reg_val = rt5631_read_index(codec, reg);\r
- reg_val &= ~mask;\r
- reg_val |= (value & mask);\r
- rt5631_write_index(codec, reg, reg_val);\r
- } else {\r
- rt5631_write_index(codec, reg, value);\r
- }\r
-\r
- return;\r
-}\r
-\r
-static inline int rt5631_reset(struct snd_soc_codec *codec)\r
-{\r
- return snd_soc_write(codec, RT5631_RESET, 0);\r
-}\r
-\r
-struct rt5631_init_reg {\r
- u8 reg;\r
- u16 val;\r
-};\r
-\r
-#ifndef DEF_VOL\r
-#define DEF_VOL 0xc0\r
-#endif\r
-#ifndef DEF_VOL_SPK\r
-#define DEF_VOL_SPK 0xc0\r
-#endif\r
-\r
-/*\r
- * speaker channel volume select SPKMIXER, 0DB by default\r
- * Headphone channel volume select OUTMIXER,0DB by default\r
- * AXO1/AXO2 channel volume select OUTMIXER,0DB by default\r
- * Record Mixer source from Mic1/Mic2 by default\r
- * Mic1/Mic2 boost 40dB by default\r
- * DAC_L-->OutMixer_L by default\r
- * DAC_R-->OutMixer_R by default\r
- * DAC-->SpeakerMixer\r
- * Speaker volume-->SPOMixer(L-->L,R-->R)\r
- * Speaker AMP ratio gain is 1.44X\r
- * HP from OutMixer,speaker out from SpeakerOut Mixer\r
- * enable HP zero cross\r
- * change Mic1 & mic2 to differential mode\r
- */\r
-static struct rt5631_init_reg init_list[] = {\r
-\r
- {RT5631_SPK_OUT_VOL , (DEF_VOL_SPK<<8) | DEF_VOL_SPK}, //speaker channel volume select SPKMIXER,0DB by default\r
- {RT5631_HP_OUT_VOL , (DEF_VOL<<8) | DEF_VOL}, //Headphone channel volume select OUTMIXER,0DB by default\r
- {RT5631_MONO_AXO_1_2_VOL , 0xf0c0}, //AXO1/AXO2 channel volume select OUTMIXER,0DB by default\r
- {RT5631_ADC_REC_MIXER , 0xb0f0}, //Record Mixer source from Mic1 by default\r
- {RT5631_ADC_CTRL_1 , 0x0006},//STEREO ADC CONTROL 1\r
- {RT5631_MIC_CTRL_2 , 0x6600},//0x8800},//0x5500}, //Mic1/Mic2 boost 40DB by default\r
- \r
-#if RT5631_ALC_ADC_FUNC_ENA \r
-\r
- {RT5631_ALC_CTRL_1 , 0x0a0f},//ALC CONTROL 1\r
- {RT5631_ALC_CTRL_2 , 0x0005},//ALC CONTROL 2\r
- {RT5631_ALC_CTRL_3 , 0xe080},//ALC CONTROL 3\r
- \r
-#endif \r
- {RT5631_OUTMIXER_L_CTRL , 0xdfC0}, //DAC_L-->OutMixer_L by default\r
- {RT5631_OUTMIXER_R_CTRL , 0xdfC0}, //DAC_R-->OutMixer_R by default\r
- {RT5631_AXO1MIXER_CTRL , 0x8840}, //OutMixer_L-->AXO1Mixer by default\r
- {RT5631_AXO2MIXER_CTRL , 0x8880}, //OutMixer_R-->AXO2Mixer by default\r
- {RT5631_SPK_MIXER_CTRL , 0xd8d8}, //DAC-->SpeakerMixer\r
- {RT5631_SPK_MONO_OUT_CTRL , 0x6c00}, //Speaker volume-->SPOMixer(L-->L,R-->R) \r
- {RT5631_GEN_PUR_CTRL_REG , 0x2e00}, //Speaker AMP ratio gain is 1.27x\r
-#if defined(CONFIG_ADJUST_VOL_BY_CODEC)\r
- {RT5631_SPK_MONO_HP_OUT_CTRL, 0x0000}, //HP from outputmixer,speaker out from SpeakerOut Mixer \r
-#else\r
- {RT5631_SPK_MONO_HP_OUT_CTRL, 0x000c}, //HP from DAC,speaker out from SpeakerOut Mixer\r
-#endif\r
- {RT5631_DEPOP_FUN_CTRL_2 , 0x8000}, //HP depop by register control \r
- {RT5631_INT_ST_IRQ_CTRL_2 , 0x0f18}, //enable HP zero cross \r
- {RT5631_MIC_CTRL_1 , 0x8000}, //set mic 1 to differnetial mode\r
- {RT5631_GPIO_CTRL , 0x0000}, //set GPIO to input pin \r
-// {RT5631_JACK_DET_CTRL , 0x4e80}, //Jack detect for GPIO,high is HP,low is speaker \r
- {RT5631_JACK_DET_CTRL , 0x4bc0}, //Jack detect for GPIO,high is speaker,low is hp \r
-};\r
-#define RT5631_INIT_REG_LEN ARRAY_SIZE(init_list)\r
-\r
-/*\r
- * EQ parameter\r
- */\r
-enum {\r
- NORMAL,\r
- CLUB,\r
- DANCE,\r
- LIVE,\r
- POP,\r
- ROCK,\r
- OPPO,\r
- TREBLE,\r
- BASS,\r
- HFREQ, \r
- SPK_FR \r
-};\r
-\r
-struct hw_eq_preset {\r
- u16 type;\r
- u16 value[22];\r
- u16 ctrl;\r
-};\r
-\r
-/*\r
- * EQ param reg : 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x6, 0x7,\r
- * 0x8, 0x9, 0xa, 0xb, 0xc, 0xd, 0xe, 0xf\r
- * EQ control reg : 0x6e\r
- */\r
-struct hw_eq_preset hweq_preset[] = {\r
- {NORMAL , {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,\r
- 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x0000},\r
- {CLUB , {0x1C10, 0x0000, 0xC1CC, 0x1E5D, 0x0699, 0xCD48,\r
- 0x188D, 0x0699, 0xC3B6, 0x1CD0, 0x0699, 0x0436,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x000E},\r
- {DANCE , {0x1F2C, 0x095B, 0xC071, 0x1F95, 0x0616, 0xC96E,\r
- 0x1B11, 0xFC91, 0xDCF2, 0x1194, 0xFAF2, 0x0436,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},\r
- {LIVE , {0x1EB5, 0xFCB6, 0xC24A, 0x1DF8, 0x0E7C, 0xC883,\r
- 0x1C10, 0x0699, 0xDA41, 0x1561, 0x0295, 0x0436,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},\r
- {POP , {0x1EB5, 0xFCB6, 0xC1D4, 0x1E5D, 0x0E23, 0xD92E,\r
- 0x16E6, 0xFCB6, 0x0000, 0x0969, 0xF988, 0x0436,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},\r
- {ROCK , {0x1EB5, 0xFCB6, 0xC071, 0x1F95, 0x0424, 0xC30A,\r
- 0x1D27, 0xF900, 0x0C5D, 0x0FC7, 0x0E23, 0x0436,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},\r
- {OPPO , {0x0000, 0x0000, 0xCA4A, 0x17F8, 0x0FEC, 0xCA4A,\r
- 0x17F8, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},\r
- {TREBLE , {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,\r
- 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x188D,\r
- 0x1699, 0x0000, 0x0000, 0x0000}, 0x0010},\r
- {BASS , {0x1A43, 0x0C00, 0x0000, 0x0000, 0x0000, 0x0000,\r
- 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,\r
- 0x0000, 0x0000, 0x0000, 0x0000}, 0x0001},\r
-};\r
-\r
-static int rt5631_reg_init(struct snd_soc_codec *codec)\r
-{\r
- int i;\r
-\r
- for (i = 0; i < RT5631_INIT_REG_LEN; i++)\r
- rt5631_write(codec, init_list[i].reg, init_list[i].val);\r
-\r
- return 0;\r
-}\r
-\r
-static const char *rt5631_spol_source_sel[] = {\r
- "SPOLMIX", "MONOIN_RX", "VDAC", "DACL"};\r
-static const char *rt5631_spor_source_sel[] = {\r
- "SPORMIX", "MONOIN_RX", "VDAC", "DACR"};\r
-static const char *rt5631_mono_source_sel[] = {"MONOMIX", "MONOIN_RX", "VDAC"};\r
-static const char *rt5631_input_mode_source_sel[] = {\r
- "Single-end", "Differential"};\r
-static const char *rt5631_mic_boost[] = {"Bypass", "+20db", "+24db", "+30db",\r
- "+35db", "+40db", "+44db", "+50db", "+52db"};\r
-static const char *rt5631_hpl_source_sel[] = {"LEFT HPVOL", "LEFT DAC"};\r
-static const char *rt5631_hpr_source_sel[] = {"RIGHT HPVOL", "RIGHT DAC"};\r
-static const char *rt5631_eq_sel[] = {"NORMAL", "CLUB", "DANCE", "LIVE", "POP",\r
- "ROCK", "OPPO", "TREBLE", "BASS"};\r
-\r
-\r
-static const struct soc_enum rt5631_enum[] = {\r
-SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 14, 4, rt5631_spol_source_sel),\r
-SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 10, 4, rt5631_spor_source_sel),\r
-SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 6, 3, rt5631_mono_source_sel),\r
-SOC_ENUM_SINGLE(RT5631_MIC_CTRL_1, 15, 2, rt5631_input_mode_source_sel),\r
-SOC_ENUM_SINGLE(RT5631_MIC_CTRL_1, 7, 2, rt5631_input_mode_source_sel),\r
-SOC_ENUM_SINGLE(RT5631_MONO_INPUT_VOL, 15, 2, rt5631_input_mode_source_sel),\r
-SOC_ENUM_SINGLE(RT5631_MIC_CTRL_2, 12, 9, rt5631_mic_boost),\r
-SOC_ENUM_SINGLE(RT5631_MIC_CTRL_2, 8, 9, rt5631_mic_boost),\r
-SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 3, 2, rt5631_hpl_source_sel),\r
-SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 2, 2, rt5631_hpr_source_sel),\r
-SOC_ENUM_SINGLE(0, 4, 9, rt5631_eq_sel),\r
-};\r
-\r
-static int rt5631_dmic_get(struct snd_kcontrol *kcontrol,\r
- struct snd_ctl_elem_value *ucontrol)\r
-{\r
- struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
-\r
- ucontrol->value.integer.value[0] = rt5631->dmic_used_flag;\r
-\r
- return 0;\r
-}\r
-\r
-static void rt5631_close_dmic(struct snd_soc_codec *codec)\r
-{\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,\r
- DMIC_L_CH_MUTE | DMIC_R_CH_MUTE,\r
- DMIC_L_CH_MUTE_MASK | DMIC_R_CH_MUTE_MASK);\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,\r
- DMIC_DIS, DMIC_ENA_MASK);\r
- return;\r
-}\r
-\r
-static int rt5631_dmic_put(struct snd_kcontrol *kcontrol,\r
- struct snd_ctl_elem_value *ucontrol)\r
-{\r
- struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
-\r
- if (rt5631->dmic_used_flag == ucontrol->value.integer.value[0])\r
- return 0;\r
-\r
- if (ucontrol->value.integer.value[0]) {\r
- rt5631->dmic_used_flag = 1;\r
- } else {\r
- rt5631_close_dmic(codec);\r
- rt5631->dmic_used_flag = 0;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int rt5631_eq_sel_get(struct snd_kcontrol *kcontrol,\r
- struct snd_ctl_elem_value *ucontrol)\r
-{\r
- struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
-\r
- ucontrol->value.integer.value[0] = rt5631->eq_mode;\r
-\r
- return 0;\r
-}\r
-\r
-static void rt5631_update_eqmode(struct snd_soc_codec *codec, int mode)\r
-{\r
- int i;\r
-\r
- if (NORMAL == mode) {\r
- /* In Normal mode, the EQ parameter is cleared,\r
- * and hardware LP, BP1, BP2, BP3, HP1, HP2\r
- * block control and EQ block are disabled.\r
- */\r
- for (i = RT5631_EQ_BW_LOP; i <= RT5631_EQ_HPF_GAIN; i++)\r
- rt5631_write_index(codec, i,\r
- hweq_preset[mode].value[i]);\r
- rt5631_write_mask(codec, RT5631_EQ_CTRL, 0x0000, 0x003f);\r
- rt5631_write_index_mask(codec, RT5631_EQ_PRE_VOL_CTRL\r
- , 0x0000, 0x8000);\r
- } else {\r
- /* Fill and update EQ parameter,\r
- * and EQ block are enabled.\r
- */\r
- rt5631_write_index_mask(codec, RT5631_EQ_PRE_VOL_CTRL\r
- , 0x8000, 0x8000);\r
- rt5631_write(codec, RT5631_EQ_CTRL,\r
- hweq_preset[mode].ctrl);\r
- for (i = RT5631_EQ_BW_LOP; i <= RT5631_EQ_HPF_GAIN; i++)\r
- rt5631_write_index(codec, i,\r
- hweq_preset[mode].value[i]);\r
- rt5631_write_mask(codec, RT5631_EQ_CTRL, 0x4000, 0x4000);\r
- }\r
-\r
- return;\r
-}\r
-\r
-static int rt5631_eq_sel_put(struct snd_kcontrol *kcontrol,\r
- struct snd_ctl_elem_value *ucontrol)\r
-{\r
- struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
-\r
- if (rt5631->eq_mode == ucontrol->value.integer.value[0])\r
- return 0;\r
-\r
- rt5631_update_eqmode(codec, ucontrol->value.enumerated.item[0]);\r
- rt5631->eq_mode = ucontrol->value.integer.value[0];\r
-\r
- return 0;\r
-}\r
-\r
-#if (RT5631_SPK_TIMER == 1)\r
-static void spk_work_handler(struct work_struct *work)\r
-{\r
- struct snd_soc_codec *codec = rt5631_codec;\r
- bool is_spk = (rt5631_read(codec, 0x4a)) & 0x04; //detect rt5631 reg4a[3], 1'b:SPK, 0'b:HP ;\r
- if(last_is_spk != is_spk)\r
- printk("%s---%s is in use.last is %s in use\n", __FUNCTION__,is_spk?"speaker":"headphone",last_is_spk?"speaker":"headphone");\r
- \r
- if(is_spk && !last_is_spk){\r
- rt5631_write_index_mask(codec,0x11,0x0000,0x0007); //0db\r
- rt5631_write_index(codec,0x12,0x0003); //0db\r
- rt5631_update_eqmode(codec, SPK_FR); // SPK is in use, enable EQ mode of SPK_FR.\r
- }else if(!is_spk && last_is_spk){\r
- //flove071311 rt5631_update_eqmode(codec, NORMAL); // HP is in use, enable EQ mode of NORMAL.\r
- rt5631_write_index_mask(codec,0x11,0x0001,0x0003);\r
- rt5631_write_index(codec,0x12,0x0001); \r
- rt5631_update_eqmode(codec,HFREQ); \r
- }\r
- last_is_spk = is_spk;\r
-}\r
-\r
-/* timer to judge SPK or HP in use, and handle EQ issues accordingly. */\r
-void spk_timer_callback(unsigned long data )\r
-{ \r
- int ret = 0;\r
-\r
- schedule_work(&spk_work);\r
-\r
- //DBG("Starting timer to fire in 1000ms (%ld)\n", jiffies );\r
- ret = mod_timer(&spk_timer, jiffies + msecs_to_jiffies(1000));\r
- if (ret) printk("Error in mod_timer\n");\r
-}\r
-#endif\r
-\r
-static const struct snd_kcontrol_new rt5631_snd_controls[] = {\r
-SOC_ENUM("MIC1 Mode Control", rt5631_enum[3]),\r
-SOC_ENUM("MIC1 Boost", rt5631_enum[6]),\r
-SOC_ENUM("MIC2 Mode Control", rt5631_enum[4]),\r
-SOC_ENUM("MIC2 Boost", rt5631_enum[7]),\r
-SOC_ENUM("MONOIN Mode Control", rt5631_enum[5]),\r
-SOC_DOUBLE("PCM Playback Volume", RT5631_STEREO_DAC_VOL_2, 8, 0, 255, 1),\r
-SOC_DOUBLE("PCM Playback Switch", RT5631_STEREO_DAC_VOL_1, 15, 7, 1, 1),\r
-SOC_DOUBLE("MONOIN_RX Capture Volume", RT5631_MONO_INPUT_VOL, 8, 0, 31, 1),\r
-SOC_DOUBLE("AXI Capture Volume", RT5631_AUX_IN_VOL, 8, 0, 31, 1),\r
-SOC_SINGLE("AXO1 Playback Switch", RT5631_MONO_AXO_1_2_VOL, 15, 1, 1),\r
-SOC_SINGLE("AXO2 Playback Switch", RT5631_MONO_AXO_1_2_VOL, 7, 1, 1),\r
-SOC_DOUBLE("OUTVOL Playback Volume", RT5631_MONO_AXO_1_2_VOL, 8, 0, 31, 1),\r
-SOC_DOUBLE("Speaker Playback Switch", RT5631_SPK_OUT_VOL, 15, 7, 1, 1),\r
-SOC_DOUBLE("Speaker Playback Volume", RT5631_SPK_OUT_VOL, 8, 0, 63, 1),\r
-SOC_SINGLE("MONO Playback Switch", RT5631_MONO_AXO_1_2_VOL, 13, 1, 1),\r
-SOC_DOUBLE("HP Playback Switch", RT5631_HP_OUT_VOL, 15, 7, 1, 1),\r
-SOC_DOUBLE("HP Playback Volume", RT5631_HP_OUT_VOL, 8, 0, 63, 1),\r
-SOC_SINGLE_EXT("DMIC Capture Switch", 0, 2, 1, 0,\r
- rt5631_dmic_get, rt5631_dmic_put),\r
-SOC_ENUM_EXT("EQ Mode", rt5631_enum[10], rt5631_eq_sel_get, rt5631_eq_sel_put),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_recmixl_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("OUTMIXL Capture Switch", RT5631_ADC_REC_MIXER, 15, 1, 1),\r
-SOC_DAPM_SINGLE("MIC1_BST1 Capture Switch", RT5631_ADC_REC_MIXER, 14, 1, 1),\r
-SOC_DAPM_SINGLE("AXILVOL Capture Switch", RT5631_ADC_REC_MIXER, 13, 1, 1),\r
-SOC_DAPM_SINGLE("MONOIN_RX Capture Switch", RT5631_ADC_REC_MIXER, 12, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_recmixr_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("MONOIN_RX Capture Switch", RT5631_ADC_REC_MIXER, 4, 1, 1),\r
-SOC_DAPM_SINGLE("AXIRVOL Capture Switch", RT5631_ADC_REC_MIXER, 5, 1, 1),\r
-SOC_DAPM_SINGLE("MIC2_BST2 Capture Switch", RT5631_ADC_REC_MIXER, 6, 1, 1),\r
-SOC_DAPM_SINGLE("OUTMIXR Capture Switch", RT5631_ADC_REC_MIXER, 7, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_spkmixl_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("RECMIXL Playback Switch", RT5631_SPK_MIXER_CTRL, 15, 1, 1),\r
-SOC_DAPM_SINGLE("MIC1_P Playback Switch", RT5631_SPK_MIXER_CTRL, 14, 1, 1),\r
-SOC_DAPM_SINGLE("DACL Playback Switch", RT5631_SPK_MIXER_CTRL, 13, 1, 1),\r
-SOC_DAPM_SINGLE("OUTMIXL Playback Switch", RT5631_SPK_MIXER_CTRL, 12, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_spkmixr_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("OUTMIXR Playback Switch", RT5631_SPK_MIXER_CTRL, 4, 1, 1),\r
-SOC_DAPM_SINGLE("DACR Playback Switch", RT5631_SPK_MIXER_CTRL, 5, 1, 1),\r
-SOC_DAPM_SINGLE("MIC2_P Playback Switch", RT5631_SPK_MIXER_CTRL, 6, 1, 1),\r
-SOC_DAPM_SINGLE("RECMIXR Playback Switch", RT5631_SPK_MIXER_CTRL, 7, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_outmixl_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("RECMIXL Playback Switch", RT5631_OUTMIXER_L_CTRL, 15, 1, 1),\r
-SOC_DAPM_SINGLE("RECMIXR Playback Switch", RT5631_OUTMIXER_L_CTRL, 14, 1, 1),\r
-SOC_DAPM_SINGLE("DACL Playback Switch", RT5631_OUTMIXER_L_CTRL, 13, 1, 1),\r
-SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_OUTMIXER_L_CTRL, 12, 1, 1),\r
-SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_OUTMIXER_L_CTRL, 11, 1, 1),\r
-SOC_DAPM_SINGLE("MONOIN_RXP Playback Switch", RT5631_OUTMIXER_L_CTRL, 10, 1, 1),\r
-SOC_DAPM_SINGLE("AXILVOL Playback Switch", RT5631_OUTMIXER_L_CTRL, 9, 1, 1),\r
-SOC_DAPM_SINGLE("AXIRVOL Playback Switch", RT5631_OUTMIXER_L_CTRL, 8, 1, 1),\r
-SOC_DAPM_SINGLE("VDAC Playback Switch", RT5631_OUTMIXER_L_CTRL, 7, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_outmixr_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("VDAC Playback Switch", RT5631_OUTMIXER_R_CTRL, 7, 1, 1),\r
-SOC_DAPM_SINGLE("AXIRVOL Playback Switch", RT5631_OUTMIXER_R_CTRL, 8, 1, 1),\r
-SOC_DAPM_SINGLE("AXILVOL Playback Switch", RT5631_OUTMIXER_R_CTRL, 9, 1, 1),\r
-SOC_DAPM_SINGLE("MONOIN_RXN Playback Switch", RT5631_OUTMIXER_R_CTRL, 10, 1, 1),\r
-SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_OUTMIXER_R_CTRL, 11, 1, 1),\r
-SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_OUTMIXER_R_CTRL, 12, 1, 1),\r
-SOC_DAPM_SINGLE("DACR Playback Switch", RT5631_OUTMIXER_R_CTRL, 13, 1, 1),\r
-SOC_DAPM_SINGLE("RECMIXR Playback Switch", RT5631_OUTMIXER_R_CTRL, 14, 1, 1),\r
-SOC_DAPM_SINGLE("RECMIXL Playback Switch", RT5631_OUTMIXER_R_CTRL, 15, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_AXO1MIX_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_AXO1MIXER_CTRL, 15 , 1, 1),\r
-SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_AXO1MIXER_CTRL, 11, 1, 1),\r
-SOC_DAPM_SINGLE("OUTVOLL Playback Switch", RT5631_AXO1MIXER_CTRL, 7 , 1 , 1),\r
-SOC_DAPM_SINGLE("OUTVOLR Playback Switch", RT5631_AXO1MIXER_CTRL, 6, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_AXO2MIX_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_AXO2MIXER_CTRL, 15, 1, 1),\r
-SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_AXO2MIXER_CTRL, 11, 1, 1),\r
-SOC_DAPM_SINGLE("OUTVOLL Playback Switch", RT5631_AXO2MIXER_CTRL, 7, 1, 1),\r
-SOC_DAPM_SINGLE("OUTVOLR Playback Switch", RT5631_AXO2MIXER_CTRL, 6, 1 , 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_spolmix_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("SPKVOLL Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 15, 1, 1),\r
-SOC_DAPM_SINGLE("SPKVOLR Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 14, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_spormix_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("SPKVOLL Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 13, 1, 1),\r
-SOC_DAPM_SINGLE("SPKVOLR Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 12, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_monomix_mixer_controls[] = {\r
-SOC_DAPM_SINGLE("OUTVOLL Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 11, 1, 1),\r
-SOC_DAPM_SINGLE("OUTVOLR Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 10, 1, 1),\r
-};\r
-\r
-static const struct snd_kcontrol_new rt5631_spol_mux_control =\r
-SOC_DAPM_ENUM("Route", rt5631_enum[0]);\r
-static const struct snd_kcontrol_new rt5631_spor_mux_control =\r
-SOC_DAPM_ENUM("Route", rt5631_enum[1]);\r
-static const struct snd_kcontrol_new rt5631_mono_mux_control =\r
-SOC_DAPM_ENUM("Route", rt5631_enum[2]);\r
-\r
-static const struct snd_kcontrol_new rt5631_hpl_mux_control =\r
-SOC_DAPM_ENUM("Route", rt5631_enum[8]);\r
-static const struct snd_kcontrol_new rt5631_hpr_mux_control =\r
-SOC_DAPM_ENUM("Route", rt5631_enum[9]);\r
-\r
-//ALC for DAC function\r
-#if (RT5631_ALC_DAC_FUNC_ENA == 1)\r
-static void rt5631_alc_enable(struct snd_soc_codec *codec,unsigned int EnableALC)\r
-{\r
- if(EnableALC)\r
- {\r
- rt5631_write(codec, 0x64,0x0206);\r
- rt5631_write(codec, 0x65,0x0003);\r
- rt5631_write_index(codec, 0x21,0x5000);\r
- rt5631_write_index(codec, 0x22,0xa480);\r
- rt5631_write_index(codec, 0x23,0x0a08);\r
- rt5631_write(codec, 0x0c,0x0010);\r
- rt5631_write(codec, 0x66,0x650a);\r
- \r
- }\r
- else\r
- {\r
- rt5631_write(codec, 0x66,0x250A);\r
- rt5631_write(codec, 0x0c,0x0000); \r
- } \r
- \r
-}\r
-#endif\r
-\r
-static int spk_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- static int spkl_out_enable, spkr_out_enable;\r
-\r
- switch (event) {\r
- case SND_SOC_DAPM_POST_PMU:\r
-\r
-#if (RT5631_ALC_DAC_FUNC_ENA == 1) \r
- rt5631_alc_enable(codec, 1);\r
-#endif \r
-\r
- if (!spkl_out_enable && !strcmp(w->name, "SPKL Amp")) {\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,\r
- PWR_SPK_L_VOL, PWR_SPK_L_VOL);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,\r
- PWR_CLASS_D, PWR_CLASS_D);\r
- rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,\r
- 0, RT_L_MUTE);\r
- spkl_out_enable = 1;\r
- }\r
- if (!spkr_out_enable && !strcmp(w->name, "SPKR Amp")) {\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,\r
- PWR_SPK_R_VOL, PWR_SPK_R_VOL);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,\r
- PWR_CLASS_D, PWR_CLASS_D);\r
- rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,\r
- 0, RT_R_MUTE);\r
- spkr_out_enable = 1;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_POST_PMD:\r
- if (spkl_out_enable && !strcmp(w->name, "SPKL Amp")) {\r
- rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,\r
- RT_L_MUTE, RT_L_MUTE);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,\r
- 0, PWR_SPK_L_VOL);\r
- spkl_out_enable = 0;\r
- }\r
- if (spkr_out_enable && !strcmp(w->name, "SPKR Amp")) {\r
- rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,\r
- RT_R_MUTE, RT_R_MUTE);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,\r
- 0, PWR_SPK_R_VOL);\r
- spkr_out_enable = 0;\r
- }\r
- if (0 == spkl_out_enable && 0 == spkr_out_enable)\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,\r
- 0, PWR_CLASS_D);\r
-\r
-#if (RT5631_ALC_DAC_FUNC_ENA == 1) \r
- rt5631_alc_enable(codec, 0);\r
-#endif\r
-\r
- break;\r
-\r
- default:\r
- return 0;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-\r
-static void hp_depop_mode2_onebit(struct snd_soc_codec *codec, int enable)\r
-{\r
- unsigned int soft_vol, hp_zc;\r
-\r
- rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2, 0, EN_ONE_BIT_DEPOP);\r
-\r
- soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);\r
- hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);\r
- if (enable) {\r
- rt5631_write_index(codec, RT5631_TEST_MODE_CTRL, 0x84c0);\r
- rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x309f);\r
- rt5631_write_index(codec, RT5631_CP_INTL_REG2, 0x6530);\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_2,\r
- EN_CAP_FREE_DEPOP);\r
- } else {\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_2, 0);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(100));\r
- }\r
-\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);\r
-\r
- return;\r
-}\r
-\r
-static void hp_mute_unmute_depop_onebit(struct snd_soc_codec *codec, int enable)\r
-{\r
- unsigned int soft_vol, hp_zc;\r
-\r
- rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2, 0, EN_ONE_BIT_DEPOP);\r
- soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);\r
- hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);\r
- if (enable) {\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(10));\r
- rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x307f);\r
- rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0,\r
- RT_L_MUTE | RT_R_MUTE);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(300));\r
-\r
- } else {\r
- rt5631_write_mask(codec, RT5631_HP_OUT_VOL,\r
- RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(100));\r
- }\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);\r
-\r
- return;\r
-}\r
-\r
-static void hp_depop2(struct snd_soc_codec *codec, int enable)\r
-{\r
- unsigned int soft_vol, hp_zc;\r
-\r
- rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2,\r
- EN_ONE_BIT_DEPOP, EN_ONE_BIT_DEPOP);\r
- soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);\r
- hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);\r
- if (enable) {\r
- rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x303e);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- PWR_CHARGE_PUMP | PWR_HP_L_AMP | PWR_HP_R_AMP,\r
- PWR_CHARGE_PUMP | PWR_HP_L_AMP | PWR_HP_R_AMP);\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,\r
- POW_ON_SOFT_GEN | EN_DEPOP2_FOR_HP);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(100));\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- PWR_HP_DEPOP_DIS, PWR_HP_DEPOP_DIS);\r
- } else {\r
- rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x303F);\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,\r
- POW_ON_SOFT_GEN | EN_MUTE_UNMUTE_DEPOP |\r
- PD_HPAMP_L_ST_UP | PD_HPAMP_R_ST_UP);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(75));\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,\r
- POW_ON_SOFT_GEN | PD_HPAMP_L_ST_UP | PD_HPAMP_R_ST_UP);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3, 0,\r
- PWR_HP_DEPOP_DIS);\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,\r
- POW_ON_SOFT_GEN | EN_DEPOP2_FOR_HP |\r
- PD_HPAMP_L_ST_UP | PD_HPAMP_R_ST_UP);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(80));\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1, POW_ON_SOFT_GEN);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3, 0,\r
- PWR_CHARGE_PUMP | PWR_HP_L_AMP | PWR_HP_R_AMP);\r
- }\r
-\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);\r
-\r
- return;\r
-}\r
-\r
-static void hp_mute_unmute_depop(struct snd_soc_codec *codec, int enable)\r
-{\r
- unsigned int soft_vol, hp_zc;\r
-\r
- rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2,\r
- EN_ONE_BIT_DEPOP, EN_ONE_BIT_DEPOP);\r
- soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);\r
- hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);\r
- if (enable) {\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(10));\r
- rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x302f);\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,\r
- POW_ON_SOFT_GEN | EN_MUTE_UNMUTE_DEPOP |\r
- EN_HP_R_M_UN_MUTE_DEPOP | EN_HP_L_M_UN_MUTE_DEPOP);\r
- rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0,\r
- RT_L_MUTE | RT_R_MUTE);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(160));\r
- } else {\r
- rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x302f);\r
- rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,\r
- POW_ON_SOFT_GEN | EN_MUTE_UNMUTE_DEPOP |\r
- EN_HP_R_M_UN_MUTE_DEPOP | EN_HP_L_M_UN_MUTE_DEPOP);\r
- rt5631_write_mask(codec, RT5631_HP_OUT_VOL,\r
- RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(150));\r
- }\r
-\r
- rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);\r
- rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);\r
-\r
- return;\r
-}\r
-\r
-static int hp_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
- static bool hp_en;\r
- int pu_l, pu_r;\r
-\r
- pu_l = rt5631_read(codec, RT5631_PWR_MANAG_ADD4) & PWR_HP_L_OUT_VOL;\r
- pu_r = rt5631_read(codec, RT5631_PWR_MANAG_ADD4) & PWR_HP_R_OUT_VOL;\r
- switch (event) {\r
- case SND_SOC_DAPM_PRE_PMD:\r
- if ((pu_l && pu_r) && hp_en) {\r
- if (rt5631->codec_version) {\r
- hp_mute_unmute_depop_onebit(codec, 0);\r
- hp_depop_mode2_onebit(codec, 0);\r
- } else {\r
- hp_mute_unmute_depop(codec, 0);\r
- hp_depop2(codec, 0);\r
- }\r
- hp_en = false;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_POST_PMU:\r
- if ((pu_l && pu_r) && !hp_en) {\r
- if (rt5631->codec_version) {\r
- hp_depop_mode2_onebit(codec, 1);\r
- hp_mute_unmute_depop_onebit(codec, 1);\r
- } else {\r
- hp_depop2(codec, 1);\r
- hp_mute_unmute_depop(codec, 1);\r
- }\r
- hp_en = true;\r
- }\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int dac_to_hp_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
- static bool hp_en;\r
-\r
- switch (event) {\r
- case SND_SOC_DAPM_PRE_PMD:\r
- if (hp_en) {\r
- if (rt5631->codec_version) {\r
- hp_mute_unmute_depop_onebit(codec, 0);\r
- hp_depop_mode2_onebit(codec, 0);\r
- } else {\r
- hp_mute_unmute_depop(codec, 0);\r
- hp_depop2(codec, 0);\r
- }\r
- hp_en = false;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_POST_PMU:\r
- if (!hp_en) {\r
- if (rt5631->codec_version) {\r
- hp_depop_mode2_onebit(codec, 1);\r
- hp_mute_unmute_depop_onebit(codec, 1);\r
- } else {\r
- hp_depop2(codec, 1);\r
- hp_mute_unmute_depop(codec, 1);\r
- }\r
- hp_en = true;\r
- }\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int mic_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- int val_mic1, val_mic2;\r
-\r
- val_mic1 = rt5631_read(codec, RT5631_PWR_MANAG_ADD2) &\r
- PWR_MIC1_BOOT_GAIN;\r
- val_mic2 = rt5631_read(codec, RT5631_PWR_MANAG_ADD2) &\r
- PWR_MIC2_BOOT_GAIN;\r
- switch (event) {\r
- case SND_SOC_DAPM_POST_PMU:\r
- /*\r
- * If microphone is stereo, need not copy ADC channel\r
- * If mic1 is used, copy ADC left to right\r
- * If mic2 is used, copy ADC right to left\r
- */\r
- if (val_mic1 && val_mic2)\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0x0000, 0xc000);\r
- else if (val_mic1)\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0x4000, 0xc000);\r
- else if (val_mic2)\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0x8000, 0xc000);\r
- else\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0x0000, 0xc000);\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int auxo1_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- static bool aux1_en;\r
-\r
- switch (event) {\r
- case SND_SOC_DAPM_PRE_PMD:\r
- if (aux1_en) {\r
- rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,\r
- RT_L_MUTE, RT_L_MUTE);\r
- aux1_en = false;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_POST_PMU:\r
- if (!aux1_en) {\r
- rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,\r
- 0, RT_L_MUTE);\r
- aux1_en = true;\r
- }\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int auxo2_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- static bool aux2_en;\r
-\r
- switch (event) {\r
- case SND_SOC_DAPM_PRE_PMD:\r
- if (aux2_en) {\r
- rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,\r
- RT_R_MUTE, RT_R_MUTE);\r
- aux2_en = false;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_POST_PMU:\r
- if (!aux2_en) {\r
- rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,\r
- 0, RT_R_MUTE);\r
- aux2_en = true;\r
- }\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int mono_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- static bool mono_en;\r
-\r
- switch (event) {\r
- case SND_SOC_DAPM_PRE_PMD:\r
- if (mono_en) {\r
- rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,\r
- MUTE_MONO, MUTE_MONO);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- 0, PWR_MONO_DEPOP_DIS);\r
- mono_en = false;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_POST_PMU:\r
- if (!mono_en) {\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- PWR_MONO_DEPOP_DIS, PWR_MONO_DEPOP_DIS);\r
- rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,\r
- 0, MUTE_MONO);\r
- mono_en = true;\r
- }\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-/**\r
- * config_common_power - control all common power of codec system\r
- * @pmu: power up or not\r
- */\r
-static int config_common_power(struct snd_soc_codec *codec, bool pmu)\r
-{\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
- unsigned int mux_val;\r
-\r
- if (pmu) {\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,\r
- PWR_MAIN_I2S_EN | PWR_DAC_REF,\r
- PWR_MAIN_I2S_EN | PWR_DAC_REF);\r
- mux_val = rt5631_read(codec, RT5631_SPK_MONO_HP_OUT_CTRL);\r
- if (!(mux_val & HP_L_MUX_SEL_DAC_L))\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,\r
- PWR_DAC_L_TO_MIXER, PWR_DAC_L_TO_MIXER);\r
- if (!(mux_val & HP_R_MUX_SEL_DAC_R))\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,\r
- PWR_DAC_R_TO_MIXER, PWR_DAC_R_TO_MIXER);\r
- if (rt5631->pll_used_flag)\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2,\r
- PWR_PLL, PWR_PLL);\r
- } else if (isPlaybackon == false && isCaptureon == false){\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1, 0,\r
- PWR_MAIN_I2S_EN | PWR_DAC_REF |\r
- PWR_DAC_L_TO_MIXER | PWR_DAC_R_TO_MIXER);\r
- if (rt5631->pll_used_flag)\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2,\r
- 0, PWR_PLL);\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int adc_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- static bool pmu;\r
-\r
- switch (event) {\r
- case SND_SOC_DAPM_POST_PMD:\r
- if (pmu) {\r
- isPlaybackon = false;\r
- config_common_power(codec, false);\r
- pmu = false;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_PRE_PMU:\r
- if (!pmu) {\r
- isPlaybackon = true;\r
- config_common_power(codec, true);\r
- pmu = true;\r
- }\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int dac_event(struct snd_soc_dapm_widget *w,\r
- struct snd_kcontrol *kcontrol, int event)\r
-{\r
- struct snd_soc_codec *codec = w->codec;\r
- static bool pmu;\r
-\r
- switch (event) {\r
- case SND_SOC_DAPM_POST_PMD:\r
- if (pmu) {\r
- isCaptureon = false;\r
- config_common_power(codec, false);\r
- pmu = false;\r
- }\r
- break;\r
-\r
- case SND_SOC_DAPM_PRE_PMU:\r
- if (!pmu) {\r
- isCaptureon = true;\r
- config_common_power(codec, true);\r
- pmu = true;\r
- }\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static const struct snd_soc_dapm_widget rt5631_dapm_widgets[] = {\r
-SND_SOC_DAPM_INPUT("MIC1"),\r
-SND_SOC_DAPM_INPUT("MIC2"),\r
-SND_SOC_DAPM_INPUT("AXIL"),\r
-SND_SOC_DAPM_INPUT("AXIR"),\r
-SND_SOC_DAPM_INPUT("MONOIN_RXN"),\r
-SND_SOC_DAPM_INPUT("MONOIN_RXP"),\r
-\r
-SND_SOC_DAPM_MICBIAS("Mic Bias1", RT5631_PWR_MANAG_ADD2, 3, 0),\r
-SND_SOC_DAPM_MICBIAS("Mic Bias2", RT5631_PWR_MANAG_ADD2, 2, 0),\r
-\r
-SND_SOC_DAPM_PGA_E("Mic1 Boost", RT5631_PWR_MANAG_ADD2, 5, 0, NULL, 0,\r
- mic_event, SND_SOC_DAPM_POST_PMU),\r
-SND_SOC_DAPM_PGA_E("Mic2 Boost", RT5631_PWR_MANAG_ADD2, 4, 0, NULL, 0,\r
- mic_event, SND_SOC_DAPM_POST_PMU),\r
-SND_SOC_DAPM_PGA("MONOIN_RXP Boost", RT5631_PWR_MANAG_ADD4, 7, 0, NULL, 0),\r
-SND_SOC_DAPM_PGA("MONOIN_RXN Boost", RT5631_PWR_MANAG_ADD4, 6, 0, NULL, 0),\r
-SND_SOC_DAPM_PGA("AXIL Boost", RT5631_PWR_MANAG_ADD4, 9, 0, NULL, 0),\r
-SND_SOC_DAPM_PGA("AXIR Boost", RT5631_PWR_MANAG_ADD4, 8, 0, NULL, 0),\r
-SND_SOC_DAPM_MIXER("MONO_IN", SND_SOC_NOPM, 0, 0, NULL, 0),\r
-\r
-SND_SOC_DAPM_MIXER("RECMIXL Mixer", RT5631_PWR_MANAG_ADD2, 11, 0,\r
- &rt5631_recmixl_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_recmixl_mixer_controls)),\r
-SND_SOC_DAPM_MIXER("RECMIXR Mixer", RT5631_PWR_MANAG_ADD2, 10, 0,\r
- &rt5631_recmixr_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_recmixr_mixer_controls)),\r
-SND_SOC_DAPM_MIXER("ADC Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),\r
-\r
-SND_SOC_DAPM_ADC_E("Left ADC", "Left ADC HIFI Capture",\r
- RT5631_PWR_MANAG_ADD1, 11, 0,\r
- adc_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),\r
-SND_SOC_DAPM_ADC_E("Right ADC", "Right ADC HIFI Capture",\r
- RT5631_PWR_MANAG_ADD1, 10, 0,\r
- adc_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),\r
-SND_SOC_DAPM_DAC_E("Left DAC", "Left DAC HIFI Playback",\r
- RT5631_PWR_MANAG_ADD1, 9, 0,\r
- dac_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),\r
-SND_SOC_DAPM_DAC_E("Right DAC", "Right DAC HIFI Playback",\r
- RT5631_PWR_MANAG_ADD1, 8, 0,\r
- dac_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),\r
-SND_SOC_DAPM_DAC("Voice DAC", "Voice DAC Mono Playback", SND_SOC_NOPM, 0, 0),\r
-SND_SOC_DAPM_PGA("Voice DAC Boost", SND_SOC_NOPM, 0, 0, NULL, 0),\r
-\r
-SND_SOC_DAPM_MIXER("SPKMIXL Mixer", RT5631_PWR_MANAG_ADD2, 13, 0,\r
- &rt5631_spkmixl_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_spkmixl_mixer_controls)),\r
-SND_SOC_DAPM_MIXER("OUTMIXL Mixer", RT5631_PWR_MANAG_ADD2, 15, 0,\r
- &rt5631_outmixl_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_outmixl_mixer_controls)),\r
-SND_SOC_DAPM_MIXER("OUTMIXR Mixer", RT5631_PWR_MANAG_ADD2, 14, 0,\r
- &rt5631_outmixr_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_outmixr_mixer_controls)),\r
-SND_SOC_DAPM_MIXER("SPKMIXR Mixer", RT5631_PWR_MANAG_ADD2, 12, 0,\r
- &rt5631_spkmixr_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_spkmixr_mixer_controls)),\r
-\r
-SND_SOC_DAPM_PGA("Left SPK Vol", RT5631_PWR_MANAG_ADD4, 15, 0, NULL, 0),\r
-SND_SOC_DAPM_PGA("Right SPK Vol", RT5631_PWR_MANAG_ADD4, 14, 0, NULL, 0),\r
-SND_SOC_DAPM_PGA_E("Left HP Vol", RT5631_PWR_MANAG_ADD4, 11, 0, NULL, 0,\r
- hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),\r
-SND_SOC_DAPM_PGA_E("Right HP Vol", RT5631_PWR_MANAG_ADD4, 10, 0, NULL, 0,\r
- hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),\r
-\r
-SND_SOC_DAPM_PGA_E("Left DAC_HP", SND_SOC_NOPM, 0, 0, NULL, 0,\r
- dac_to_hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),\r
-SND_SOC_DAPM_PGA_E("Right DAC_HP", SND_SOC_NOPM, 0, 0, NULL, 0,\r
- dac_to_hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),\r
-\r
-SND_SOC_DAPM_PGA("Left Out Vol", RT5631_PWR_MANAG_ADD4, 13, 0, NULL, 0),\r
-SND_SOC_DAPM_PGA("Right Out Vol", RT5631_PWR_MANAG_ADD4, 12, 0, NULL, 0),\r
-\r
-SND_SOC_DAPM_MIXER_E("AXO1MIX Mixer", RT5631_PWR_MANAG_ADD3, 11, 0,\r
- &rt5631_AXO1MIX_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_AXO1MIX_mixer_controls),\r
- auxo1_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),\r
-SND_SOC_DAPM_MIXER("SPOLMIX Mixer", SND_SOC_NOPM, 0, 0,\r
- &rt5631_spolmix_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_spolmix_mixer_controls)),\r
-SND_SOC_DAPM_MIXER("MONOMIX Mixer", RT5631_PWR_MANAG_ADD3, 9, 0,\r
- &rt5631_monomix_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_monomix_mixer_controls)),\r
-SND_SOC_DAPM_MIXER("SPORMIX Mixer", SND_SOC_NOPM, 0, 0,\r
- &rt5631_spormix_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_spormix_mixer_controls)),\r
-SND_SOC_DAPM_MIXER_E("AXO2MIX Mixer", RT5631_PWR_MANAG_ADD3, 10, 0,\r
- &rt5631_AXO2MIX_mixer_controls[0],\r
- ARRAY_SIZE(rt5631_AXO2MIX_mixer_controls),\r
- auxo2_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),\r
-\r
-SND_SOC_DAPM_MUX("SPOL Mux", SND_SOC_NOPM, 0, 0, &rt5631_spol_mux_control),\r
-SND_SOC_DAPM_MUX("SPOR Mux", SND_SOC_NOPM, 0, 0, &rt5631_spor_mux_control),\r
-SND_SOC_DAPM_MUX("Mono Mux", SND_SOC_NOPM, 0, 0, &rt5631_mono_mux_control),\r
-SND_SOC_DAPM_MUX("HPL Mux", SND_SOC_NOPM, 0, 0, &rt5631_hpl_mux_control),\r
-SND_SOC_DAPM_MUX("HPR Mux", SND_SOC_NOPM, 0, 0, &rt5631_hpr_mux_control),\r
-\r
-SND_SOC_DAPM_PGA_E("Mono Amp", RT5631_PWR_MANAG_ADD3, 7, 0, NULL, 0,\r
- mono_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),\r
-SND_SOC_DAPM_PGA_E("SPKL Amp", SND_SOC_NOPM, 0, 0, NULL, 0,\r
- spk_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),\r
-SND_SOC_DAPM_PGA_E("SPKR Amp", SND_SOC_NOPM, 1, 0, NULL, 0,\r
- spk_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),\r
-\r
-SND_SOC_DAPM_OUTPUT("AUXO1"),\r
-SND_SOC_DAPM_OUTPUT("AUXO2"),\r
-SND_SOC_DAPM_OUTPUT("SPOL"),\r
-SND_SOC_DAPM_OUTPUT("SPOR"),\r
-SND_SOC_DAPM_OUTPUT("HPOL"),\r
-SND_SOC_DAPM_OUTPUT("HPOR"),\r
-SND_SOC_DAPM_OUTPUT("MONO"),\r
-};\r
-\r
-\r
-static const struct snd_soc_dapm_route audio_map[] = {\r
- {"Mic1 Boost", NULL, "MIC1"},\r
- {"Mic2 Boost", NULL, "MIC2"},\r
- {"MONOIN_RXP Boost", NULL, "MONOIN_RXP"},\r
- {"MONOIN_RXN Boost", NULL, "MONOIN_RXN"},\r
- {"AXIL Boost", NULL, "AXIL"},\r
- {"AXIR Boost", NULL, "AXIR"},\r
-\r
- {"MONO_IN", NULL, "MONOIN_RXP Boost"},\r
- {"MONO_IN", NULL, "MONOIN_RXN Boost"},\r
-\r
- {"RECMIXL Mixer", "OUTMIXL Capture Switch", "OUTMIXL Mixer"},\r
- {"RECMIXL Mixer", "MIC1_BST1 Capture Switch", "Mic1 Boost"},\r
- {"RECMIXL Mixer", "AXILVOL Capture Switch", "AXIL Boost"},\r
- {"RECMIXL Mixer", "MONOIN_RX Capture Switch", "MONO_IN"},\r
-\r
- {"RECMIXR Mixer", "OUTMIXR Capture Switch", "OUTMIXR Mixer"},\r
- {"RECMIXR Mixer", "MIC2_BST2 Capture Switch", "Mic2 Boost"},\r
- {"RECMIXR Mixer", "AXIRVOL Capture Switch", "AXIR Boost"},\r
- {"RECMIXR Mixer", "MONOIN_RX Capture Switch", "MONO_IN"},\r
-\r
- {"ADC Mixer", NULL, "RECMIXL Mixer"},\r
- {"ADC Mixer", NULL, "RECMIXR Mixer"},\r
- {"Left ADC", NULL, "ADC Mixer"},\r
- {"Right ADC", NULL, "ADC Mixer"},\r
-\r
- {"Voice DAC Boost", NULL, "Voice DAC"},\r
-\r
- {"SPKMIXL Mixer", "RECMIXL Playback Switch", "RECMIXL Mixer"},\r
- {"SPKMIXL Mixer", "MIC1_P Playback Switch", "MIC1"},\r
- {"SPKMIXL Mixer", "DACL Playback Switch", "Left DAC"},\r
- {"SPKMIXL Mixer", "OUTMIXL Playback Switch", "OUTMIXL Mixer"},\r
-\r
- {"SPKMIXR Mixer", "OUTMIXR Playback Switch", "OUTMIXR Mixer"},\r
- {"SPKMIXR Mixer", "DACR Playback Switch", "Right DAC"},\r
- {"SPKMIXR Mixer", "MIC2_P Playback Switch", "MIC2"},\r
- {"SPKMIXR Mixer", "RECMIXR Playback Switch", "RECMIXR Mixer"},\r
-\r
- {"OUTMIXL Mixer", "RECMIXL Playback Switch", "RECMIXL Mixer"},\r
- {"OUTMIXL Mixer", "RECMIXR Playback Switch", "RECMIXR Mixer"},\r
- {"OUTMIXL Mixer", "DACL Playback Switch", "Left DAC"},\r
- {"OUTMIXL Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},\r
- {"OUTMIXL Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},\r
- {"OUTMIXL Mixer", "MONOIN_RXP Playback Switch", "MONOIN_RXP Boost"},\r
- {"OUTMIXL Mixer", "AXILVOL Playback Switch", "AXIL Boost"},\r
- {"OUTMIXL Mixer", "AXIRVOL Playback Switch", "AXIR Boost"},\r
- {"OUTMIXL Mixer", "VDAC Playback Switch", "Voice DAC Boost"},\r
-\r
- {"OUTMIXR Mixer", "RECMIXL Playback Switch", "RECMIXL Mixer"},\r
- {"OUTMIXR Mixer", "RECMIXR Playback Switch", "RECMIXR Mixer"},\r
- {"OUTMIXR Mixer", "DACR Playback Switch", "Right DAC"},\r
- {"OUTMIXR Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},\r
- {"OUTMIXR Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},\r
- {"OUTMIXR Mixer", "MONOIN_RXN Playback Switch", "MONOIN_RXN Boost"},\r
- {"OUTMIXR Mixer", "AXILVOL Playback Switch", "AXIL Boost"},\r
- {"OUTMIXR Mixer", "AXIRVOL Playback Switch", "AXIR Boost"},\r
- {"OUTMIXR Mixer", "VDAC Playback Switch", "Voice DAC Boost"},\r
-\r
- {"Left SPK Vol", NULL, "SPKMIXL Mixer"},\r
- {"Right SPK Vol", NULL, "SPKMIXR Mixer"},\r
- {"Left HP Vol", NULL, "OUTMIXL Mixer"},\r
- {"Left Out Vol", NULL, "OUTMIXL Mixer"},\r
- {"Right Out Vol", NULL, "OUTMIXR Mixer"},\r
- {"Right HP Vol", NULL, "OUTMIXR Mixer"},\r
-\r
- {"AXO1MIX Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},\r
- {"AXO1MIX Mixer", "OUTVOLL Playback Switch", "Left Out Vol"},\r
- {"AXO1MIX Mixer", "OUTVOLR Playback Switch", "Right Out Vol"},\r
- {"AXO1MIX Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},\r
-\r
- {"AXO2MIX Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},\r
- {"AXO2MIX Mixer", "OUTVOLL Playback Switch", "Left Out Vol"},\r
- {"AXO2MIX Mixer", "OUTVOLR Playback Switch", "Right Out Vol"},\r
- {"AXO2MIX Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},\r
-\r
- {"SPOLMIX Mixer", "SPKVOLL Playback Switch", "Left SPK Vol"},\r
- {"SPOLMIX Mixer", "SPKVOLR Playback Switch", "Right SPK Vol"},\r
-\r
- {"SPORMIX Mixer", "SPKVOLL Playback Switch", "Left SPK Vol"},\r
- {"SPORMIX Mixer", "SPKVOLR Playback Switch", "Right SPK Vol"},\r
-\r
- {"MONOMIX Mixer", "OUTVOLL Playback Switch", "Left Out Vol"},\r
- {"MONOMIX Mixer", "OUTVOLR Playback Switch", "Right Out Vol"},\r
-\r
- {"SPOL Mux", "SPOLMIX", "SPOLMIX Mixer"},\r
- {"SPOL Mux", "MONOIN_RX", "MONO_IN"},\r
- {"SPOL Mux", "VDAC", "Voice DAC Boost"},\r
- {"SPOL Mux", "DACL", "Left DAC"},\r
-\r
- {"SPOR Mux", "SPORMIX", "SPORMIX Mixer"},\r
- {"SPOR Mux", "MONOIN_RX", "MONO_IN"},\r
- {"SPOR Mux", "VDAC", "Voice DAC Boost"},\r
- {"SPOR Mux", "DACR", "Right DAC"},\r
-\r
- {"Mono Mux", "MONOMIX", "MONOMIX Mixer"},\r
- {"Mono Mux", "MONOIN_RX", "MONO_IN"},\r
- {"Mono Mux", "VDAC", "Voice DAC Boost"},\r
-\r
- {"Right DAC_HP", "NULL", "Right DAC"},\r
- {"Left DAC_HP", "NULL", "Left DAC"},\r
-\r
- {"HPL Mux", "LEFT HPVOL", "Left HP Vol"},\r
- {"HPL Mux", "LEFT DAC", "Left DAC_HP"},\r
- {"HPR Mux", "RIGHT HPVOL", "Right HP Vol"},\r
- {"HPR Mux", "RIGHT DAC", "Right DAC_HP"},\r
-\r
- {"SPKL Amp", NULL, "SPOL Mux"},\r
- {"SPKR Amp", NULL, "SPOR Mux"},\r
- {"Mono Amp", NULL, "Mono Mux"},\r
-\r
- {"AUXO1", NULL, "AXO1MIX Mixer"},\r
- {"AUXO2", NULL, "AXO2MIX Mixer"},\r
- {"SPOL", NULL, "SPKL Amp"},\r
- {"SPOR", NULL, "SPKR Amp"},\r
-\r
- {"HPOL", NULL, "HPL Mux"},\r
- {"HPOR", NULL, "HPR Mux"},\r
-\r
- {"MONO", NULL, "Mono Amp"}\r
-};\r
-\r
-static int rt5631_add_widgets(struct snd_soc_codec *codec)\r
-{\r
- struct snd_soc_dapm_context *dapm = &codec->dapm;\r
-\r
- snd_soc_dapm_new_controls(dapm, rt5631_dapm_widgets,\r
- ARRAY_SIZE(rt5631_dapm_widgets));\r
- snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map));\r
-\r
- return 0;\r
-}\r
-\r
-static int gvolume = 0;\r
-\r
-#if 1\r
-static int get_vol(int max, int min, int stage_num, int stage)\r
-{\r
- int ret, step=((max-min)<<8)/(stage_num-1);\r
- if(stage==stage_num-1)\r
- ret=min;\r
- else if(stage==0)\r
- ret=max;\r
- else {\r
- ret=(stage_num-stage-1) * step;\r
- ret >>= 8;\r
- ret = min+ret;\r
- }\r
- DBG("%s(): ret=%02x, max=0x%02x, min=0x%02x, stage_num=%d, stage=%d\n", \r
- __FUNCTION__, \r
- ret,\r
- max,\r
- min,\r
- stage_num,\r
- stage);\r
- return ret;\r
-}\r
-\r
-static void rt5631_set_volume(int vollevel)\r
-{\r
- struct snd_soc_codec *codec = rt5631_codec;\r
- int tmpvol1, tmpvol2;\r
-\r
- //DBG("rt5631_set_volume = %d\n", vollevel);\r
- \r
- if (vollevel > 15) vollevel = 8;\r
- gvolume = vollevel;\r
- \r
-// tmpvol1 = voltab[0][vollevel];\r
-// tmpvol2 = voltab[1][vollevel];\r
- tmpvol1=get_vol(0x27, DEF_VOL_SPK&0x3f, 16, vollevel);\r
- tmpvol2=get_vol(0x1f, DEF_VOL&0x1f, 16, vollevel);\r
-\r
- if(vollevel == 0){\r
- rt5631_write_mask(codec, RT5631_SPK_OUT_VOL, 0x8080, 0x8080);\r
- rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0x8080, 0x8080);\r
- }\r
-// else{\r
-// rt5631_write_mask(codec, RT5631_SPK_OUT_VOL, 0x00, 0x8080);\r
-// rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0x00, 0x8080);\r
-// }\r
-\r
- rt5631_write_mask(codec, RT5631_SPK_OUT_VOL, ((tmpvol1<<8)|tmpvol1), 0x3f3f);\r
- rt5631_write_mask(codec, RT5631_HP_OUT_VOL, ((tmpvol2<<8)|tmpvol2), 0x3f3f);\r
-}\r
-\r
-static void rt5631_set_eq(int on)\r
-{\r
- struct snd_soc_codec *codec = rt5631_codec;\r
- unsigned int Reg0C;\r
-\r
- Reg0C = rt5631_read(codec, RT5631_STEREO_DAC_VOL_1);\r
- DBG("------- rt5631_set_eq: read Reg0C = 0x%04x\n", Reg0C);\r
-\r
- Reg0C &= 0xFF80;\r
- if(on) { \r
- Reg0C |= 0x10;\r
- } else {\r
- Reg0C |= 0x00;\r
- }\r
-\r
- DBG("------- rt5631_set_eq: write Reg0C = 0x%04x\n", Reg0C);\r
- rt5631_write(codec, RT5631_STEREO_DAC_VOL_1, Reg0C);\r
-}\r
-\r
-#else\r
-\r
-static int voltab[2][16] =\r
-{\r
- //spk\r
- {0x27, 0x1b, 0x18, 0x15, 0x13, 0x11, 0x0f, 0x0e, 0x0d, 0x0c, 0x0b, 0x0a, 0x09, 0x08, 0x07, 0x06},\r
- //hp\r
- {0x1f, 0x1c, 0x1a, 0x18, 0x16, 0x14, 0x12, 0x10, 0x0e, 0x0c, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01},\r
-};\r
-\r
-static void rt5631_set_volume(int vollevel)\r
-{\r
- struct snd_soc_codec *codec = rt5631_codec;\r
- u8 tmpvol1, tmpvol2;\r
- u16 spk_vol, hp_vol;\r
-\r
- DBG("rt5631_set_volume = %d\n", vollevel);\r
- \r
- if (vollevel > 15) vollevel = 8;\r
- gvolume = vollevel;\r
- \r
- tmpvol1 = voltab[0][vollevel];\r
- tmpvol2 = voltab[1][vollevel];\r
-\r
- spk_vol = snd_soc_read(codec, RT5631_SPK_OUT_VOL);\r
- hp_vol = snd_soc_read(codec, RT5631_HP_OUT_VOL);\r
-\r
- DBG("\n\nold value: 0x%04x, 0x%04x\n", spk_vol & 0x3F3F, hp_vol & 0x3F3F);\r
- DBG("new value: 0x%04x\n", (tmpvol1<<8)|tmpvol1, (tmpvol2<<8)|tmpvol2);\r
-\r
- spk_vol &= 0x3C3C;\r
- spk_vol |= (tmpvol1<<8)|tmpvol1;\r
- hp_vol &= 0x3C3C;\r
- hp_vol |= (tmpvol2<<8)|tmpvol2;\r
-\r
- snd_soc_write(codec, RT5631_SPK_OUT_VOL, spk_vol);\r
- snd_soc_write(codec, RT5631_HP_OUT_VOL , hp_vol);\r
-}\r
-\r
-#endif\r
-struct coeff_clk_div {\r
- u32 mclk;\r
- u32 bclk;\r
- u32 rate;\r
- u16 reg_val;\r
-};\r
-\r
-/* PLL divisors yes*/\r
-struct pll_div {\r
- u32 pll_in;\r
- u32 pll_out;\r
- u16 reg_val;\r
-};\r
-\r
-static const struct pll_div codec_master_pll_div[] = {\r
- {2048000, 8192000, 0x0ea0},\r
- {3686400, 8192000, 0x4e27},\r
- {12000000, 8192000, 0x456b},\r
- {13000000, 8192000, 0x495f},\r
- {13100000, 8192000, 0x0320},\r
- {2048000, 11289600, 0xf637},\r
- {3686400, 11289600, 0x2f22},\r
- {12000000, 11289600, 0x3e2f},\r
- {13000000, 11289600, 0x4d5b},\r
- {13100000, 11289600, 0x363b},\r
- {2048000, 16384000, 0x1ea0},\r
- {3686400, 16384000, 0x9e27},\r
- {12000000, 16384000, 0x452b},\r
- {13000000, 16384000, 0x542f},\r
- {13100000, 16384000, 0x03a0},\r
- {2048000, 16934400, 0xe625},\r
- {3686400, 16934400, 0x9126},\r
- {12000000, 16934400, 0x4d2c},\r
- {13000000, 16934400, 0x742f},\r
- {13100000, 16934400, 0x3c27},\r
- {2048000, 22579200, 0x2aa0},\r
- {3686400, 22579200, 0x2f20},\r
- {12000000, 22579200, 0x7e2f},\r
- {13000000, 22579200, 0x742f},\r
- {13100000, 22579200, 0x3c27},\r
- {2048000, 24576000, 0x2ea0},\r
- {3686400, 24576000, 0xee27},\r
- {12000000, 24576000, 0x2915},\r
- {13000000, 24576000, 0x772e},\r
- {13100000, 24576000, 0x0d20},\r
- {26000000, 24576000, 0x2027},\r
- {26000000, 22579200, 0x392f},\r
- {24576000, 22579200, 0x0921},\r
- {24576000, 24576000, 0x02a0},\r
-};\r
-\r
-static const struct pll_div codec_slave_pll_div[] = {\r
- {256000, 2048000, 0x46f0},\r
- {256000, 4096000, 0x3ea0},\r
- {352800, 5644800, 0x3ea0},\r
- {512000, 8192000, 0x3ea0},\r
- {1024000, 8192000, 0x46f0},\r
- {705600, 11289600, 0x3ea0},\r
- {1024000, 16384000, 0x3ea0},\r
- {1411200, 22579200, 0x3ea0},\r
- {1536000, 24576000, 0x3ea0},\r
- {2048000, 16384000, 0x1ea0},\r
- {2822400, 22579200, 0x1ea0},\r
- {2822400, 45158400, 0x5ec0},\r
- {5644800, 45158400, 0x46f0},\r
- {3072000, 24576000, 0x1ea0},\r
- {3072000, 49152000, 0x5ec0},\r
- {6144000, 49152000, 0x46f0},\r
- {705600, 11289600, 0x3ea0},\r
- {705600, 8467200, 0x3ab0},\r
- {24576000, 24576000, 0x02a0},\r
- {1411200, 11289600, 0x1690},\r
- {2822400, 11289600, 0x0a90},\r
- {1536000, 12288000, 0x1690},\r
- {3072000, 12288000, 0x0a90},\r
-};\r
-\r
-struct coeff_clk_div coeff_div[] = {\r
- /* sysclk is 256fs */\r
- {2048000, 8000 * 32, 8000, 0x1000},\r
- {2048000, 8000 * 64, 8000, 0x0000},\r
- {2822400, 11025 * 32, 11025, 0x1000},\r
- {2822400, 11025 * 64, 11025, 0x0000},\r
- {4096000, 16000 * 32, 16000, 0x1000},\r
- {4096000, 16000 * 64, 16000, 0x0000},\r
- {5644800, 22050 * 32, 22050, 0x1000},\r
- {5644800, 22050 * 64, 22050, 0x0000},\r
- {8192000, 32000 * 32, 32000, 0x1000},\r
- {8192000, 32000 * 64, 32000, 0x0000},\r
- {11289600, 44100 * 32, 44100, 0x1000},\r
- {11289600, 44100 * 64, 44100, 0x0000},\r
- {12288000, 48000 * 32, 48000, 0x1000},\r
- {12288000, 48000 * 64, 48000, 0x0000},\r
- {22579200, 88200 * 32, 88200, 0x1000},\r
- {22579200, 88200 * 64, 88200, 0x0000},\r
- {24576000, 96000 * 32, 96000, 0x1000},\r
- {24576000, 96000 * 64, 96000, 0x0000},\r
- /* sysclk is 512fs */\r
- {4096000, 8000 * 32, 8000, 0x3000},\r
- {4096000, 8000 * 64, 8000, 0x2000},\r
- {5644800, 11025 * 32, 11025, 0x3000},\r
- {5644800, 11025 * 64, 11025, 0x2000},\r
- {8192000, 16000 * 32, 16000, 0x3000},\r
- {8192000, 16000 * 64, 16000, 0x2000},\r
- {11289600, 22050 * 32, 22050, 0x3000},\r
- {11289600, 22050 * 64, 22050, 0x2000},\r
- {16384000, 32000 * 32, 32000, 0x3000},\r
- {16384000, 32000 * 64, 32000, 0x2000},\r
- {22579200, 44100 * 32, 44100, 0x3000},\r
- {22579200, 44100 * 64, 44100, 0x2000},\r
- {24576000, 48000 * 32, 48000, 0x3000},\r
- {24576000, 48000 * 64, 48000, 0x2000},\r
- {45158400, 88200 * 32, 88200, 0x3000},\r
- {45158400, 88200 * 64, 88200, 0x2000},\r
- {49152000, 96000 * 32, 96000, 0x3000},\r
- {49152000, 96000 * 64, 96000, 0x2000},\r
- /* sysclk is 24.576Mhz or 22.5792Mhz */\r
- {24576000, 8000 * 32, 8000, 0x7080},\r
- {24576000, 8000 * 64, 8000, 0x6080},\r
- {24576000, 16000 * 32, 16000, 0x5080},\r
- {24576000, 16000 * 64, 16000, 0x4080},\r
- {24576000, 24000 * 32, 24000, 0x5000},\r
- {24576000, 24000 * 64, 24000, 0x4000},\r
- {24576000, 32000 * 32, 32000, 0x3080},\r
- {24576000, 32000 * 64, 32000, 0x2080},\r
- {22579200, 11025 * 32, 11025, 0x7000},\r
- {22579200, 11025 * 64, 11025, 0x6000},\r
- {22579200, 22050 * 32, 22050, 0x5000},\r
- {22579200, 22050 * 64, 22050, 0x4000},\r
-};\r
-\r
-static int get_coeff(int mclk, int rate, int timesofbclk)\r
-{\r
- int i;\r
-\r
- for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {\r
- if (coeff_div[i].mclk == mclk && coeff_div[i].rate == rate &&\r
- (coeff_div[i].bclk / coeff_div[i].rate) == timesofbclk)\r
- return i;\r
- }\r
- return -EINVAL;\r
-}\r
-\r
-static int get_coeff_in_slave_mode(int mclk, int rate)\r
-{\r
- return get_coeff(mclk, rate, timesofbclk);\r
-}\r
-\r
-static int get_coeff_in_master_mode(int mclk, int rate, int bclk)\r
-{\r
- return get_coeff(mclk, rate, (bclk / rate));\r
-}\r
-\r
-static void rt5631_set_dmic_params(struct snd_soc_codec *codec,\r
- struct snd_pcm_hw_params *params)\r
-{\r
- int rate;\r
-\r
- rt5631_write_mask(codec, RT5631_GPIO_CTRL,\r
- GPIO_PIN_FUN_SEL_GPIO_DIMC | GPIO_DMIC_FUN_SEL_DIMC,\r
- GPIO_PIN_FUN_SEL_MASK | GPIO_DMIC_FUN_SEL_MASK);\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL, DMIC_ENA, DMIC_ENA_MASK);\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,\r
- DMIC_L_CH_LATCH_FALLING | DMIC_R_CH_LATCH_RISING,\r
- DMIC_L_CH_LATCH_MASK|DMIC_R_CH_LATCH_MASK);\r
-\r
- rate = params_rate(params);\r
- switch (rate) {\r
- case 44100:\r
- case 48000:\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,\r
- DMIC_CLK_CTRL_TO_32FS, DMIC_CLK_CTRL_MASK);\r
- break;\r
-\r
- case 32000:\r
- case 22050:\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,\r
- DMIC_CLK_CTRL_TO_64FS, DMIC_CLK_CTRL_MASK);\r
- break;\r
-\r
- case 16000:\r
- case 11025:\r
- case 8000:\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,\r
- DMIC_CLK_CTRL_TO_128FS, DMIC_CLK_CTRL_MASK);\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
-\r
- rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,\r
- DMIC_L_CH_UNMUTE | DMIC_R_CH_UNMUTE,\r
- DMIC_L_CH_MUTE_MASK | DMIC_R_CH_MUTE_MASK);\r
-\r
- return;\r
-}\r
-\r
-static int rt5631_hifi_pcm_params(struct snd_pcm_substream *substream,\r
- struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)\r
-{\r
- struct snd_soc_pcm_runtime *rtd = substream->private_data;\r
- struct snd_soc_codec *codec = rtd->codec;\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
- int stream = substream->stream, rate = params_rate(params), coeff;\r
- unsigned int iface = 0;\r
-\r
- pr_debug("enter %s\n", __func__);\r
-\r
- if (!rt5631->master)\r
- coeff = get_coeff_in_slave_mode(rt5631->sysclk, rate);\r
- else\r
- coeff = get_coeff_in_master_mode(rt5631->sysclk, rate,\r
- rate * timesofbclk);\r
- if (coeff < 0)\r
- pr_err("%s: get coeff err!\n", __func__);\r
-\r
- switch (params_format(params)) {\r
- case SNDRV_PCM_FORMAT_S16_LE:\r
- break;\r
- case SNDRV_PCM_FORMAT_S20_3LE:\r
- iface |= SDP_I2S_DL_20;\r
- break;\r
- case SNDRV_PCM_FORMAT_S24_LE:\r
- iface |= SDP_I2S_DL_24;\r
- break;\r
- case SNDRV_PCM_FORMAT_S8:\r
- iface |= SDP_I2S_DL_8;\r
- break;\r
- default:\r
- return -EINVAL;\r
- }\r
-\r
- if (SNDRV_PCM_STREAM_CAPTURE == stream) {\r
- if (rt5631->dmic_used_flag)\r
- rt5631_set_dmic_params(codec, params);\r
- }\r
-\r
- rt5631_write_mask(codec, RT5631_SDP_CTRL, iface, SDP_I2S_DL_MASK);\r
-\r
- if (coeff >= 0)\r
- rt5631_write(codec, RT5631_STEREO_AD_DA_CLK_CTRL,\r
- coeff_div[coeff].reg_val);\r
-\r
- return 0;\r
-}\r
-\r
-static int rt5631_hifi_codec_set_dai_fmt(struct snd_soc_dai *codec_dai,\r
- unsigned int fmt)\r
-{\r
- struct snd_soc_codec *codec = codec_dai->codec;\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
- unsigned int iface = 0;\r
-\r
- pr_debug("enter %s\n", __func__);\r
-\r
- switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {\r
- case SND_SOC_DAIFMT_CBM_CFM:\r
- rt5631->master = 1;\r
- break;\r
- case SND_SOC_DAIFMT_CBS_CFS:\r
- iface |= SDP_MODE_SEL_SLAVE;\r
- rt5631->master = 0;\r
- break;\r
- default:\r
- return -EINVAL;\r
- }\r
-\r
- switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {\r
- case SND_SOC_DAIFMT_I2S:\r
- break;\r
- case SND_SOC_DAIFMT_LEFT_J:\r
- iface |= SDP_I2S_DF_LEFT;\r
- break;\r
- case SND_SOC_DAIFMT_DSP_A:\r
- iface |= SDP_I2S_DF_PCM_A;\r
- break;\r
- case SND_SOC_DAIFMT_DSP_B:\r
- iface |= SDP_I2S_DF_PCM_B;\r
- break;\r
- default:\r
- return -EINVAL;\r
- }\r
-\r
- switch (fmt & SND_SOC_DAIFMT_INV_MASK) {\r
- case SND_SOC_DAIFMT_NB_NF:\r
- break;\r
- case SND_SOC_DAIFMT_IB_NF:\r
- iface |= SDP_I2S_BCLK_POL_CTRL;\r
- break;\r
- default:\r
- return -EINVAL;\r
- }\r
-\r
- rt5631_write(codec, RT5631_SDP_CTRL, iface);\r
-\r
- return 0;\r
-}\r
-\r
-static int rt5631_hifi_codec_set_dai_sysclk(struct snd_soc_dai *codec_dai,\r
- int clk_id, unsigned int freq, int dir)\r
-{\r
- struct snd_soc_codec *codec = codec_dai->codec;\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
-\r
- pr_info("enter %s, syclk=%d\n", __func__, freq);\r
- if ((freq >= (256 * 8000)) && (freq <= (512 * 96000))) {\r
- rt5631->sysclk = freq;\r
- return 0;\r
- }\r
-\r
- pr_info("unsupported sysclk freq %u for audio i2s\n", freq);\r
- pr_info("set sysclk to 24.576Mhz by default\n");\r
-\r
- rt5631->sysclk = 24576000;\r
- return 0;\r
-}\r
-\r
-static int rt5631_codec_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,\r
- int source, unsigned int freq_in, unsigned int freq_out)\r
-{\r
- struct snd_soc_codec *codec = codec_dai->codec;\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
- int i, ret = -EINVAL;\r
-\r
- printk(KERN_DEBUG "enter %s\n", __func__);\r
-\r
- if (!freq_in || !freq_out)\r
- return 0;\r
-\r
- if (rt5631->master) {\r
- for (i = 0; i < ARRAY_SIZE(codec_master_pll_div); i++)\r
- if (freq_in == codec_master_pll_div[i].pll_in &&\r
- freq_out == codec_master_pll_div[i].pll_out) {\r
- rt5631_write(codec, RT5631_PLL_CTRL,\r
- codec_master_pll_div[i].reg_val);\r
- schedule_timeout_uninterruptible(\r
- msecs_to_jiffies(20));\r
- rt5631_write(codec, RT5631_GLOBAL_CLK_CTRL,\r
- SYSCLK_SOUR_SEL_PLL);\r
- rt5631->pll_used_flag = 1;\r
- ret = 0;\r
- break;\r
- }\r
- } else {\r
- for (i = 0; i < ARRAY_SIZE(codec_slave_pll_div); i++)\r
- if (freq_in == codec_slave_pll_div[i].pll_in &&\r
- freq_out == codec_slave_pll_div[i].pll_out) {\r
- rt5631_write(codec, RT5631_PLL_CTRL,\r
- codec_slave_pll_div[i].reg_val);\r
- schedule_timeout_uninterruptible(\r
- msecs_to_jiffies(20));\r
- rt5631_write(codec, RT5631_GLOBAL_CLK_CTRL,\r
- SYSCLK_SOUR_SEL_PLL |\r
- PLLCLK_SOUR_SEL_BITCLK);\r
- rt5631->pll_used_flag = 1;\r
- ret = 0;\r
- break;\r
- }\r
- }\r
-\r
- return ret;\r
-}\r
-\r
-#if defined(CONFIG_ADJUST_VOL_BY_CODEC)\r
-static int rt5631_trigger(struct snd_pcm_substream *substream, int status, struct snd_soc_dai *dai)\r
-{\r
- //DBG("rt5631_trigger\n");\r
- if(status == SNDRV_PCM_TRIGGER_VOLUME){\r
- //DBG("rt5631_trigger: vol = %d\n", substream->number);\r
- if(substream->number < 100){\r
- rt5631_set_volume(substream->number);\r
- } else {\r
- if(substream->number == 100) { // eq off\r
- DBG("---------- eq off\n");\r
- rt5631_set_eq(0);\r
- } else { // eq on +6dB\r
- DBG("---------- eq on\n");\r
- rt5631_set_eq(1);\r
- }\r
- } \r
- }\r
-\r
- return 0;\r
-}\r
-#endif\r
-\r
-static ssize_t rt5631_index_reg_show(struct device *dev,\r
- struct device_attribute *attr, char *buf)\r
-{\r
- #define IDX_REG_FMT "%02x: %04x\n"\r
- #define IDX_REG_LEN 9\r
- unsigned int val;\r
- int cnt = 0, i;\r
-\r
- cnt += sprintf(buf, "RT5631 index register\n");\r
- for (i = 0; i < 0x55; i++) {\r
- if (cnt + IDX_REG_LEN >= PAGE_SIZE - 1)\r
- break;\r
- val = rt5631_read_index(rt5631_codec, i);\r
- if (!val)\r
- continue;\r
- cnt += sprintf(buf + cnt, IDX_REG_FMT, i, val);\r
- }\r
-\r
- if (cnt >= PAGE_SIZE)\r
- cnt = PAGE_SIZE - 1;\r
-\r
- return cnt;\r
-}\r
-static DEVICE_ATTR(index_reg, 0444, rt5631_index_reg_show, NULL);\r
-\r
-#define RT5631_STEREO_RATES SNDRV_PCM_RATE_8000_96000\r
-#define RT5631_FORMAT (SNDRV_PCM_FMTBIT_S16_LE | \\r
- SNDRV_PCM_FMTBIT_S20_3LE | \\r
- SNDRV_PCM_FMTBIT_S24_LE | \\r
- SNDRV_PCM_FMTBIT_S8)\r
-\r
-struct snd_soc_dai_ops rt5631_ops = {\r
- .hw_params = rt5631_hifi_pcm_params,\r
- .set_fmt = rt5631_hifi_codec_set_dai_fmt,\r
- .set_sysclk = rt5631_hifi_codec_set_dai_sysclk,\r
- .set_pll = rt5631_codec_set_dai_pll,\r
-#if defined(CONFIG_ADJUST_VOL_BY_CODEC)\r
- .trigger = rt5631_trigger,\r
-#endif\r
-};\r
-\r
-struct snd_soc_dai_driver rt5631_dai[] = {\r
- {\r
- .name = "RT5631 HiFi",\r
- .playback = {\r
- .stream_name = "HIFI Playback",\r
- .channels_min = 1,\r
- .channels_max = 2,\r
- .rates = RT5631_STEREO_RATES,\r
- .formats = RT5631_FORMAT,\r
- },\r
- .capture = {\r
- .stream_name = "HIFI Capture",\r
- .channels_min = 1,\r
- .channels_max = 2,\r
- .rates = RT5631_STEREO_RATES,\r
- .formats = RT5631_FORMAT,\r
- },\r
- .ops = &rt5631_ops,\r
- },\r
-};\r
-EXPORT_SYMBOL_GPL(rt5631_dai);\r
-\r
-static int rt5631_set_bias_level(struct snd_soc_codec *codec,\r
- enum snd_soc_bias_level level)\r
-{\r
- switch (level) {\r
- case SND_SOC_BIAS_ON:\r
- break;\r
-\r
- case SND_SOC_BIAS_PREPARE:\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- PWR_VREF | PWR_MAIN_BIAS, PWR_VREF | PWR_MAIN_BIAS);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2,\r
- PWR_MICBIAS1_VOL | PWR_MICBIAS2_VOL,\r
- PWR_MICBIAS1_VOL | PWR_MICBIAS2_VOL);\r
- break;\r
-\r
- case SND_SOC_BIAS_STANDBY:\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2, 0,\r
- PWR_MICBIAS1_VOL | PWR_MICBIAS2_VOL);\r
- break;\r
-\r
- case SND_SOC_BIAS_OFF:\r
- rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,\r
- RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);\r
- rt5631_write_mask(codec, RT5631_HP_OUT_VOL,\r
- RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);\r
- rt5631_write(codec, RT5631_PWR_MANAG_ADD1, 0x0000);\r
- rt5631_write(codec, RT5631_PWR_MANAG_ADD2, 0x0000);\r
- rt5631_write(codec, RT5631_PWR_MANAG_ADD3, 0x0000);\r
- rt5631_write(codec, RT5631_PWR_MANAG_ADD4, 0x0000);\r
- break;\r
-\r
- default:\r
- break;\r
- }\r
- codec->dapm.bias_level = level;\r
-\r
- return 0;\r
-}\r
-\r
-static int rt5631_probe(struct snd_soc_codec *codec)\r
-{\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
- unsigned int val;\r
- int ret;\r
- ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);\r
- if (ret != 0) {\r
- dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);\r
- return ret;\r
- }\r
- codec->cache_bypass = 1;\r
-\r
- val = rt5631_read_index(codec, RT5631_ADDA_MIXER_INTL_REG3);\r
- if (val & 0x0002)\r
- rt5631->codec_version = 1;\r
- else\r
- rt5631->codec_version = 0;\r
-\r
- rt5631_reset(codec);\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- PWR_VREF | PWR_MAIN_BIAS, PWR_VREF | PWR_MAIN_BIAS);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(80));\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3, PWR_FAST_VREF_CTRL,\r
- PWR_FAST_VREF_CTRL);\r
- rt5631_reg_init(codec);\r
-\r
- /* power off ClassD auto Recovery */\r
- if (rt5631->codec_version)\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0x2000, 0x2000);\r
- else\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0, 0x2000);\r
-\r
- codec->dapm.bias_level = SND_SOC_BIAS_STANDBY;\r
- rt5631_codec = codec;\r
-\r
-#if (RT5631_SPK_TIMER == 1)\r
- /* Timer module installing */\r
- setup_timer( &spk_timer, spk_timer_callback, 0 );\r
- DBG( "Starting timer to fire in 5s (%ld)\n", jiffies );\r
- ret = mod_timer( &spk_timer, jiffies + msecs_to_jiffies(5000) );\r
- if (ret) printk("Error in mod_timer\n");\r
-\r
- INIT_WORK(&spk_work, spk_work_handler);\r
-#endif\r
-\r
- snd_soc_add_controls(codec, rt5631_snd_controls,\r
- ARRAY_SIZE(rt5631_snd_controls));\r
- rt5631_add_widgets(codec);\r
-\r
- ret = device_create_file(codec->dev, &dev_attr_index_reg);\r
- if (ret != 0) {\r
- dev_err(codec->dev,\r
- "Failed to create index_reg sysfs files: %d\n", ret);\r
- return ret;\r
- }\r
-\r
- pr_info("RT5631 initial ok!\n");\r
-\r
- return 0;\r
-}\r
-\r
-static int rt5631_remove(struct snd_soc_codec *codec)\r
-{\r
-\r
-\r
-#if (RT5631_SPK_TIMER == 1) \r
- /* Timer¡¡module¡¡uninstalling */\r
- int ret;\r
- ret = del_timer(&spk_timer);\r
- if(ret) printk("The timer is still in use...\n");\r
- DBG("Timer module uninstalling\n");\r
-#endif\r
-\r
-\r
- rt5631_set_bias_level(codec, SND_SOC_BIAS_OFF);\r
- return 0;\r
-}\r
-\r
-static int rt5631_suspend(struct snd_soc_codec *codec, pm_message_t state)\r
-{\r
- rt5631_set_bias_level(codec, SND_SOC_BIAS_OFF);\r
- return 0;\r
-}\r
-\r
-static int rt5631_resume(struct snd_soc_codec *codec)\r
-{\r
- struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);\r
-\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- PWR_VREF | PWR_MAIN_BIAS, PWR_VREF | PWR_MAIN_BIAS);\r
- schedule_timeout_uninterruptible(msecs_to_jiffies(110));\r
- rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,\r
- PWR_FAST_VREF_CTRL, PWR_FAST_VREF_CTRL);\r
- rt5631_reg_init(codec);\r
-\r
- /* power off ClassD auto Recovery */\r
- if (rt5631->codec_version)\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0x2000, 0x2000);\r
- else\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,\r
- 0, 0x2000);\r
-\r
-#if (RT5631_SPK_TIMER == 1)\r
- last_is_spk = !last_is_spk; //wired~, update eqmode right here by spk_timer.\r
-#endif\r
-\r
- return 0;\r
-}\r
-\r
-void codec_set_spk(bool on)\r
-{\r
- struct snd_soc_codec *codec = rt5631_codec;\r
-\r
- DBG("%s: %d\n", __func__, on);\r
-\r
- if(!codec)\r
- return;\r
-\r
- if(on){\r
- DBG("snd_soc_dapm_enable_pin\n");\r
- snd_soc_dapm_enable_pin(&codec->dapm, "Headphone Jack");\r
- snd_soc_dapm_enable_pin(&codec->dapm, "Ext Spk");\r
- }\r
- else{\r
-\r
- DBG("snd_soc_dapm_disable_pin\n");\r
- snd_soc_dapm_disable_pin(&codec->dapm, "Headphone Jack");\r
- snd_soc_dapm_disable_pin(&codec->dapm, "Ext Spk");\r
- }\r
-\r
- snd_soc_dapm_sync(&codec->dapm);\r
-\r
- return;\r
-}\r
-\r
-/*\r
- * detect short current for mic1\r
- */\r
-int rt5631_ext_mic_detect(void)\r
-{\r
- struct snd_soc_codec *codec = rt5631_codec;\r
- int det;\r
-\r
- rt5631_write_mask(codec, RT5631_MIC_CTRL_2, MICBIAS1_S_C_DET_ENA,\r
- MICBIAS1_S_C_DET_MASK);\r
- det = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2) & 0x0001;\r
- rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2, 0x0001, 0x00001);\r
-\r
- return det;\r
-}\r
-EXPORT_SYMBOL_GPL(rt5631_ext_mic_detect);\r
-\r
-static struct snd_soc_codec_driver soc_codec_dev_rt5631 = {\r
- .probe = rt5631_probe,\r
- .remove = rt5631_remove,\r
- .suspend = rt5631_suspend,\r
- .resume = rt5631_resume,\r
- .set_bias_level = rt5631_set_bias_level,\r
- .reg_cache_size = ARRAY_SIZE(rt5631_reg),\r
- .reg_word_size = sizeof(u16),\r
- .reg_cache_default = rt5631_reg,\r
- .reg_cache_step = 1,\r
-};\r
-\r
-static const struct i2c_device_id rt5631_i2c_id[] = {\r
- { "rt5631", 0 },\r
- { }\r
-};\r
-MODULE_DEVICE_TABLE(i2c, rt5631_i2c_id);\r
-\r
-static int rt5631_i2c_probe(struct i2c_client *i2c,\r
- const struct i2c_device_id *id)\r
-{\r
- struct rt5631_priv *rt5631;\r
- int ret;\r
-\r
- pr_info("RT5631 Audio Codec %s\n", RT5631_VERSION);\r
-\r
- rt5631 = kzalloc(sizeof(struct rt5631_priv), GFP_KERNEL);\r
- if (NULL == rt5631)\r
- return -ENOMEM;\r
-\r
- i2c_set_clientdata(i2c, rt5631);\r
-\r
- ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5631,\r
- rt5631_dai, ARRAY_SIZE(rt5631_dai));\r
- if (ret < 0)\r
- kfree(rt5631);\r
-\r
- return ret;\r
-}\r
-\r
-static __devexit int rt5631_i2c_remove(struct i2c_client *client)\r
-{\r
- snd_soc_unregister_codec(&client->dev);\r
- kfree(i2c_get_clientdata(client));\r
- return 0;\r
-}\r
-\r
-struct i2c_driver rt5631_i2c_driver = {\r
- .driver = {\r
- .name = "RT5631",\r
- .owner = THIS_MODULE,\r
- },\r
- .probe = rt5631_i2c_probe,\r
- .remove = __devexit_p(rt5631_i2c_remove),\r
- .id_table = rt5631_i2c_id,\r
-};\r
-\r
-static int __init rt5631_modinit(void)\r
-{\r
- return i2c_add_driver(&rt5631_i2c_driver);\r
-}\r
-module_init(rt5631_modinit);\r
-\r
-static void __exit rt5631_modexit(void)\r
-{\r
- i2c_del_driver(&rt5631_i2c_driver);\r
-}\r
-module_exit(rt5631_modexit);\r
-\r
-MODULE_DESCRIPTION("ASoC RT5631 driver");\r
-MODULE_AUTHOR("flove <flove@realtek.com>");\r
-MODULE_LICENSE("GPL");\r
+/*
+ * rt5631.c -- RT5631 ALSA Soc Audio driver
+ *
+ * Copyright 2011 Realtek Microelectronics
+ *
+ * Author: flove <flove@realtek.com>
+ *
+ * Based on WM8753.c
+ *
+ * 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.
+ *
+ */
+#include <linux/module.h>
+#include <linux/moduleparam.h>
+#include <linux/init.h>
+#include <linux/delay.h>
+#include <linux/pm.h>
+#include <linux/i2c.h>
+#include <linux/platform_device.h>
+#include <linux/spi/spi.h>
+#include <sound/core.h>
+#include <sound/pcm.h>
+#include <sound/pcm_params.h>
+#include <sound/soc.h>
+#include <sound/soc-dapm.h>
+#include <sound/initval.h>
+
+#include "rt5631.h"
+#include <linux/timer.h>
+
+#if 0
+#define DBG(x...) printk(x)
+#else
+#define DBG(x...)
+#endif
+#define RT5631_VERSION "0.01 alsa 1.0.24"
+
+#define RT5631_ALC_DAC_FUNC_ENA 1 //ALC functio for DAC
+#define RT5631_ALC_ADC_FUNC_ENA 1 //ALC function for ADC
+#define RT5631_SPK_TIMER 0 //if enable this, MUST enable RT5631_EQ_FUNC_ENA first!
+
+struct rt5631_priv {
+ int codec_version;
+ int master;
+ int sysclk;
+ int dmic_used_flag;
+ int eq_mode;
+ int pll_used_flag;
+};
+#if (RT5631_SPK_TIMER == 1)
+static struct timer_list spk_timer;
+struct work_struct spk_work;
+static bool last_is_spk = false; // need modify.
+#endif
+
+static struct snd_soc_codec *rt5631_codec;
+static const u16 rt5631_reg[0x80];
+static int timesofbclk = 32;
+bool isPlaybackon = false, isCaptureon = false;
+
+module_param(timesofbclk, int, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
+MODULE_PARM_DESC(timeofbclk, "relationship between bclk and fs");
+
+
+static inline int rt5631_write(struct snd_soc_codec *codec,
+ unsigned int reg, unsigned int val)
+{
+ return snd_soc_write(codec, reg, val);
+}
+
+static inline unsigned int rt5631_read(struct snd_soc_codec *codec,
+ unsigned int reg)
+{
+ return snd_soc_read(codec, reg);
+}
+
+static int rt5631_write_mask(struct snd_soc_codec *codec,
+ unsigned int reg, unsigned int value, unsigned int mask)
+{
+ unsigned int reg_val;
+ int ret = 0;
+
+ if (!mask)
+ return 0;
+
+ if (mask != 0xffff) {
+ reg_val = rt5631_read(codec, reg);
+ reg_val &= ~mask;
+ reg_val |= (value & mask);
+ ret = rt5631_write(codec, reg, reg_val);
+ } else {
+ ret = rt5631_write(codec, reg, value);
+ }
+
+ return ret;
+}
+
+static void rt5631_write_index(struct snd_soc_codec *codec,
+ unsigned int reg, unsigned int value)
+{
+ rt5631_write(codec, RT5631_INDEX_ADD, reg);
+ rt5631_write(codec, RT5631_INDEX_DATA, value);
+ return;
+}
+
+static unsigned int rt5631_read_index(struct snd_soc_codec *codec,
+ unsigned int reg)
+{
+ unsigned int value;
+
+ rt5631_write(codec, RT5631_INDEX_ADD, reg);
+ value = rt5631_read(codec, RT5631_INDEX_DATA);
+
+ return value;
+}
+
+static void rt5631_write_index_mask(struct snd_soc_codec *codec,
+ unsigned int reg, unsigned int value, unsigned int mask)
+{
+ unsigned int reg_val;
+
+ if (!mask)
+ return;
+
+ if (mask != 0xffff) {
+ reg_val = rt5631_read_index(codec, reg);
+ reg_val &= ~mask;
+ reg_val |= (value & mask);
+ rt5631_write_index(codec, reg, reg_val);
+ } else {
+ rt5631_write_index(codec, reg, value);
+ }
+
+ return;
+}
+
+static inline int rt5631_reset(struct snd_soc_codec *codec)
+{
+ return snd_soc_write(codec, RT5631_RESET, 0);
+}
+
+struct rt5631_init_reg {
+ u8 reg;
+ u16 val;
+};
+
+#ifndef DEF_VOL
+#define DEF_VOL 0xd4//0xd4 -30dB 0xc0 0dB
+#endif
+#ifndef DEF_VOL_SPK
+#define DEF_VOL_SPK 0xc4
+#endif
+
+/*
+ * speaker channel volume select SPKMIXER, 0DB by default
+ * Headphone channel volume select OUTMIXER,0DB by default
+ * AXO1/AXO2 channel volume select OUTMIXER,0DB by default
+ * Record Mixer source from Mic1/Mic2 by default
+ * Mic1/Mic2 boost 40dB by default
+ * DAC_L-->OutMixer_L by default
+ * DAC_R-->OutMixer_R by default
+ * DAC-->SpeakerMixer
+ * Speaker volume-->SPOMixer(L-->L,R-->R)
+ * Speaker AMP ratio gain is 1.44X
+ * HP from OutMixer,speaker out from SpeakerOut Mixer
+ * enable HP zero cross
+ * change Mic1 & mic2 to differential mode
+ */
+static struct rt5631_init_reg init_list[] = {
+
+ {RT5631_SPK_OUT_VOL , (DEF_VOL_SPK<<8) | DEF_VOL_SPK},//speaker channel volume select SPKMIXER,0DB by default
+ {RT5631_HP_OUT_VOL , (DEF_VOL<<8) | DEF_VOL},//Headphone channel volume select OUTMIXER,0DB by default
+ {RT5631_MONO_AXO_1_2_VOL , 0xf0c0},//AXO1/AXO2 channel volume select OUTMIXER,0DB by default
+ //{RT5631_STEREO_DAC_VOL_1 , 0x004C},
+ {RT5631_ADC_REC_MIXER , 0xb0f0},//Record Mixer source from Mic1 by default
+ {RT5631_ADC_CTRL_1 , 0x0006},//STEREO ADC CONTROL 1
+ {RT5631_MIC_CTRL_2 , 0x6600},//0x8800},//0x5500}, //Mic1/Mic2 boost 40DB by default
+ {RT5631_PWR_MANAG_ADD1 , 0x93e0},
+
+#if RT5631_ALC_ADC_FUNC_ENA
+
+ {RT5631_ALC_CTRL_1 , 0x0a0f},//ALC CONTROL 1
+ {RT5631_ALC_CTRL_2 , 0x0005},//ALC CONTROL 2
+ {RT5631_ALC_CTRL_3 , 0xe080},//ALC CONTROL 3
+
+#endif
+ {RT5631_OUTMIXER_L_CTRL , 0xdfC0},//DAC_L-->OutMixer_L by default
+ {RT5631_OUTMIXER_R_CTRL , 0xdfC0},//DAC_R-->OutMixer_R by default
+ {RT5631_AXO1MIXER_CTRL , 0x8840},//OutMixer_L-->AXO1Mixer by default
+ {RT5631_AXO2MIXER_CTRL , 0x8880},//OutMixer_R-->AXO2Mixer by default
+ {RT5631_SPK_MIXER_CTRL , 0xd8d8},//DAC-->SpeakerMixer
+ {RT5631_SPK_MONO_OUT_CTRL , 0x6c00},//Speaker volume-->SPOMixer(L-->L,R-->R)
+ {RT5631_GEN_PUR_CTRL_REG , 0x4e00},//Speaker AMP ratio gain is 1.27x
+#if defined(CONFIG_ADJUST_VOL_BY_CODEC)
+ {RT5631_SPK_MONO_HP_OUT_CTRL , 0x0000},//HP from outputmixer,speaker out from SpeakerOut Mixer
+#else
+ {RT5631_SPK_MONO_HP_OUT_CTRL , 0x000c},//HP from DAC,speaker out from SpeakerOut Mixer
+#endif
+ {RT5631_DEPOP_FUN_CTRL_2 , 0x8000},//HP depop by register control
+ {RT5631_INT_ST_IRQ_CTRL_2 , 0x0f18},//enable HP zero cross
+ {RT5631_MIC_CTRL_1 , 0x8000},//set mic 1 to differnetial mode
+ {RT5631_GPIO_CTRL , 0x0000},//set GPIO to input pin
+// {RT5631_JACK_DET_CTRL , 0x4e80},//Jack detect for GPIO,high is HP,low is speaker
+ {RT5631_JACK_DET_CTRL , 0x4bc0},//Jack detect for GPIO,high is speaker,low is hp
+};
+#define RT5631_INIT_REG_LEN ARRAY_SIZE(init_list)
+
+/*
+ * EQ parameter
+ */
+enum {
+ NORMAL,
+ CLUB,
+ DANCE,
+ LIVE,
+ POP,
+ ROCK,
+ OPPO,
+ TREBLE,
+ BASS,
+ HFREQ,
+ SPK_FR
+};
+
+struct hw_eq_preset {
+ u16 type;
+ u16 value[22];
+ u16 ctrl;
+};
+
+/*
+ * EQ param reg : 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x6, 0x7,
+ * 0x8, 0x9, 0xa, 0xb, 0xc, 0xd, 0xe, 0xf
+ * EQ control reg : 0x6e
+ */
+struct hw_eq_preset hweq_preset[] = {
+ {NORMAL , {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x0000},
+ {CLUB , {0x1C10, 0x0000, 0xC1CC, 0x1E5D, 0x0699, 0xCD48,
+ 0x188D, 0x0699, 0xC3B6, 0x1CD0, 0x0699, 0x0436,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x000E},
+ {DANCE , {0x1F2C, 0x095B, 0xC071, 0x1F95, 0x0616, 0xC96E,
+ 0x1B11, 0xFC91, 0xDCF2, 0x1194, 0xFAF2, 0x0436,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},
+ {LIVE , {0x1EB5, 0xFCB6, 0xC24A, 0x1DF8, 0x0E7C, 0xC883,
+ 0x1C10, 0x0699, 0xDA41, 0x1561, 0x0295, 0x0436,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},
+ {POP , {0x1EB5, 0xFCB6, 0xC1D4, 0x1E5D, 0x0E23, 0xD92E,
+ 0x16E6, 0xFCB6, 0x0000, 0x0969, 0xF988, 0x0436,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},
+ {ROCK , {0x1EB5, 0xFCB6, 0xC071, 0x1F95, 0x0424, 0xC30A,
+ 0x1D27, 0xF900, 0x0C5D, 0x0FC7, 0x0E23, 0x0436,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},
+ {OPPO , {0x0000, 0x0000, 0xCA4A, 0x17F8, 0x0FEC, 0xCA4A,
+ 0x17F8, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x000F},
+ {TREBLE , {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x188D,
+ 0x1699, 0x0000, 0x0000, 0x0000}, 0x0010},
+ {BASS , {0x1A43, 0x0C00, 0x0000, 0x0000, 0x0000, 0x0000,
+ 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+ 0x0000, 0x0000, 0x0000, 0x0000}, 0x0001},
+};
+
+static int rt5631_reg_init(struct snd_soc_codec *codec)
+{
+ int i;
+
+ for (i = 0; i < RT5631_INIT_REG_LEN; i++)
+ rt5631_write(codec, init_list[i].reg, init_list[i].val);
+
+ return 0;
+}
+
+static const char *rt5631_spol_source_sel[] = {
+ "SPOLMIX", "MONOIN_RX", "VDAC", "DACL"};
+static const char *rt5631_spor_source_sel[] = {
+ "SPORMIX", "MONOIN_RX", "VDAC", "DACR"};
+static const char *rt5631_mono_source_sel[] = {"MONOMIX", "MONOIN_RX", "VDAC"};
+static const char *rt5631_input_mode_source_sel[] = {
+ "Single-end", "Differential"};
+static const char *rt5631_mic_boost[] = {"Bypass", "+20db", "+24db", "+30db",
+ "+35db", "+40db", "+44db", "+50db", "+52db"};
+static const char *rt5631_hpl_source_sel[] = {"LEFT HPVOL", "LEFT DAC"};
+static const char *rt5631_hpr_source_sel[] = {"RIGHT HPVOL", "RIGHT DAC"};
+static const char *rt5631_eq_sel[] = {"NORMAL", "CLUB", "DANCE", "LIVE", "POP",
+ "ROCK", "OPPO", "TREBLE", "BASS"};
+
+
+static const struct soc_enum rt5631_enum[] = {
+SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 14, 4, rt5631_spol_source_sel),
+SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 10, 4, rt5631_spor_source_sel),
+SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 6, 3, rt5631_mono_source_sel),
+SOC_ENUM_SINGLE(RT5631_MIC_CTRL_1, 15, 2, rt5631_input_mode_source_sel),
+SOC_ENUM_SINGLE(RT5631_MIC_CTRL_1, 7, 2, rt5631_input_mode_source_sel),
+SOC_ENUM_SINGLE(RT5631_MONO_INPUT_VOL, 15, 2, rt5631_input_mode_source_sel),
+SOC_ENUM_SINGLE(RT5631_MIC_CTRL_2, 12, 9, rt5631_mic_boost),
+SOC_ENUM_SINGLE(RT5631_MIC_CTRL_2, 8, 9, rt5631_mic_boost),
+SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 3, 2, rt5631_hpl_source_sel),
+SOC_ENUM_SINGLE(RT5631_SPK_MONO_HP_OUT_CTRL, 2, 2, rt5631_hpr_source_sel),
+SOC_ENUM_SINGLE(0, 4, 9, rt5631_eq_sel),
+};
+
+static int rt5631_dmic_get(struct snd_kcontrol *kcontrol,
+ struct snd_ctl_elem_value *ucontrol)
+{
+ struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+
+ ucontrol->value.integer.value[0] = rt5631->dmic_used_flag;
+
+ return 0;
+}
+
+static void rt5631_close_dmic(struct snd_soc_codec *codec)
+{
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,
+ DMIC_L_CH_MUTE | DMIC_R_CH_MUTE,
+ DMIC_L_CH_MUTE_MASK | DMIC_R_CH_MUTE_MASK);
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,
+ DMIC_DIS, DMIC_ENA_MASK);
+ return;
+}
+
+static int rt5631_dmic_put(struct snd_kcontrol *kcontrol,
+ struct snd_ctl_elem_value *ucontrol)
+{
+ struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+
+ if (rt5631->dmic_used_flag == ucontrol->value.integer.value[0])
+ return 0;
+
+ if (ucontrol->value.integer.value[0]) {
+ rt5631->dmic_used_flag = 1;
+ } else {
+ rt5631_close_dmic(codec);
+ rt5631->dmic_used_flag = 0;
+ }
+
+ return 0;
+}
+
+static int rt5631_eq_sel_get(struct snd_kcontrol *kcontrol,
+ struct snd_ctl_elem_value *ucontrol)
+{
+ struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+
+ ucontrol->value.integer.value[0] = rt5631->eq_mode;
+
+ return 0;
+}
+
+static void rt5631_update_eqmode(struct snd_soc_codec *codec, int mode)
+{
+ int i;
+
+ if (NORMAL == mode) {
+ /* In Normal mode, the EQ parameter is cleared,
+ * and hardware LP, BP1, BP2, BP3, HP1, HP2
+ * block control and EQ block are disabled.
+ */
+ for (i = RT5631_EQ_BW_LOP; i <= RT5631_EQ_HPF_GAIN; i++)
+ rt5631_write_index(codec, i,
+ hweq_preset[mode].value[i]);
+ rt5631_write_mask(codec, RT5631_EQ_CTRL, 0x0000, 0x003f);
+ rt5631_write_index_mask(codec, RT5631_EQ_PRE_VOL_CTRL
+ , 0x0000, 0x8000);
+ } else {
+ /* Fill and update EQ parameter,
+ * and EQ block are enabled.
+ */
+ rt5631_write_index_mask(codec, RT5631_EQ_PRE_VOL_CTRL
+ , 0x8000, 0x8000);
+ rt5631_write(codec, RT5631_EQ_CTRL,
+ hweq_preset[mode].ctrl);
+ for (i = RT5631_EQ_BW_LOP; i <= RT5631_EQ_HPF_GAIN; i++)
+ rt5631_write_index(codec, i,
+ hweq_preset[mode].value[i]);
+ rt5631_write_mask(codec, RT5631_EQ_CTRL, 0x4000, 0x4000);
+ }
+
+ return;
+}
+
+static int rt5631_eq_sel_put(struct snd_kcontrol *kcontrol,
+ struct snd_ctl_elem_value *ucontrol)
+{
+ struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+
+ if (rt5631->eq_mode == ucontrol->value.integer.value[0])
+ return 0;
+
+ rt5631_update_eqmode(codec, ucontrol->value.enumerated.item[0]);
+ rt5631->eq_mode = ucontrol->value.integer.value[0];
+
+ return 0;
+}
+
+#if (RT5631_SPK_TIMER == 1)
+static void spk_work_handler(struct work_struct *work)
+{
+ struct snd_soc_codec *codec = rt5631_codec;
+ bool is_spk = (rt5631_read(codec, 0x4a)) & 0x04; //detect rt5631 reg4a[3], 1'b:SPK, 0'b:HP ;
+ if(last_is_spk != is_spk)
+ printk("%s---%s is in use.last is %s in use\n", __FUNCTION__,is_spk?"speaker":"headphone",last_is_spk?"speaker":"headphone");
+
+ if(is_spk && !last_is_spk){
+ rt5631_write_index_mask(codec,0x11,0x0000,0x0007); //0db
+ rt5631_write_index(codec,0x12,0x0003); //0db
+ rt5631_update_eqmode(codec, SPK_FR); // SPK is in use, enable EQ mode of SPK_FR.
+ }else if(!is_spk && last_is_spk){
+ //flove071311 rt5631_update_eqmode(codec, NORMAL); // HP is in use, enable EQ mode of NORMAL.
+ rt5631_write_index_mask(codec,0x11,0x0001,0x0003);
+ rt5631_write_index(codec,0x12,0x0001);
+ rt5631_update_eqmode(codec,HFREQ);
+ }
+ last_is_spk = is_spk;
+}
+
+/* timer to judge SPK or HP in use, and handle EQ issues accordingly. */
+void spk_timer_callback(unsigned long data )
+{
+ int ret = 0;
+
+ schedule_work(&spk_work);
+
+ //DBG("Starting timer to fire in 1000ms (%ld)\n", jiffies );
+ ret = mod_timer(&spk_timer, jiffies + msecs_to_jiffies(1000));
+ if (ret) printk("Error in mod_timer\n");
+}
+#endif
+
+static const struct snd_kcontrol_new rt5631_snd_controls[] = {
+SOC_ENUM("MIC1 Mode Control", rt5631_enum[3]),
+SOC_ENUM("MIC1 Boost", rt5631_enum[6]),
+SOC_ENUM("MIC2 Mode Control", rt5631_enum[4]),
+SOC_ENUM("MIC2 Boost", rt5631_enum[7]),
+SOC_ENUM("MONOIN Mode Control", rt5631_enum[5]),
+SOC_DOUBLE("PCM Playback Volume", RT5631_STEREO_DAC_VOL_2, 8, 0, 255, 1),
+SOC_DOUBLE("PCM Playback Switch", RT5631_STEREO_DAC_VOL_1, 15, 7, 1, 1),
+SOC_DOUBLE("MONOIN_RX Capture Volume", RT5631_MONO_INPUT_VOL, 8, 0, 31, 1),
+SOC_DOUBLE("AXI Capture Volume", RT5631_AUX_IN_VOL, 8, 0, 31, 1),
+SOC_SINGLE("AXO1 Playback Switch", RT5631_MONO_AXO_1_2_VOL, 15, 1, 1),
+SOC_SINGLE("AXO2 Playback Switch", RT5631_MONO_AXO_1_2_VOL, 7, 1, 1),
+SOC_DOUBLE("OUTVOL Playback Volume", RT5631_MONO_AXO_1_2_VOL, 8, 0, 31, 1),
+SOC_DOUBLE("Speaker Playback Switch", RT5631_SPK_OUT_VOL, 15, 7, 1, 1),
+SOC_DOUBLE("Speaker Playback Volume", RT5631_SPK_OUT_VOL, 8, 0, 63, 1),
+SOC_SINGLE("MONO Playback Switch", RT5631_MONO_AXO_1_2_VOL, 13, 1, 1),
+SOC_DOUBLE("HP Playback Switch", RT5631_HP_OUT_VOL, 15, 7, 1, 1),
+SOC_DOUBLE("HP Playback Volume", RT5631_HP_OUT_VOL, 8, 0, 63, 1),
+SOC_SINGLE_EXT("DMIC Capture Switch", 0, 2, 1, 0,
+ rt5631_dmic_get, rt5631_dmic_put),
+SOC_ENUM_EXT("EQ Mode", rt5631_enum[10], rt5631_eq_sel_get, rt5631_eq_sel_put),
+};
+
+static const struct snd_kcontrol_new rt5631_recmixl_mixer_controls[] = {
+SOC_DAPM_SINGLE("OUTMIXL Capture Switch", RT5631_ADC_REC_MIXER, 15, 1, 1),
+SOC_DAPM_SINGLE("MIC1_BST1 Capture Switch", RT5631_ADC_REC_MIXER, 14, 1, 1),
+SOC_DAPM_SINGLE("AXILVOL Capture Switch", RT5631_ADC_REC_MIXER, 13, 1, 1),
+SOC_DAPM_SINGLE("MONOIN_RX Capture Switch", RT5631_ADC_REC_MIXER, 12, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_recmixr_mixer_controls[] = {
+SOC_DAPM_SINGLE("MONOIN_RX Capture Switch", RT5631_ADC_REC_MIXER, 4, 1, 1),
+SOC_DAPM_SINGLE("AXIRVOL Capture Switch", RT5631_ADC_REC_MIXER, 5, 1, 1),
+SOC_DAPM_SINGLE("MIC2_BST2 Capture Switch", RT5631_ADC_REC_MIXER, 6, 1, 1),
+SOC_DAPM_SINGLE("OUTMIXR Capture Switch", RT5631_ADC_REC_MIXER, 7, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_spkmixl_mixer_controls[] = {
+SOC_DAPM_SINGLE("RECMIXL Playback Switch", RT5631_SPK_MIXER_CTRL, 15, 1, 1),
+SOC_DAPM_SINGLE("MIC1_P Playback Switch", RT5631_SPK_MIXER_CTRL, 14, 1, 1),
+SOC_DAPM_SINGLE("DACL Playback Switch", RT5631_SPK_MIXER_CTRL, 13, 1, 1),
+SOC_DAPM_SINGLE("OUTMIXL Playback Switch", RT5631_SPK_MIXER_CTRL, 12, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_spkmixr_mixer_controls[] = {
+SOC_DAPM_SINGLE("OUTMIXR Playback Switch", RT5631_SPK_MIXER_CTRL, 4, 1, 1),
+SOC_DAPM_SINGLE("DACR Playback Switch", RT5631_SPK_MIXER_CTRL, 5, 1, 1),
+SOC_DAPM_SINGLE("MIC2_P Playback Switch", RT5631_SPK_MIXER_CTRL, 6, 1, 1),
+SOC_DAPM_SINGLE("RECMIXR Playback Switch", RT5631_SPK_MIXER_CTRL, 7, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_outmixl_mixer_controls[] = {
+SOC_DAPM_SINGLE("RECMIXL Playback Switch", RT5631_OUTMIXER_L_CTRL, 15, 1, 1),
+SOC_DAPM_SINGLE("RECMIXR Playback Switch", RT5631_OUTMIXER_L_CTRL, 14, 1, 1),
+SOC_DAPM_SINGLE("DACL Playback Switch", RT5631_OUTMIXER_L_CTRL, 13, 1, 1),
+SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_OUTMIXER_L_CTRL, 12, 1, 1),
+SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_OUTMIXER_L_CTRL, 11, 1, 1),
+SOC_DAPM_SINGLE("MONOIN_RXP Playback Switch", RT5631_OUTMIXER_L_CTRL, 10, 1, 1),
+SOC_DAPM_SINGLE("AXILVOL Playback Switch", RT5631_OUTMIXER_L_CTRL, 9, 1, 1),
+SOC_DAPM_SINGLE("AXIRVOL Playback Switch", RT5631_OUTMIXER_L_CTRL, 8, 1, 1),
+SOC_DAPM_SINGLE("VDAC Playback Switch", RT5631_OUTMIXER_L_CTRL, 7, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_outmixr_mixer_controls[] = {
+SOC_DAPM_SINGLE("VDAC Playback Switch", RT5631_OUTMIXER_R_CTRL, 7, 1, 1),
+SOC_DAPM_SINGLE("AXIRVOL Playback Switch", RT5631_OUTMIXER_R_CTRL, 8, 1, 1),
+SOC_DAPM_SINGLE("AXILVOL Playback Switch", RT5631_OUTMIXER_R_CTRL, 9, 1, 1),
+SOC_DAPM_SINGLE("MONOIN_RXN Playback Switch", RT5631_OUTMIXER_R_CTRL, 10, 1, 1),
+SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_OUTMIXER_R_CTRL, 11, 1, 1),
+SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_OUTMIXER_R_CTRL, 12, 1, 1),
+SOC_DAPM_SINGLE("DACR Playback Switch", RT5631_OUTMIXER_R_CTRL, 13, 1, 1),
+SOC_DAPM_SINGLE("RECMIXR Playback Switch", RT5631_OUTMIXER_R_CTRL, 14, 1, 1),
+SOC_DAPM_SINGLE("RECMIXL Playback Switch", RT5631_OUTMIXER_R_CTRL, 15, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_AXO1MIX_mixer_controls[] = {
+SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_AXO1MIXER_CTRL, 15 , 1, 1),
+SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_AXO1MIXER_CTRL, 11, 1, 1),
+SOC_DAPM_SINGLE("OUTVOLL Playback Switch", RT5631_AXO1MIXER_CTRL, 7 , 1 , 1),
+SOC_DAPM_SINGLE("OUTVOLR Playback Switch", RT5631_AXO1MIXER_CTRL, 6, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_AXO2MIX_mixer_controls[] = {
+SOC_DAPM_SINGLE("MIC1_BST1 Playback Switch", RT5631_AXO2MIXER_CTRL, 15, 1, 1),
+SOC_DAPM_SINGLE("MIC2_BST2 Playback Switch", RT5631_AXO2MIXER_CTRL, 11, 1, 1),
+SOC_DAPM_SINGLE("OUTVOLL Playback Switch", RT5631_AXO2MIXER_CTRL, 7, 1, 1),
+SOC_DAPM_SINGLE("OUTVOLR Playback Switch", RT5631_AXO2MIXER_CTRL, 6, 1 , 1),
+};
+
+static const struct snd_kcontrol_new rt5631_spolmix_mixer_controls[] = {
+SOC_DAPM_SINGLE("SPKVOLL Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 15, 1, 1),
+SOC_DAPM_SINGLE("SPKVOLR Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 14, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_spormix_mixer_controls[] = {
+SOC_DAPM_SINGLE("SPKVOLL Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 13, 1, 1),
+SOC_DAPM_SINGLE("SPKVOLR Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 12, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_monomix_mixer_controls[] = {
+SOC_DAPM_SINGLE("OUTVOLL Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 11, 1, 1),
+SOC_DAPM_SINGLE("OUTVOLR Playback Switch", RT5631_SPK_MONO_OUT_CTRL, 10, 1, 1),
+};
+
+static const struct snd_kcontrol_new rt5631_spol_mux_control =
+SOC_DAPM_ENUM("Route", rt5631_enum[0]);
+static const struct snd_kcontrol_new rt5631_spor_mux_control =
+SOC_DAPM_ENUM("Route", rt5631_enum[1]);
+static const struct snd_kcontrol_new rt5631_mono_mux_control =
+SOC_DAPM_ENUM("Route", rt5631_enum[2]);
+
+static const struct snd_kcontrol_new rt5631_hpl_mux_control =
+SOC_DAPM_ENUM("Route", rt5631_enum[8]);
+static const struct snd_kcontrol_new rt5631_hpr_mux_control =
+SOC_DAPM_ENUM("Route", rt5631_enum[9]);
+
+//ALC for DAC function
+#if (RT5631_ALC_DAC_FUNC_ENA == 1)
+static void rt5631_alc_enable(struct snd_soc_codec *codec,unsigned int EnableALC)
+{
+ if(EnableALC)
+ {
+ rt5631_write(codec, 0x64,0x0206);
+ rt5631_write(codec, 0x65,0x0003);
+ rt5631_write_index(codec, 0x21,0x5000);
+ rt5631_write_index(codec, 0x22,0xa480);
+ rt5631_write_index(codec, 0x23,0x0a08);
+ rt5631_write(codec, 0x0c,0x0010);
+ rt5631_write(codec, 0x66,0x650a);
+
+ }
+ else
+ {
+ rt5631_write(codec, 0x66,0x250A);
+ rt5631_write(codec, 0x0c,0x0000);
+ }
+
+}
+#endif
+
+static int spk_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ static int spkl_out_enable, spkr_out_enable;
+
+ switch (event) {
+ case SND_SOC_DAPM_POST_PMU:
+
+#if (RT5631_ALC_DAC_FUNC_ENA == 1)
+ rt5631_alc_enable(codec, 1);
+#endif
+
+ if (!spkl_out_enable && !strcmp(w->name, "SPKL Amp")) {
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,
+ PWR_SPK_L_VOL, PWR_SPK_L_VOL);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,
+ PWR_CLASS_D, PWR_CLASS_D);
+ rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,
+ 0, RT_L_MUTE);
+ spkl_out_enable = 1;
+ }
+ if (!spkr_out_enable && !strcmp(w->name, "SPKR Amp")) {
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,
+ PWR_SPK_R_VOL, PWR_SPK_R_VOL);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,
+ PWR_CLASS_D, PWR_CLASS_D);
+ rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,
+ 0, RT_R_MUTE);
+ spkr_out_enable = 1;
+ }
+ break;
+
+ case SND_SOC_DAPM_POST_PMD:
+ if (spkl_out_enable && !strcmp(w->name, "SPKL Amp")) {
+ rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,
+ RT_L_MUTE, RT_L_MUTE);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,
+ 0, PWR_SPK_L_VOL);
+ spkl_out_enable = 0;
+ }
+ if (spkr_out_enable && !strcmp(w->name, "SPKR Amp")) {
+ rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,
+ RT_R_MUTE, RT_R_MUTE);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD4,
+ 0, PWR_SPK_R_VOL);
+ spkr_out_enable = 0;
+ }
+ if (0 == spkl_out_enable && 0 == spkr_out_enable)
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,
+ 0, PWR_CLASS_D);
+
+#if (RT5631_ALC_DAC_FUNC_ENA == 1)
+ rt5631_alc_enable(codec, 0);
+#endif
+
+ break;
+
+ default:
+ return 0;
+ }
+
+ return 0;
+}
+
+
+static void hp_depop_mode2_onebit(struct snd_soc_codec *codec, int enable)
+{
+ unsigned int soft_vol, hp_zc;
+
+ rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2, 0, EN_ONE_BIT_DEPOP);
+
+ soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);
+ hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);
+ if (enable) {
+ rt5631_write_index(codec, RT5631_TEST_MODE_CTRL, 0x84c0);
+ rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x309f);
+ rt5631_write_index(codec, RT5631_CP_INTL_REG2, 0x6530);
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_2,
+ EN_CAP_FREE_DEPOP);
+ } else {
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_2, 0);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(100));
+ }
+
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);
+
+ return;
+}
+
+static void hp_mute_unmute_depop_onebit(struct snd_soc_codec *codec, int enable)
+{
+ unsigned int soft_vol, hp_zc;
+
+ rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2, 0, EN_ONE_BIT_DEPOP);
+ soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);
+ hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);
+ if (enable) {
+ schedule_timeout_uninterruptible(msecs_to_jiffies(10));
+ rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x307f);
+ rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0,
+ RT_L_MUTE | RT_R_MUTE);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(300));
+
+ } else {
+ rt5631_write_mask(codec, RT5631_HP_OUT_VOL,
+ RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(100));
+ }
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);
+
+ return;
+}
+
+static void hp_depop2(struct snd_soc_codec *codec, int enable)
+{
+ unsigned int soft_vol, hp_zc;
+
+ rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2,
+ EN_ONE_BIT_DEPOP, EN_ONE_BIT_DEPOP);
+ soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);
+ hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);
+ if (enable) {
+ rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x303e);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ PWR_CHARGE_PUMP | PWR_HP_L_AMP | PWR_HP_R_AMP,
+ PWR_CHARGE_PUMP | PWR_HP_L_AMP | PWR_HP_R_AMP);
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,
+ POW_ON_SOFT_GEN | EN_DEPOP2_FOR_HP);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(100));
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ PWR_HP_DEPOP_DIS, PWR_HP_DEPOP_DIS);
+ } else {
+ rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x303F);
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,
+ POW_ON_SOFT_GEN | EN_MUTE_UNMUTE_DEPOP |
+ PD_HPAMP_L_ST_UP | PD_HPAMP_R_ST_UP);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(75));
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,
+ POW_ON_SOFT_GEN | PD_HPAMP_L_ST_UP | PD_HPAMP_R_ST_UP);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3, 0,
+ PWR_HP_DEPOP_DIS);
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,
+ POW_ON_SOFT_GEN | EN_DEPOP2_FOR_HP |
+ PD_HPAMP_L_ST_UP | PD_HPAMP_R_ST_UP);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(80));
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1, POW_ON_SOFT_GEN);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3, 0,
+ PWR_CHARGE_PUMP | PWR_HP_L_AMP | PWR_HP_R_AMP);
+ }
+
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);
+
+ return;
+}
+
+static void hp_mute_unmute_depop(struct snd_soc_codec *codec, int enable)
+{
+ unsigned int soft_vol, hp_zc;
+
+ rt5631_write_mask(codec, RT5631_DEPOP_FUN_CTRL_2,
+ EN_ONE_BIT_DEPOP, EN_ONE_BIT_DEPOP);
+ soft_vol = rt5631_read(codec, RT5631_SOFT_VOL_CTRL);
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, 0);
+ hp_zc = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);
+ if (enable) {
+ schedule_timeout_uninterruptible(msecs_to_jiffies(10));
+ rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x302f);
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,
+ POW_ON_SOFT_GEN | EN_MUTE_UNMUTE_DEPOP |
+ EN_HP_R_M_UN_MUTE_DEPOP | EN_HP_L_M_UN_MUTE_DEPOP);
+ rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0,
+ RT_L_MUTE | RT_R_MUTE);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(160));
+ } else {
+ rt5631_write_index(codec, RT5631_SPK_INTL_CTRL, 0x302f);
+ rt5631_write(codec, RT5631_DEPOP_FUN_CTRL_1,
+ POW_ON_SOFT_GEN | EN_MUTE_UNMUTE_DEPOP |
+ EN_HP_R_M_UN_MUTE_DEPOP | EN_HP_L_M_UN_MUTE_DEPOP);
+ rt5631_write_mask(codec, RT5631_HP_OUT_VOL,
+ RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(150));
+ }
+
+ rt5631_write(codec, RT5631_SOFT_VOL_CTRL, soft_vol);
+ rt5631_write(codec, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);
+
+ return;
+}
+
+static int hp_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+ static bool hp_en;
+ int pu_l, pu_r;
+
+ pu_l = rt5631_read(codec, RT5631_PWR_MANAG_ADD4) & PWR_HP_L_OUT_VOL;
+ pu_r = rt5631_read(codec, RT5631_PWR_MANAG_ADD4) & PWR_HP_R_OUT_VOL;
+ switch (event) {
+ case SND_SOC_DAPM_PRE_PMD:
+ if ((pu_l && pu_r) && hp_en) {
+ if (rt5631->codec_version) {
+ hp_mute_unmute_depop_onebit(codec, 0);
+ hp_depop_mode2_onebit(codec, 0);
+ } else {
+ hp_mute_unmute_depop(codec, 0);
+ hp_depop2(codec, 0);
+ }
+ hp_en = false;
+ }
+ break;
+
+ case SND_SOC_DAPM_POST_PMU:
+ if ((pu_l && pu_r) && !hp_en) {
+ if (rt5631->codec_version) {
+ hp_depop_mode2_onebit(codec, 1);
+ hp_mute_unmute_depop_onebit(codec, 1);
+ } else {
+ hp_depop2(codec, 1);
+ hp_mute_unmute_depop(codec, 1);
+ }
+ hp_en = true;
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+static int dac_to_hp_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+ static bool hp_en;
+
+ switch (event) {
+ case SND_SOC_DAPM_PRE_PMD:
+ if (hp_en) {
+ if (rt5631->codec_version) {
+ hp_mute_unmute_depop_onebit(codec, 0);
+ hp_depop_mode2_onebit(codec, 0);
+ } else {
+ hp_mute_unmute_depop(codec, 0);
+ hp_depop2(codec, 0);
+ }
+ hp_en = false;
+ }
+ break;
+
+ case SND_SOC_DAPM_POST_PMU:
+ if (!hp_en) {
+ if (rt5631->codec_version) {
+ hp_depop_mode2_onebit(codec, 1);
+ hp_mute_unmute_depop_onebit(codec, 1);
+ } else {
+ hp_depop2(codec, 1);
+ hp_mute_unmute_depop(codec, 1);
+ }
+ hp_en = true;
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+static int mic_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ int val_mic1, val_mic2;
+
+ val_mic1 = rt5631_read(codec, RT5631_PWR_MANAG_ADD2) &
+ PWR_MIC1_BOOT_GAIN;
+ val_mic2 = rt5631_read(codec, RT5631_PWR_MANAG_ADD2) &
+ PWR_MIC2_BOOT_GAIN;
+ switch (event) {
+ case SND_SOC_DAPM_POST_PMU:
+ /*
+ * If microphone is stereo, need not copy ADC channel
+ * If mic1 is used, copy ADC left to right
+ * If mic2 is used, copy ADC right to left
+ */
+ if (val_mic1 && val_mic2)
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0x0000, 0xc000);
+ else if (val_mic1)
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0x4000, 0xc000);
+ else if (val_mic2)
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0x8000, 0xc000);
+ else
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0x0000, 0xc000);
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+static int auxo1_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ static bool aux1_en;
+
+ switch (event) {
+ case SND_SOC_DAPM_PRE_PMD:
+ if (aux1_en) {
+ rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,
+ RT_L_MUTE, RT_L_MUTE);
+ aux1_en = false;
+ }
+ break;
+
+ case SND_SOC_DAPM_POST_PMU:
+ if (!aux1_en) {
+ rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,
+ 0, RT_L_MUTE);
+ aux1_en = true;
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+static int auxo2_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ static bool aux2_en;
+
+ switch (event) {
+ case SND_SOC_DAPM_PRE_PMD:
+ if (aux2_en) {
+ rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,
+ RT_R_MUTE, RT_R_MUTE);
+ aux2_en = false;
+ }
+ break;
+
+ case SND_SOC_DAPM_POST_PMU:
+ if (!aux2_en) {
+ rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,
+ 0, RT_R_MUTE);
+ aux2_en = true;
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+static int mono_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ static bool mono_en;
+
+ switch (event) {
+ case SND_SOC_DAPM_PRE_PMD:
+ if (mono_en) {
+ rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,
+ MUTE_MONO, MUTE_MONO);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ 0, PWR_MONO_DEPOP_DIS);
+ mono_en = false;
+ }
+ break;
+
+ case SND_SOC_DAPM_POST_PMU:
+ if (!mono_en) {
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ PWR_MONO_DEPOP_DIS, PWR_MONO_DEPOP_DIS);
+ rt5631_write_mask(codec, RT5631_MONO_AXO_1_2_VOL,
+ 0, MUTE_MONO);
+ mono_en = true;
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+/**
+ * config_common_power - control all common power of codec system
+ * @pmu: power up or not
+ */
+static int config_common_power(struct snd_soc_codec *codec, bool pmu)
+{
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+ unsigned int mux_val;
+
+ if (pmu) {
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,
+ PWR_MAIN_I2S_EN | PWR_DAC_REF,
+ PWR_MAIN_I2S_EN | PWR_DAC_REF);
+ mux_val = rt5631_read(codec, RT5631_SPK_MONO_HP_OUT_CTRL);
+ //if (!(mux_val & HP_L_MUX_SEL_DAC_L))
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,
+ PWR_DAC_L_TO_MIXER, PWR_DAC_L_TO_MIXER);
+ //if (!(mux_val & HP_R_MUX_SEL_DAC_R))
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1,
+ PWR_DAC_R_TO_MIXER, PWR_DAC_R_TO_MIXER);
+ if (rt5631->pll_used_flag)
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2,
+ PWR_PLL, PWR_PLL);
+ } else if (isPlaybackon == false && isCaptureon == false){
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD1, 0,
+ PWR_MAIN_I2S_EN | PWR_DAC_REF |
+ PWR_DAC_L_TO_MIXER | PWR_DAC_R_TO_MIXER);
+ if (rt5631->pll_used_flag)
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2,
+ 0, PWR_PLL);
+ }
+
+ return 0;
+}
+
+static int adc_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ static bool pmu;
+
+ switch (event) {
+ case SND_SOC_DAPM_POST_PMD:
+ if (pmu) {
+ isPlaybackon = false;
+ config_common_power(codec, false);
+ pmu = false;
+ }
+ break;
+
+ case SND_SOC_DAPM_PRE_PMU:
+ if (!pmu) {
+ isPlaybackon = true;
+ config_common_power(codec, true);
+ pmu = true;
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+static int dac_event(struct snd_soc_dapm_widget *w,
+ struct snd_kcontrol *kcontrol, int event)
+{
+ struct snd_soc_codec *codec = w->codec;
+ static bool pmu;
+
+ switch (event) {
+ case SND_SOC_DAPM_POST_PMD:
+ if (pmu) {
+ isCaptureon = false;
+ config_common_power(codec, false);
+ pmu = false;
+ }
+ break;
+
+ case SND_SOC_DAPM_PRE_PMU:
+ if (!pmu) {
+ isCaptureon = true;
+ config_common_power(codec, true);
+ pmu = true;
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ return 0;
+}
+
+static const struct snd_soc_dapm_widget rt5631_dapm_widgets[] = {
+SND_SOC_DAPM_INPUT("MIC1"),
+SND_SOC_DAPM_INPUT("MIC2"),
+SND_SOC_DAPM_INPUT("AXIL"),
+SND_SOC_DAPM_INPUT("AXIR"),
+SND_SOC_DAPM_INPUT("MONOIN_RXN"),
+SND_SOC_DAPM_INPUT("MONOIN_RXP"),
+
+SND_SOC_DAPM_MICBIAS("Mic Bias1", RT5631_PWR_MANAG_ADD2, 3, 0),
+SND_SOC_DAPM_MICBIAS("Mic Bias2", RT5631_PWR_MANAG_ADD2, 2, 0),
+
+SND_SOC_DAPM_PGA_E("Mic1 Boost", RT5631_PWR_MANAG_ADD2, 5, 0, NULL, 0,
+ mic_event, SND_SOC_DAPM_POST_PMU),
+SND_SOC_DAPM_PGA_E("Mic2 Boost", RT5631_PWR_MANAG_ADD2, 4, 0, NULL, 0,
+ mic_event, SND_SOC_DAPM_POST_PMU),
+SND_SOC_DAPM_PGA("MONOIN_RXP Boost", RT5631_PWR_MANAG_ADD4, 7, 0, NULL, 0),
+SND_SOC_DAPM_PGA("MONOIN_RXN Boost", RT5631_PWR_MANAG_ADD4, 6, 0, NULL, 0),
+SND_SOC_DAPM_PGA("AXIL Boost", RT5631_PWR_MANAG_ADD4, 9, 0, NULL, 0),
+SND_SOC_DAPM_PGA("AXIR Boost", RT5631_PWR_MANAG_ADD4, 8, 0, NULL, 0),
+SND_SOC_DAPM_MIXER("MONO_IN", SND_SOC_NOPM, 0, 0, NULL, 0),
+
+SND_SOC_DAPM_MIXER("RECMIXL Mixer", RT5631_PWR_MANAG_ADD2, 11, 0,
+ &rt5631_recmixl_mixer_controls[0],
+ ARRAY_SIZE(rt5631_recmixl_mixer_controls)),
+SND_SOC_DAPM_MIXER("RECMIXR Mixer", RT5631_PWR_MANAG_ADD2, 10, 0,
+ &rt5631_recmixr_mixer_controls[0],
+ ARRAY_SIZE(rt5631_recmixr_mixer_controls)),
+SND_SOC_DAPM_MIXER("ADC Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),
+
+SND_SOC_DAPM_ADC_E("Left ADC", "Left ADC HIFI Capture",
+ RT5631_PWR_MANAG_ADD1, 11, 0,
+ adc_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),
+SND_SOC_DAPM_ADC_E("Right ADC", "Right ADC HIFI Capture",
+ RT5631_PWR_MANAG_ADD1, 10, 0,
+ adc_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),
+SND_SOC_DAPM_DAC_E("Left DAC", "Left DAC HIFI Playback",
+ RT5631_PWR_MANAG_ADD1, 9, 0,
+ dac_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),
+SND_SOC_DAPM_DAC_E("Right DAC", "Right DAC HIFI Playback",
+ RT5631_PWR_MANAG_ADD1, 8, 0,
+ dac_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),
+SND_SOC_DAPM_DAC("Voice DAC", "Voice DAC Mono Playback", SND_SOC_NOPM, 0, 0),
+SND_SOC_DAPM_PGA("Voice DAC Boost", SND_SOC_NOPM, 0, 0, NULL, 0),
+
+SND_SOC_DAPM_MIXER("SPKMIXL Mixer", RT5631_PWR_MANAG_ADD2, 13, 0,
+ &rt5631_spkmixl_mixer_controls[0],
+ ARRAY_SIZE(rt5631_spkmixl_mixer_controls)),
+SND_SOC_DAPM_MIXER("OUTMIXL Mixer", RT5631_PWR_MANAG_ADD2, 15, 0,
+ &rt5631_outmixl_mixer_controls[0],
+ ARRAY_SIZE(rt5631_outmixl_mixer_controls)),
+SND_SOC_DAPM_MIXER("OUTMIXR Mixer", RT5631_PWR_MANAG_ADD2, 14, 0,
+ &rt5631_outmixr_mixer_controls[0],
+ ARRAY_SIZE(rt5631_outmixr_mixer_controls)),
+SND_SOC_DAPM_MIXER("SPKMIXR Mixer", RT5631_PWR_MANAG_ADD2, 12, 0,
+ &rt5631_spkmixr_mixer_controls[0],
+ ARRAY_SIZE(rt5631_spkmixr_mixer_controls)),
+
+SND_SOC_DAPM_PGA("Left SPK Vol", RT5631_PWR_MANAG_ADD4, 15, 0, NULL, 0),
+SND_SOC_DAPM_PGA("Right SPK Vol", RT5631_PWR_MANAG_ADD4, 14, 0, NULL, 0),
+SND_SOC_DAPM_PGA_E("Left HP Vol", RT5631_PWR_MANAG_ADD4, 11, 0, NULL, 0,
+ hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
+SND_SOC_DAPM_PGA_E("Right HP Vol", RT5631_PWR_MANAG_ADD4, 10, 0, NULL, 0,
+ hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
+
+SND_SOC_DAPM_PGA_E("Left DAC_HP", SND_SOC_NOPM, 0, 0, NULL, 0,
+ dac_to_hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
+SND_SOC_DAPM_PGA_E("Right DAC_HP", SND_SOC_NOPM, 0, 0, NULL, 0,
+ dac_to_hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
+
+SND_SOC_DAPM_PGA("Left Out Vol", RT5631_PWR_MANAG_ADD4, 13, 0, NULL, 0),
+SND_SOC_DAPM_PGA("Right Out Vol", RT5631_PWR_MANAG_ADD4, 12, 0, NULL, 0),
+
+SND_SOC_DAPM_MIXER_E("AXO1MIX Mixer", RT5631_PWR_MANAG_ADD3, 11, 0,
+ &rt5631_AXO1MIX_mixer_controls[0],
+ ARRAY_SIZE(rt5631_AXO1MIX_mixer_controls),
+ auxo1_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
+SND_SOC_DAPM_MIXER("SPOLMIX Mixer", SND_SOC_NOPM, 0, 0,
+ &rt5631_spolmix_mixer_controls[0],
+ ARRAY_SIZE(rt5631_spolmix_mixer_controls)),
+SND_SOC_DAPM_MIXER("MONOMIX Mixer", RT5631_PWR_MANAG_ADD3, 9, 0,
+ &rt5631_monomix_mixer_controls[0],
+ ARRAY_SIZE(rt5631_monomix_mixer_controls)),
+SND_SOC_DAPM_MIXER("SPORMIX Mixer", SND_SOC_NOPM, 0, 0,
+ &rt5631_spormix_mixer_controls[0],
+ ARRAY_SIZE(rt5631_spormix_mixer_controls)),
+SND_SOC_DAPM_MIXER_E("AXO2MIX Mixer", RT5631_PWR_MANAG_ADD3, 10, 0,
+ &rt5631_AXO2MIX_mixer_controls[0],
+ ARRAY_SIZE(rt5631_AXO2MIX_mixer_controls),
+ auxo2_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
+
+SND_SOC_DAPM_MUX("SPOL Mux", SND_SOC_NOPM, 0, 0, &rt5631_spol_mux_control),
+SND_SOC_DAPM_MUX("SPOR Mux", SND_SOC_NOPM, 0, 0, &rt5631_spor_mux_control),
+SND_SOC_DAPM_MUX("Mono Mux", SND_SOC_NOPM, 0, 0, &rt5631_mono_mux_control),
+SND_SOC_DAPM_MUX("HPL Mux", SND_SOC_NOPM, 0, 0, &rt5631_hpl_mux_control),
+SND_SOC_DAPM_MUX("HPR Mux", SND_SOC_NOPM, 0, 0, &rt5631_hpr_mux_control),
+
+SND_SOC_DAPM_PGA_E("Mono Amp", RT5631_PWR_MANAG_ADD3, 7, 0, NULL, 0,
+ mono_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
+SND_SOC_DAPM_PGA_E("SPKL Amp", SND_SOC_NOPM, 0, 0, NULL, 0,
+ spk_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),
+SND_SOC_DAPM_PGA_E("SPKR Amp", SND_SOC_NOPM, 1, 0, NULL, 0,
+ spk_event, SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),
+
+SND_SOC_DAPM_OUTPUT("AUXO1"),
+SND_SOC_DAPM_OUTPUT("AUXO2"),
+SND_SOC_DAPM_OUTPUT("SPOL"),
+SND_SOC_DAPM_OUTPUT("SPOR"),
+SND_SOC_DAPM_OUTPUT("HPOL"),
+SND_SOC_DAPM_OUTPUT("HPOR"),
+SND_SOC_DAPM_OUTPUT("MONO"),
+};
+
+
+static const struct snd_soc_dapm_route audio_map[] = {
+ {"Mic1 Boost", NULL, "MIC1"},
+ {"Mic2 Boost", NULL, "MIC2"},
+ {"MONOIN_RXP Boost", NULL, "MONOIN_RXP"},
+ {"MONOIN_RXN Boost", NULL, "MONOIN_RXN"},
+ {"AXIL Boost", NULL, "AXIL"},
+ {"AXIR Boost", NULL, "AXIR"},
+
+ {"MONO_IN", NULL, "MONOIN_RXP Boost"},
+ {"MONO_IN", NULL, "MONOIN_RXN Boost"},
+
+ {"RECMIXL Mixer", "OUTMIXL Capture Switch", "OUTMIXL Mixer"},
+ {"RECMIXL Mixer", "MIC1_BST1 Capture Switch", "Mic1 Boost"},
+ {"RECMIXL Mixer", "AXILVOL Capture Switch", "AXIL Boost"},
+ {"RECMIXL Mixer", "MONOIN_RX Capture Switch", "MONO_IN"},
+
+ {"RECMIXR Mixer", "OUTMIXR Capture Switch", "OUTMIXR Mixer"},
+ {"RECMIXR Mixer", "MIC2_BST2 Capture Switch", "Mic2 Boost"},
+ {"RECMIXR Mixer", "AXIRVOL Capture Switch", "AXIR Boost"},
+ {"RECMIXR Mixer", "MONOIN_RX Capture Switch", "MONO_IN"},
+
+ {"ADC Mixer", NULL, "RECMIXL Mixer"},
+ {"ADC Mixer", NULL, "RECMIXR Mixer"},
+ {"Left ADC", NULL, "ADC Mixer"},
+ {"Right ADC", NULL, "ADC Mixer"},
+
+ {"Voice DAC Boost", NULL, "Voice DAC"},
+
+ {"SPKMIXL Mixer", "RECMIXL Playback Switch", "RECMIXL Mixer"},
+ {"SPKMIXL Mixer", "MIC1_P Playback Switch", "MIC1"},
+ {"SPKMIXL Mixer", "DACL Playback Switch", "Left DAC"},
+ {"SPKMIXL Mixer", "OUTMIXL Playback Switch", "OUTMIXL Mixer"},
+
+ {"SPKMIXR Mixer", "OUTMIXR Playback Switch", "OUTMIXR Mixer"},
+ {"SPKMIXR Mixer", "DACR Playback Switch", "Right DAC"},
+ {"SPKMIXR Mixer", "MIC2_P Playback Switch", "MIC2"},
+ {"SPKMIXR Mixer", "RECMIXR Playback Switch", "RECMIXR Mixer"},
+
+ {"OUTMIXL Mixer", "RECMIXL Playback Switch", "RECMIXL Mixer"},
+ {"OUTMIXL Mixer", "RECMIXR Playback Switch", "RECMIXR Mixer"},
+ {"OUTMIXL Mixer", "DACL Playback Switch", "Left DAC"},
+ {"OUTMIXL Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},
+ {"OUTMIXL Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},
+ {"OUTMIXL Mixer", "MONOIN_RXP Playback Switch", "MONOIN_RXP Boost"},
+ {"OUTMIXL Mixer", "AXILVOL Playback Switch", "AXIL Boost"},
+ {"OUTMIXL Mixer", "AXIRVOL Playback Switch", "AXIR Boost"},
+ {"OUTMIXL Mixer", "VDAC Playback Switch", "Voice DAC Boost"},
+
+ {"OUTMIXR Mixer", "RECMIXL Playback Switch", "RECMIXL Mixer"},
+ {"OUTMIXR Mixer", "RECMIXR Playback Switch", "RECMIXR Mixer"},
+ {"OUTMIXR Mixer", "DACR Playback Switch", "Right DAC"},
+ {"OUTMIXR Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},
+ {"OUTMIXR Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},
+ {"OUTMIXR Mixer", "MONOIN_RXN Playback Switch", "MONOIN_RXN Boost"},
+ {"OUTMIXR Mixer", "AXILVOL Playback Switch", "AXIL Boost"},
+ {"OUTMIXR Mixer", "AXIRVOL Playback Switch", "AXIR Boost"},
+ {"OUTMIXR Mixer", "VDAC Playback Switch", "Voice DAC Boost"},
+
+ {"Left SPK Vol", NULL, "SPKMIXL Mixer"},
+ {"Right SPK Vol", NULL, "SPKMIXR Mixer"},
+ {"Left HP Vol", NULL, "OUTMIXL Mixer"},
+ {"Left Out Vol", NULL, "OUTMIXL Mixer"},
+ {"Right Out Vol", NULL, "OUTMIXR Mixer"},
+ {"Right HP Vol", NULL, "OUTMIXR Mixer"},
+
+ {"AXO1MIX Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},
+ {"AXO1MIX Mixer", "OUTVOLL Playback Switch", "Left Out Vol"},
+ {"AXO1MIX Mixer", "OUTVOLR Playback Switch", "Right Out Vol"},
+ {"AXO1MIX Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},
+
+ {"AXO2MIX Mixer", "MIC1_BST1 Playback Switch", "Mic1 Boost"},
+ {"AXO2MIX Mixer", "OUTVOLL Playback Switch", "Left Out Vol"},
+ {"AXO2MIX Mixer", "OUTVOLR Playback Switch", "Right Out Vol"},
+ {"AXO2MIX Mixer", "MIC2_BST2 Playback Switch", "Mic2 Boost"},
+
+ {"SPOLMIX Mixer", "SPKVOLL Playback Switch", "Left SPK Vol"},
+ {"SPOLMIX Mixer", "SPKVOLR Playback Switch", "Right SPK Vol"},
+
+ {"SPORMIX Mixer", "SPKVOLL Playback Switch", "Left SPK Vol"},
+ {"SPORMIX Mixer", "SPKVOLR Playback Switch", "Right SPK Vol"},
+
+ {"MONOMIX Mixer", "OUTVOLL Playback Switch", "Left Out Vol"},
+ {"MONOMIX Mixer", "OUTVOLR Playback Switch", "Right Out Vol"},
+
+ {"SPOL Mux", "SPOLMIX", "SPOLMIX Mixer"},
+ {"SPOL Mux", "MONOIN_RX", "MONO_IN"},
+ {"SPOL Mux", "VDAC", "Voice DAC Boost"},
+ {"SPOL Mux", "DACL", "Left DAC"},
+
+ {"SPOR Mux", "SPORMIX", "SPORMIX Mixer"},
+ {"SPOR Mux", "MONOIN_RX", "MONO_IN"},
+ {"SPOR Mux", "VDAC", "Voice DAC Boost"},
+ {"SPOR Mux", "DACR", "Right DAC"},
+
+ {"Mono Mux", "MONOMIX", "MONOMIX Mixer"},
+ {"Mono Mux", "MONOIN_RX", "MONO_IN"},
+ {"Mono Mux", "VDAC", "Voice DAC Boost"},
+
+ {"Right DAC_HP", "NULL", "Right DAC"},
+ {"Left DAC_HP", "NULL", "Left DAC"},
+
+ {"HPL Mux", "LEFT HPVOL", "Left HP Vol"},
+ {"HPL Mux", "LEFT DAC", "Left DAC_HP"},
+ {"HPR Mux", "RIGHT HPVOL", "Right HP Vol"},
+ {"HPR Mux", "RIGHT DAC", "Right DAC_HP"},
+
+ {"SPKL Amp", NULL, "SPOL Mux"},
+ {"SPKR Amp", NULL, "SPOR Mux"},
+ {"Mono Amp", NULL, "Mono Mux"},
+
+ {"AUXO1", NULL, "AXO1MIX Mixer"},
+ {"AUXO2", NULL, "AXO2MIX Mixer"},
+ {"SPOL", NULL, "SPKL Amp"},
+ {"SPOR", NULL, "SPKR Amp"},
+
+ {"HPOL", NULL, "HPL Mux"},
+ {"HPOR", NULL, "HPR Mux"},
+
+ {"MONO", NULL, "Mono Amp"}
+};
+
+static int rt5631_add_widgets(struct snd_soc_codec *codec)
+{
+ struct snd_soc_dapm_context *dapm = &codec->dapm;
+
+ snd_soc_dapm_new_controls(dapm, rt5631_dapm_widgets,
+ ARRAY_SIZE(rt5631_dapm_widgets));
+ snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map));
+
+ return 0;
+}
+
+static int voltab[2][16] =
+{
+ //spk
+ {0x27, 0x1b, 0x18, 0x15, 0x13, 0x11, 0x0f, 0x0e, 0x0d, 0x0c, 0x0b, 0x0a, 0x09, 0x08, 0x07, 0x06},
+ //hp
+ {0x1f, 0x1c, 0x1a, 0x18, 0x16, 0x14, 0x12, 0x10, 0x0e, 0x0c, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01},
+};
+static int gvolume = 0;
+
+#if 1
+static int get_vol(int max, int min, int stage_num, int stage)
+{
+ int ret, step=((max-min)<<8)/(stage_num-1);
+ if(stage==stage_num-1)
+ ret=min;
+ else if(stage==0)
+ ret=max;
+ else {
+ ret=(stage_num-stage-1) * step;
+ ret >>= 8;
+ ret = min+ret;
+ }
+ DBG("%s(): ret=%02x, max=0x%02x, min=0x%02x, stage_num=%d, stage=%d\n",
+ __FUNCTION__,
+ ret,
+ max,
+ min,
+ stage_num,
+ stage);
+ return ret;
+}
+
+static void rt5631_set_volume(int vollevel)
+{
+ struct snd_soc_codec *codec = rt5631_codec;
+ int tmpvol1, tmpvol2;
+
+ //DBG("rt5631_set_volume = %d\n", vollevel);
+
+ if (vollevel > 15) vollevel = 8;
+ gvolume = vollevel;
+
+// tmpvol1 = voltab[0][vollevel];
+// tmpvol2 = voltab[1][vollevel];
+ tmpvol1=get_vol(0x27, DEF_VOL_SPK&0x3f, 16, vollevel);
+ tmpvol2=get_vol(0x1f, DEF_VOL&0x1f, 16, vollevel);
+
+ if(vollevel == 0){
+ rt5631_write_mask(codec, RT5631_SPK_OUT_VOL, 0x8080, 0x8080);
+ rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0x8080, 0x8080);
+ }
+// else{
+// rt5631_write_mask(codec, RT5631_SPK_OUT_VOL, 0x00, 0x8080);
+// rt5631_write_mask(codec, RT5631_HP_OUT_VOL, 0x00, 0x8080);
+// }
+
+ rt5631_write_mask(codec, RT5631_SPK_OUT_VOL, ((tmpvol1<<8)|tmpvol1), 0x3f3f);
+ rt5631_write_mask(codec, RT5631_HP_OUT_VOL, ((tmpvol2<<8)|tmpvol2), 0x3f3f);
+}
+
+static void rt5631_set_eq(int on)
+{
+ struct snd_soc_codec *codec = rt5631_codec;
+ unsigned int Reg0C;
+
+ Reg0C = rt5631_read(codec, RT5631_STEREO_DAC_VOL_1);
+ DBG("------- rt5631_set_eq: read Reg0C = 0x%04x\n", Reg0C);
+
+ Reg0C &= 0xFF80;
+ if(on) {
+ Reg0C |= 0x10;
+ } else {
+ Reg0C |= 0x00;
+ }
+
+ DBG("------- rt5631_set_eq: write Reg0C = 0x%04x\n", Reg0C);
+ rt5631_write(codec, RT5631_STEREO_DAC_VOL_1, Reg0C);
+}
+
+#else
+
+static void rt5631_set_volume(int vollevel)
+{
+ struct snd_soc_codec *codec = rt5631_codec;
+ u8 tmpvol1, tmpvol2;
+ u16 spk_vol, hp_vol;
+
+ DBG("rt5631_set_volume = %d\n", vollevel);
+
+ if (vollevel > 15) vollevel = 8;
+ gvolume = vollevel;
+
+ tmpvol1 = voltab[0][vollevel];
+ tmpvol2 = voltab[1][vollevel];
+
+ spk_vol = snd_soc_read(codec, RT5631_SPK_OUT_VOL);
+ hp_vol = snd_soc_read(codec, RT5631_HP_OUT_VOL);
+
+ DBG("\n\nold value: 0x%04x, 0x%04x\n", spk_vol & 0x3F3F, hp_vol & 0x3F3F);
+ DBG("new value: 0x%04x\n", (tmpvol1<<8)|tmpvol1, (tmpvol2<<8)|tmpvol2);
+
+ spk_vol &= 0x3C3C;
+ spk_vol |= (tmpvol1<<8)|tmpvol1;
+ hp_vol &= 0x3C3C;
+ hp_vol |= (tmpvol2<<8)|tmpvol2;
+
+ snd_soc_write(codec, RT5631_SPK_OUT_VOL, spk_vol);
+ snd_soc_write(codec, RT5631_HP_OUT_VOL , hp_vol);
+}
+
+#endif
+struct coeff_clk_div {
+ u32 mclk;
+ u32 bclk;
+ u32 rate;
+ u16 reg_val;
+};
+
+/* PLL divisors yes*/
+struct pll_div {
+ u32 pll_in;
+ u32 pll_out;
+ u16 reg_val;
+};
+
+static const struct pll_div codec_master_pll_div[] = {
+ {2048000, 8192000, 0x0ea0},
+ {3686400, 8192000, 0x4e27},
+ {12000000, 8192000, 0x456b},
+ {13000000, 8192000, 0x495f},
+ {13100000, 8192000, 0x0320},
+ {2048000, 11289600, 0xf637},
+ {3686400, 11289600, 0x2f22},
+ {12000000, 11289600, 0x3e2f},
+ {13000000, 11289600, 0x4d5b},
+ {13100000, 11289600, 0x363b},
+ {2048000, 16384000, 0x1ea0},
+ {3686400, 16384000, 0x9e27},
+ {12000000, 16384000, 0x452b},
+ {13000000, 16384000, 0x542f},
+ {13100000, 16384000, 0x03a0},
+ {2048000, 16934400, 0xe625},
+ {3686400, 16934400, 0x9126},
+ {12000000, 16934400, 0x4d2c},
+ {13000000, 16934400, 0x742f},
+ {13100000, 16934400, 0x3c27},
+ {2048000, 22579200, 0x2aa0},
+ {3686400, 22579200, 0x2f20},
+ {12000000, 22579200, 0x7e2f},
+ {13000000, 22579200, 0x742f},
+ {13100000, 22579200, 0x3c27},
+ {2048000, 24576000, 0x2ea0},
+ {3686400, 24576000, 0xee27},
+ {12000000, 24576000, 0x2915},
+ {13000000, 24576000, 0x772e},
+ {13100000, 24576000, 0x0d20},
+ {26000000, 24576000, 0x2027},
+ {26000000, 22579200, 0x392f},
+ {24576000, 22579200, 0x0921},
+ {24576000, 24576000, 0x02a0},
+};
+
+static const struct pll_div codec_slave_pll_div[] = {
+ {256000, 2048000, 0x46f0},
+ {256000, 4096000, 0x3ea0},
+ {352800, 5644800, 0x3ea0},
+ {512000, 8192000, 0x3ea0},
+ {1024000, 8192000, 0x46f0},
+ {705600, 11289600, 0x3ea0},
+ {1024000, 16384000, 0x3ea0},
+ {1411200, 22579200, 0x3ea0},
+ {1536000, 24576000, 0x3ea0},
+ {2048000, 16384000, 0x1ea0},
+ {2822400, 22579200, 0x1ea0},
+ {2822400, 45158400, 0x5ec0},
+ {5644800, 45158400, 0x46f0},
+ {3072000, 24576000, 0x1ea0},
+ {3072000, 49152000, 0x5ec0},
+ {6144000, 49152000, 0x46f0},
+ {705600, 11289600, 0x3ea0},
+ {705600, 8467200, 0x3ab0},
+ {24576000, 24576000, 0x02a0},
+ {1411200, 11289600, 0x1690},
+ {2822400, 11289600, 0x0a90},
+ {1536000, 12288000, 0x1690},
+ {3072000, 12288000, 0x0a90},
+};
+
+struct coeff_clk_div coeff_div[] = {
+ /* sysclk is 256fs */
+ {2048000, 8000 * 32, 8000, 0x1000},
+ {2048000, 8000 * 64, 8000, 0x0000},
+ {2822400, 11025 * 32, 11025, 0x1000},
+ {2822400, 11025 * 64, 11025, 0x0000},
+ {4096000, 16000 * 32, 16000, 0x1000},
+ {4096000, 16000 * 64, 16000, 0x0000},
+ {5644800, 22050 * 32, 22050, 0x1000},
+ {5644800, 22050 * 64, 22050, 0x0000},
+ {8192000, 32000 * 32, 32000, 0x1000},
+ {8192000, 32000 * 64, 32000, 0x0000},
+ {11289600, 44100 * 32, 44100, 0x1000},
+ {11289600, 44100 * 64, 44100, 0x0000},
+ {12288000, 48000 * 32, 48000, 0x1000},
+ {12288000, 48000 * 64, 48000, 0x0000},
+ {22579200, 88200 * 32, 88200, 0x1000},
+ {22579200, 88200 * 64, 88200, 0x0000},
+ {24576000, 96000 * 32, 96000, 0x1000},
+ {24576000, 96000 * 64, 96000, 0x0000},
+ /* sysclk is 512fs */
+ {4096000, 8000 * 32, 8000, 0x3000},
+ {4096000, 8000 * 64, 8000, 0x2000},
+ {5644800, 11025 * 32, 11025, 0x3000},
+ {5644800, 11025 * 64, 11025, 0x2000},
+ {8192000, 16000 * 32, 16000, 0x3000},
+ {8192000, 16000 * 64, 16000, 0x2000},
+ {11289600, 22050 * 32, 22050, 0x3000},
+ {11289600, 22050 * 64, 22050, 0x2000},
+ {16384000, 32000 * 32, 32000, 0x3000},
+ {16384000, 32000 * 64, 32000, 0x2000},
+ {22579200, 44100 * 32, 44100, 0x3000},
+ {22579200, 44100 * 64, 44100, 0x2000},
+ {24576000, 48000 * 32, 48000, 0x3000},
+ {24576000, 48000 * 64, 48000, 0x2000},
+ {45158400, 88200 * 32, 88200, 0x3000},
+ {45158400, 88200 * 64, 88200, 0x2000},
+ {49152000, 96000 * 32, 96000, 0x3000},
+ {49152000, 96000 * 64, 96000, 0x2000},
+ /* sysclk is 24.576Mhz or 22.5792Mhz */
+ {24576000, 8000 * 32, 8000, 0x7080},
+ {24576000, 8000 * 64, 8000, 0x6080},
+ {24576000, 16000 * 32, 16000, 0x5080},
+ {24576000, 16000 * 64, 16000, 0x4080},
+ {24576000, 24000 * 32, 24000, 0x5000},
+ {24576000, 24000 * 64, 24000, 0x4000},
+ {24576000, 32000 * 32, 32000, 0x3080},
+ {24576000, 32000 * 64, 32000, 0x2080},
+ {22579200, 11025 * 32, 11025, 0x7000},
+ {22579200, 11025 * 64, 11025, 0x6000},
+ {22579200, 22050 * 32, 22050, 0x5000},
+ {22579200, 22050 * 64, 22050, 0x4000},
+};
+
+static int get_coeff(int mclk, int rate, int timesofbclk)
+{
+ int i;
+
+ for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
+ if (coeff_div[i].mclk == mclk && coeff_div[i].rate == rate &&
+ (coeff_div[i].bclk / coeff_div[i].rate) == timesofbclk)
+ return i;
+ }
+ return -EINVAL;
+}
+
+static int get_coeff_in_slave_mode(int mclk, int rate)
+{
+ return get_coeff(mclk, rate, timesofbclk);
+}
+
+static int get_coeff_in_master_mode(int mclk, int rate, int bclk)
+{
+ return get_coeff(mclk, rate, (bclk / rate));
+}
+
+static void rt5631_set_dmic_params(struct snd_soc_codec *codec,
+ struct snd_pcm_hw_params *params)
+{
+ int rate;
+
+ rt5631_write_mask(codec, RT5631_GPIO_CTRL,
+ GPIO_PIN_FUN_SEL_GPIO_DIMC | GPIO_DMIC_FUN_SEL_DIMC,
+ GPIO_PIN_FUN_SEL_MASK | GPIO_DMIC_FUN_SEL_MASK);
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL, DMIC_ENA, DMIC_ENA_MASK);
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,
+ DMIC_L_CH_LATCH_FALLING | DMIC_R_CH_LATCH_RISING,
+ DMIC_L_CH_LATCH_MASK|DMIC_R_CH_LATCH_MASK);
+
+ rate = params_rate(params);
+ switch (rate) {
+ case 44100:
+ case 48000:
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,
+ DMIC_CLK_CTRL_TO_32FS, DMIC_CLK_CTRL_MASK);
+ break;
+
+ case 32000:
+ case 22050:
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,
+ DMIC_CLK_CTRL_TO_64FS, DMIC_CLK_CTRL_MASK);
+ break;
+
+ case 16000:
+ case 11025:
+ case 8000:
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,
+ DMIC_CLK_CTRL_TO_128FS, DMIC_CLK_CTRL_MASK);
+ break;
+
+ default:
+ break;
+ }
+
+ rt5631_write_mask(codec, RT5631_DIG_MIC_CTRL,
+ DMIC_L_CH_UNMUTE | DMIC_R_CH_UNMUTE,
+ DMIC_L_CH_MUTE_MASK | DMIC_R_CH_MUTE_MASK);
+
+ return;
+}
+
+static int rt5631_hifi_pcm_params(struct snd_pcm_substream *substream,
+ struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
+{
+ struct snd_soc_pcm_runtime *rtd = substream->private_data;
+ struct snd_soc_codec *codec = rtd->codec;
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+ int stream = substream->stream, rate = params_rate(params), coeff;
+ unsigned int iface = 0;
+
+ pr_debug("enter %s\n", __func__);
+
+ if (!rt5631->master)
+ coeff = get_coeff_in_slave_mode(rt5631->sysclk, rate);
+ else
+ coeff = get_coeff_in_master_mode(rt5631->sysclk, rate,
+ rate * timesofbclk);
+ if (coeff < 0)
+ pr_err("%s: get coeff err!\n", __func__);
+
+ switch (params_format(params)) {
+ case SNDRV_PCM_FORMAT_S16_LE:
+ break;
+ case SNDRV_PCM_FORMAT_S20_3LE:
+ iface |= SDP_I2S_DL_20;
+ break;
+ case SNDRV_PCM_FORMAT_S24_LE:
+ iface |= SDP_I2S_DL_24;
+ break;
+ case SNDRV_PCM_FORMAT_S8:
+ iface |= SDP_I2S_DL_8;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ if (SNDRV_PCM_STREAM_CAPTURE == stream) {
+ if (rt5631->dmic_used_flag)
+ rt5631_set_dmic_params(codec, params);
+ }
+
+ rt5631_write_mask(codec, RT5631_SDP_CTRL, iface, SDP_I2S_DL_MASK);
+
+ if (coeff >= 0)
+ rt5631_write(codec, RT5631_STEREO_AD_DA_CLK_CTRL,
+ coeff_div[coeff].reg_val);
+
+ return 0;
+}
+
+static int rt5631_hifi_codec_set_dai_fmt(struct snd_soc_dai *codec_dai,
+ unsigned int fmt)
+{
+ struct snd_soc_codec *codec = codec_dai->codec;
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+ unsigned int iface = 0;
+
+ pr_debug("enter %s\n", __func__);
+
+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
+ case SND_SOC_DAIFMT_CBM_CFM:
+ rt5631->master = 1;
+ break;
+ case SND_SOC_DAIFMT_CBS_CFS:
+ iface |= SDP_MODE_SEL_SLAVE;
+ rt5631->master = 0;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
+ case SND_SOC_DAIFMT_I2S:
+ break;
+ case SND_SOC_DAIFMT_LEFT_J:
+ iface |= SDP_I2S_DF_LEFT;
+ break;
+ case SND_SOC_DAIFMT_DSP_A:
+ iface |= SDP_I2S_DF_PCM_A;
+ break;
+ case SND_SOC_DAIFMT_DSP_B:
+ iface |= SDP_I2S_DF_PCM_B;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
+ case SND_SOC_DAIFMT_NB_NF:
+ break;
+ case SND_SOC_DAIFMT_IB_NF:
+ iface |= SDP_I2S_BCLK_POL_CTRL;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ rt5631_write(codec, RT5631_SDP_CTRL, iface);
+
+ return 0;
+}
+
+static int rt5631_hifi_codec_set_dai_sysclk(struct snd_soc_dai *codec_dai,
+ int clk_id, unsigned int freq, int dir)
+{
+ struct snd_soc_codec *codec = codec_dai->codec;
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+
+ pr_info("enter %s, syclk=%d\n", __func__, freq);
+ if ((freq >= (256 * 8000)) && (freq <= (512 * 96000))) {
+ rt5631->sysclk = freq;
+ return 0;
+ }
+
+ pr_info("unsupported sysclk freq %u for audio i2s\n", freq);
+ pr_info("set sysclk to 24.576Mhz by default\n");
+
+ rt5631->sysclk = 24576000;
+ return 0;
+}
+
+static int rt5631_codec_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
+ int source, unsigned int freq_in, unsigned int freq_out)
+{
+ struct snd_soc_codec *codec = codec_dai->codec;
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+ int i, ret = -EINVAL;
+
+ printk(KERN_DEBUG "enter %s\n", __func__);
+
+ if (!freq_in || !freq_out)
+ return 0;
+
+ if (rt5631->master) {
+ for (i = 0; i < ARRAY_SIZE(codec_master_pll_div); i++)
+ if (freq_in == codec_master_pll_div[i].pll_in &&
+ freq_out == codec_master_pll_div[i].pll_out) {
+ rt5631_write(codec, RT5631_PLL_CTRL,
+ codec_master_pll_div[i].reg_val);
+ schedule_timeout_uninterruptible(
+ msecs_to_jiffies(20));
+ rt5631_write(codec, RT5631_GLOBAL_CLK_CTRL,
+ SYSCLK_SOUR_SEL_PLL);
+ rt5631->pll_used_flag = 1;
+ ret = 0;
+ break;
+ }
+ } else {
+ for (i = 0; i < ARRAY_SIZE(codec_slave_pll_div); i++)
+ if (freq_in == codec_slave_pll_div[i].pll_in &&
+ freq_out == codec_slave_pll_div[i].pll_out) {
+ rt5631_write(codec, RT5631_PLL_CTRL,
+ codec_slave_pll_div[i].reg_val);
+ schedule_timeout_uninterruptible(
+ msecs_to_jiffies(20));
+ rt5631_write(codec, RT5631_GLOBAL_CLK_CTRL,
+ SYSCLK_SOUR_SEL_PLL |
+ PLLCLK_SOUR_SEL_BITCLK);
+ rt5631->pll_used_flag = 1;
+ ret = 0;
+ break;
+ }
+ }
+
+ return ret;
+}
+
+#if defined(CONFIG_ADJUST_VOL_BY_CODEC)
+static int rt5631_trigger(struct snd_pcm_substream *substream, int status, struct snd_soc_dai *dai)
+{
+ //DBG("rt5631_trigger\n");
+ if(status == SNDRV_PCM_TRIGGER_VOLUME){
+ //DBG("rt5631_trigger: vol = %d\n", substream->number);
+ if(substream->number < 100){
+ rt5631_set_volume(substream->number);
+ } else {
+ if(substream->number == 100) { // eq off
+ DBG("---------- eq off\n");
+ rt5631_set_eq(0);
+ } else { // eq on +6dB
+ DBG("---------- eq on\n");
+ rt5631_set_eq(1);
+ }
+ }
+ }
+
+ return 0;
+}
+#endif
+
+static ssize_t rt5631_index_reg_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ #define IDX_REG_FMT "%02x: %04x\n"
+ #define IDX_REG_LEN 9
+ unsigned int val;
+ int cnt = 0, i;
+
+ cnt += sprintf(buf, "RT5631 index register\n");
+ for (i = 0; i < 0x55; i++) {
+ if (cnt + IDX_REG_LEN >= PAGE_SIZE - 1)
+ break;
+ val = rt5631_read_index(rt5631_codec, i);
+ if (!val)
+ continue;
+ cnt += sprintf(buf + cnt, IDX_REG_FMT, i, val);
+ }
+
+ if (cnt >= PAGE_SIZE)
+ cnt = PAGE_SIZE - 1;
+
+ return cnt;
+}
+static DEVICE_ATTR(index_reg, 0444, rt5631_index_reg_show, NULL);
+
+#define RT5631_STEREO_RATES SNDRV_PCM_RATE_8000_96000
+#define RT5631_FORMAT (SNDRV_PCM_FMTBIT_S16_LE | \
+ SNDRV_PCM_FMTBIT_S20_3LE | \
+ SNDRV_PCM_FMTBIT_S24_LE | \
+ SNDRV_PCM_FMTBIT_S8)
+
+struct snd_soc_dai_ops rt5631_ops = {
+ .hw_params = rt5631_hifi_pcm_params,
+ .set_fmt = rt5631_hifi_codec_set_dai_fmt,
+ .set_sysclk = rt5631_hifi_codec_set_dai_sysclk,
+ .set_pll = rt5631_codec_set_dai_pll,
+#if defined(CONFIG_ADJUST_VOL_BY_CODEC)
+ .trigger = rt5631_trigger,
+#endif
+};
+
+struct snd_soc_dai_driver rt5631_dai[] = {
+ {
+ .name = "RT5631 HiFi",
+ .playback = {
+ .stream_name = "HIFI Playback",
+ .channels_min = 1,
+ .channels_max = 2,
+ .rates = RT5631_STEREO_RATES,
+ .formats = RT5631_FORMAT,
+ },
+ .capture = {
+ .stream_name = "HIFI Capture",
+ .channels_min = 1,
+ .channels_max = 2,
+ .rates = RT5631_STEREO_RATES,
+ .formats = RT5631_FORMAT,
+ },
+ .ops = &rt5631_ops,
+ },
+};
+EXPORT_SYMBOL_GPL(rt5631_dai);
+
+static int rt5631_set_bias_level(struct snd_soc_codec *codec,
+ enum snd_soc_bias_level level)
+{
+ switch (level) {
+ case SND_SOC_BIAS_ON:
+ break;
+
+ case SND_SOC_BIAS_PREPARE:
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ PWR_VREF | PWR_MAIN_BIAS, PWR_VREF | PWR_MAIN_BIAS);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2,
+ PWR_MICBIAS1_VOL | PWR_MICBIAS2_VOL,
+ PWR_MICBIAS1_VOL | PWR_MICBIAS2_VOL);
+ break;
+
+ case SND_SOC_BIAS_STANDBY:
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD2, 0,
+ PWR_MICBIAS1_VOL | PWR_MICBIAS2_VOL);
+ break;
+
+ case SND_SOC_BIAS_OFF:
+ rt5631_write_mask(codec, RT5631_SPK_OUT_VOL,
+ RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);
+ rt5631_write_mask(codec, RT5631_HP_OUT_VOL,
+ RT_L_MUTE | RT_R_MUTE, RT_L_MUTE | RT_R_MUTE);
+ rt5631_write(codec, RT5631_PWR_MANAG_ADD1, 0x0000);
+ rt5631_write(codec, RT5631_PWR_MANAG_ADD2, 0x0000);
+ rt5631_write(codec, RT5631_PWR_MANAG_ADD3, 0x0000);
+ rt5631_write(codec, RT5631_PWR_MANAG_ADD4, 0x0000);
+ break;
+
+ default:
+ break;
+ }
+ codec->dapm.bias_level = level;
+
+ return 0;
+}
+
+static int rt5631_probe(struct snd_soc_codec *codec)
+{
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+ unsigned int val;
+ int ret;
+ ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);
+ if (ret != 0) {
+ dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
+ return ret;
+ }
+ codec->cache_bypass = 1;
+
+ val = rt5631_read_index(codec, RT5631_ADDA_MIXER_INTL_REG3);
+ if (val & 0x0002)
+ rt5631->codec_version = 1;
+ else
+ rt5631->codec_version = 0;
+
+ rt5631_reset(codec);
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ PWR_VREF | PWR_MAIN_BIAS, PWR_VREF | PWR_MAIN_BIAS);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(80));
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3, PWR_FAST_VREF_CTRL,
+ PWR_FAST_VREF_CTRL);
+ rt5631_reg_init(codec);
+
+ /* power off ClassD auto Recovery */
+ if (rt5631->codec_version)
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0x2000, 0x2000);
+ else
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0, 0x2000);
+
+ codec->dapm.bias_level = SND_SOC_BIAS_STANDBY;
+ rt5631_codec = codec;
+
+#if (RT5631_SPK_TIMER == 1)
+ /* Timer module installing */
+ setup_timer( &spk_timer, spk_timer_callback, 0 );
+ DBG( "Starting timer to fire in 5s (%ld)\n", jiffies );
+ ret = mod_timer( &spk_timer, jiffies + msecs_to_jiffies(5000) );
+ if (ret) printk("Error in mod_timer\n");
+
+ INIT_WORK(&spk_work, spk_work_handler);
+#endif
+
+ snd_soc_add_controls(codec, rt5631_snd_controls,
+ ARRAY_SIZE(rt5631_snd_controls));
+ rt5631_add_widgets(codec);
+
+ ret = device_create_file(codec->dev, &dev_attr_index_reg);
+ if (ret != 0) {
+ dev_err(codec->dev,
+ "Failed to create index_reg sysfs files: %d\n", ret);
+ return ret;
+ }
+
+ pr_info("RT5631 initial ok!\n");
+
+ return 0;
+}
+
+static int rt5631_remove(struct snd_soc_codec *codec)
+{
+
+
+#if (RT5631_SPK_TIMER == 1)
+ /* Timer¡¡module¡¡uninstalling */
+ int ret;
+ ret = del_timer(&spk_timer);
+ if(ret) printk("The timer is still in use...\n");
+ DBG("Timer module uninstalling\n");
+#endif
+
+
+ rt5631_set_bias_level(codec, SND_SOC_BIAS_OFF);
+ return 0;
+}
+
+static int rt5631_suspend(struct snd_soc_codec *codec, pm_message_t state)
+{
+ rt5631_set_bias_level(codec, SND_SOC_BIAS_OFF);
+ return 0;
+}
+
+static int rt5631_resume(struct snd_soc_codec *codec)
+{
+ struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ PWR_VREF | PWR_MAIN_BIAS, PWR_VREF | PWR_MAIN_BIAS);
+ schedule_timeout_uninterruptible(msecs_to_jiffies(110));
+ rt5631_write_mask(codec, RT5631_PWR_MANAG_ADD3,
+ PWR_FAST_VREF_CTRL, PWR_FAST_VREF_CTRL);
+ rt5631_reg_init(codec);
+
+ /* power off ClassD auto Recovery */
+ if (rt5631->codec_version)
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0x2000, 0x2000);
+ else
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2,
+ 0, 0x2000);
+
+#if (RT5631_SPK_TIMER == 1)
+ last_is_spk = !last_is_spk; //wired~, update eqmode right here by spk_timer.
+#endif
+
+ return 0;
+}
+
+void codec_set_spk(bool on)
+{
+ struct snd_soc_codec *codec = rt5631_codec;
+
+ DBG("%s: %d\n", __func__, on);
+
+ if(!codec)
+ return;
+
+ if(on){
+ DBG("snd_soc_dapm_enable_pin\n");
+ snd_soc_dapm_enable_pin(&codec->dapm, "Headphone Jack");
+ snd_soc_dapm_enable_pin(&codec->dapm, "Ext Spk");
+ }
+ else{
+
+ DBG("snd_soc_dapm_disable_pin\n");
+ snd_soc_dapm_disable_pin(&codec->dapm, "Headphone Jack");
+ snd_soc_dapm_disable_pin(&codec->dapm, "Ext Spk");
+ }
+
+ snd_soc_dapm_sync(&codec->dapm);
+
+ return;
+}
+
+/*
+ * detect short current for mic1
+ */
+int rt5631_ext_mic_detect(void)
+{
+ struct snd_soc_codec *codec = rt5631_codec;
+ int det;
+
+ rt5631_write_mask(codec, RT5631_MIC_CTRL_2, MICBIAS1_S_C_DET_ENA,
+ MICBIAS1_S_C_DET_MASK);
+ det = rt5631_read(codec, RT5631_INT_ST_IRQ_CTRL_2) & 0x0001;
+ rt5631_write_mask(codec, RT5631_INT_ST_IRQ_CTRL_2, 0x0001, 0x00001);
+
+ return det;
+}
+EXPORT_SYMBOL_GPL(rt5631_ext_mic_detect);
+
+static struct snd_soc_codec_driver soc_codec_dev_rt5631 = {
+ .probe = rt5631_probe,
+ .remove = rt5631_remove,
+ .suspend = rt5631_suspend,
+ .resume = rt5631_resume,
+ .set_bias_level = rt5631_set_bias_level,
+ .reg_cache_size = ARRAY_SIZE(rt5631_reg),
+ .reg_word_size = sizeof(u16),
+ .reg_cache_default = rt5631_reg,
+ .reg_cache_step = 1,
+};
+
+static const struct i2c_device_id rt5631_i2c_id[] = {
+ { "rt5631", 0 },
+ { }
+};
+MODULE_DEVICE_TABLE(i2c, rt5631_i2c_id);
+
+static int rt5631_i2c_probe(struct i2c_client *i2c,
+ const struct i2c_device_id *id)
+{
+ struct rt5631_priv *rt5631;
+ int ret;
+
+ pr_info("RT5631 Audio Codec %s\n", RT5631_VERSION);
+
+ rt5631 = kzalloc(sizeof(struct rt5631_priv), GFP_KERNEL);
+ if (NULL == rt5631)
+ return -ENOMEM;
+
+ i2c_set_clientdata(i2c, rt5631);
+
+ ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5631,
+ rt5631_dai, ARRAY_SIZE(rt5631_dai));
+ if (ret < 0)
+ kfree(rt5631);
+
+ return ret;
+}
+
+static __devexit int rt5631_i2c_remove(struct i2c_client *client)
+{
+ snd_soc_unregister_codec(&client->dev);
+ kfree(i2c_get_clientdata(client));
+ return 0;
+}
+
+struct i2c_driver rt5631_i2c_driver = {
+ .driver = {
+ .name = "RT5631",
+ .owner = THIS_MODULE,
+ },
+ .probe = rt5631_i2c_probe,
+ .remove = __devexit_p(rt5631_i2c_remove),
+ .id_table = rt5631_i2c_id,
+};
+
+static int __init rt5631_modinit(void)
+{
+ return i2c_add_driver(&rt5631_i2c_driver);
+}
+module_init(rt5631_modinit);
+
+static void __exit rt5631_modexit(void)
+{
+ i2c_del_driver(&rt5631_i2c_driver);
+}
+module_exit(rt5631_modexit);
+
+MODULE_DESCRIPTION("ASoC RT5631 driver");
+MODULE_AUTHOR("flove <flove@realtek.com>");
+MODULE_LICENSE("GPL");
projects / firefly-linux-kernel-4.4.55.git / commitdiff