drivers/power/88pm860x_charger.c - kernel/msm-4.9 - Gitiles

 /*
  * Battery driver for Marvell 88PM860x PMIC
  *
  * Copyright (c) 2012 Marvell International Ltd.
  * Author:	Jett Zhou <jtzhou@marvell.com>
  *		Haojian Zhuang <haojian.zhuang@marvell.com>
  *
  * 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.
  */

 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/platform_device.h>
 #include <linux/slab.h>
 #include <linux/power_supply.h>
 #include <linux/mfd/88pm860x.h>
 #include <linux/delay.h>
 #include <linux/uaccess.h>
 #include <asm/div64.h>

 /* bit definitions of Status Query Interface 2 */
 #define STATUS2_CHG		(1 << 2)

 /* bit definitions of Reset Out Register */
 #define RESET_SW_PD		(1 << 7)

 /* bit definitions of PreReg 1 */
 #define PREREG1_90MA		(0x0)
 #define PREREG1_180MA		(0x1)
 #define PREREG1_450MA		(0x4)
 #define PREREG1_540MA		(0x5)
 #define PREREG1_1350MA		(0xE)
 #define PREREG1_VSYS_4_5V	(3 << 4)

 /* bit definitions of Charger Control 1 Register */
 #define CC1_MODE_OFF		(0)
 #define CC1_MODE_PRECHARGE	(1)
 #define CC1_MODE_FASTCHARGE	(2)
 #define CC1_MODE_PULSECHARGE	(3)
 #define CC1_ITERM_20MA		(0 << 2)
 #define CC1_ITERM_60MA		(2 << 2)
 #define CC1_VFCHG_4_2V		(9 << 4)

 /* bit definitions of Charger Control 2 Register */
 #define CC2_ICHG_100MA		(0x1)
 #define CC2_ICHG_500MA		(0x9)
 #define CC2_ICHG_1000MA		(0x13)

 /* bit definitions of Charger Control 3 Register */
 #define CC3_180MIN_TIMEOUT	(0x6 << 4)
 #define CC3_270MIN_TIMEOUT	(0x7 << 4)
 #define CC3_360MIN_TIMEOUT	(0xA << 4)
 #define CC3_DISABLE_TIMEOUT	(0xF << 4)

 /* bit definitions of Charger Control 4 Register */
 #define CC4_IPRE_40MA		(7)
 #define CC4_VPCHG_3_2V		(3 << 4)
 #define CC4_IFCHG_MON_EN	(1 << 6)
 #define CC4_BTEMP_MON_EN	(1 << 7)

 /* bit definitions of Charger Control 6 Register */
 #define CC6_BAT_OV_EN		(1 << 2)
 #define CC6_BAT_UV_EN		(1 << 3)
 #define CC6_UV_VBAT_SET		(0x3 << 6)	/* 2.8v */

 /* bit definitions of Charger Control 7 Register */
 #define CC7_BAT_REM_EN		(1 << 3)
 #define CC7_IFSM_EN		(1 << 7)

 /* bit definitions of Measurement Enable 1 Register */
 #define MEAS1_VBAT		(1 << 0)

 /* bit definitions of Measurement Enable 3 Register */
 #define MEAS3_IBAT_EN		(1 << 0)
 #define MEAS3_CC_EN		(1 << 2)

 #define FSM_INIT		0
 #define FSM_DISCHARGE		1
 #define FSM_PRECHARGE		2
 #define FSM_FASTCHARGE		3

 #define PRECHARGE_THRESHOLD	3100
 #define POWEROFF_THRESHOLD	3400
 #define CHARGE_THRESHOLD	4000
 #define DISCHARGE_THRESHOLD	4180

 /* over-temperature on PM8606 setting */
 #define OVER_TEMP_FLAG		(1 << 6)
 #define OVTEMP_AUTORECOVER	(1 << 3)

 /* over-voltage protect on vchg setting mv */
 #define VCHG_NORMAL_LOW		4200
 #define VCHG_NORMAL_CHECK	5800
 #define VCHG_NORMAL_HIGH	6000
 #define VCHG_OVP_LOW		5500

 struct pm860x_charger_info {
 	struct pm860x_chip *chip;
 	struct i2c_client *i2c;
 	struct i2c_client *i2c_8606;
 	struct device *dev;

 	struct power_supply *usb;
 	struct mutex lock;
 	int irq_nums;
 	int irq[7];
 	unsigned state:3;	/* fsm state */
 	unsigned online:1;	/* usb charger */
 	unsigned present:1;	/* battery present */
 	unsigned allowed:1;
 };

 static char *pm860x_supplied_to[] = {
 	"battery-monitor",
 };

 static int measure_vchg(struct pm860x_charger_info *info, int *data)
 {
 	unsigned char buf[2];
 	int ret = 0;

 	ret = pm860x_bulk_read(info->i2c, PM8607_VCHG_MEAS1, 2, buf);
 	if (ret < 0)
 		return ret;

 	*data = ((buf[0] & 0xff) << 4) | (buf[1] & 0x0f);
 	/* V_BATT_MEAS(mV) = value * 5 * 1.8 * 1000 / (2^12) */
 	*data = ((*data & 0xfff) * 9 * 125) >> 9;

 	dev_dbg(info->dev, "%s, vchg: %d mv\n", __func__, *data);

 	return ret;
 }

 static void set_vchg_threshold(struct pm860x_charger_info *info,
 			       int min, int max)
 {
 	int data;

 	/* (tmp << 8) * / 5 / 1800 */
 	if (min <= 0)
 		data = 0;
 	else
 		data = (min << 5) / 1125;
 	pm860x_reg_write(info->i2c, PM8607_VCHG_LOWTH, data);
 	dev_dbg(info->dev, "VCHG_LOWTH:%dmv, 0x%x\n", min, data);

 	if (max <= 0)
 		data = 0xff;
 	else
 		data = (max << 5) / 1125;
 	pm860x_reg_write(info->i2c, PM8607_VCHG_HIGHTH, data);
 	dev_dbg(info->dev, "VCHG_HIGHTH:%dmv, 0x%x\n", max, data);

 }

 static void set_vbatt_threshold(struct pm860x_charger_info *info,
 				int min, int max)
 {
 	int data;

 	/* (tmp << 8) * 3 / 1800 */
 	if (min <= 0)
 		data = 0;
 	else
 		data = (min << 5) / 675;
 	pm860x_reg_write(info->i2c, PM8607_VBAT_LOWTH, data);
 	dev_dbg(info->dev, "VBAT Min:%dmv, LOWTH:0x%x\n", min, data);

 	if (max <= 0)
 		data = 0xff;
 	else
 		data = (max << 5) / 675;
 	pm860x_reg_write(info->i2c, PM8607_VBAT_HIGHTH, data);
 	dev_dbg(info->dev, "VBAT Max:%dmv, HIGHTH:0x%x\n", max, data);

 	return;
 }

 static int start_precharge(struct pm860x_charger_info *info)
 {
 	int ret;

 	dev_dbg(info->dev, "Start Pre-charging!\n");
 	set_vbatt_threshold(info, 0, 0);

 	ret = pm860x_reg_write(info->i2c_8606, PM8606_PREREGULATORA,
 			       PREREG1_1350MA | PREREG1_VSYS_4_5V);
 	if (ret < 0)
 		goto out;
 	/* stop charging */
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
 			      CC1_MODE_OFF);
 	if (ret < 0)
 		goto out;
 	/* set 270 minutes timeout */
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL3, (0xf << 4),
 			      CC3_270MIN_TIMEOUT);
 	if (ret < 0)
 		goto out;
 	/* set precharge current, termination voltage, IBAT & TBAT monitor */
 	ret = pm860x_reg_write(info->i2c, PM8607_CHG_CTRL4,
 			       CC4_IPRE_40MA | CC4_VPCHG_3_2V |
 			       CC4_IFCHG_MON_EN | CC4_BTEMP_MON_EN);
 	if (ret < 0)
 		goto out;
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL7,
 			      CC7_BAT_REM_EN | CC7_IFSM_EN,
 			      CC7_BAT_REM_EN | CC7_IFSM_EN);
 	if (ret < 0)
 		goto out;
 	/* trigger precharge */
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
 			      CC1_MODE_PRECHARGE);
 out:
 	return ret;
 }

 static int start_fastcharge(struct pm860x_charger_info *info)
 {
 	int ret;

 	dev_dbg(info->dev, "Start Fast-charging!\n");

 	/* set fastcharge termination current & voltage, disable charging */
 	ret = pm860x_reg_write(info->i2c, PM8607_CHG_CTRL1,
 			       CC1_MODE_OFF | CC1_ITERM_60MA |
 			       CC1_VFCHG_4_2V);
 	if (ret < 0)
 		goto out;
 	ret = pm860x_reg_write(info->i2c_8606, PM8606_PREREGULATORA,
 			       PREREG1_540MA | PREREG1_VSYS_4_5V);
 	if (ret < 0)
 		goto out;
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL2, 0x1f,
 			      CC2_ICHG_500MA);
 	if (ret < 0)
 		goto out;
 	/* set 270 minutes timeout */
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL3, (0xf << 4),
 			      CC3_270MIN_TIMEOUT);
 	if (ret < 0)
 		goto out;
 	/* set IBAT & TBAT monitor */
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL4,
 			      CC4_IFCHG_MON_EN | CC4_BTEMP_MON_EN,
 			      CC4_IFCHG_MON_EN | CC4_BTEMP_MON_EN);
 	if (ret < 0)
 		goto out;
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL6,
 			      CC6_BAT_OV_EN | CC6_BAT_UV_EN |
 			      CC6_UV_VBAT_SET,
 			      CC6_BAT_OV_EN | CC6_BAT_UV_EN |
 			      CC6_UV_VBAT_SET);
 	if (ret < 0)
 		goto out;
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL7,
 			      CC7_BAT_REM_EN | CC7_IFSM_EN,
 			      CC7_BAT_REM_EN | CC7_IFSM_EN);
 	if (ret < 0)
 		goto out;
 	/* launch fast-charge */
 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
 			      CC1_MODE_FASTCHARGE);
 	/* vchg threshold setting */
 	set_vchg_threshold(info, VCHG_NORMAL_LOW, VCHG_NORMAL_HIGH);
 out:
 	return ret;
 }

 static void stop_charge(struct pm860x_charger_info *info, int vbatt)
 {
 	dev_dbg(info->dev, "Stop charging!\n");
 	pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3, CC1_MODE_OFF);
 	if (vbatt > CHARGE_THRESHOLD && info->online)
 		set_vbatt_threshold(info, CHARGE_THRESHOLD, 0);
 }

 static void power_off_notification(struct pm860x_charger_info *info)
 {
 	dev_dbg(info->dev, "Power-off notification!\n");
 }

 static int set_charging_fsm(struct pm860x_charger_info *info)
 {
 	struct power_supply *psy;
 	union power_supply_propval data;
 	unsigned char fsm_state[][16] = { "init", "discharge", "precharge",
 		"fastcharge",
 	};
 	int ret;
 	int vbatt;

 	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
 	if (!psy)
 		return -EINVAL;
 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW,
 			&data);
 	if (ret) {
 		power_supply_put(psy);
 		return ret;
 	}
 	vbatt = data.intval / 1000;

 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_PRESENT, &data);
 	if (ret) {
 		power_supply_put(psy);
 		return ret;
 	}
 	power_supply_put(psy);

 	mutex_lock(&info->lock);
 	info->present = data.intval;

 	dev_dbg(info->dev, "Entering FSM:%s, Charger:%s, Battery:%s, "
 		"Allowed:%d\n",
 		&fsm_state[info->state][0],
 		(info->online) ? "online" : "N/A",
 		(info->present) ? "present" : "N/A", info->allowed);
 	dev_dbg(info->dev, "set_charging_fsm:vbatt:%d(mV)\n", vbatt);

 	switch (info->state) {
 	case FSM_INIT:
 		if (info->online && info->present && info->allowed) {
 			if (vbatt < PRECHARGE_THRESHOLD) {
 				info->state = FSM_PRECHARGE;
 				start_precharge(info);
 			} else if (vbatt > DISCHARGE_THRESHOLD) {
 				info->state = FSM_DISCHARGE;
 				stop_charge(info, vbatt);
 			} else if (vbatt < DISCHARGE_THRESHOLD) {
 				info->state = FSM_FASTCHARGE;
 				start_fastcharge(info);
 			}
 		} else {
 			if (vbatt < POWEROFF_THRESHOLD) {
 				power_off_notification(info);
 			} else {
 				info->state = FSM_DISCHARGE;
 				stop_charge(info, vbatt);
 			}
 		}
 		break;
 	case FSM_PRECHARGE:
 		if (info->online && info->present && info->allowed) {
 			if (vbatt > PRECHARGE_THRESHOLD) {
 				info->state = FSM_FASTCHARGE;
 				start_fastcharge(info);
 			}
 		} else {
 			info->state = FSM_DISCHARGE;
 			stop_charge(info, vbatt);
 		}
 		break;
 	case FSM_FASTCHARGE:
 		if (info->online && info->present && info->allowed) {
 			if (vbatt < PRECHARGE_THRESHOLD) {
 				info->state = FSM_PRECHARGE;
 				start_precharge(info);
 			}
 		} else {
 			info->state = FSM_DISCHARGE;
 			stop_charge(info, vbatt);
 		}
 		break;
 	case FSM_DISCHARGE:
 		if (info->online && info->present && info->allowed) {
 			if (vbatt < PRECHARGE_THRESHOLD) {
 				info->state = FSM_PRECHARGE;
 				start_precharge(info);
 			} else if (vbatt < DISCHARGE_THRESHOLD) {
 				info->state = FSM_FASTCHARGE;
 				start_fastcharge(info);
 			}
 		} else {
 			if (vbatt < POWEROFF_THRESHOLD)
 				power_off_notification(info);
 			else if (vbatt > CHARGE_THRESHOLD && info->online)
 				set_vbatt_threshold(info, CHARGE_THRESHOLD, 0);
 		}
 		break;
 	default:
 		dev_warn(info->dev, "FSM meets wrong state:%d\n",
 			 info->state);
 		break;
 	}
 	dev_dbg(info->dev,
 		"Out FSM:%s, Charger:%s, Battery:%s, Allowed:%d\n",
 		&fsm_state[info->state][0],
 		(info->online) ? "online" : "N/A",
 		(info->present) ? "present" : "N/A", info->allowed);
 	mutex_unlock(&info->lock);

 	return 0;
 }

 static irqreturn_t pm860x_charger_handler(int irq, void *data)
 {
 	struct pm860x_charger_info *info = data;
 	int ret;

 	mutex_lock(&info->lock);
 	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
 	if (ret < 0) {
 		mutex_unlock(&info->lock);
 		goto out;
 	}
 	if (ret & STATUS2_CHG) {
 		info->online = 1;
 		info->allowed = 1;
 	} else {
 		info->online = 0;
 		info->allowed = 0;
 	}
 	mutex_unlock(&info->lock);
 	dev_dbg(info->dev, "%s, Charger:%s, Allowed:%d\n", __func__,
 		(info->online) ? "online" : "N/A", info->allowed);

 	set_charging_fsm(info);

 	power_supply_changed(info->usb);
 out:
 	return IRQ_HANDLED;
 }

 static irqreturn_t pm860x_temp_handler(int irq, void *data)
 {
 	struct power_supply *psy;
 	struct pm860x_charger_info *info = data;
 	union power_supply_propval temp;
 	int value;
 	int ret;

 	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
 	if (!psy)
 		goto out;
 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_TEMP, &temp);
 	if (ret)
 		goto out;
 	value = temp.intval / 10;

 	mutex_lock(&info->lock);
 	/* Temperature < -10 C or >40 C, Will not allow charge */
 	if (value < -10 || value > 40)
 		info->allowed = 0;
 	else
 		info->allowed = 1;
 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
 	mutex_unlock(&info->lock);

 	set_charging_fsm(info);
 out:
 	power_supply_put(psy);
 	return IRQ_HANDLED;
 }

 static irqreturn_t pm860x_exception_handler(int irq, void *data)
 {
 	struct pm860x_charger_info *info = data;

 	mutex_lock(&info->lock);
 	info->allowed = 0;
 	mutex_unlock(&info->lock);
 	dev_dbg(info->dev, "%s, irq: %d\n", __func__, irq);

 	set_charging_fsm(info);
 	return IRQ_HANDLED;
 }

 static irqreturn_t pm860x_done_handler(int irq, void *data)
 {
 	struct pm860x_charger_info *info = data;
 	struct power_supply *psy;
 	union power_supply_propval val;
 	int ret;
 	int vbatt;

 	mutex_lock(&info->lock);
 	/* pre-charge done, will transimit to fast-charge stage */
 	if (info->state == FSM_PRECHARGE) {
 		info->allowed = 1;
 		goto out;
 	}
 	/*
 	 * Fast charge done, delay to read
 	 * the correct status of CHG_DET.
 	 */
 	mdelay(5);
 	info->allowed = 0;
 	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
 	if (!psy)
 		goto out;
 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW,
 			&val);
 	if (ret)
 		goto out_psy_put;
 	vbatt = val.intval / 1000;
 	/*
 	 * CHG_DONE interrupt is faster than CHG_DET interrupt when
 	 * plug in/out usb, So we can not rely on info->online, we
 	 * need check pm8607 status register to check usb is online
 	 * or not, then we can decide it is real charge done
 	 * automatically or it is triggered by usb plug out;
 	 */
 	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
 	if (ret < 0)
 		goto out_psy_put;
 	if (vbatt > CHARGE_THRESHOLD && ret & STATUS2_CHG)
 		power_supply_set_property(psy, POWER_SUPPLY_PROP_CHARGE_FULL,
 				&val);

 out_psy_put:
 	power_supply_put(psy);
 out:
 	mutex_unlock(&info->lock);
 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
 	set_charging_fsm(info);

 	return IRQ_HANDLED;
 }

 static irqreturn_t pm860x_vbattery_handler(int irq, void *data)
 {
 	struct pm860x_charger_info *info = data;

 	mutex_lock(&info->lock);

 	set_vbatt_threshold(info, 0, 0);

 	if (info->present && info->online)
 		info->allowed = 1;
 	else
 		info->allowed = 0;
 	mutex_unlock(&info->lock);
 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);

 	set_charging_fsm(info);

 	return IRQ_HANDLED;
 }

 static irqreturn_t pm860x_vchg_handler(int irq, void *data)
 {
 	struct pm860x_charger_info *info = data;
 	int vchg = 0;

 	if (info->present)
 		goto out;

 	measure_vchg(info, &vchg);

 	mutex_lock(&info->lock);
 	if (!info->online) {
 		int status;
 		/* check if over-temp on pm8606 or not */
 		status = pm860x_reg_read(info->i2c_8606, PM8606_FLAGS);
 		if (status & OVER_TEMP_FLAG) {
 			/* clear over temp flag and set auto recover */
 			pm860x_set_bits(info->i2c_8606, PM8606_FLAGS,
 					OVER_TEMP_FLAG, OVER_TEMP_FLAG);
 			pm860x_set_bits(info->i2c_8606,
 					PM8606_VSYS,
 					OVTEMP_AUTORECOVER,
 					OVTEMP_AUTORECOVER);
 			dev_dbg(info->dev,
 				"%s, pm8606 over-temp occurred\n", __func__);
 		}
 	}

 	if (vchg > VCHG_NORMAL_CHECK) {
 		set_vchg_threshold(info, VCHG_OVP_LOW, 0);
 		info->allowed = 0;
 		dev_dbg(info->dev,
 			"%s,pm8607 over-vchg occurred,vchg = %dmv\n",
 			__func__, vchg);
 	} else if (vchg < VCHG_OVP_LOW) {
 		set_vchg_threshold(info, VCHG_NORMAL_LOW,
 				   VCHG_NORMAL_HIGH);
 		info->allowed = 1;
 		dev_dbg(info->dev,
 			"%s,pm8607 over-vchg recover,vchg = %dmv\n",
 			__func__, vchg);
 	}
 	mutex_unlock(&info->lock);

 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
 	set_charging_fsm(info);
 out:
 	return IRQ_HANDLED;
 }

 static int pm860x_usb_get_prop(struct power_supply *psy,
 			       enum power_supply_property psp,
 			       union power_supply_propval *val)
 {
 	struct pm860x_charger_info *info = power_supply_get_drvdata(psy);

 	switch (psp) {
 	case POWER_SUPPLY_PROP_STATUS:
 		if (info->state == FSM_FASTCHARGE ||
 				info->state == FSM_PRECHARGE)
 			val->intval = POWER_SUPPLY_STATUS_CHARGING;
 		else
 			val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
 		break;
 	case POWER_SUPPLY_PROP_ONLINE:
 		val->intval = info->online;
 		break;
 	default:
 		return -ENODEV;
 	}
 	return 0;
 }

 static enum power_supply_property pm860x_usb_props[] = {
 	POWER_SUPPLY_PROP_STATUS,
 	POWER_SUPPLY_PROP_ONLINE,
 };

 static int pm860x_init_charger(struct pm860x_charger_info *info)
 {
 	int ret;

 	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
 	if (ret < 0)
 		return ret;

 	mutex_lock(&info->lock);
 	info->state = FSM_INIT;
 	if (ret & STATUS2_CHG) {
 		info->online = 1;
 		info->allowed = 1;
 	} else {
 		info->online = 0;
 		info->allowed = 0;
 	}
 	mutex_unlock(&info->lock);

 	set_charging_fsm(info);
 	return 0;
 }

 static struct pm860x_irq_desc {
 	const char *name;
 	irqreturn_t (*handler)(int irq, void *data);
 } pm860x_irq_descs[] = {
 	{ "usb supply detect", pm860x_charger_handler },
 	{ "charge done", pm860x_done_handler },
 	{ "charge timeout", pm860x_exception_handler },
 	{ "charge fault", pm860x_exception_handler },
 	{ "temperature", pm860x_temp_handler },
 	{ "vbatt", pm860x_vbattery_handler },
 	{ "vchg", pm860x_vchg_handler },
 };

 static const struct power_supply_desc pm860x_charger_desc = {
 	.name		= "usb",
 	.type		= POWER_SUPPLY_TYPE_USB,
 	.properties	= pm860x_usb_props,
 	.num_properties	= ARRAY_SIZE(pm860x_usb_props),
 	.get_property	= pm860x_usb_get_prop,
 };

 static int pm860x_charger_probe(struct platform_device *pdev)
 {
 	struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
 	struct power_supply_config psy_cfg = {};
 	struct pm860x_charger_info *info;
 	int ret;
 	int count;
 	int i;
 	int j;

 	info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
 	if (!info)
 		return -ENOMEM;

 	count = pdev->num_resources;
 	for (i = 0, j = 0; i < count; i++) {
 		info->irq[j] = platform_get_irq(pdev, i);
 		if (info->irq[j] < 0)
 			continue;
 		j++;
 	}
 	info->irq_nums = j;

 	info->chip = chip;
 	info->i2c =
 	    (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
 	info->i2c_8606 =
 	    (chip->id == CHIP_PM8607) ? chip->companion : chip->client;
 	if (!info->i2c_8606) {
 		dev_err(&pdev->dev, "Missed I2C address of 88PM8606!\n");
 		ret = -EINVAL;
 		goto out;
 	}
 	info->dev = &pdev->dev;

 	/* set init value for the case we are not using battery */
 	set_vchg_threshold(info, VCHG_NORMAL_LOW, VCHG_OVP_LOW);

 	mutex_init(&info->lock);
 	platform_set_drvdata(pdev, info);

 	psy_cfg.drv_data = info;
 	psy_cfg.supplied_to = pm860x_supplied_to;
 	psy_cfg.num_supplicants = ARRAY_SIZE(pm860x_supplied_to);
 	info->usb = power_supply_register(&pdev->dev, &pm860x_charger_desc,
 					  &psy_cfg);
 	if (IS_ERR(info->usb)) {
 		ret = PTR_ERR(info->usb);
 		goto out;
 	}

 	pm860x_init_charger(info);

 	for (i = 0; i < ARRAY_SIZE(info->irq); i++) {
 		ret = request_threaded_irq(info->irq[i], NULL,
 			pm860x_irq_descs[i].handler,
 			IRQF_ONESHOT, pm860x_irq_descs[i].name, info);
 		if (ret < 0) {
 			dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n",
 				info->irq[i], ret);
 			goto out_irq;
 		}
 	}
 	return 0;

 out_irq:
 	power_supply_unregister(info->usb);
 	while (--i >= 0)
 		free_irq(info->irq[i], info);
 out:
 	return ret;
 }

 static int pm860x_charger_remove(struct platform_device *pdev)
 {
 	struct pm860x_charger_info *info = platform_get_drvdata(pdev);
 	int i;

 	power_supply_unregister(info->usb);
 	free_irq(info->irq[0], info);
 	for (i = 0; i < info->irq_nums; i++)
 		free_irq(info->irq[i], info);
 	return 0;
 }

 static struct platform_driver pm860x_charger_driver = {
 	.driver = {
 		   .name = "88pm860x-charger",
 	},
 	.probe = pm860x_charger_probe,
 	.remove = pm860x_charger_remove,
 };
 module_platform_driver(pm860x_charger_driver);

 MODULE_DESCRIPTION("Marvell 88PM860x Charger driver");
 MODULE_LICENSE("GPL");
	/*
	* Battery driver for Marvell 88PM860x PMIC
	*
	* Copyright (c) 2012 Marvell International Ltd.
	* Author: Jett Zhou <jtzhou@marvell.com>
	* Haojian Zhuang <haojian.zhuang@marvell.com>
	*
	* 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.
	*/

	#include <linux/kernel.h>
	#include <linux/module.h>
	#include <linux/platform_device.h>
	#include <linux/slab.h>
	#include <linux/power_supply.h>
	#include <linux/mfd/88pm860x.h>
	#include <linux/delay.h>
	#include <linux/uaccess.h>
	#include <asm/div64.h>

	/* bit definitions of Status Query Interface 2 */
	#define STATUS2_CHG (1 << 2)

	/* bit definitions of Reset Out Register */
	#define RESET_SW_PD (1 << 7)

	/* bit definitions of PreReg 1 */
	#define PREREG1_90MA (0x0)
	#define PREREG1_180MA (0x1)
	#define PREREG1_450MA (0x4)
	#define PREREG1_540MA (0x5)
	#define PREREG1_1350MA (0xE)
	#define PREREG1_VSYS_4_5V (3 << 4)

	/* bit definitions of Charger Control 1 Register */
	#define CC1_MODE_OFF (0)
	#define CC1_MODE_PRECHARGE (1)
	#define CC1_MODE_FASTCHARGE (2)
	#define CC1_MODE_PULSECHARGE (3)
	#define CC1_ITERM_20MA (0 << 2)
	#define CC1_ITERM_60MA (2 << 2)
	#define CC1_VFCHG_4_2V (9 << 4)

	/* bit definitions of Charger Control 2 Register */
	#define CC2_ICHG_100MA (0x1)
	#define CC2_ICHG_500MA (0x9)
	#define CC2_ICHG_1000MA (0x13)

	/* bit definitions of Charger Control 3 Register */
	#define CC3_180MIN_TIMEOUT (0x6 << 4)
	#define CC3_270MIN_TIMEOUT (0x7 << 4)
	#define CC3_360MIN_TIMEOUT (0xA << 4)
	#define CC3_DISABLE_TIMEOUT (0xF << 4)

	/* bit definitions of Charger Control 4 Register */
	#define CC4_IPRE_40MA (7)
	#define CC4_VPCHG_3_2V (3 << 4)
	#define CC4_IFCHG_MON_EN (1 << 6)
	#define CC4_BTEMP_MON_EN (1 << 7)

	/* bit definitions of Charger Control 6 Register */
	#define CC6_BAT_OV_EN (1 << 2)
	#define CC6_BAT_UV_EN (1 << 3)
	#define CC6_UV_VBAT_SET (0x3 << 6) /* 2.8v */

	/* bit definitions of Charger Control 7 Register */
	#define CC7_BAT_REM_EN (1 << 3)
	#define CC7_IFSM_EN (1 << 7)

	/* bit definitions of Measurement Enable 1 Register */
	#define MEAS1_VBAT (1 << 0)

	/* bit definitions of Measurement Enable 3 Register */
	#define MEAS3_IBAT_EN (1 << 0)
	#define MEAS3_CC_EN (1 << 2)

	#define FSM_INIT 0
	#define FSM_DISCHARGE 1
	#define FSM_PRECHARGE 2
	#define FSM_FASTCHARGE 3

	#define PRECHARGE_THRESHOLD 3100
	#define POWEROFF_THRESHOLD 3400
	#define CHARGE_THRESHOLD 4000
	#define DISCHARGE_THRESHOLD 4180

	/* over-temperature on PM8606 setting */
	#define OVER_TEMP_FLAG (1 << 6)
	#define OVTEMP_AUTORECOVER (1 << 3)

	/* over-voltage protect on vchg setting mv */
	#define VCHG_NORMAL_LOW 4200
	#define VCHG_NORMAL_CHECK 5800
	#define VCHG_NORMAL_HIGH 6000
	#define VCHG_OVP_LOW 5500

	struct pm860x_charger_info {
	struct pm860x_chip *chip;
	struct i2c_client *i2c;
	struct i2c_client *i2c_8606;
	struct device *dev;

	struct power_supply *usb;
	struct mutex lock;
	int irq_nums;
	int irq[7];
	unsigned state:3; /* fsm state */
	unsigned online:1; /* usb charger */
	unsigned present:1; /* battery present */
	unsigned allowed:1;
	};

	static char *pm860x_supplied_to[] = {
	"battery-monitor",
	};

	static int measure_vchg(struct pm860x_charger_info info, int data)
	{
	unsigned char buf[2];
	int ret = 0;

	ret = pm860x_bulk_read(info->i2c, PM8607_VCHG_MEAS1, 2, buf);
	if (ret < 0)
	return ret;

	*data = ((buf[0] & 0xff) << 4) \| (buf[1] & 0x0f);
	/* V_BATT_MEAS(mV) = value * 5 * 1.8 * 1000 / (2^12) */
	data = ((data & 0xfff) * 9 * 125) >> 9;

	dev_dbg(info->dev, "%s, vchg: %d mv\n", __func__, *data);

	return ret;
	}

	static void set_vchg_threshold(struct pm860x_charger_info *info,
	int min, int max)
	{
	int data;

	/* (tmp << 8) * / 5 / 1800 */
	if (min <= 0)
	data = 0;
	else
	data = (min << 5) / 1125;
	pm860x_reg_write(info->i2c, PM8607_VCHG_LOWTH, data);
	dev_dbg(info->dev, "VCHG_LOWTH:%dmv, 0x%x\n", min, data);

	if (max <= 0)
	data = 0xff;
	else
	data = (max << 5) / 1125;
	pm860x_reg_write(info->i2c, PM8607_VCHG_HIGHTH, data);
	dev_dbg(info->dev, "VCHG_HIGHTH:%dmv, 0x%x\n", max, data);

	}

	static void set_vbatt_threshold(struct pm860x_charger_info *info,
	int min, int max)
	{
	int data;

	/* (tmp << 8) * 3 / 1800 */
	if (min <= 0)
	data = 0;
	else
	data = (min << 5) / 675;
	pm860x_reg_write(info->i2c, PM8607_VBAT_LOWTH, data);
	dev_dbg(info->dev, "VBAT Min:%dmv, LOWTH:0x%x\n", min, data);

	if (max <= 0)
	data = 0xff;
	else
	data = (max << 5) / 675;
	pm860x_reg_write(info->i2c, PM8607_VBAT_HIGHTH, data);
	dev_dbg(info->dev, "VBAT Max:%dmv, HIGHTH:0x%x\n", max, data);

	return;
	}

	static int start_precharge(struct pm860x_charger_info *info)
	{
	int ret;

	dev_dbg(info->dev, "Start Pre-charging!\n");
	set_vbatt_threshold(info, 0, 0);

	ret = pm860x_reg_write(info->i2c_8606, PM8606_PREREGULATORA,
	PREREG1_1350MA \| PREREG1_VSYS_4_5V);
	if (ret < 0)
	goto out;
	/* stop charging */
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
	CC1_MODE_OFF);
	if (ret < 0)
	goto out;
	/* set 270 minutes timeout */
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL3, (0xf << 4),
	CC3_270MIN_TIMEOUT);
	if (ret < 0)
	goto out;
	/* set precharge current, termination voltage, IBAT & TBAT monitor */
	ret = pm860x_reg_write(info->i2c, PM8607_CHG_CTRL4,
	CC4_IPRE_40MA \| CC4_VPCHG_3_2V \|
	CC4_IFCHG_MON_EN \| CC4_BTEMP_MON_EN);
	if (ret < 0)
	goto out;
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL7,
	CC7_BAT_REM_EN \| CC7_IFSM_EN,
	CC7_BAT_REM_EN \| CC7_IFSM_EN);
	if (ret < 0)
	goto out;
	/* trigger precharge */
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
	CC1_MODE_PRECHARGE);
	out:
	return ret;
	}

	static int start_fastcharge(struct pm860x_charger_info *info)
	{
	int ret;

	dev_dbg(info->dev, "Start Fast-charging!\n");

	/* set fastcharge termination current & voltage, disable charging */
	ret = pm860x_reg_write(info->i2c, PM8607_CHG_CTRL1,
	CC1_MODE_OFF \| CC1_ITERM_60MA \|
	CC1_VFCHG_4_2V);
	if (ret < 0)
	goto out;
	ret = pm860x_reg_write(info->i2c_8606, PM8606_PREREGULATORA,
	PREREG1_540MA \| PREREG1_VSYS_4_5V);
	if (ret < 0)
	goto out;
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL2, 0x1f,
	CC2_ICHG_500MA);
	if (ret < 0)
	goto out;
	/* set 270 minutes timeout */
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL3, (0xf << 4),
	CC3_270MIN_TIMEOUT);
	if (ret < 0)
	goto out;
	/* set IBAT & TBAT monitor */
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL4,
	CC4_IFCHG_MON_EN \| CC4_BTEMP_MON_EN,
	CC4_IFCHG_MON_EN \| CC4_BTEMP_MON_EN);
	if (ret < 0)
	goto out;
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL6,
	CC6_BAT_OV_EN \| CC6_BAT_UV_EN \|
	CC6_UV_VBAT_SET,
	CC6_BAT_OV_EN \| CC6_BAT_UV_EN \|
	CC6_UV_VBAT_SET);
	if (ret < 0)
	goto out;
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL7,
	CC7_BAT_REM_EN \| CC7_IFSM_EN,
	CC7_BAT_REM_EN \| CC7_IFSM_EN);
	if (ret < 0)
	goto out;
	/* launch fast-charge */
	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
	CC1_MODE_FASTCHARGE);
	/* vchg threshold setting */
	set_vchg_threshold(info, VCHG_NORMAL_LOW, VCHG_NORMAL_HIGH);
	out:
	return ret;
	}

	static void stop_charge(struct pm860x_charger_info *info, int vbatt)
	{
	dev_dbg(info->dev, "Stop charging!\n");
	pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3, CC1_MODE_OFF);
	if (vbatt > CHARGE_THRESHOLD && info->online)
	set_vbatt_threshold(info, CHARGE_THRESHOLD, 0);
	}

	static void power_off_notification(struct pm860x_charger_info *info)
	{
	dev_dbg(info->dev, "Power-off notification!\n");
	}

	static int set_charging_fsm(struct pm860x_charger_info *info)
	{
	struct power_supply *psy;
	union power_supply_propval data;
	unsigned char fsm_state[][16] = { "init", "discharge", "precharge",
	"fastcharge",
	};
	int ret;
	int vbatt;

	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
	if (!psy)
	return -EINVAL;
	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW,
	&data);
	if (ret) {
	power_supply_put(psy);
	return ret;
	}
	vbatt = data.intval / 1000;

	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_PRESENT, &data);
	if (ret) {
	power_supply_put(psy);
	return ret;
	}
	power_supply_put(psy);

	mutex_lock(&info->lock);
	info->present = data.intval;

	dev_dbg(info->dev, "Entering FSM:%s, Charger:%s, Battery:%s, "
	"Allowed:%d\n",
	&fsm_state[info->state][0],
	(info->online) ? "online" : "N/A",
	(info->present) ? "present" : "N/A", info->allowed);
	dev_dbg(info->dev, "set_charging_fsm:vbatt:%d(mV)\n", vbatt);

	switch (info->state) {
	case FSM_INIT:
	if (info->online && info->present && info->allowed) {
	if (vbatt < PRECHARGE_THRESHOLD) {
	info->state = FSM_PRECHARGE;
	start_precharge(info);
	} else if (vbatt > DISCHARGE_THRESHOLD) {
	info->state = FSM_DISCHARGE;
	stop_charge(info, vbatt);
	} else if (vbatt < DISCHARGE_THRESHOLD) {
	info->state = FSM_FASTCHARGE;
	start_fastcharge(info);
	}
	} else {
	if (vbatt < POWEROFF_THRESHOLD) {
	power_off_notification(info);
	} else {
	info->state = FSM_DISCHARGE;
	stop_charge(info, vbatt);
	}
	}
	break;
	case FSM_PRECHARGE:
	if (info->online && info->present && info->allowed) {
	if (vbatt > PRECHARGE_THRESHOLD) {
	info->state = FSM_FASTCHARGE;
	start_fastcharge(info);
	}
	} else {
	info->state = FSM_DISCHARGE;
	stop_charge(info, vbatt);
	}
	break;
	case FSM_FASTCHARGE:
	if (info->online && info->present && info->allowed) {
	if (vbatt < PRECHARGE_THRESHOLD) {
	info->state = FSM_PRECHARGE;
	start_precharge(info);
	}
	} else {
	info->state = FSM_DISCHARGE;
	stop_charge(info, vbatt);
	}
	break;
	case FSM_DISCHARGE:
	if (info->online && info->present && info->allowed) {
	if (vbatt < PRECHARGE_THRESHOLD) {
	info->state = FSM_PRECHARGE;
	start_precharge(info);
	} else if (vbatt < DISCHARGE_THRESHOLD) {
	info->state = FSM_FASTCHARGE;
	start_fastcharge(info);
	}
	} else {
	if (vbatt < POWEROFF_THRESHOLD)
	power_off_notification(info);
	else if (vbatt > CHARGE_THRESHOLD && info->online)
	set_vbatt_threshold(info, CHARGE_THRESHOLD, 0);
	}
	break;
	default:
	dev_warn(info->dev, "FSM meets wrong state:%d\n",
	info->state);
	break;
	}
	dev_dbg(info->dev,
	"Out FSM:%s, Charger:%s, Battery:%s, Allowed:%d\n",
	&fsm_state[info->state][0],
	(info->online) ? "online" : "N/A",
	(info->present) ? "present" : "N/A", info->allowed);
	mutex_unlock(&info->lock);

	return 0;
	}

	static irqreturn_t pm860x_charger_handler(int irq, void *data)
	{
	struct pm860x_charger_info *info = data;
	int ret;

	mutex_lock(&info->lock);
	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
	if (ret < 0) {
	mutex_unlock(&info->lock);
	goto out;
	}
	if (ret & STATUS2_CHG) {
	info->online = 1;
	info->allowed = 1;
	} else {
	info->online = 0;
	info->allowed = 0;
	}
	mutex_unlock(&info->lock);
	dev_dbg(info->dev, "%s, Charger:%s, Allowed:%d\n", __func__,
	(info->online) ? "online" : "N/A", info->allowed);

	set_charging_fsm(info);

	power_supply_changed(info->usb);
	out:
	return IRQ_HANDLED;
	}

	static irqreturn_t pm860x_temp_handler(int irq, void *data)
	{
	struct power_supply *psy;
	struct pm860x_charger_info *info = data;
	union power_supply_propval temp;
	int value;
	int ret;

	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
	if (!psy)
	goto out;
	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_TEMP, &temp);
	if (ret)
	goto out;
	value = temp.intval / 10;

	mutex_lock(&info->lock);
	/* Temperature < -10 C or >40 C, Will not allow charge */
	if (value < -10 \|\| value > 40)
	info->allowed = 0;
	else
	info->allowed = 1;
	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
	mutex_unlock(&info->lock);

	set_charging_fsm(info);
	out:
	power_supply_put(psy);
	return IRQ_HANDLED;
	}

	static irqreturn_t pm860x_exception_handler(int irq, void *data)
	{
	struct pm860x_charger_info *info = data;

	mutex_lock(&info->lock);
	info->allowed = 0;
	mutex_unlock(&info->lock);
	dev_dbg(info->dev, "%s, irq: %d\n", __func__, irq);

	set_charging_fsm(info);
	return IRQ_HANDLED;
	}

	static irqreturn_t pm860x_done_handler(int irq, void *data)
	{
	struct pm860x_charger_info *info = data;
	struct power_supply *psy;
	union power_supply_propval val;
	int ret;
	int vbatt;

	mutex_lock(&info->lock);
	/* pre-charge done, will transimit to fast-charge stage */
	if (info->state == FSM_PRECHARGE) {
	info->allowed = 1;
	goto out;
	}
	/*
	* Fast charge done, delay to read
	* the correct status of CHG_DET.
	*/
	mdelay(5);
	info->allowed = 0;
	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
	if (!psy)
	goto out;
	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW,
	&val);
	if (ret)
	goto out_psy_put;
	vbatt = val.intval / 1000;
	/*
	* CHG_DONE interrupt is faster than CHG_DET interrupt when
	* plug in/out usb, So we can not rely on info->online, we
	* need check pm8607 status register to check usb is online
	* or not, then we can decide it is real charge done
	* automatically or it is triggered by usb plug out;
	*/
	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
	if (ret < 0)
	goto out_psy_put;
	if (vbatt > CHARGE_THRESHOLD && ret & STATUS2_CHG)
	power_supply_set_property(psy, POWER_SUPPLY_PROP_CHARGE_FULL,
	&val);

	out_psy_put:
	power_supply_put(psy);
	out:
	mutex_unlock(&info->lock);
	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
	set_charging_fsm(info);

	return IRQ_HANDLED;
	}

	static irqreturn_t pm860x_vbattery_handler(int irq, void *data)
	{
	struct pm860x_charger_info *info = data;

	mutex_lock(&info->lock);

	set_vbatt_threshold(info, 0, 0);

	if (info->present && info->online)
	info->allowed = 1;
	else
	info->allowed = 0;
	mutex_unlock(&info->lock);
	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);

	set_charging_fsm(info);

	return IRQ_HANDLED;
	}

	static irqreturn_t pm860x_vchg_handler(int irq, void *data)
	{
	struct pm860x_charger_info *info = data;
	int vchg = 0;

	if (info->present)
	goto out;

	measure_vchg(info, &vchg);

	mutex_lock(&info->lock);
	if (!info->online) {
	int status;
	/* check if over-temp on pm8606 or not */
	status = pm860x_reg_read(info->i2c_8606, PM8606_FLAGS);
	if (status & OVER_TEMP_FLAG) {
	/* clear over temp flag and set auto recover */
	pm860x_set_bits(info->i2c_8606, PM8606_FLAGS,
	OVER_TEMP_FLAG, OVER_TEMP_FLAG);
	pm860x_set_bits(info->i2c_8606,
	PM8606_VSYS,
	OVTEMP_AUTORECOVER,
	OVTEMP_AUTORECOVER);
	dev_dbg(info->dev,
	"%s, pm8606 over-temp occurred\n", __func__);
	}
	}

	if (vchg > VCHG_NORMAL_CHECK) {
	set_vchg_threshold(info, VCHG_OVP_LOW, 0);
	info->allowed = 0;
	dev_dbg(info->dev,
	"%s,pm8607 over-vchg occurred,vchg = %dmv\n",
	__func__, vchg);
	} else if (vchg < VCHG_OVP_LOW) {
	set_vchg_threshold(info, VCHG_NORMAL_LOW,
	VCHG_NORMAL_HIGH);
	info->allowed = 1;
	dev_dbg(info->dev,
	"%s,pm8607 over-vchg recover,vchg = %dmv\n",
	__func__, vchg);
	}
	mutex_unlock(&info->lock);

	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
	set_charging_fsm(info);
	out:
	return IRQ_HANDLED;
	}

	static int pm860x_usb_get_prop(struct power_supply *psy,
	enum power_supply_property psp,
	union power_supply_propval *val)
	{
	struct pm860x_charger_info *info = power_supply_get_drvdata(psy);

	switch (psp) {
	case POWER_SUPPLY_PROP_STATUS:
	if (info->state == FSM_FASTCHARGE \|\|
	info->state == FSM_PRECHARGE)
	val->intval = POWER_SUPPLY_STATUS_CHARGING;
	else
	val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
	break;
	case POWER_SUPPLY_PROP_ONLINE:
	val->intval = info->online;
	break;
	default:
	return -ENODEV;
	}
	return 0;
	}

	static enum power_supply_property pm860x_usb_props[] = {
	POWER_SUPPLY_PROP_STATUS,
	POWER_SUPPLY_PROP_ONLINE,
	};

	static int pm860x_init_charger(struct pm860x_charger_info *info)
	{
	int ret;

	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
	if (ret < 0)
	return ret;

	mutex_lock(&info->lock);
	info->state = FSM_INIT;
	if (ret & STATUS2_CHG) {
	info->online = 1;
	info->allowed = 1;
	} else {
	info->online = 0;
	info->allowed = 0;
	}
	mutex_unlock(&info->lock);

	set_charging_fsm(info);
	return 0;
	}

	static struct pm860x_irq_desc {
	const char *name;
	irqreturn_t (handler)(int irq, void data);
	} pm860x_irq_descs[] = {
	{ "usb supply detect", pm860x_charger_handler },
	{ "charge done", pm860x_done_handler },
	{ "charge timeout", pm860x_exception_handler },
	{ "charge fault", pm860x_exception_handler },
	{ "temperature", pm860x_temp_handler },
	{ "vbatt", pm860x_vbattery_handler },
	{ "vchg", pm860x_vchg_handler },
	};

	static const struct power_supply_desc pm860x_charger_desc = {
	.name = "usb",
	.type = POWER_SUPPLY_TYPE_USB,
	.properties = pm860x_usb_props,
	.num_properties = ARRAY_SIZE(pm860x_usb_props),
	.get_property = pm860x_usb_get_prop,
	};

	static int pm860x_charger_probe(struct platform_device *pdev)
	{
	struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
	struct power_supply_config psy_cfg = {};
	struct pm860x_charger_info *info;
	int ret;
	int count;
	int i;
	int j;

	info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
	if (!info)
	return -ENOMEM;

	count = pdev->num_resources;
	for (i = 0, j = 0; i < count; i++) {
	info->irq[j] = platform_get_irq(pdev, i);
	if (info->irq[j] < 0)
	continue;
	j++;
	}
	info->irq_nums = j;

	info->chip = chip;
	info->i2c =
	(chip->id == CHIP_PM8607) ? chip->client : chip->companion;
	info->i2c_8606 =
	(chip->id == CHIP_PM8607) ? chip->companion : chip->client;
	if (!info->i2c_8606) {
	dev_err(&pdev->dev, "Missed I2C address of 88PM8606!\n");
	ret = -EINVAL;
	goto out;
	}
	info->dev = &pdev->dev;

	/* set init value for the case we are not using battery */
	set_vchg_threshold(info, VCHG_NORMAL_LOW, VCHG_OVP_LOW);

	mutex_init(&info->lock);
	platform_set_drvdata(pdev, info);

	psy_cfg.drv_data = info;
	psy_cfg.supplied_to = pm860x_supplied_to;
	psy_cfg.num_supplicants = ARRAY_SIZE(pm860x_supplied_to);
	info->usb = power_supply_register(&pdev->dev, &pm860x_charger_desc,
	&psy_cfg);
	if (IS_ERR(info->usb)) {
	ret = PTR_ERR(info->usb);
	goto out;
	}

	pm860x_init_charger(info);

	for (i = 0; i < ARRAY_SIZE(info->irq); i++) {
	ret = request_threaded_irq(info->irq[i], NULL,
	pm860x_irq_descs[i].handler,
	IRQF_ONESHOT, pm860x_irq_descs[i].name, info);
	if (ret < 0) {
	dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n",
	info->irq[i], ret);
	goto out_irq;
	}
	}
	return 0;

	out_irq:
	power_supply_unregister(info->usb);
	while (--i >= 0)
	free_irq(info->irq[i], info);
	out:
	return ret;
	}

	static int pm860x_charger_remove(struct platform_device *pdev)
	{
	struct pm860x_charger_info *info = platform_get_drvdata(pdev);
	int i;

	power_supply_unregister(info->usb);
	free_irq(info->irq[0], info);
	for (i = 0; i < info->irq_nums; i++)
	free_irq(info->irq[i], info);
	return 0;
	}

	static struct platform_driver pm860x_charger_driver = {
	.driver = {
	.name = "88pm860x-charger",
	},
	.probe = pm860x_charger_probe,
	.remove = pm860x_charger_remove,
	};
	module_platform_driver(pm860x_charger_driver);

	MODULE_DESCRIPTION("Marvell 88PM860x Charger driver");
	MODULE_LICENSE("GPL");