samsung-sm8650/android_kernel_samsung_sm8650-modules
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

asoc: codec: enable impedance for wcd939x

Browse Source 
enable impedance and calculations according to wcd939x.

Change-Id: Id0c2c7ebea6941dadbe501d388bdedc265e93db6
Signed-off-by: Prasad Kumpatla <quic_pkumpatl@quicinc.com>
This commit is contained in:
Prasad Kumpatla
2022-10-17 11:43:35 +05:30
parent 5d647662c7
commit 3117a98c02
2 changed files with 14 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
asoc/codecs/wcd-mbhc-v2.c
View File

@@ -1685,14 +1685,12 @@ static int wcd_mbhc_usbc_ana_event_handler(struct notifier_block *nb,
if (mbhc->mbhc_cb->clk_setup) if (mbhc->mbhc_cb->clk_setup)
mbhc->mbhc_cb->clk_setup(mbhc->component, true); mbhc->mbhc_cb->clk_setup(mbhc->component, true);
/* insertion detected, enable L_DET_EN */
WCD_MBHC_REG_UPDATE_BITS(WCD_MBHC_L_DET_EN, 1);
#if IS_ENABLED(CONFIG_QCOM_WCD_USBSS_I2C) #if IS_ENABLED(CONFIG_QCOM_WCD_USBSS_I2C)
if (unlikely((mbhc->mbhc_cb->lock_sleep(mbhc, true)) == false)) if (unlikely((mbhc->mbhc_cb->lock_sleep(mbhc, true)) == false))
pr_warn("%s: failed to hold suspend\n", __func__); pr_warn("%s: failed to hold suspend\n", __func__);
else { else {
if (mbhc->current_plug != MBHC_PLUG_TYPE_NONE) if (mbhc->current_plug == MBHC_PLUG_TYPE_NONE)
wcd_mbhc_swch_irq_handler(mbhc); wcd_mbhc_swch_irq_handler(mbhc);
mbhc->mbhc_cb->lock_sleep(mbhc, false); mbhc->mbhc_cb->lock_sleep(mbhc, false);
} }

25
asoc/codecs/wcd939x/wcd939x-mbhc.c
View File

@@ -22,7 +22,7 @@
#include "wcd939x-registers.h" #include "wcd939x-registers.h"
#include "internal.h" #include "internal.h"
#define WCD939X_ZDET_SUPPORTED false #define WCD939X_ZDET_SUPPORTED true
/* Z value defined in milliohm */ /* Z value defined in milliohm */
#define WCD939X_ZDET_VAL_32 32000 #define WCD939X_ZDET_VAL_32 32000
#define WCD939X_ZDET_VAL_400 400000 #define WCD939X_ZDET_VAL_400 400000
@@ -35,8 +35,8 @@
#define WCD939X_MBHC_GET_C1(c) ((c & 0xC000) >> 14) #define WCD939X_MBHC_GET_C1(c) ((c & 0xC000) >> 14)
#define WCD939X_MBHC_GET_X1(x) (x & 0x3FFF) #define WCD939X_MBHC_GET_X1(x) (x & 0x3FFF)
/* Z value compared in milliOhm */ /* Z value compared in milliOhm */
#define WCD939X_MBHC_IS_SECOND_RAMP_REQUIRED(z) ((z > 400000) || (z < 32000)) #define WCD939X_MBHC_IS_SECOND_RAMP_REQUIRED(z) false
#define WCD939X_MBHC_ZDET_CONST (86 * 16384) #define WCD939X_MBHC_ZDET_CONST (1018 * 1024)
#define WCD939X_MBHC_MOISTURE_RREF R_24_KOHM #define WCD939X_MBHC_MOISTURE_RREF R_24_KOHM
static struct wcd_mbhc_register static struct wcd_mbhc_register
@@ -451,6 +451,8 @@ static void wcd939x_mbhc_zdet_ramp(struct snd_soc_component *component,
0x0F, zdet_param->noff); 0x0F, zdet_param->noff);
snd_soc_component_update_bits(component, WCD939X_ZDET_RAMP_CTL, snd_soc_component_update_bits(component, WCD939X_ZDET_RAMP_CTL,
0x0F, zdet_param->nshift); 0x0F, zdet_param->nshift);
snd_soc_component_update_bits(component, WCD939X_ZDET_RAMP_CTL,
0x70, 0x60); /*acc1_min_63 */
if (!zl) if (!zl)
goto z_right; goto z_right;
@@ -487,16 +489,12 @@ static inline void wcd939x_wcd_mbhc_qfuse_cal(
s16 q1; s16 q1;
int q1_cal; int q1_cal;
if (*z_val < (WCD939X_ZDET_VAL_400/1000))
q1 = snd_soc_component_read(component, q1 = snd_soc_component_read(component,
WCD939X_EFUSE_REG_23 + (2 * flag_l_r)); WCD939X_EFUSE_REG_21 + flag_l_r);
else
q1 = snd_soc_component_read(component,
WCD939X_EFUSE_REG_24 + (2 * flag_l_r));
if (q1 & 0x80) if (q1 & 0x80)
q1_cal = (10000 - ((q1 & 0x7F) * 25)); q1_cal = (10000 - ((q1 & 0x7F) * 10));
else else
q1_cal = (10000 + (q1 * 25)); q1_cal = (10000 + (q1 * 10));
if (q1_cal > 0) if (q1_cal > 0)
*z_val = ((*z_val) * 10000) / q1_cal; *z_val = ((*z_val) * 10000) / q1_cal;
} }
@@ -512,14 +510,14 @@ static void wcd939x_wcd_mbhc_calc_impedance(struct wcd_mbhc *mbhc, uint32_t *zl,
bool is_fsm_disable = false; bool is_fsm_disable = false;
struct wcd939x_mbhc_zdet_param zdet_param[] = { struct wcd939x_mbhc_zdet_param zdet_param[] = {
{4, 0, 4, 0x08, 0x14, 0x18}, /* < 32ohm */ {4, 0, 4, 0x08, 0x14, 0x18}, /* < 32ohm */
{2, 0, 3, 0x18, 0x7C, 0x90}, /* 32ohm < Z < 400ohm */ {4, 0, 6, 0x18, 0x60, 0x78}, /* 32ohm < Z < 400ohm */
{1, 4, 5, 0x18, 0x7C, 0x90}, /* 400ohm < Z < 1200ohm */ {1, 4, 5, 0x18, 0x7C, 0x90}, /* 400ohm < Z < 1200ohm */
{1, 6, 7, 0x18, 0x7C, 0x90}, /* >1200ohm */ {1, 6, 7, 0x18, 0x7C, 0x90}, /* >1200ohm */
}; };
struct wcd939x_mbhc_zdet_param *zdet_param_ptr = NULL; struct wcd939x_mbhc_zdet_param *zdet_param_ptr = NULL;
s16 d1_a[][4] = { s16 d1_a[][4] = {
{0, 30, 90, 30}, {0, 30, 90, 30},
{0, 30, 30, 5}, {0, 30, 30, 6},
{0, 30, 30, 5}, {0, 30, 30, 5},
{0, 30, 30, 5}, {0, 30, 30, 5},
}; };
@@ -643,9 +641,6 @@ right_ch_impedance:
} }
snd_soc_component_update_bits(component, WCD939X_R_ATEST, 0x02, 0x02); snd_soc_component_update_bits(component, WCD939X_R_ATEST, 0x02, 0x02);
snd_soc_component_update_bits(component, WCD939X_PA_CTL2, 0x40, 0x01); snd_soc_component_update_bits(component, WCD939X_PA_CTL2, 0x40, 0x01);
if (*zl < (WCD939X_ZDET_VAL_32/1000))
wcd939x_mbhc_zdet_ramp(component, &zdet_param[0], &z1Ls, NULL, d1);
else
wcd939x_mbhc_zdet_ramp(component, &zdet_param[1], &z1Ls, NULL, d1); wcd939x_mbhc_zdet_ramp(component, &zdet_param[1], &z1Ls, NULL, d1);
snd_soc_component_update_bits(component, WCD939X_PA_CTL2, 0x40, 0x00); snd_soc_component_update_bits(component, WCD939X_PA_CTL2, 0x40, 0x00);
snd_soc_component_update_bits(component, WCD939X_R_ATEST, 0x02, 0x00); snd_soc_component_update_bits(component, WCD939X_R_ATEST, 0x02, 0x00);