UbiquitousOS
/
OpenCloudOS-Kernel
mirror of https://gitee.com/OpenCloudOS/OpenCloudOS-Kernel.git
11
0
Fork 0
Code Issues Projects Releases Wiki Activity

ASoC: codecs: MBHC: Add support for special headset 

Update MBHC driver to support special headset such as apple
and huwawei headsets.

Signed-off-by: Srinivasa Rao Mandadapu <srivasam@codeaurora.org>
Co-developed-by: Venkata Prasad Potturu <potturu@codeaurora.org>
Signed-off-by: Venkata Prasad Potturu <potturu@codeaurora.org>
Reviewed-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
Link: https://lore.kernel.org/r/1636960288-27537-1-git-send-email-srivasam@codeaurora.org
Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
Srinivasa Rao Mandadapu 2021-11-15 12:41:28 +05:30 committed by Mark Brown
parent 5b59289bfd
commit 3c8a3ad401
No known key found for this signature in database
GPG Key ID: 24D68B725D5487D0
1 changed files with 71 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

75
sound/soc/codecs/wcd-mbhc-v2.c
View File

@ -1022,6 +1022,56 @@ static int wcd_mbhc_get_plug_from_adc(struct wcd_mbhc *mbhc, int adc_result)
return plug_type; return plug_type;
} }
static int wcd_mbhc_get_spl_hs_thres(struct wcd_mbhc *mbhc)
{
int hs_threshold, micbias_mv;
micbias_mv = wcd_mbhc_get_micbias(mbhc);
if (mbhc->cfg->hs_thr && mbhc->cfg->micb_mv != WCD_MBHC_ADC_MICBIAS_MV) {
if (mbhc->cfg->micb_mv == micbias_mv)
hs_threshold = mbhc->cfg->hs_thr;
else
hs_threshold = (mbhc->cfg->hs_thr * micbias_mv) / mbhc->cfg->micb_mv;
} else {
hs_threshold = ((WCD_MBHC_ADC_HS_THRESHOLD_MV * micbias_mv) /
WCD_MBHC_ADC_MICBIAS_MV);
}
return hs_threshold;
}
static bool wcd_mbhc_check_for_spl_headset(struct wcd_mbhc *mbhc)
{
bool is_spl_hs = false;
int output_mv, hs_threshold, hph_threshold;
if (!mbhc->mbhc_cb->mbhc_micb_ctrl_thr_mic)
return false;
/* Bump up MIC_BIAS2 to 2.7V */
mbhc->mbhc_cb->mbhc_micb_ctrl_thr_mic(mbhc->component, MIC_BIAS_2, true);
usleep_range(10000, 10100);
output_mv = wcd_measure_adc_once(mbhc, MUX_CTL_IN2P);
hs_threshold = wcd_mbhc_get_spl_hs_thres(mbhc);
hph_threshold = wcd_mbhc_adc_get_hph_thres(mbhc);
if (output_mv > hs_threshold || output_mv < hph_threshold) {
if (mbhc->force_linein == true)
is_spl_hs = false;
} else {
is_spl_hs = true;
}
/* Back MIC_BIAS2 to 1.8v if the type is not special headset */
if (!is_spl_hs) {
mbhc->mbhc_cb->mbhc_micb_ctrl_thr_mic(mbhc->component, MIC_BIAS_2, false);
/* Add 10ms delay for micbias to settle */
usleep_range(10000, 10100);
}
return is_spl_hs;
}
static void wcd_correct_swch_plug(struct work_struct *work) static void wcd_correct_swch_plug(struct work_struct *work)
{ {
struct wcd_mbhc *mbhc; struct wcd_mbhc *mbhc;
@ -1029,12 +1079,14 @@ static void wcd_correct_swch_plug(struct work_struct *work)
enum wcd_mbhc_plug_type plug_type = MBHC_PLUG_TYPE_INVALID; enum wcd_mbhc_plug_type plug_type = MBHC_PLUG_TYPE_INVALID;
unsigned long timeout; unsigned long timeout;
int pt_gnd_mic_swap_cnt = 0; int pt_gnd_mic_swap_cnt = 0;
int output_mv, cross_conn, hs_threshold, try = 0; int output_mv, cross_conn, hs_threshold, try = 0, micbias_mv;
bool is_spl_hs = false;
bool is_pa_on; bool is_pa_on;
mbhc = container_of(work, struct wcd_mbhc, correct_plug_swch); mbhc = container_of(work, struct wcd_mbhc, correct_plug_swch);
component = mbhc->component; component = mbhc->component;
micbias_mv = wcd_mbhc_get_micbias(mbhc);
hs_threshold = wcd_mbhc_adc_get_hs_thres(mbhc); hs_threshold = wcd_mbhc_adc_get_hs_thres(mbhc);
/* Mask ADC COMPLETE interrupt */ /* Mask ADC COMPLETE interrupt */
@ -1097,6 +1149,16 @@ correct_plug_type:
plug_type = wcd_mbhc_get_plug_from_adc(mbhc, output_mv); plug_type = wcd_mbhc_get_plug_from_adc(mbhc, output_mv);
is_pa_on = wcd_mbhc_read_field(mbhc, WCD_MBHC_HPH_PA_EN); is_pa_on = wcd_mbhc_read_field(mbhc, WCD_MBHC_HPH_PA_EN);
if ((output_mv > hs_threshold) && (!is_spl_hs)) {
is_spl_hs = wcd_mbhc_check_for_spl_headset(mbhc);
output_mv = wcd_measure_adc_once(mbhc, MUX_CTL_IN2P);
if (is_spl_hs) {
hs_threshold = (hs_threshold * wcd_mbhc_get_micbias(mbhc)) /
micbias_mv;
}
}
if ((output_mv <= hs_threshold) && !is_pa_on) { if ((output_mv <= hs_threshold) && !is_pa_on) {
/* Check for cross connection*/ /* Check for cross connection*/
cross_conn = wcd_check_cross_conn(mbhc); cross_conn = wcd_check_cross_conn(mbhc);
@ -1122,14 +1184,19 @@ correct_plug_type:
} }
} }
if (output_mv > hs_threshold) /* cable is extension cable */ /* cable is extension cable */
if (output_mv > hs_threshold || mbhc->force_linein == true)
plug_type = MBHC_PLUG_TYPE_HIGH_HPH; plug_type = MBHC_PLUG_TYPE_HIGH_HPH;
} }
wcd_mbhc_bcs_enable(mbhc, plug_type, true); wcd_mbhc_bcs_enable(mbhc, plug_type, true);
if (plug_type == MBHC_PLUG_TYPE_HIGH_HPH) if (plug_type == MBHC_PLUG_TYPE_HIGH_HPH) {
wcd_mbhc_write_field(mbhc, WCD_MBHC_ELECT_ISRC_EN, 1); if (is_spl_hs)
plug_type = MBHC_PLUG_TYPE_HEADSET;
else
wcd_mbhc_write_field(mbhc, WCD_MBHC_ELECT_ISRC_EN, 1);
}
wcd_mbhc_write_field(mbhc, WCD_MBHC_ADC_MODE, 0); wcd_mbhc_write_field(mbhc, WCD_MBHC_ADC_MODE, 0);
wcd_mbhc_write_field(mbhc, WCD_MBHC_ADC_EN, 0); wcd_mbhc_write_field(mbhc, WCD_MBHC_ADC_EN, 0);