diff options
author | Sebastian Reichel <sre@kernel.org> | 2016-06-17 13:54:32 +0200 |
---|---|---|
committer | Sebastian Reichel <sre@kernel.org> | 2016-08-11 01:11:03 +0200 |
commit | 8c0984e5a75337df513047ec92a6c09d78e3e5cd (patch) | |
tree | a2fc0a0dd7c7c40d9379bdd1c2b279c0959d0e1f /drivers/power/88pm860x_charger.c | |
parent | 29b4817d4018df78086157ea3a55c1d9424a7cfc (diff) | |
download | talos-op-linux-8c0984e5a75337df513047ec92a6c09d78e3e5cd.tar.gz talos-op-linux-8c0984e5a75337df513047ec92a6c09d78e3e5cd.zip |
power: move power supply drivers to power/supply
This moves all power supply drivers from drivers/power/
to drivers/power/supply/. The intention is a cleaner
source tree, since drivers/power/ also contains frameworks
unrelated to power supply, like adaptive voltage scaling.
Signed-off-by: Sebastian Reichel <sre@kernel.org>
Diffstat (limited to 'drivers/power/88pm860x_charger.c')
-rw-r--r-- | drivers/power/88pm860x_charger.c | 760 |
1 files changed, 0 insertions, 760 deletions
diff --git a/drivers/power/88pm860x_charger.c b/drivers/power/88pm860x_charger.c deleted file mode 100644 index 2b82e44d9027..000000000000 --- a/drivers/power/88pm860x_charger.c +++ /dev/null @@ -1,760 +0,0 @@ -/* - * 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) - return IRQ_HANDLED; - 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); - 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"); |