diff options
Diffstat (limited to 'drivers/power/88pm860x_charger.c')
| -rw-r--r-- | drivers/power/88pm860x_charger.c | 743 | 
1 files changed, 743 insertions, 0 deletions
diff --git a/drivers/power/88pm860x_charger.c b/drivers/power/88pm860x_charger.c new file mode 100644 index 00000000000..de029bbc1cc --- /dev/null +++ b/drivers/power/88pm860x_charger.c @@ -0,0 +1,743 @@ +/* + * 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 = psy->get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW, &data); +	if (ret) +		return ret; +	vbatt = data.intval / 1000; + +	ret = psy->get_property(psy, POWER_SUPPLY_PROP_PRESENT, &data); +	if (ret) +		return ret; + +	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 = psy->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: +	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 = psy->get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW, &val); +	if (ret) +		goto out; +	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; +	if (vbatt > CHARGE_THRESHOLD && ret & STATUS2_CHG) +		psy->set_property(psy, POWER_SUPPLY_PROP_CHARGE_FULL, &val); + +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 = +	    dev_get_drvdata(psy->dev->parent); + +	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 int pm860x_charger_probe(struct platform_device *pdev) +{ +	struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent); +	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); + +	info->usb.name = "usb"; +	info->usb.type = POWER_SUPPLY_TYPE_USB; +	info->usb.supplied_to = pm860x_supplied_to; +	info->usb.num_supplicants = ARRAY_SIZE(pm860x_supplied_to); +	info->usb.properties = pm860x_usb_props; +	info->usb.num_properties = ARRAY_SIZE(pm860x_usb_props); +	info->usb.get_property = pm860x_usb_get_prop; +	ret = power_supply_register(&pdev->dev, &info->usb); +	if (ret) +		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: +	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", +		   .owner = THIS_MODULE, +	}, +	.probe = pm860x_charger_probe, +	.remove = pm860x_charger_remove, +}; +module_platform_driver(pm860x_charger_driver); + +MODULE_DESCRIPTION("Marvell 88PM860x Charger driver"); +MODULE_LICENSE("GPL");  | 
