static void wcd9xxx_clsh_state_hph_r(struct snd_soc_codec *codec,
struct wcd9xxx_clsh_cdc_data *clsh_d,
u8 req_state, bool is_enable)
{
pr_debug("%s: enter %s, state %d, req_state %d\n", __func__,
is_enable ? "enable" : "disable", clsh_d->state,
req_state);
if (is_enable) {
wcd9xxx_cfg_clsh_param_common(codec);
wcd9xxx_cfg_clsh_param_hph(codec);
wcd9xxx_enable_clsh_block(codec, clsh_d, true);
wcd9xxx_chargepump_request(codec, true);
wcd9xxx_enable_anc_delay(codec, true);
wcd9xxx_clsh_comp_req(codec, clsh_d, CLSH_COMPUTE_HPH_R, true);
wcd9xxx_set_buck_mode(codec, BUCK_VREF_0P494V);
wcd9xxx_enable_buck(codec, clsh_d, true);
wcd9xxx_set_fclk_get_ncp(codec, clsh_d, NCP_FCLK_LEVEL_8);
dev_dbg(codec->dev, "%s: Done\n", __func__);
} else {
wcd9xxx_set_fclk_put_ncp(codec, clsh_d, NCP_FCLK_LEVEL_8);
wcd9xxx_enable_buck(codec, clsh_d, false);
wcd9xxx_clsh_comp_req(codec, clsh_d, CLSH_COMPUTE_HPH_R, false);
wcd9xxx_chargepump_request(codec, false);
wcd9xxx_enable_clsh_block(codec, clsh_d, false);
}
}
static void wcd9xxx_clsh_state_ear(struct snd_soc_codec *codec,
struct wcd9xxx_clsh_cdc_data *clsh_d,
u8 req_state, bool is_enable)
{
pr_debug("%s: enter %s\n", __func__, is_enable ? "enable" : "disable");
if (is_enable) {
wcd9xxx_cfg_clsh_param_common(codec);
wcd9xxx_cfg_clsh_param_ear(codec);
wcd9xxx_enable_clsh_block(codec, clsh_d, true);
wcd9xxx_chargepump_request(codec, true);
wcd9xxx_enable_anc_delay(codec, true);
wcd9xxx_clsh_comp_req(codec, clsh_d, CLSH_COMPUTE_EAR, true);
wcd9xxx_set_buck_mode(codec, BUCK_VREF_2V);
wcd9xxx_enable_buck(codec, clsh_d, true);
wcd9xxx_set_fclk_get_ncp(codec, clsh_d, NCP_FCLK_LEVEL_8);
dev_dbg(codec->dev, "%s: Enabled ear mode class h\n", __func__);
} else {
dev_dbg(codec->dev, "%s: stub fallback to ear\n", __func__);
wcd9xxx_set_fclk_put_ncp(codec, clsh_d, NCP_FCLK_LEVEL_8);
wcd9xxx_enable_buck(codec, clsh_d, false);
#ifdef CONFIG_MACH_URSA
wcd9xxx_clsh_comp_req(codec, clsh_d, CLSH_COMPUTE_EAR, false);
#else
wcd9xxx_clsh_comp_req(codec, clsh_d, CLSH_COMPUTE_EAR, true);
#endif
wcd9xxx_chargepump_request(codec, false);
wcd9xxx_enable_clsh_block(codec, clsh_d, false);
}
}
static void wcd9xxx_clsh_state_lo(struct snd_soc_codec *codec,
struct wcd9xxx_clsh_cdc_data *clsh_d,
u8 req_state, bool is_enable)
{
/* TODO. Read from device tree */
clsh_d->buck_mv = WCD9XXX_CDC_BUCK_MV_2P15;
if (is_enable) {
wcd9xxx_set_buck_mode(codec, BUCK_VREF_1P8V);
wcd9xxx_enable_buck(codec, clsh_d, true);
wcd9xxx_set_fclk_get_ncp(codec, clsh_d, NCP_FCLK_LEVEL_5);
if (clsh_d->buck_mv == WCD9XXX_CDC_BUCK_MV_1P8) {
wcd9xxx_enable_buck(codec, clsh_d, false);
snd_soc_update_bits(codec, WCD9XXX_A_NCP_STATIC,
1 << 4, 1 << 4);
msleep(NCP_SETTLE_TIME_US);
} else {
msleep(NCP_SETTLE_TIME_US);
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_5,
0x01, 0x01);
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_5,
0xFB, (0x02 << 2));
}
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_1, 0x04, 0x00);
} else {
dev_dbg(codec->dev, "%s: stub fallback to lineout\n", __func__);
wcd9xxx_set_fclk_put_ncp(codec, clsh_d, NCP_FCLK_LEVEL_5);
if (clsh_d->buck_mv != WCD9XXX_CDC_BUCK_MV_1P8)
wcd9xxx_enable_buck(codec, clsh_d, false);
}
}
static void wcd9xxx_clsh_state_ear(struct snd_soc_codec *codec,
struct wcd9xxx_clsh_cdc_data *clsh_d,
u8 req_state, bool is_enable)
{
if (is_enable) {
wcd9xxx_cfg_clsh_param_common(codec);
wcd9xxx_cfg_clsh_param_ear(codec);
wcd9xxx_enable_clsh_block(codec, clsh_d, true);
wcd9xxx_chargepump_request(codec, true);
wcd9xxx_enable_anc_delay(codec, true);
wcd9xxx_clsh_computation_request(codec,
CLSH_COMPUTE_EAR, true);
wcd9xxx_set_buck_mode(codec, BUCK_VREF_2V);
wcd9xxx_enable_buck(codec, clsh_d, true);
wcd9xxx_set_fclk_get_ncp(codec, clsh_d, NCP_FCLK_LEVEL_8);
dev_dbg(codec->dev, "%s: Enabled ear mode class h\n", __func__);
} else {
dev_dbg(codec->dev, "%s: stub fallback to ear\n", __func__);
wcd9xxx_set_fclk_put_ncp(codec, clsh_d, NCP_FCLK_LEVEL_8);
wcd9xxx_enable_buck(codec, clsh_d, false);
wcd9xxx_clsh_computation_request(codec,
CLSH_COMPUTE_EAR, true);
wcd9xxx_chargepump_request(codec, false);
wcd9xxx_enable_clsh_block(codec, clsh_d, false);
}
}
static void wcd9xxx_clsh_state_ear_lo(struct snd_soc_codec *codec,
struct wcd9xxx_clsh_cdc_data *clsh_d,
u8 req_state, bool is_enable)
{
dev_dbg(codec->dev, "%s: enter %s\n", __func__,
is_enable ? "enable" : "disable");
if (is_enable) {
wcd9xxx_dynamic_bypass_buck_ctrl(codec, false);
wcd9xxx_enable_buck(codec, clsh_d, true);
if (req_state & WCD9XXX_CLSH_STATE_EAR) {
wcd9xxx_set_fclk_get_ncp(codec, clsh_d,
NCP_FCLK_LEVEL_8);
wcd9xxx_ncp_bypass_enable(codec, true);
wcd9xxx_enable_clsh_block(codec, clsh_d, true);
wcd9xxx_chargepump_request(codec, true);
wcd9xxx_enable_anc_delay(codec, true);
wcd9xxx_clsh_comp_req(codec, clsh_d,
CLSH_COMPUTE_EAR, true);
}
} else {
wcd9xxx_set_fclk_put_ncp(codec, clsh_d, NCP_FCLK_LEVEL_8);
wcd9xxx_ncp_bypass_enable(codec, false);
if (req_state & WCD9XXX_CLSH_STATE_LO) {
snd_soc_update_bits(codec, WCD9XXX_A_NCP_STATIC,
0x20, 0x00);
wcd9xxx_dynamic_bypass_buck_ctrl(codec, true);
} else if (req_state & WCD9XXX_CLSH_STATE_EAR) {
wcd9xxx_clsh_comp_req(codec, clsh_d, CLSH_COMPUTE_EAR,
false);
/*sleep 5ms*/
if (clsh_d->buck_mv == WCD9XXX_CDC_BUCK_MV_1P8) {
wcd9xxx_enable_buck(codec, clsh_d, false);
wcd9xxx_ncp_bypass_enable(codec, true);
} else {
/* NCP settle time recommended by codec spec */
usleep_range(NCP_SETTLE_TIME_US,
NCP_SETTLE_TIME_US + 10);
wcd9xxx_clsh_set_Iest(codec, 0x02);
}
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_1,
0x04, 0x00);
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_4,
0xFF, BUCK_VREF_1P8V);
}
}
}
static void wcd9xxx_clsh_state_lo(struct snd_soc_codec *codec,
struct wcd9xxx_clsh_cdc_data *clsh_d,
u8 req_state, bool is_enable)
{
pr_debug("%s: enter %s, buck_mv %d\n", __func__,
is_enable ? "enable" : "disable", clsh_d->buck_mv);
if (is_enable) {
wcd9xxx_set_buck_mode(codec, BUCK_VREF_1P8V);
wcd9xxx_enable_buck(codec, clsh_d, true);
wcd9xxx_set_fclk_get_ncp(codec, clsh_d, NCP_FCLK_LEVEL_5);
if (clsh_d->buck_mv == WCD9XXX_CDC_BUCK_MV_1P8) {
wcd9xxx_enable_buck(codec, clsh_d, false);
snd_soc_update_bits(codec, WCD9XXX_A_NCP_STATIC,
1 << 4, 1 << 4);
/* NCP settle time recommended by codec specification */
usleep_range(NCP_SETTLE_TIME_US,
NCP_SETTLE_TIME_US + 10);
} else {
/* NCP settle time recommended by codec specification */
usleep_range(NCP_SETTLE_TIME_US,
NCP_SETTLE_TIME_US + 10);
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_5,
0x01, (0x01 & 0x03));
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_5,
0xFC, (0xFC & 0xB));
}
snd_soc_update_bits(codec, WCD9XXX_A_BUCK_MODE_1, 0x04, 0x00);
} else {
dev_dbg(codec->dev, "%s: stub fallback to lineout\n", __func__);
wcd9xxx_set_fclk_put_ncp(codec, clsh_d, NCP_FCLK_LEVEL_5);
if (clsh_d->buck_mv != WCD9XXX_CDC_BUCK_MV_1P8)
wcd9xxx_enable_buck(codec, clsh_d, false);
}
}
static void wcd9xxx_clsh_state_hph_lo(struct snd_soc_codec *codec,
struct wcd9xxx_clsh_cdc_data *clsh_d,
u8 req_state, bool is_enable)
{
dev_dbg(codec->dev, "%s: enter %s\n", __func__,
is_enable ? "enable" : "disable");
if (is_enable) {
if ((clsh_d->state == WCD9XXX_CLSH_STATE_LO) ||
(req_state == WCD9XXX_CLSH_STATE_LO)) {
wcd9xxx_dynamic_bypass_buck_ctrl(codec, false);
wcd9xxx_enable_buck(codec, clsh_d, true);
wcd9xxx_set_fclk_get_ncp(codec, clsh_d,
NCP_FCLK_LEVEL_8);
if (req_state & WCD9XXX_CLSH_STATE_HPH_ST) {
wcd9xxx_ncp_bypass_enable(codec, true);
wcd9xxx_enable_clsh_block(codec, clsh_d, true);
wcd9xxx_chargepump_request(codec, true);
wcd9xxx_enable_anc_delay(codec, true);
}
}
if (req_state == WCD9XXX_CLSH_STATE_HPHL)
wcd9xxx_clsh_comp_req(codec, clsh_d,
CLSH_COMPUTE_HPH_L, true);
if (req_state == WCD9XXX_CLSH_STATE_HPHR)
wcd9xxx_clsh_comp_req(codec, clsh_d,
CLSH_COMPUTE_HPH_R, true);
} else {
switch (req_state) {
case WCD9XXX_CLSH_STATE_LO:
snd_soc_update_bits(codec, WCD9XXX_A_NCP_STATIC,
0x20, 0x00);
wcd9xxx_dynamic_bypass_buck_ctrl(codec, true);
break;
case WCD9XXX_CLSH_STATE_HPHL:
wcd9xxx_clsh_comp_req(codec, clsh_d,
CLSH_COMPUTE_HPH_L, false);
break;
case WCD9XXX_CLSH_STATE_HPHR:
wcd9xxx_clsh_comp_req(codec, clsh_d,
CLSH_COMPUTE_HPH_R, false);
break;
default:
dev_dbg(codec->dev,
"%s:Invalid state:0x%x,enable:0x%x\n",
__func__, req_state, is_enable);
break;
}
if ((req_state == WCD9XXX_CLSH_STATE_LO) ||
((clsh_d->state & (~req_state)) == WCD9XXX_CLSH_STATE_LO)) {
wcd9xxx_set_fclk_put_ncp(codec, clsh_d,
NCP_FCLK_LEVEL_8);
wcd9xxx_ncp_bypass_enable(codec, false);
if (req_state & WCD9XXX_CLSH_STATE_HPH_ST) {
usleep_range(BUCK_SETTLE_TIME_US,
BUCK_SETTLE_TIME_US + 10);
if (clsh_d->buck_mv ==
WCD9XXX_CDC_BUCK_MV_1P8) {
wcd9xxx_enable_buck(codec, clsh_d,
false);
wcd9xxx_ncp_bypass_enable(codec, true);
} else {
/*
*NCP settle time recommended by codec
*specification
*/
usleep_range(NCP_SETTLE_TIME_US,
NCP_SETTLE_TIME_US + 10);
wcd9xxx_clsh_set_Iest(codec, 0x02);
}
snd_soc_update_bits(codec,
WCD9XXX_A_BUCK_MODE_1,
0x04, 0x00);
snd_soc_update_bits(codec,
WCD9XXX_A_BUCK_MODE_4,
0xFF, BUCK_VREF_1P8V);
}
}
}
}
