mirror of
https://github.com/torvalds/linux.git
synced 2024-11-30 16:11:38 +00:00
9761dca68c
In the case where power_supply_get_by_name returns NULL the current error return path calls power_supply_put with a NULL psy which will cause a null pointer dereference. Avoid this with an immediate return. Signed-off-by: Colin Ian King <colin.king@canonical.com> Signed-off-by: Sebastian Reichel <sre@kernel.org>
761 lines
19 KiB
C
761 lines
19 KiB
C
/*
|
|
* 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");
|