-/*
- * 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 1
-#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 0 //ALC functio for DAC
-#define RT5631_ALC_ADC_FUNC_ENA 1 //ALC function for ADC
-#define RT5631_SPK_TIMER 1 //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;
-
-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 0xc0
-#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_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
-
-#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 , 0x2e00}, //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 {
- 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) {
- config_common_power(codec, false);
- pmu = false;
- }
- break;
-
- case SND_SOC_DAPM_PRE_PMU:
- if (!pmu) {
- 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) {
- config_common_power(codec, false);
- pmu = false;
- }
- break;
-
- case SND_SOC_DAPM_PRE_PMU:
- if (!pmu) {
- 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;
-}
-
-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;
-}
-
-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;
-printk("rt5631_probe\n");
- 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, "Headphone Jack");
- snd_soc_dapm_enable_pin(codec, "Ext Spk");
- }
- else{
-
- DBG("snd_soc_dapm_disable_pin\n");
- snd_soc_dapm_disable_pin(codec, "Headphone Jack");
- snd_soc_dapm_disable_pin(codec, "Ext Spk");
- }
-
- snd_soc_dapm_sync(codec);
-
- 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");
+/*\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 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
+static int gvolume = 0;\r
+#if 1\r
+\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 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
+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
+\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, "Headphone Jack");\r
+ snd_soc_dapm_enable_pin(codec, "Ext Spk");\r
+ }\r
+ else{\r
+\r
+ DBG("snd_soc_dapm_disable_pin\n");\r
+ snd_soc_dapm_disable_pin(codec, "Headphone Jack");\r
+ snd_soc_dapm_disable_pin(codec, "Ext Spk");\r
+ }\r
+\r
+ snd_soc_dapm_sync(codec);\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
projects / firefly-linux-kernel-4.4.55.git / commitdiff