Aquaris-M10-4G/drivers/misc/mediatek/power/mt6735/battery_meter_hal.c

/*
 * Copyright (C) 2015 MediaTek Inc.
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU General Public License for more details.
 */


#include <linux/delay.h>
#include <asm/div64.h>

#include <mt-plat/upmu_common.h>

#include <mt-plat/battery_meter_hal.h>
#include <mach/mt_battery_meter.h>
#include <mach/mt_pmic.h>
#include <mt-plat/battery_meter.h>
#include <mt-plat/mt_boot_reason.h>


/* ============================================================ // */
/* define */
/* ============================================================ // */
#define STATUS_OK    0
#define STATUS_UNSUPPORTED    -1
#define VOLTAGE_FULL_RANGE    1800
#define ADC_PRECISE           32768	/* 12 bits */

#define UNIT_FGCURRENT     (158122)	/* 158.122 uA */

/* ============================================================ // */
/* global variable */
/* ============================================================ // */
signed int chip_diff_trim_value_4_0 = 0;
signed int chip_diff_trim_value = 0;	/* unit = 0.1 */

signed int g_hw_ocv_tune_value = 0;

kal_bool g_fg_is_charging = 0;

/* ============================================================ // */
/* function prototype */
/* ============================================================ // */

/* ============================================================ // */
/* extern variable */
/* ============================================================ // */

/* ============================================================ // */
/* extern function */
/* ============================================================ // */
/*extern unsigned int upmu_get_reg_value(unsigned int reg);
extern int IMM_GetOneChannelValue(int dwChannel, int data[4], int *rawdata);
extern int IMM_IsAdcInitReady(void);
extern U32 pmic_config_interface(U32 RegNum, U32 val, U32 MASK, U32 SHIFT);
extern U32 pmic_read_interface(U32 RegNum, U32 *val, U32 MASK, U32 SHIFT);
extern unsigned int get_pmic_mt6325_cid(void);*/
/* ============================================================ // */
void get_hw_chip_diff_trim_value(void)
{
#if defined(CONFIG_POWER_EXT)
#else

#if 1
	signed int reg_val = 0;

	reg_val = upmu_get_reg_value(0xCB8);
	chip_diff_trim_value_4_0 = (reg_val >> 7) & 0x001F;	/* chip_diff_trim_value_4_0 = (reg_val>>10)&0x001F; */

	bm_print(BM_LOG_CRTI, "[Chip_Trim] Reg[0xCB8]=0x%x, chip_diff_trim_value_4_0=%d\n", reg_val,
		 chip_diff_trim_value_4_0);
#else
	bm_print(BM_LOG_FULL, "[Chip_Trim] need check reg number\n");
#endif

	switch (chip_diff_trim_value_4_0) {
	case 0:
		chip_diff_trim_value = 1000;
		break;
	case 1:
		chip_diff_trim_value = 1005;
		break;
	case 2:
		chip_diff_trim_value = 1010;
		break;
	case 3:
		chip_diff_trim_value = 1015;
		break;
	case 4:
		chip_diff_trim_value = 1020;
		break;
	case 5:
		chip_diff_trim_value = 1025;
		break;
	case 6:
		chip_diff_trim_value = 1030;
		break;
	case 7:
		chip_diff_trim_value = 1036;
		break;
	case 8:
		chip_diff_trim_value = 1041;
		break;
	case 9:
		chip_diff_trim_value = 1047;
		break;
	case 10:
		chip_diff_trim_value = 1052;
		break;
	case 11:
		chip_diff_trim_value = 1058;
		break;
	case 12:
		chip_diff_trim_value = 1063;
		break;
	case 13:
		chip_diff_trim_value = 1069;
		break;
	case 14:
		chip_diff_trim_value = 1075;
		break;
	case 15:
		chip_diff_trim_value = 1081;
		break;
	case 31:
		chip_diff_trim_value = 995;
		break;
	case 30:
		chip_diff_trim_value = 990;
		break;
	case 29:
		chip_diff_trim_value = 985;
		break;
	case 28:
		chip_diff_trim_value = 980;
		break;
	case 27:
		chip_diff_trim_value = 975;
		break;
	case 26:
		chip_diff_trim_value = 970;
		break;
	case 25:
		chip_diff_trim_value = 966;
		break;
	case 24:
		chip_diff_trim_value = 961;
		break;
	case 23:
		chip_diff_trim_value = 956;
		break;
	case 22:
		chip_diff_trim_value = 952;
		break;
	case 21:
		chip_diff_trim_value = 947;
		break;
	case 20:
		chip_diff_trim_value = 943;
		break;
	case 19:
		chip_diff_trim_value = 938;
		break;
	case 18:
		chip_diff_trim_value = 934;
		break;
	case 17:
		chip_diff_trim_value = 930;
		break;
	default:
		bm_print(BM_LOG_FULL, "[Chip_Trim] Invalid value(%d)\n", chip_diff_trim_value_4_0);
		break;
	}

	bm_print(BM_LOG_CRTI, "[Chip_Trim] chip_diff_trim_value=%d\n", chip_diff_trim_value);
#endif
}

signed int use_chip_trim_value(signed int not_trim_val)
{
#if defined(CONFIG_POWER_EXT)
	return not_trim_val;
#else
	signed int ret_val = 0;

	ret_val = ((not_trim_val * chip_diff_trim_value) / 1000);

	bm_print(BM_LOG_FULL, "[use_chip_trim_value] %d -> %d\n", not_trim_val, ret_val);

	return ret_val;
#endif
}

int get_hw_ocv(void)
{
#if defined(CONFIG_POWER_EXT)
	return 4001;
	bm_print(BM_LOG_CRTI, "[get_hw_ocv] TBD\n");
#else
	signed int adc_result_reg = 0;
	signed int adc_result = 0;
	signed int r_val_temp = 3;	/* MT6325 use 2, old chip use 4 */

#if defined(SWCHR_POWER_PATH)
	adc_result_reg = pmic_get_register_value(PMIC_AUXADC_ADC_OUT_WAKEUP_SWCHR);
	/* mt6325_upmu_get_rg_adc_out_wakeup_swchr(); */
	adc_result = (adc_result_reg * r_val_temp * VOLTAGE_FULL_RANGE) / ADC_PRECISE;
	bm_print(BM_LOG_CRTI, "[oam] get_hw_ocv (swchr) : adc_result_reg=%d, adc_result=%d\n",
		 adc_result_reg, adc_result);
#else
	adc_result_reg = pmic_get_register_value(PMIC_AUXADC_ADC_OUT_WAKEUP_PCHR);
/* mt6325_upmu_get_rg_adc_out_wakeup_pchr(); */
	adc_result = (adc_result_reg * r_val_temp * VOLTAGE_FULL_RANGE) / ADC_PRECISE;
	bm_print(BM_LOG_CRTI, "[oam] get_hw_ocv (pchr) : adc_result_reg=%d, adc_result=%d\n",
		 adc_result_reg, adc_result);
#endif

	adc_result += g_hw_ocv_tune_value;
	return adc_result;
#endif
}


/* ============================================================// */

#if defined(CONFIG_POWER_EXT)
/*  */
#else

static void dump_nter(void)
{
	bm_print(BM_LOG_CRTI, "[dump_nter] mt6328_upmu_get_fg_nter_29_16 = 0x%x\r\n",
		 pmic_get_register_value(PMIC_FG_NTER_29_16));
	bm_print(BM_LOG_CRTI, "[dump_nter] mt6328_upmu_get_fg_nter_15_00 = 0x%x\r\n",
		 pmic_get_register_value(PMIC_FG_NTER_15_00));
}

static void dump_car(void)
{
	bm_print(BM_LOG_CRTI, "[dump_car] upmu_get_fg_car_31_16 = 0x%x\r\n",
		 pmic_get_register_value(PMIC_FG_CAR_31_16));
	bm_print(BM_LOG_CRTI, "[dump_car] upmu_get_fg_car_15_00 = 0x%x\r\n",
		 pmic_get_register_value(PMIC_FG_CAR_15_00));
}

static unsigned int fg_get_data_ready_status(void)
{
	unsigned int ret = 0;
	unsigned int temp_val = 0;

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

	bm_print(BM_LOG_FULL, "[fg_get_data_ready_status] Reg[0x%x]=0x%x\r\n", MT6328_FGADC_CON0,
		 temp_val);

	temp_val =
	    (temp_val & (MT6328_PMIC_FG_LATCHDATA_ST_MASK << MT6328_PMIC_FG_LATCHDATA_ST_SHIFT)) >>
	    MT6328_PMIC_FG_LATCHDATA_ST_SHIFT;

	return temp_val;
}
#endif

static signed int fgauge_read_current(void *data);
static signed int fgauge_initialization(void *data)
{
#if defined(CONFIG_POWER_EXT)
	/*  */
#else
	unsigned int ret = 0;
	signed int current_temp = 0;
	int m = 0;

	get_hw_chip_diff_trim_value();

/* 1. HW initialization */
	/* FGADC clock is 32768Hz from RTC */
	/* Enable FGADC in current mode at 32768Hz with auto-calibration */

	/* (1)    Enable VA2 */
	/* (2)    Enable FGADC clock for digital */
	pmic_set_register_value(PMIC_RG_FGADC_ANA_CK_PDN, 0);	/* mt6325_upmu_set_rg_fgadc_ana_ck_pdn(0); */
	pmic_set_register_value(PMIC_RG_FGADC_DIG_CK_PDN, 0);	/* mt6325_upmu_set_rg_fgadc_dig_ck_pdn(0); */

	/* (3)    Set current mode, auto-calibration mode and 32KHz clock source */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0028, 0x00FF, 0x0);
	/* (4)    Enable FGADC */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0029, 0x00FF, 0x0);

	/* reset HW FG */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x7100, 0xFF00, 0x0);
	bm_print(BM_LOG_CRTI, "******** [fgauge_initialization] reset HW FG!\n");

	/* set FG_OSR */
	ret = pmic_config_interface(MT6328_FGADC_CON11, 0x8, 0xF, 0x0);
	bm_print(BM_LOG_CRTI, "[fgauge_initialization] Reg[0x%x]=0x%x\n", MT6328_FGADC_CON11,
		 upmu_get_reg_value(MT6328_FGADC_CON11));

	/* make sure init finish */
	m = 0;
	while (current_temp == 0) {
		fgauge_read_current(&current_temp);
		m++;
		if (m > 1000) {
			bm_print(BM_LOG_CRTI, "[fgauge_initialization] timeout!\r\n");
			break;
		}
	}

	bm_print(BM_LOG_CRTI, "******** [fgauge_initialization] Done!\n");
#endif

	return STATUS_OK;
}

static signed int fgauge_read_current(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 0;
#else
	unsigned short uvalue16 = 0;
	signed int dvalue = 0;
	int m = 0;
	long long Temp_Value = 0;
	signed int Current_Compensate_Value = 0;
	unsigned int ret = 0;

/* HW Init */
	/* (1)    i2c_write (0x60, 0xC8, 0x01); // Enable VA2 */
	/* (2)    i2c_write (0x61, 0x15, 0x00); // Enable FGADC clock for digital */
	/* (3)    i2c_write (0x61, 0x69, 0x28); // Set current mode, auto-calibration mode and 32KHz clock source */
	/* (4)    i2c_write (0x61, 0x69, 0x29); // Enable FGADC */

/* Read HW Raw Data */
	/* (1)    Set READ command */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0200, 0xFF00, 0x0);
	/* (2)     Keep i2c read when status = 1 (0x06) */
	m = 0;
	while (fg_get_data_ready_status() == 0) {
		m++;
		if (m > 1000) {
			bm_print(BM_LOG_FULL,
				 "[fgauge_read_current] fg_get_data_ready_status timeout 1 !\r\n");
			break;
		}
	}
	/* (3)    Read FG_CURRENT_OUT[15:08] */
	/* (4)    Read FG_CURRENT_OUT[07:00] */
	uvalue16 = pmic_get_register_value(PMIC_FG_CURRENT_OUT);	/* mt6325_upmu_get_fg_current_out(); */
	bm_print(BM_LOG_FULL, "[fgauge_read_current] : FG_CURRENT = %x\r\n", uvalue16);
	/* (5)    (Read other data) */
	/* (6)    Clear status to 0 */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0800, 0xFF00, 0x0);
	/* (7)    Keep i2c read when status = 0 (0x08) */
	/* while ( fg_get_sw_clear_status() != 0 ) */
	m = 0;
	while (fg_get_data_ready_status() != 0) {
		m++;
		if (m > 1000) {
			bm_print(BM_LOG_FULL,
				 "[fgauge_read_current] fg_get_data_ready_status timeout 2 !\r\n");
			break;
		}
	}
	/* (8)    Recover original settings */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0000, 0xFF00, 0x0);

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

		Temp_Value = (long long) (dvalue - 65535);
		Temp_Value = Temp_Value - (Temp_Value * 2);
		g_fg_is_charging = KAL_FALSE;
	} else {
		Temp_Value = (long long) dvalue;
		g_fg_is_charging = KAL_TRUE;
	}

	Temp_Value = Temp_Value * UNIT_FGCURRENT;
	do_div(Temp_Value, 100000);
	dvalue = (unsigned int) Temp_Value;

	if (g_fg_is_charging == KAL_TRUE) {
		bm_print(BM_LOG_FULL, "[fgauge_read_current] current(charging) = %d mA\r\n",
			 dvalue);
	} else {
		bm_print(BM_LOG_FULL, "[fgauge_read_current] current(discharging) = %d mA\r\n",
			 dvalue);
	}

/* Auto adjust value */
	if (batt_meter_cust_data.r_fg_value != 20) {
		bm_print(BM_LOG_FULL,
			 "[fgauge_read_current] Auto adjust value due to the Rfg is %d\n Ori current=%d, ",
			 batt_meter_cust_data.r_fg_value, dvalue);

		dvalue = (dvalue * 20) / batt_meter_cust_data.r_fg_value;

		bm_print(BM_LOG_FULL, "[fgauge_read_current] new current=%d\n", dvalue);
	}
/* K current */
	if (batt_meter_cust_data.r_fg_board_slope != batt_meter_cust_data.r_fg_board_base) {
		dvalue =
		    ((dvalue * batt_meter_cust_data.r_fg_board_base) +
		     (batt_meter_cust_data.r_fg_board_slope / 2)) /
		    batt_meter_cust_data.r_fg_board_slope;
	}
/* current compensate */
	if (g_fg_is_charging == KAL_TRUE)
		dvalue = dvalue + Current_Compensate_Value;
	else
		dvalue = dvalue - Current_Compensate_Value;


	bm_print(BM_LOG_FULL, "[fgauge_read_current] ori current=%d\n", dvalue);

	dvalue = ((dvalue * batt_meter_cust_data.car_tune_value) / 100);

	dvalue = use_chip_trim_value(dvalue);

	bm_print(BM_LOG_FULL, "[fgauge_read_current] final current=%d (ratio=%d)\n", dvalue,
		 batt_meter_cust_data.car_tune_value);

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

	return STATUS_OK;
}



signed int fgauge_read_IM_current(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 0;
#else
	unsigned short uvalue16 = 0;
	signed int dvalue = 0;
	/*int m = 0;*/
	long long Temp_Value = 0;
	signed int Current_Compensate_Value = 0;
	/*unsigned int ret = 0;*/



	uvalue16 = pmic_get_register_value(PMIC_FG_R_CURR);
	bm_print(BM_LOG_FULL, "[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 = KAL_FALSE;
	} else if (dvalue > 32767) {/* > 0x8000 */

		Temp_Value = (long long) (dvalue - 65535);
		Temp_Value = Temp_Value - (Temp_Value * 2);
		g_fg_is_charging = KAL_FALSE;
	} else {
		Temp_Value = (long long) dvalue;
		g_fg_is_charging = KAL_TRUE;
	}

	Temp_Value = Temp_Value * UNIT_FGCURRENT;
	do_div(Temp_Value, 100000);
	dvalue = (unsigned int) Temp_Value;

	if (g_fg_is_charging == KAL_TRUE) {
		bm_print(BM_LOG_FULL, "[fgauge_read_IM_current] current(charging) = %d mA\r\n",
			 dvalue);
	} else {
		bm_print(BM_LOG_FULL, "[fgauge_read_IM_current] current(discharging) = %d mA\r\n",
			 dvalue);
	}

/* Auto adjust value */
	if (batt_meter_cust_data.r_fg_value != 20) {
		bm_print(BM_LOG_FULL,
			 "[fgauge_read_IM_current] Auto adjust value due to the Rfg is %d\n Ori current=%d, ",
			 batt_meter_cust_data.r_fg_value, dvalue);

		dvalue = (dvalue * 20) / batt_meter_cust_data.r_fg_value;

		bm_print(BM_LOG_FULL, "[fgauge_read_IM_current] new current=%d\n", dvalue);
	}
/* K current */
	if (batt_meter_cust_data.r_fg_board_slope != batt_meter_cust_data.r_fg_board_base) {
		dvalue =
		    ((dvalue * batt_meter_cust_data.r_fg_board_base) +
		     (batt_meter_cust_data.r_fg_board_slope / 2)) /
		    batt_meter_cust_data.r_fg_board_slope;
	}
/* current compensate */
	if (g_fg_is_charging == KAL_TRUE)
		dvalue = dvalue + Current_Compensate_Value;
	else
		dvalue = dvalue - Current_Compensate_Value;


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

	dvalue = ((dvalue * batt_meter_cust_data.car_tune_value) / 100);

	dvalue = use_chip_trim_value(dvalue);

	bm_print(BM_LOG_FULL, "[fgauge_read_IM_current] final current=%d (ratio=%d)\n", dvalue,
		 batt_meter_cust_data.car_tune_value);

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

	return STATUS_OK;
}


static signed int fgauge_read_current_sign(void *data)
{
	*(kal_bool *) (data) = g_fg_is_charging;

	return STATUS_OK;
}

static signed int fgauge_read_columb(void *data);

signed int fgauge_set_columb_interrupt_internal(void *data, int reset)
{
#if defined(CONFIG_POWER_EXT)
	return STATUS_OK;
#else

	unsigned int uvalue32_CAR = 0;
	unsigned int uvalue32_CAR_MSB = 0;
	signed short upperbound = 0, lowbound = 0;
	signed short pcar = 0;
	signed short m;
	unsigned int car = *(unsigned int *) (data);
	unsigned int ret = 0;
	unsigned short *plow, *phigh, *pori;

	bm_print(BM_LOG_FULL, "fgauge_set_columb_interrupt_internal car=%d\n", car);


	plow = (unsigned short *) &lowbound;
	phigh = (unsigned short *) &upperbound;
	pori = (unsigned short *) &uvalue32_CAR;

	if (car == 0) {
		pmic_set_register_value(PMIC_RG_INT_EN_FG_BAT_H, 0);
		pmic_set_register_value(PMIC_RG_INT_EN_FG_BAT_L, 0);
		bm_print(BM_LOG_FULL,
			 "[fgauge_set_columb_interrupt] low:[0xcae]=0x%x  high:[0xcb0]=0x%x  %d %d \r\n",
			 pmic_get_register_value(PMIC_FG_BLTR),
			 pmic_get_register_value(PMIC_FG_BFTR),
			 pmic_get_register_value(PMIC_RG_INT_EN_FG_BAT_L),
			 pmic_get_register_value(PMIC_RG_INT_EN_FG_BAT_H));
		return STATUS_OK;
	}

	if (car == 0x1ffff) {
		pmic_set_register_value(PMIC_RG_INT_EN_FG_BAT_H, 1);
		pmic_set_register_value(PMIC_RG_INT_EN_FG_BAT_L, 1);

		bm_print(BM_LOG_FULL,
			 "[fgauge_set_columb_interrupt] low:[0xcae]=0x%x  high:[0xcb0]=0x%x %d %d\r\n",
			 pmic_get_register_value(PMIC_FG_BLTR),
			 pmic_get_register_value(PMIC_FG_BFTR),
			 pmic_get_register_value(PMIC_RG_INT_EN_FG_BAT_L),
			 pmic_get_register_value(PMIC_RG_INT_EN_FG_BAT_H));
		return STATUS_OK;
	}

	/* HW Init */
	/* (1)    i2c_write (0x60, 0xC8, 0x01); // Enable VA2 */
	/* (2)    i2c_write (0x61, 0x15, 0x00); // Enable FGADC clock for digital */
	/* (3)    i2c_write (0x61, 0x69, 0x28); // Set current mode, auto-calibration mode and 32KHz clock source */
	/* (4)    i2c_write (0x61, 0x69, 0x29); // Enable FGADC */

	/* Read HW Raw Data */
	/* (1)    Set READ command */
	if (reset == 0)
		ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0200, 0xFF00, 0x0);
	else
		ret = pmic_config_interface(MT6328_FGADC_CON0, 0x7300, 0xFF00, 0x0);


	/* (2)    Keep i2c read when status = 1 (0x06) */
	m = 0;
	while (fg_get_data_ready_status() == 0) {
		m++;
		if (m > 1000) {
			bm_print(BM_LOG_FULL,
				 "[fgauge_set_columb_interrupt] fg_get_data_ready_status timeout 1 !");
			break;
		}
	}
	/* (3)    Read FG_CURRENT_OUT[28:14] */
	/* (4)    Read FG_CURRENT_OUT[31] */
	uvalue32_CAR = (pmic_get_register_value(PMIC_FG_CAR_15_00)) >> 14;
	uvalue32_CAR |= ((pmic_get_register_value(PMIC_FG_CAR_31_16)) & 0x7FFF) << 2;

	uvalue32_CAR_MSB = (pmic_get_register_value(PMIC_FG_CAR_31_16) & 0x8000) >> 15;

	bm_print(BM_LOG_FULL,
		 "[fgauge_set_columb_interrupt] FG_CAR = 0x%x   uvalue32_CAR_MSB:0x%x\r\n",
		 uvalue32_CAR, uvalue32_CAR_MSB);
	uvalue32_CAR = uvalue32_CAR & 0x7fff;

	if (uvalue32_CAR_MSB == 1)
		uvalue32_CAR = uvalue32_CAR | 0x8000;


	bm_print(BM_LOG_FULL,
		 "[fgauge_set_columb_interrupt] FG_CAR = 0x%x:%d  msb=0x%x  car=0x%x:%d FG_CAR2:0x%x:%d \r\n ",
		 uvalue32_CAR, uvalue32_CAR, uvalue32_CAR_MSB, car, car, *pori, *pori);
	/* restore use_chip_trim_value() */
	car = ((car * 1000) / chip_diff_trim_value);
	car = ((car * 100) / batt_meter_cust_data.car_tune_value);
	car = ((car * batt_meter_cust_data.r_fg_value) / 20);
	car = car * 8000;
	car = car * 10;
	car = car + 5;
	car = car * 10;
	car = car / 35986;
	pcar = (signed short) car;

	upperbound = *pori;
	lowbound = *pori;

/*
	if(uvalue32_CAR_MSB==1)
	{
		upperbound=(signed short)(upperbound-upperbound*2);
		lowbound=(signed short)(lowbound-lowbound*2);
	}
*/
	bm_print(BM_LOG_FULL,
		 "[fgauge_set_columb_interrupt] upper = 0x%x:%d  low=0x%x:%d  car=0x%x:%d\r\n",
		 upperbound, upperbound, lowbound, lowbound, pcar, pcar);

	upperbound = upperbound + pcar;
	lowbound = lowbound - pcar;

	bm_print(BM_LOG_FULL,
		 "[fgauge_set_columb_interrupt]final upper = 0x%x:%d  low=0x%x:%d  car=0x%x:%d\r\n",
		 upperbound, upperbound, lowbound, lowbound, pcar, pcar);


	pmic_set_register_value(PMIC_FG_BLTR, *plow);
	pmic_set_register_value(PMIC_FG_BFTR, *phigh);
	/*msleep(1);*/usleep_range(1000, 2000);
	pmic_set_register_value(PMIC_RG_INT_EN_FG_BAT_H, 1);
	pmic_set_register_value(PMIC_RG_INT_EN_FG_BAT_L, 1);


	bm_print(BM_LOG_FULL,
		 "[fgauge_set_columb_interrupt] low:[0xcae]=0x%x  high:[0xcb0]=0x%x\r\n",
		 pmic_get_register_value(PMIC_FG_BLTR), pmic_get_register_value(PMIC_FG_BFTR));

	return STATUS_OK;
#endif

}


static signed int fgauge_set_columb_interrupt(void *data)
{
	return fgauge_set_columb_interrupt_internal(data, 0);
}

static signed int fgauge_read_columb_internal(void *data, int reset, int precise)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 0;
#else
	unsigned int uvalue32_CAR = 0;
	unsigned int uvalue32_CAR_MSB = 0;
	signed int dvalue_CAR = 0;
	int m = 0;
	long long Temp_Value = 0;
	unsigned int ret = 0;

/* HW Init */
	/* (1)    i2c_write (0x60, 0xC8, 0x01); // Enable VA2 */
	/* (2)    i2c_write (0x61, 0x15, 0x00); // Enable FGADC clock for digital */
	/* (3)    i2c_write (0x61, 0x69, 0x28); // Set current mode, auto-calibration mode and 32KHz clock source */
	/* (4)    i2c_write (0x61, 0x69, 0x29); // Enable FGADC */

/* Read HW Raw Data */
	/* (1)    Set READ command */
	if (reset == 0)
		ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0200, 0xFF00, 0x0);
	else
		ret = pmic_config_interface(MT6328_FGADC_CON0, 0x7300, 0xFF00, 0x0);


	/* (2)    Keep i2c read when status = 1 (0x06) */
	m = 0;
	while (fg_get_data_ready_status() == 0) {
		m++;
		if (m > 1000) {
			bm_print(BM_LOG_FULL,
				 "[fgauge_read_columb_internal] fg_get_data_ready_status timeout 1 !\r\n");
			break;
		}
	}
	/* (3)    Read FG_CURRENT_OUT[28:14] */
	/* (4)    Read FG_CURRENT_OUT[31] */
	uvalue32_CAR = (pmic_get_register_value(PMIC_FG_CAR_15_00)) >> 14;
	uvalue32_CAR |= ((pmic_get_register_value(PMIC_FG_CAR_31_16)) & 0x7FFF) << 2;

	uvalue32_CAR_MSB = (pmic_get_register_value(PMIC_FG_CAR_31_16) & 0x8000) >> 15;

	bm_print(BM_LOG_FULL, "[fgauge_read_columb_internal] FG_CAR = 0x%x\r\n", uvalue32_CAR);
	bm_print(BM_LOG_FULL, "[fgauge_read_columb_internal] uvalue32_CAR_MSB = 0x%x\r\n",
		 uvalue32_CAR_MSB);

	/* (5)    (Read other data) */
	/* (6)    Clear status to 0 */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0800, 0xFF00, 0x0);
	/* (7)    Keep i2c read when status = 0 (0x08) */
	/* while ( fg_get_sw_clear_status() != 0 ) */
	m = 0;
	while (fg_get_data_ready_status() != 0) {
		m++;
		if (m > 1000) {
			bm_print(BM_LOG_FULL,
				 "[fgauge_read_columb_internal] fg_get_data_ready_status timeout 2 !\r\n");
			break;
		}
	}
	/* (8)    Recover original settings */
	ret = pmic_config_interface(MT6328_FGADC_CON0, 0x0000, 0xFF00, 0x0);

/* calculate the real world data */
	dvalue_CAR = (signed int) uvalue32_CAR;

	if (uvalue32_CAR == 0) {
		Temp_Value = 0;
	} else if (uvalue32_CAR == 0x1ffff) {
		Temp_Value = 0;
	} else if (uvalue32_CAR_MSB == 0x1) {
		/* dis-charging */
		Temp_Value = (long long) (dvalue_CAR - 0x1ffff);	/* keep negative value */
		Temp_Value = Temp_Value - (Temp_Value * 2);
	} else {
		/* charging */
		Temp_Value = (long long) dvalue_CAR;
	}

#if 0
	Temp_Value = (((Temp_Value * 35986) / 10) + (5)) / 10;	/* [28:14]'s LSB=359.86 uAh */
#else
	Temp_Value = Temp_Value * 35986;
	do_div(Temp_Value, 10);
	Temp_Value = Temp_Value + 5;
	do_div(Temp_Value, 10);
#endif

#if 0
	dvalue_CAR = Temp_Value / 1000;	/* mAh */
#else
	/* dvalue_CAR = (Temp_Value/8)/1000; //mAh, due to FG_OSR=0x8 */
	if (precise == 0) {
		do_div(Temp_Value, 8);
		do_div(Temp_Value, 1000);
	} else {
		do_div(Temp_Value, 8);
		do_div(Temp_Value, 100);
	}

	if (uvalue32_CAR_MSB == 0x1)
		dvalue_CAR = (signed int) (Temp_Value - (Temp_Value * 2));	/* keep negative value */
	else
		dvalue_CAR = (signed int) Temp_Value;
#endif

	bm_print(BM_LOG_FULL, "[fgauge_read_columb_internal] dvalue_CAR = %d\r\n", dvalue_CAR);

	/* #if (OSR_SELECT_7 == 1) */



/* Auto adjust value */
	if (batt_meter_cust_data.r_fg_value != 20) {
		bm_print(BM_LOG_FULL,
			 "[fgauge_read_columb_internal] Auto adjust value deu to the Rfg is %d\n Ori CAR=%d, ",
			 batt_meter_cust_data.r_fg_value, dvalue_CAR);

		dvalue_CAR = (dvalue_CAR * 20) / batt_meter_cust_data.r_fg_value;

		bm_print(BM_LOG_FULL, "[fgauge_read_columb_internal] new CAR=%d\n", dvalue_CAR);
	}

	dvalue_CAR = ((dvalue_CAR * batt_meter_cust_data.car_tune_value) / 100);

	dvalue_CAR = use_chip_trim_value(dvalue_CAR);

	bm_print(BM_LOG_FULL, "[fgauge_read_columb_internal] final dvalue_CAR = %d\r\n",
		 dvalue_CAR);

	dump_nter();
	dump_car();

	*(signed int *) (data) = dvalue_CAR;
#endif

	return STATUS_OK;
}

static signed int fgauge_read_columb(void *data)
{
	return fgauge_read_columb_internal(data, 0, 0);
}

static signed int fgauge_read_columb_accurate(void *data)
{
	return fgauge_read_columb_internal(data, 0, 1);
}

static signed int fgauge_hw_reset(void *data)
{
#if defined(CONFIG_POWER_EXT)
	/*  */
#else
	volatile unsigned int val_car = 1;
	unsigned int val_car_temp = 1;
	unsigned int ret = 0;

	bm_print(BM_LOG_FULL, "[fgauge_hw_reset] : Start \r\n");

	while (val_car != 0x0) {
		ret = pmic_config_interface(MT6328_FGADC_CON0, 0x7100, 0xFF00, 0x0);
		fgauge_read_columb_internal(&val_car_temp, 1, 0);
		val_car = val_car_temp;
		bm_print(BM_LOG_FULL, "#");
	}

	bm_print(BM_LOG_FULL, "[fgauge_hw_reset] : End \r\n");
#endif

	return STATUS_OK;
}

static signed int read_adc_v_bat_sense(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 4201;
#else
#if defined(SWCHR_POWER_PATH)
	*(signed int *) (data) =
	    PMIC_IMM_GetOneChannelValue(MT6328_AUX_ISENSE_AP, *(signed int *) (data), 1);
#else
	*(signed int *) (data) =
	    PMIC_IMM_GetOneChannelValue(MT6328_AUX_BATSNS_AP, *(signed int *) (data), 1);
#endif
#endif

	return STATUS_OK;
}



static signed int read_adc_v_i_sense(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 4202;
#else
#if defined(SWCHR_POWER_PATH)
	*(signed int *) (data) =
	    PMIC_IMM_GetOneChannelValue(MT6328_AUX_BATSNS_AP, *(signed int *) (data), 1);
#else
	*(signed int *) (data) =
	    PMIC_IMM_GetOneChannelValue(MT6328_AUX_ISENSE_AP, *(signed int *) (data), 1);
#endif
#endif

	return STATUS_OK;
}

static signed int read_adc_v_bat_temp(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 0;
#else
#if defined(MTK_PCB_TBAT_FEATURE)
	/* no HW support */
#else
	bm_print(BM_LOG_FULL,
		 "[read_adc_v_bat_temp] return PMIC_IMM_GetOneChannelValue(4,times,1);\n");
	*(signed int *) (data) =
	    PMIC_IMM_GetOneChannelValue(MT6328_AUX_BATON_AP, *(signed int *) (data), 1);
#endif
#endif

	return STATUS_OK;
}

static signed int read_adc_v_charger(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 5001;
#else
	signed int val;

	val = PMIC_IMM_GetOneChannelValue(MT6328_AUX_VCDT_AP, *(signed int *) (data), 1);
	val =
	    (((batt_meter_cust_data.r_charger_1 +
	       batt_meter_cust_data.r_charger_2) * 100 * val) / batt_meter_cust_data.r_charger_2) /
	    100;
	*(signed int *) (data) = val;
#endif

	return STATUS_OK;
}

static signed int read_hw_ocv(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 3999;
#else
#if 0
	*(signed int *) (data) = PMIC_IMM_GetOneChannelValue(AUX_BATSNS_AP, 5, 1);
	bm_print(BM_LOG_CRTI, "[read_hw_ocv] By SW AUXADC for bring up\n");
#else
	*(signed int *) (data) = get_hw_ocv();
#endif
#endif

	return STATUS_OK;
}

static signed int read_is_hw_ocv_ready(void *data)
{
#if defined(CONFIG_POWER_EXT)
	*(signed int *) (data) = 0;
#else
#if defined(SWCHR_POWER_PATH)
	*(signed int *) (data) = pmic_get_register_value(PMIC_AUXADC_ADC_RDY_WAKEUP_SWCHR);
	bm_err("[read_is_hw_ocv_ready] is_hw_ocv_ready(SWCHR) %d\n", *(signed int *) (data));
	pmic_set_register_value(PMIC_AUXADC_ADC_RDY_WAKEUP_CLR, 1);
	mdelay(1);
	pmic_set_register_value(PMIC_AUXADC_ADC_RDY_WAKEUP_CLR, 0);
#else
	*(signed int *) (data) = pmic_get_register_value(PMIC_AUXADC_ADC_RDY_WAKEUP_PCHR);
	bm_err("[read_is_hw_ocv_ready] is_hw_ocv_ready(PCHR) %d\n", *(signed int *) (data));
	pmic_set_register_value(PMIC_AUXADC_ADC_RDY_WAKEUP_CLR, 1);
	mdelay(1);
	pmic_set_register_value(PMIC_AUXADC_ADC_RDY_WAKEUP_CLR, 0);
#endif
#endif

	return STATUS_OK;
}

static signed int dump_register_fgadc(void *data)
{
	return STATUS_OK;
}

static signed int read_battery_plug_out_status(void *data)
{
	*(signed int *) (data) = is_battery_remove_pmic();

	return STATUS_OK;
}

static signed int(*bm_func[BATTERY_METER_CMD_NUMBER]) (void *data);

signed int bm_ctrl_cmd(BATTERY_METER_CTRL_CMD cmd, void *data)
{
	signed int status = STATUS_UNSUPPORTED;
	static signed int init = -1;

	if (init == -1) {
		init = 0;
		bm_func[BATTERY_METER_CMD_HW_FG_INIT] = fgauge_initialization;
		bm_func[BATTERY_METER_CMD_GET_HW_FG_CURRENT] = fgauge_read_current;
		bm_func[BATTERY_METER_CMD_GET_HW_FG_CURRENT_SIGN] = fgauge_read_current_sign;
		bm_func[BATTERY_METER_CMD_GET_HW_FG_CAR] = fgauge_read_columb;
		bm_func[BATTERY_METER_CMD_HW_RESET] = fgauge_hw_reset;
		bm_func[BATTERY_METER_CMD_GET_ADC_V_BAT_SENSE] = read_adc_v_bat_sense;
		bm_func[BATTERY_METER_CMD_GET_ADC_V_I_SENSE] = read_adc_v_i_sense;
		bm_func[BATTERY_METER_CMD_GET_ADC_V_BAT_TEMP] = read_adc_v_bat_temp;
		bm_func[BATTERY_METER_CMD_GET_ADC_V_CHARGER] = read_adc_v_charger;
		bm_func[BATTERY_METER_CMD_GET_HW_OCV] = read_hw_ocv;
		bm_func[BATTERY_METER_CMD_DUMP_REGISTER] = dump_register_fgadc;
		bm_func[BATTERY_METER_CMD_SET_COLUMB_INTERRUPT] = fgauge_set_columb_interrupt;
		bm_func[BATTERY_METER_CMD_GET_BATTERY_PLUG_STATUS] = read_battery_plug_out_status;
		bm_func[BATTERY_METER_CMD_GET_HW_FG_CAR_ACT] = fgauge_read_columb_accurate;
		bm_func[BATTERY_METER_CMD_GET_IS_HW_OCV_READY] = read_is_hw_ocv_ready;
	}

	if (cmd < BATTERY_METER_CMD_NUMBER) {
		if (bm_func[cmd] != NULL)
			status = bm_func[cmd] (data);
	} else
		return STATUS_UNSUPPORTED;

	return status;
}

signed int pmic_is_battery_plugout(void)
{
	int is_battery_plugout;
	int pmic_strup_pwroff_seq_en = pmic_get_register_value(PMIC_STRUP_PWROFF_SEQ_EN);
	int uvlo_rstb_status = pmic_get_register_value(PMIC_UVLO_RSTB_STATUS);
	int is_long_press = (get_boot_reason() == BR_POWER_KEY ? 1 : 0);
	int is_wdt_reboot = pmic_get_register_value(PMIC_WDTRSTB_STATUS);

	pmic_set_register_value(PMIC_UVLO_RSTB_STATUS, 1);

	if (pmic_strup_pwroff_seq_en) {
		if (uvlo_rstb_status)
			is_battery_plugout = 0;
		else {
			if (is_long_press)
				is_battery_plugout = 0;
			else {
				if (is_wdt_reboot)
					is_battery_plugout = 0;
				else
					is_battery_plugout = 1;
			}
		}
	} else
		is_battery_plugout = 1;

	bm_err("[pmic_is_battery_plugout] [%d] %d, %d, %d, %d\n",
		is_battery_plugout, pmic_strup_pwroff_seq_en, uvlo_rstb_status, is_long_press, is_wdt_reboot);
	return is_battery_plugout;
}