mtk-lk/platform/mt6763/mt_battery.c

/* Copyright Statement:
*
* This software/firmware and related documentation ("MediaTek Software") are
* protected under relevant copyright laws. The information contained herein
* is confidential and proprietary to MediaTek Inc. and/or its licensors.
* Without the prior written permission of MediaTek inc. and/or its licensors,
* any reproduction, modification, use or disclosure of MediaTek Software,
* and information contained herein, in whole or in part, shall be strictly prohibited.
*/
/* MediaTek Inc. (C) 2015. All rights reserved.
*
* BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
* THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
* RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
* AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
* NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
* SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
* SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
* THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
* THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
* CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
* SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
* STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
* CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
* AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
* OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
* MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
*/

#include <target/board.h>
#ifdef MTK_KERNEL_POWER_OFF_CHARGING
#define CFG_POWER_CHARGING
#endif
#ifdef CFG_POWER_CHARGING
#include <platform/mt_typedefs.h>
#include <platform/mt_reg_base.h>
#include <platform/mt_pmic.h>
#include <platform/upmu_hw.h>
#include <platform/upmu_common.h>
#include <platform/boot_mode.h>
#include <platform/mt_gpio.h>
#include <platform/mt_gpt.h>
#include <platform/mt_rtc.h>
#include <platform/mt_rtc_hw.h>
#include <platform/mt_pmic_wrap_init.h>
#include <platform/mt_pumpexpress.h>
//#include <platform/mt_disp_drv.h>
//#include <platform/mtk_wdt.h>
//#include <platform/mtk_key.h>
//#include <platform/mt_logo.h>
#include <platform/mt_leds.h>
#include <printf.h>
#include <sys/types.h>
#include <target/cust_battery.h>

#if defined(MTK_BQ24261_SUPPORT)
#include <platform/bq24261.h>
#endif

#if defined(MTK_BQ24296_SUPPORT)
#include <platform/bq24296.h>
#endif

#if defined(MTK_NCP1854_SUPPORT)
#include <platform/ncp1854.h>
#endif

#if defined(MTK_BQ25896_SUPPORT)
#include <platform/bq25890.h>
#endif

#ifdef MTK_CHARGER_INTERFACE
#include <platform/mtk_charger_intf.h>
static struct mtk_charger_info *primary_mchr;
#endif

#define DLPT_FEATURE_SUPPORT

#define V_CHARGER_MAX 6500              // 6.5 V

#undef printf


/*****************************************************************************
 *  Type define
 ****************************************************************************/
#if defined(CUST_BATTERY_LOWVOL_THRESOLD)
#define BATTERY_LOWVOL_THRESOLD CUST_BATTERY_LOWVOL_THRESOLD
#else
#define BATTERY_LOWVOL_THRESOLD             3450
#endif

/*****************************************************************************
 *  Global Variable
 ****************************************************************************/
bool g_boot_reason_change = false;
kal_uint32 ptim_bat_vol=0;
kal_int32  ptim_R_curr=0;
static unsigned int count_time_out_adc_imp = 36;

kal_bool g_fg_is_charging = 0;
extern signed int fg_swocv_v;
extern signed int fg_swocv_i;
extern int shutdown_time;
extern int boot_voltage;
extern BOOT_ARGUMENT *g_boot_arg;

/* battery meter parameter */
#define UNIT_FGCURRENT     (314331)
#define CAR_TUNE_VALUE      1000 //1.00
#define R_FG_VALUE          100

#if defined(STD_AC_LARGE_CURRENT)
int g_std_ac_large_current_en=1;
#else
int g_std_ac_large_current_en=0;
#endif

/*****************************************************************************
 *  Externl Variable
 ****************************************************************************/
extern bool g_boot_menu;
extern void mtk_wdt_restart(void);
extern BOOL meta_mode_check(void);

int get_bat_volt(int times)
{
	int bat_vol;
#if defined(SWCHR_POWER_PATH)
		bat_vol = get_i_sense_volt(times);
#else
		bat_vol = get_bat_sense_volt(times);
#endif
	return bat_vol;
}

void kick_charger_wdt(void)
{
	/*
	//mt6325_upmu_set_rg_chrwdt_td(0x0);           // CHRWDT_TD, 4s
	mt6325_upmu_set_rg_chrwdt_td(0x3);           // CHRWDT_TD, 32s for keep charging for lk to kernel
	mt6325_upmu_set_rg_chrwdt_wr(1);             // CHRWDT_WR
	mt6325_upmu_set_rg_chrwdt_int_en(1);         // CHRWDT_INT_EN
	mt6325_upmu_set_rg_chrwdt_en(1);             // CHRWDT_EN
	mt6325_upmu_set_rg_chrwdt_flag_wr(1);        // CHRWDT_WR
	*/

	pmic_set_register_value(PMIC_RG_CHRWDT_TD,3);  // CHRWDT_TD, 32s for keep charging for lk to kernel
	pmic_set_register_value(PMIC_RG_CHRWDT_WR,1); // CHRWDT_WR
	pmic_set_register_value(PMIC_RG_INT_EN_WATCHDOG,1);    // CHRWDT_INT_EN
	pmic_set_register_value(PMIC_RG_CHRWDT_EN,1);        // CHRWDT_EN
	/* pmic_set_register_value(PMIC_RG_CHRWDT_FLAG_WR,1);// CHRWDT_WR */
}

#if defined(MTK_BATLOWV_NO_PANEL_ON_EARLY)
kal_bool is_low_battery(kal_int32  val)
{
	static UINT8 g_bat_low = 0xFF;

	//low battery only justice once in lk
	if (0xFF != g_bat_low)
		return g_bat_low;
	else
		g_bat_low = FALSE;

#if defined(SWCHR_POWER_PATH)
	if (0 == val)
		val = get_i_sense_volt(1);
#else
	if (0 == val)
		val = get_bat_sense_volt(1);
#endif

	if (val < BATTERY_LOWVOL_THRESOLD) {
		dprintf(INFO, "%s, TRUE\n", __FUNCTION__);
		g_bat_low = 0x1;
	}

	if (FALSE == g_bat_low)
		dprintf(INFO, "%s, FALSE\n", __FUNCTION__);

	return g_bat_low;
}
#endif

void pchr_turn_on_charging(kal_bool bEnable)
{
#ifdef MTK_CHARGER_INTERFACE
	int ret = 0;
	bool enable = bEnable ? true : false;
#endif
	pmic_set_register_value(PMIC_RG_USBDL_RST,1);//force leave USBDL mode
	//mt6325_upmu_set_rg_usbdl_rst(1);       //force leave USBDL mode
	pmic_set_register_value(PMIC_RG_BC11_RST,1);//BC11_RST
	kick_charger_wdt();

	pmic_set_register_value(PMIC_RG_CS_VTH,0xC);    // CS_VTH, 450mA
	//mt6325_upmu_set_rg_cs_vth(0xC);             // CS_VTH, 450mA
	pmic_set_register_value(PMIC_RG_CSDAC_EN,bEnable);
	//mt6325_upmu_set_rg_csdac_en(1);               // CSDAC_EN
	pmic_set_register_value(PMIC_RG_CHR_EN,bEnable);
	//mt6325_upmu_set_rg_chr_en(1);             // CHR_EN

	pmic_set_register_value(PMIC_RG_CSDAC_MODE,1);//CSDAC_MODE
	pmic_set_register_value(PMIC_RG_CSDAC_EN,1);

#if defined(MTK_BQ24261_SUPPORT)
	bq24261_hw_init();
	bq24261_charging_enable(bEnable);
	bq24261_dump_register();
#endif

#if defined(MTK_BQ24296_SUPPORT)
	bq24296_hw_init();
	bq24296_charging_enable(bEnable);
	bq24296_dump_register();
#endif

#if defined(MTK_NCP1854_SUPPORT)
	ncp1854_hw_init();
	ncp1854_charging_enable(bEnable);
	ncp1854_dump_register();
#endif

#if defined(MTK_BQ25896_SUPPORT)
	bq25890_hw_init();
	bq25890_charging_enable(bEnable);
	bq25890_dump_register();
#endif

#ifdef MTK_CHARGER_INTERFACE
	if (meta_mode_check()) {
		ret = mtk_charger_set_aicr(primary_mchr, 200);
		if (ret < 0)
			dprintf(CRITICAL, "%s: set aicr failed, ret = %d\n",
				__func__, ret);

		dprintf(CRITICAL, "Set AICR to 200mA in META mode\n");
	}

	ret = mtk_charger_enable_charging(primary_mchr, enable);
	if (ret < 0)
		dprintf(CRITICAL, "%s: %s charging failed, ret = %d\n",
			__func__, (enable ? "enable" : "disable"), ret);
	mtk_charger_dump_register(primary_mchr);
	if (ret < 0)
		dprintf(CRITICAL, "%s: dump register failed, ret = %d\n",
			__func__, ret);
#endif
}

void pchr_turn_off_charging(void)
{
	pmic_set_register_value(PMIC_RG_INT_EN_WATCHDOG,0);
	pmic_set_register_value(PMIC_RG_CHRWDT_EN,0);// CHRWDT_EN
	/* pmic_set_register_value(PMIC_RG_CHRWDT_FLAG_WR,0);// CHRWDT_FLAG */
	pmic_set_register_value(PMIC_RG_CSDAC_EN,0);// CSDAC_EN
	pmic_set_register_value(PMIC_RG_CHR_EN,0);// CHR_EN
	pmic_set_register_value(PMIC_RG_HWCV_EN,0);// RG_HWCV_EN
}

/*
*   Switch Charger Power Path switch
*/
void switch_charger_power_path_enable(kal_bool enable)
{
#if defined(MTK_BQ25896_SUPPORT)
	if (enable == KAL_TRUE) {
		bq25890_set_FORCE_VINDPM(1);
		bq25890_set_VINDPM(0x14);
	} else {
		bq25890_set_FORCE_VINDPM(1);
		bq25890_set_VINDPM(0x7F);
	}
#elif defined(MTK_CHARGER_INTERFACE)
	int ret = 0;
	bool _enable = enable ? true : false;

	ret = mtk_charger_enable_power_path(primary_mchr, _enable);
	if (ret < 0)
		dprintf(CRITICAL, "%s: %s power path failed, ret = %d\n",
			__func__, (_enable ? "enable" : "disable"), ret);
#endif
}

int is_charging = 0;
int fix_coverity = 0;

/*
* enter this function when low battery with charger
* For BQ25896, power path support can provide current and voltage for cell phone to boot directly to kernel.
*/
void check_bat_protect_status()
{
	kal_int32 bat_val = 0;
	int current,chr_volt,cnt=0,i;

#if defined(SWCHR_POWER_PATH)
	bat_val = get_i_sense_volt(5);
#else
	bat_val = get_bat_sense_volt(5);
#endif

	dprintf(CRITICAL, "[%s]: check VBAT=%d mV with %d mV, start charging... \n", __FUNCTION__, bat_val, BATTERY_LOWVOL_THRESOLD);

	if (bat_val == 56789)
		fix_coverity = 1;

	while (bat_val < BATTERY_LOWVOL_THRESOLD) {
		mtk_wdt_restart();
		if (upmu_is_chr_det() == KAL_FALSE) {
			dprintf(CRITICAL, "[BATTERY] No Charger, Power OFF !\n");
			mt6575_power_off();
			while (1) {
				if (fix_coverity == 1)
					return;
			}
		}


		chr_volt= get_charger_volt(1);

		if (chr_volt>V_CHARGER_MAX) {
			dprintf(CRITICAL, "[BATTERY] charger voltage is too high :%d , threshold is %d !\n",chr_volt,V_CHARGER_MAX);
#if defined(SWCHR_POWER_PATH)
			mt6575_power_off();
#endif
			break;
		}

		/* pmic_set_register_value(PMIC_BATON_TDET_EN, 1); */
		pmic_set_register_value(PMIC_RG_BATON_EN, 1);
		if (pmic_get_register_value(PMIC_RGS_BATON_UNDET) == 1) {
			dprintf(CRITICAL, "[BATTERY] No battry plug-in. Power Off.");
			mt6575_power_off();
			break;
		}

		dprintf(CRITICAL, "[%s]: check VBAT=%d mV with %d mV, start charging... \n", __FUNCTION__, bat_val, BATTERY_LOWVOL_THRESOLD);

		is_charging = 1;
		pchr_turn_on_charging(KAL_TRUE);

#if defined(SWCHR_POWER_PATH)
		mdelay(5000);
#else
		cnt=0;
		for (i=0; i<10; i++) {
			current=get_charging_current(1);
			chr_volt=get_charger_volt(1);
			if (current<100 && chr_volt<4400) {
				cnt++;
				dprintf(CRITICAL, "[BATTERY] charging current=%d charger volt=%d\n\r",current,chr_volt);
			} else {
				dprintf(CRITICAL, "[BATTERY] charging current=%d charger volt=%d\n\r",current,chr_volt);
				cnt=0;
			}
		}

		if (cnt>=8) {

			dprintf(CRITICAL, "[BATTERY] charging current and charger volt too low !! \n\r",cnt);

			pchr_turn_off_charging();
#ifndef NO_POWER_OFF
			mt6575_power_off();
#endif
			while (1) {
				dprintf(CRITICAL, "If you see the log, please check with RTC power off API\n\r");
			}
		}
		mdelay(50);
#endif



#if defined(SWCHR_POWER_PATH)
		bat_val = get_i_sense_volt(5);
#else
		bat_val = get_bat_sense_volt(5);
#endif
		dprintf(CRITICAL, "[%s]: check VBAT=%d mV  \n", __FUNCTION__, bat_val);
	}
	mtk_wdt_restart();

	dprintf(CRITICAL, "[%s]: check VBAT=%d mV with %d mV, stop charging... \n", __FUNCTION__, bat_val, BATTERY_LOWVOL_THRESOLD);
}

bool mtk_bat_allow_backlight_enable(void)
{
	int bat_vol = 0;
#if defined(SWCHR_POWER_PATH)
	bat_vol = get_i_sense_volt(1);
#else
	bat_vol = get_bat_sense_volt(1);
#endif
	if (bat_vol > (BATTERY_LOWVOL_THRESOLD + 150))
		return true;
	return false;
}

static kal_uint32 fg_get_data_ready_status(void)
{
	kal_uint32 ret=0;
	kal_uint32 temp_val=0;

	ret=pmic_read_interface(MT6356_FGADC_CON0, &temp_val, 0xFFFF, 0x0);

	dprintf(CRITICAL, "[fg_get_data_ready_status] Reg[0x%x]=0x%x\r\n", MT6356_FGADC_CON0, temp_val);

	temp_val = (temp_val & (PMIC_FG_LATCHDATA_ST_MASK << PMIC_FG_LATCHDATA_ST_SHIFT)) >> PMIC_FG_LATCHDATA_ST_SHIFT;

	return temp_val;
}

void fgauge_read_IM_current(void *data)
{
		unsigned short uvalue16 = 0;
		signed int dvalue = 0;
		/*int m = 0;*/
		long long Temp_Value = 0;
		/*unsigned int ret = 0;*/

		uvalue16 = pmic_get_register_value(PMIC_FG_R_CURR);
		dprintf(CRITICAL,"[fgauge_read_IM_current] : FG_CURRENT = %x\r\n",
			 uvalue16);

		/*calculate the real world data    */
		dvalue = (unsigned int) uvalue16;
		if (dvalue == 0) {
			Temp_Value = (long long) dvalue;
			g_fg_is_charging = false;
		} else if (dvalue > 32767) {
			/* > 0x8000 */
			Temp_Value = (long long) (dvalue - 65535);
			Temp_Value = Temp_Value - (Temp_Value * 2);
			g_fg_is_charging = false;
		} else {
			Temp_Value = (long long) dvalue;
			g_fg_is_charging = true;
		}

		Temp_Value = Temp_Value * UNIT_FGCURRENT;
		Temp_Value=Temp_Value/100000;
		dvalue = (unsigned int) Temp_Value;

		if (g_fg_is_charging == true)
			dprintf(CRITICAL,
			"[fgauge_read_IM_current] current(charging) = %d mA\r\n",
			dvalue);
		else
			dprintf(CRITICAL,
			"[fgauge_read_IM_current] current(discharging) = %d mA\r\n",
			dvalue);

		/* Auto adjust value */
		if (R_FG_VALUE != 100) {
			dprintf(CRITICAL,
			"[fgauge_read_IM_current] Auto adjust value due to the Rfg is %d\n Ori current=%d, ",
			R_FG_VALUE, dvalue);

			dvalue = (dvalue * 100) / R_FG_VALUE;

			dprintf(CRITICAL,"[fgauge_read_IM_current] new current=%d\n",
			dvalue);
		}

		dprintf(CRITICAL,"[fgauge_read_IM_current] ori current=%d\n", dvalue);

		dvalue = ((dvalue * CAR_TUNE_VALUE) / 1000);

		dprintf(CRITICAL,"[fgauge_read_IM_current] final current=%d (ratio=%d)\n",
			 dvalue, CAR_TUNE_VALUE);

		*(signed int *) (data) = dvalue;

}


void do_ptim(void)
{
	kal_uint32 vbat_reg;
	unsigned int count_adc_imp = 0;

	pmic_set_register_value(PMIC_AUXADC_SPL_NUM_LARGE, 0x0006);

	pmic_set_register_value(PMIC_AUXADC_IMP_AUTORPT_PRD,6);
#if 0 /* default use hw control, no need to set CK_PDN_HWEN to sw mode */
	pmic_set_register_value(PMIC_CLK_AUXADC_SMPS_CK_PDN,0);
	pmic_set_register_value(PMIC_CLK_AUXADC_SMPS_CK_PDN_HWEN,0);

	pmic_set_register_value(PMIC_RG_AUXADC_CK_PDN_HWEN,0);
	pmic_set_register_value(PMIC_RG_AUXADC_CK_PDN,0);
#endif

	pmic_set_register_value(PMIC_AUXADC_IMP_AUTORPT_EN,1); /*Peter-SW:55,56*/

	pmic_set_register_value(PMIC_AUXADC_CLR_IMP_CNT_STOP,1);
	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_IRQ_CLR,1);

	/*restore to initial state */
	pmic_set_register_value(PMIC_AUXADC_CLR_IMP_CNT_STOP,0);
	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_IRQ_CLR,0);

	/*set issue interrupt */
	/*pmic_set_register_value(PMIC_RG_INT_EN_AUXADC_IMP,1); */

	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_CHSEL,1);
	/*pmic_set_register_value(PMIC_AUXADC_IMP_AUTORPT_EN,1);*//*Peter-SW:55,56*/
	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_CNT,1);
	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_MODE,1);

	while (pmic_get_register_value(PMIC_AUXADC_IMPEDANCE_IRQ_STATUS)==0) {
		if (count_adc_imp > count_time_out_adc_imp) {
			dprintf(CRITICAL, "do_ptim over %d times/ms\n", count_adc_imp);
			dprintf(CRITICAL, "AUXADC_IMPEDANCE_MODE=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_IMPEDANCE_MODE));
			dprintf(CRITICAL, "AUXADC_CLR_IMP_CNT_STOP=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_CLR_IMP_CNT_STOP));
			dprintf(CRITICAL, "AUXADC_IMPEDANCE_IRQ_STATUS=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_IMPEDANCE_IRQ_STATUS));
			dprintf(CRITICAL, "AUXADC_IMPEDANCE_IRQ_CLR=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_IMPEDANCE_IRQ_CLR));
			dprintf(CRITICAL, "AUXADC_IMPEDANCE_CHSEL=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_IMPEDANCE_CHSEL));
			dprintf(CRITICAL, "AUXADC_IMPEDANCE_CNT=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_IMPEDANCE_CNT));
			dprintf(CRITICAL, "AUXADC_IMP_AUTORPT_EN=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_IMP_AUTORPT_EN));
			dprintf(CRITICAL, "AUXADC_IMP_AUTORPT_PRD=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_IMP_AUTORPT_PRD));
			dprintf(CRITICAL, "RG_AUXADC_AO_1M_CK_PDN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_AO_1M_CK_PDN));
			dprintf(CRITICAL, "RG_AUXADC_1M_CK_PDN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_1M_CK_PDN));
			dprintf(CRITICAL, "RG_AUXADC_CK_PDN_HWEN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_CK_PDN_HWEN));
			dprintf(CRITICAL, "RG_AUXADC_CK_PDN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_CK_PDN));
			dprintf(CRITICAL, "RG_AUXADC_RNG_CK_PDN_HWEN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_RNG_CK_PDN_HWEN));
			dprintf(CRITICAL, "RG_AUXADC_RNG_CK_PDN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_RNG_CK_PDN));
			dprintf(CRITICAL, "RG_AUXADC_32K_CK_PDN_HWEN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_32K_CK_PDN_HWEN));
			dprintf(CRITICAL, "RG_AUXADC_32K_CK_PDN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_32K_CK_PDN));
			dprintf(CRITICAL, "RG_AUXADC_1K_CK_PDN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_1K_CK_PDN));
			dprintf(CRITICAL, "RG_AUXADC_INTRP_CK_PDN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_INTRP_CK_PDN));
			dprintf(CRITICAL, "AUXADC_CK_AON=0x%x\n",
				pmic_get_register_value(PMIC_AUXADC_CK_AON));
			dprintf(CRITICAL, "RG_AUXADC_IMP_CK_SW_MODE=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_IMP_CK_SW_MODE));
			dprintf(CRITICAL, "RG_AUXADC_IMP_CK_SW_EN=0x%x\n",
				pmic_get_register_value(PMIC_RG_AUXADC_IMP_CK_SW_EN));
			dprintf(CRITICAL, "RG_STRUP_AUXADC_RSTB_SEL=0x%x\n",
				pmic_get_register_value(PMIC_RG_STRUP_AUXADC_RSTB_SEL));
			dprintf(CRITICAL, "RG_STRUP_AUXADC_RSTB_SW=0x%x\n",
				pmic_get_register_value(PMIC_RG_STRUP_AUXADC_RSTB_SW));
			break;
		}
		count_adc_imp++;
		mdelay(1);
	}

	/*disable */
	/*pmic_set_register_value(PMIC_AUXADC_IMP_AUTORPT_EN,0);*//*Peter-SW:55,56*/
	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_MODE,0);

	/*clear irq */
	pmic_set_register_value(PMIC_AUXADC_CLR_IMP_CNT_STOP,1);
	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_IRQ_CLR,1);
	pmic_set_register_value(PMIC_AUXADC_CLR_IMP_CNT_STOP,0);
	pmic_set_register_value(PMIC_AUXADC_IMPEDANCE_IRQ_CLR,0);

	pmic_set_register_value(PMIC_AUXADC_IMP_AUTORPT_EN,0); /*Peter-SW:55,56*/

	if (count_adc_imp <= count_time_out_adc_imp) {
		vbat_reg=pmic_get_register_value(PMIC_AUXADC_ADC_OUT_IMP_AVG);
		ptim_bat_vol=(vbat_reg*3*18000)/32768;
	} else
		ptim_bat_vol = pmic_get_auxadc_value(AUXADC_LIST_ISENSE) * 10;

	fgauge_read_IM_current((void *)&ptim_R_curr);

	/*dprintf(CRITICAL, "******** [do_ptim] Done!\n" ); */
}

void do_ptim_gauge(unsigned int *bat, signed int *cur)
{
	int volt[5] = {0};
	int curr[5] = {0};
	int i, j;
	int arraySize = sizeof(volt)/sizeof(volt[0]);

	for (i = 0; i < arraySize; i++) {
		do_ptim();

		/* insertion sort */
		for (j = i; j > 0; j--) {
			if (ptim_bat_vol < volt[j - 1])
				volt[j] = volt[j - 1];
			else
				break;
		}
		volt[j] = ptim_bat_vol;

		/* insertion sort */
		for (j = i; j > 0; j--) {
			if (ptim_R_curr < curr[j - 1])
				curr[j] = curr[j - 1];
			else
				break;
		}
		curr[j] = ptim_R_curr;
	}

	*bat = volt[arraySize >> 1];
	*cur = curr[arraySize >> 1];
	dprintf(CRITICAL, "%s, %d(%d, %d, %d, %d, %d), %d(%d, %d, %d, %d, %d)\n",
		__func__, *bat, volt[0], volt[1], volt[2], volt[3], volt[4],
		*cur, curr[0], curr[1], curr[2], curr[3], curr[4]);
}

void check_sw_ocv(int bat_vol)
{
	pchr_turn_on_charging(KAL_FALSE);
	mdelay(50);

	do_ptim_gauge(&ptim_bat_vol, &ptim_R_curr);

	fg_swocv_v = ptim_bat_vol;
	if (g_fg_is_charging == true)
		fg_swocv_i = ptim_R_curr;
	else
		fg_swocv_i = -ptim_R_curr;

	dprintf(CRITICAL, "[check_sw_ocv]%d ptim[%d %d] fg_swocv[%d %d] boot_vbat:%d shutdowntime:%d vbat:%d\n",
	g_fg_is_charging,
	ptim_bat_vol, ptim_R_curr, fg_swocv_v, fg_swocv_i, g_boot_arg->boot_voltage, g_boot_arg->shutdown_time,
	bat_vol);

	shutdown_time = g_boot_arg->shutdown_time;
	boot_voltage = g_boot_arg->boot_voltage;

	pchr_turn_on_charging(KAL_TRUE);
}


void mt65xx_bat_init(void)
{
#ifdef MTK_CHARGER_INTERFACE
	int ret = 0;
#endif /* MTK_CHARGER_INTERFACE */
	kal_int32 bat_vol;
#if defined(SWCHR_POWER_PATH) || defined(MTK_PUMP_EXPRESS_PLUS_SUPPORT)
	kal_int32 chr_volt;
	kal_int32 rc = 0;
#endif
	// Low Battery Safety Booting

	/* Get charger interface */
#ifdef MTK_CHARGER_INTERFACE
	mtk_charger_init();
	primary_mchr = mtk_charger_get_by_name("primary_charger");
	if (!primary_mchr)
		dprintf(CRITICAL, "%s: get primary charger failed\n", __func__);
#endif

#if defined(SWCHR_POWER_PATH)
	bat_vol = get_i_sense_volt(1);
#else
	bat_vol = get_bat_sense_volt(1);
#endif
	check_sw_ocv(bat_vol);

	//pchr_turn_on_charging(KAL_TRUE);
	dprintf(INFO, "[mt65xx_bat_init] check VBAT=%d mV with %d mV\n", bat_vol, BATTERY_LOWVOL_THRESOLD);

#if defined(MTK_PUMP_EXPRESS_PLUS_SUPPORT) || defined(MTK_PUMP_EXPRESS_PLUS_20_SUPPORT)
	/*Try to reset PE+ adapter once abnormal voltage is found*/
	chr_volt = get_charger_volt(1);
	while (chr_volt > V_CHARGER_MAX) {
		dprintf(CRITICAL, "[mt65xx_bat_init] PE+ adpater should be reset to 5V now\n");

		pumpex_reset_adapter_enble(1);
		mdelay(250);
		pumpex_reset_adapter_enble(0);

		chr_volt = get_charger_volt(1);
		rc++;
		if (rc == 3)
			break;
	}
#endif

	if (g_boot_mode == KERNEL_POWER_OFF_CHARGING_BOOT && (pmic_get_register_value(PMIC_PWRKEY_DEB)==0) ) {
		dprintf(CRITICAL, "[mt65xx_bat_init] KPOC+PWRKEY => change boot mode\n");
		g_boot_reason_change = true;
	}
	rtc_boot_check(false);

#ifndef MTK_DISABLE_POWER_ON_OFF_VOLTAGE_LIMITATION
#ifndef MTK_BATLOWV_NO_PANEL_ON_EARLY
	if (bat_vol < BATTERY_LOWVOL_THRESOLD)
#else
	if (is_low_battery(bat_vol))
#endif
	{
		if (g_boot_mode == KERNEL_POWER_OFF_CHARGING_BOOT && upmu_is_chr_det() == KAL_TRUE) {
			dprintf(CRITICAL, "[%s] Kernel Low Battery Power Off Charging Mode\n", __func__);
			g_boot_mode = LOW_POWER_OFF_CHARGING_BOOT;

			check_bat_protect_status();

		} else {
			dprintf(CRITICAL, "[BATTERY] battery voltage(%dmV) <= CLV ! Can not Boot Linux Kernel !! \n\r",bat_vol);
#ifndef NO_POWER_OFF
			mt6575_power_off();
#endif
			while (1) {
				dprintf(CRITICAL, "If you see the log, please check with RTC power off API\n\r");
				if (fix_coverity == 1)
					return;
			}
		}
	}
#endif

#if defined(SWCHR_POWER_PATH)
	chr_volt = get_charger_volt(1);
	if (chr_volt > V_CHARGER_MAX) {
		dprintf(CRITICAL, "Charger Over Voltage:%d\n, power off...", chr_volt);
		mt6575_power_off();
	}
#endif

#if defined(DLPT_FEATURE_SUPPORT)
	/* if fast meta mode detected, skip DLPT to speed up */
	if((g_boot_mode == META_BOOT) && !mt_get_gpio_in(GPIO0)){
		return;
	}
	if (g_boot_mode != META_BOOT && g_boot_mode != FACTORY_BOOT && g_boot_mode != ATE_FACTORY_BOOT) {
		/* pmic_set_register_value(PMIC_BATON_TDET_EN, 1); */
		pmic_set_register_value(PMIC_RG_BATON_EN, 1);
		if (pmic_get_register_value(PMIC_RGS_BATON_UNDET) == 1) {
			dprintf(CRITICAL, "[BATTERY] No battry plug-in. Power Off.");
			mt6575_power_off();
		}
	}
	pchr_turn_on_charging(KAL_FALSE);
	/* disable SW charger power path */
	switch_charger_power_path_enable(KAL_FALSE);
	mdelay(50);
	get_dlpt_imix_r();
	/* after get imix, re-enable SW charger power path */
	switch_charger_power_path_enable(KAL_TRUE);
	check_bat_protect_status();
	if (is_charging == 1) {
		pchr_turn_on_charging(KAL_TRUE);
		dprintf(CRITICAL, "turn on charging \n\r");
	}
#endif //#if defined(DLPT_FEATURE_SUPPORT)
#ifdef MTK_CHARGER_INTERFACE
	/* disable wdt in case entering fastboot later... */
	ret = mtk_charger_enable_wdt(primary_mchr, false);
	if (ret < 0)
		dprintf(CRITICAL, "%s: disable wdt fail\n", __func__);

	/* set bl/db driver */
	ret = mtk_charger_set_bl_driver(primary_mchr);
	if (ret < 0)
		dprintf(CRITICAL, "%s: set bl/db driver fail\n", __func__);
#endif /* MTK_CHARGER_INTERFACE */

	return;
}

#if defined(DLPT_FEATURE_SUPPORT)
int imix_r=170;
extern kal_uint32 upmu_get_reg_value(kal_uint32 reg);

void enable_dummy_load(kal_uint32 en)
{
	if (en==1) {
		/*1. disable isink pdn */
		pmic_set_register_value(PMIC_RG_DRV_ISINK3_CK_PDN, 0);
		pmic_set_register_value(PMIC_RG_DRV_ISINK2_CK_PDN, 0);
		pmic_set_register_value(PMIC_RG_DRV_ISINK1_CK_PDN, 0);
		pmic_set_register_value(PMIC_RG_DRV_ISINK0_CK_PDN, 0);
		/* pmic_set_register_value(PMIC_RG_DRV_32K_CK_PDN, 0); */
		pmic_set_register_value(PMIC_RG_DRV_CHRIND_CK_PDN, 0);

		/* enable isink step */
		pmic_set_register_value(PMIC_ISINK_CH0_STEP, 0x7);
		pmic_set_register_value(PMIC_ISINK_CH1_STEP, 0x7);
		pmic_set_register_value(PMIC_ISINK_CH2_STEP, 0x7);
		pmic_set_register_value(PMIC_ISINK_CH3_STEP, 0x7);

		/* double function */
		pmic_set_register_value(PMIC_RG_ISINK3_DOUBLE, 0x1); /*CH3 double on  */
		pmic_set_register_value(PMIC_RG_ISINK2_DOUBLE, 0x1); /*CH2 double on  */
		pmic_set_register_value(PMIC_RG_ISINK1_DOUBLE, 0); /*CH1 double off */
		pmic_set_register_value(PMIC_RG_ISINK0_DOUBLE, 0); /*CH0 double off */

		/*enable isink */
		pmic_set_register_value(PMIC_ISINK_CH3_BIAS_EN, 0x1);
		pmic_set_register_value(PMIC_ISINK_CH2_BIAS_EN, 0x1);
		pmic_set_register_value(PMIC_ISINK_CH1_BIAS_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH0_BIAS_EN, 0);
		/* TODO */
		pmic_set_register_value(PMIC_ISINK_CHOP3_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CHOP2_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CHOP1_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CHOP0_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CH3_EN, 0x1);
		pmic_set_register_value(PMIC_ISINK_CH2_EN, 0x1);
		pmic_set_register_value(PMIC_ISINK_CH1_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH0_EN, 0);
		/*PMICLOG("[enable dummy load]\n"); */
	} else {
		pmic_set_register_value(PMIC_ISINK_CH3_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH2_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH1_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH0_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CHOP3_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CHOP2_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CHOP1_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CHOP0_EN, 0); /* no chop */
		pmic_set_register_value(PMIC_ISINK_CH3_BIAS_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH2_BIAS_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH1_BIAS_EN, 0);
		pmic_set_register_value(PMIC_ISINK_CH0_BIAS_EN, 0);

		/*1. enable isink pdn */
		pmic_set_register_value(PMIC_RG_DRV_ISINK3_CK_PDN, 0x1);
		pmic_set_register_value(PMIC_RG_DRV_ISINK2_CK_PDN, 0x1);
		pmic_set_register_value(PMIC_RG_DRV_ISINK1_CK_PDN, 0x1);
		pmic_set_register_value(PMIC_RG_DRV_ISINK0_CK_PDN, 0x1);
		/* pmic_set_register_value(PMIC_RG_DRV_32K_CK_PDN, 0x1); */
		pmic_set_register_value(PMIC_RG_DRV_CHRIND_CK_PDN, 0x1);

		/*pmic_set_register_value(PMIC_RG_VIBR_EN,0); */
		/*PMICLOG("[disable dummy load]\n"); */
	}
}


int get_rac_val(void)
{

	int volt_1=0;
	int volt_2=0;
	int curr_1=0;
	int curr_2=0;
	int rac_cal=0;
	int ret=0;
	kal_bool retry_state = KAL_FALSE;
	int retry_count=0;

	do {
		//adc and fg--------------------------------------------------------
		do_ptim();

		dprintf(INFO, "[1,Trigger ADC PTIM mode] volt1=%d, curr_1=%d\n", ptim_bat_vol, ptim_R_curr);
		volt_1=ptim_bat_vol;
		curr_1=ptim_R_curr;

		dprintf(INFO, "[2,enable dummy load]");
		enable_dummy_load(1);
		/* debug to measure bat volt & Isense */
		/* pmic_set_register_value(PMIC_RG_VIBR_EN, 0x1); */
		mdelay(1);
		//Wait --------------------------------------------------------------

		//adc and fg--------------------------------------------------------
		do_ptim();

		dprintf(INFO, "[3,Trigger ADC PTIM mode again]0717 volt2=%d, curr_2=%d\n", ptim_bat_vol, ptim_R_curr);
		volt_2=ptim_bat_vol;
		curr_2=ptim_R_curr;

		//Disable dummy load-------------------------------------------------
		enable_dummy_load(0);
		/* debug to measure bat volt & Isense */
		/*pmic_set_register_value(PMIC_RG_VIBR_EN, 0); */

		//Calculate Rac------------------------------------------------------
		if ( (curr_2-curr_1) >= 700 && (curr_2-curr_1) <= 1200 && (volt_1-volt_2)>=80 ) { //40.0mA
			rac_cal=((volt_1-volt_2)*1000)/(curr_2-curr_1); //m-ohm

			if (rac_cal<0) {
				ret = (rac_cal-(rac_cal*2))*1;
			} else {
				ret = rac_cal*1;
			}
		} else {
			ret=-1;
			dprintf(CRITICAL, "[4,Calculate Rac] bypass due to (curr_x-curr_y) < 40mA\n");
		}

		dprintf(INFO, "[5,Calculate Rac] volt_1=%d,volt_2=%d,curr_1=%d,curr_2=%d,rac_cal=%d,ret=%d,retry_count=%d\n",
		        volt_1,volt_2,curr_1,curr_2,rac_cal,ret,retry_count);

		dprintf(CRITICAL, "[6,Calculate Rac *] %d,%d,%d,%d,%d,%d,%d\n",
		        volt_1,volt_2,curr_1,curr_2,rac_cal,ret,retry_count);


		//------------------------
		retry_count++;

		if ((retry_count < 3) && (ret == -1)) retry_state = KAL_TRUE;
		else                                 retry_state = KAL_FALSE;

	} while (retry_state == KAL_TRUE);

	return ret;
}


void get_dlpt_imix_r(void)
{
	int rac_val[5],rac_val_avg=0,rac_val_sum=0;
	int volt[5],curr[5],volt_avg=0,curr_avg=0;
	int imix;
	int i;
	int validcnt=0;
	int min=1000,max=0;

	for (i=0; i<5; i++) {
		rac_val[i]=get_rac_val();
		if (rac_val[i]<=min && rac_val[i]!=-1)
			min=rac_val[i];
		if (rac_val[i]>=max)
			max=rac_val[i];
		if (rac_val[i]!=-1) {
			rac_val_sum+=rac_val[i];
			validcnt++;
		}
	}

	if (validcnt>=4) {
		rac_val_sum=rac_val_sum-min-max;
		imix_r=rac_val_sum/(validcnt-2);
	} else if (validcnt!=0) {
		imix_r=rac_val_sum/validcnt;
	}

	dprintf(CRITICAL, "[dlpt_R] %d,%d,%d,%d,%d [%d:%d:%d]%d\n",rac_val[0],rac_val[1],rac_val[2],rac_val[3],rac_val[4],min,max,validcnt,imix_r);

	return;

}
#endif //#if defined(DLPT_FEATURE_SUPPORT)

#else

#include <platform/mt_typedefs.h>
#include <platform/mt_reg_base.h>
#include <printf.h>

int imix_r=170;

void mt65xx_bat_init(void)
{
	dprintf(CRITICAL, "[BATTERY] Skip mt65xx_bat_init !!\n\r");
	dprintf(CRITICAL, "[BATTERY] If you want to enable power off charging, \n\r");
	dprintf(CRITICAL, "[BATTERY] Please #define CFG_POWER_CHARGING!!\n\r");
}

int get_bat_volt(int times)
{
	int bat_vol;
#if defined(SWCHR_POWER_PATH)
		bat_vol = get_i_sense_volt(times);
#else
		bat_vol = get_bat_sense_volt(times);
#endif
	return bat_vol;
}
#endif