static int hi6402_read_saradc_value_detect(struct hi6402_mbhc_platform_data *pdata)
{
	int retry = 3;
	int reg_value = 0;

	BUG_ON(NULL == pdata->p_irq);

	mutex_lock(&pdata->saradc_mutex);

	/* saradc on */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_ANA_REG60, HI6402_SARADC_PD_BIT);
	/* start saradc */
	hi6402_reg_set_bit(pdata->p_irq, HI6402_ANA_REG60, HI6402_SAR_START_BIT);

	while(retry--) {
		usleep_range(1000, 1100);
		if (check_saradc_value_ready_detect(pdata)) {
			reg_value = hi6402_irq_read(pdata->p_irq, HI6402_SARADC_VALUE_REG);
			pr_info("%s : saradc value is %#x\n", __FUNCTION__, reg_value);
			break;
		}
	}

	if (0 > retry)
		pr_err("%s : get saradc value err, set as 0\n", __FUNCTION__);

	/* end saradc */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_ANA_REG60, HI6402_SAR_START_BIT);
	/* saradc pd */
	hi6402_reg_set_bit(pdata->p_irq, HI6402_ANA_REG60, HI6402_SARADC_PD_BIT);

	mutex_unlock(&pdata->saradc_mutex);

	return GET_VOLTAGE(reg_value);
}
static irqreturn_t hi6402_plugout_handler(int irq, void *data)
{
	struct hi6402_mbhc_platform_data *pdata =
			(struct hi6402_mbhc_platform_data *)data;

	BUG_ON(NULL == pdata);

	if (check_headset_pluged_in(pdata)) {
		pr_info("%s : hs still plugin \n", __FUNCTION__);
		return IRQ_HANDLED;
	}

	mutex_lock(&pdata->plug_mutex);

	hi6402_irq_cancel_delay_work(pdata->p_irq);

	hi6402_irq_mask_btn_irqs(pdata->p_irq);
	//stop charge first
	anc_hs_stop_charge();

	/* eco off */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_MICBIAS_ECO_REG, HI6402_MICBIAS_ECO_ON_BIT);

	mutex_lock(&pdata->p_irq->hs_micbias_mutex);
	/* hs micbias off */
	pdata->p_irq->mbhc_micbias_work = false;
	pdata->p_irq->dapm_micbias_work = false;
	mutex_unlock(&pdata->p_irq->hs_micbias_mutex);
	hi6402_irq_hs_micbias_enable(pdata->p_irq, false);

	hi6402_irq_clr_btn_irqs(pdata->p_irq);

	hi6402_irq_mask_btn_irqs(pdata->p_irq);

	/* eco off */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_MICBIAS_ECO_REG, HI6402_MICBIAS_ECO_ON_BIT);
	pr_info("%s : eco disable \n", __FUNCTION__);
	/* vref off */
	hi6402_reg_set_bit(pdata->p_irq, HI6402_MBHC_VREF_REG, HI6402_MBHC_VREF_BIT);
	/* mbhc cmp off */
	hi6402_reg_set_bit(pdata->p_irq, HI6402_ANA_REG60, HI6402_MBHC_ON_BIT);

	mutex_lock(&pdata->status_mutex);
	pdata->hs_status = HISI_JACK_NONE;
	pdata->btn_report = 0;
	mutex_unlock(&pdata->status_mutex);

	hi6402_jack_report(pdata);

	hi6402_mbhc_enable_ldo8(pdata, false);

	mutex_unlock(&pdata->plug_mutex);

	return IRQ_HANDLED;
}
void hi6402_mbhc_on(struct hi6402_mbhc_platform_data *pdata)
{
	/* open mbhc */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_MBHC_VREF_REG, HI6402_MBHC_VREF_BIT);
	/* saradc cfg */
	hi6402_irq_write(pdata->p_irq, HI6402_SAR_CFG_REG, 0x7C);
	/* mbhc on */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_ANA_REG60, HI6402_MBHC_ON_BIT);
	msleep(150);

	return;
}
void hi6402_plug_out_workfunc(struct work_struct *work)
{
	struct hi6402_mbhc_platform_data *pdata = container_of(work,
			struct hi6402_mbhc_platform_data,
			headset_plug_out_delay_work.work);

	pr_info("%s : hs pluged out\n", __FUNCTION__);

	BUG_ON(NULL == pdata);

	wake_lock(&pdata->wake_lock);
	mutex_lock(&pdata->plug_mutex);

	mask_irq(pdata->irq[HI6402_IRQ_BTNDOWN_COMP1], true);
	mask_irq(pdata->irq[HI6402_IRQ_BTNUP_COMP1], true);
	mask_irq(pdata->irq[HI6402_IRQ_BTNDOWN_ECO], true);
	/* todo */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_MICBIAS_ECO_REG, 0);
	hi6402_reg_set_bit(pdata->p_irq, HI6402_MBHC_VREF_REG, 7);

	mutex_lock(&pdata->status_mutex);
	pdata->hs_status = HISI_JACK_NONE;
	pdata->btn_report = 0;
	mutex_unlock(&pdata->status_mutex);

	hi6402_jack_report(pdata);

	mutex_unlock(&pdata->plug_mutex);
	wake_unlock(&pdata->wake_lock);

	/* unmask plugin interrupt */
	mask_irq(pdata->irq[HI6402_IRQ_PLUGIN], false);
}
void hi6402_plug_in_detect(struct hi6402_mbhc_platform_data *pdata)
{
	if (!check_headset_pluged_in(pdata))
		return;

	wake_lock(&pdata->wake_lock);
	mutex_lock(&pdata->plug_mutex);

	mutex_lock(&pdata->status_mutex);
	/* todo : btn_report 4-pole headset only now */
	pdata->hs_status = HISI_JACK_HEADSET;
	pdata->btn_report = SND_JACK_HEADSET;
	mutex_unlock(&pdata->status_mutex);

	hi6402_jack_report(pdata);

	/* todo */
	hi6402_reg_clr_bit(pdata->p_irq, HI6402_MBHC_VREF_REG, 7);
	hi6402_reg_set_bit(pdata->p_irq, HI6402_MICBIAS_ECO_REG, 0);

	/* unmask btn down irq */
	mask_irq(pdata->irq[HI6402_IRQ_BTNDOWN_COMP1], false);
	mask_irq(pdata->irq[HI6402_IRQ_BTNDOWN_ECO], false);

	mutex_unlock(&pdata->plug_mutex);
	wake_unlock(&pdata->wake_lock);
}