2008-08-21 03:52:58 +04:00
|
|
|
/*
|
|
|
|
* BQ27x00 battery driver
|
|
|
|
*
|
|
|
|
* Copyright (C) 2008 Rodolfo Giometti <giometti@linux.it>
|
|
|
|
* Copyright (C) 2008 Eurotech S.p.A. <info@eurotech.it>
|
2010-05-24 21:55:27 +04:00
|
|
|
* Copyright (C) 2010-2011 Lars-Peter Clausen <lars@metafoo.de>
|
2011-05-01 01:59:35 +04:00
|
|
|
* Copyright (C) 2011 Pali Rohár <pali.rohar@gmail.com>
|
2008-08-21 03:52:58 +04:00
|
|
|
*
|
|
|
|
* Based on a previous work by Copyright (C) 2008 Texas Instruments, Inc.
|
|
|
|
*
|
|
|
|
* This package is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* THIS PACKAGE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
|
|
|
|
* IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
|
|
|
|
* WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
|
|
|
|
*
|
2011-02-01 02:08:02 +03:00
|
|
|
* Datasheets:
|
|
|
|
* http://focus.ti.com/docs/prod/folders/print/bq27000.html
|
|
|
|
* http://focus.ti.com/docs/prod/folders/print/bq27500.html
|
2012-07-14 07:20:07 +04:00
|
|
|
* http://www.ti.com/product/bq27425-g1
|
2014-09-09 23:20:35 +04:00
|
|
|
* http://www.ti.com/product/BQ27742-G1
|
2015-02-28 20:59:28 +03:00
|
|
|
* http://www.ti.com/product/BQ27510-G3
|
2011-02-01 02:08:02 +03:00
|
|
|
*/
|
|
|
|
|
bq27x00_battery: Introduce the use of the managed version of kzalloc
This patch moves data allocated using kzalloc to managed data allocated
using devm_kzalloc and cleans now unnecessary kfrees in probe and remove
functions for both platform and i2c drivers. Also, the unecessary
variable ret and labels batt_failed3, err_free were removed.
The following Coccinele script was used for making the change:
@platform@
identifier p, probefn, removefn;
@@
struct platform_driver p = {
.probe = probefn,
.remove = removefn,
};
@prb@
identifier platform.probefn, pdev;
expression e, e1, e2;
@@
probefn(struct platform_device *pdev, ...) {
<+...
- e = kzalloc(e1, e2)
+ e = devm_kzalloc(&pdev->dev, e1, e2)
...
?-kfree(e);
...+>
}
@rem depends on prb@
identifier platform.removefn;
expression e;
@@
removefn(...) {
<...
- kfree(e);
...>
}
Signed-off-by: Himangi Saraogi <himangi774@gmail.com>
Acked-by: Julia Lawall <julia.lawall@lip6.fr>
Signed-off-by: Sebastian Reichel <sre@kernel.org>
2014-05-28 21:28:49 +04:00
|
|
|
#include <linux/device.h>
|
2008-08-21 03:52:58 +04:00
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/param.h>
|
|
|
|
#include <linux/jiffies.h>
|
|
|
|
#include <linux/workqueue.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/platform_device.h>
|
|
|
|
#include <linux/power_supply.h>
|
|
|
|
#include <linux/idr.h>
|
|
|
|
#include <linux/i2c.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 11:04:11 +03:00
|
|
|
#include <linux/slab.h>
|
2008-09-23 01:53:50 +04:00
|
|
|
#include <asm/unaligned.h>
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2010-05-24 21:55:27 +04:00
|
|
|
#include <linux/power/bq27x00_battery.h>
|
|
|
|
|
2011-02-01 02:08:02 +03:00
|
|
|
#define DRIVER_VERSION "1.2.0"
|
2008-08-21 03:52:58 +04:00
|
|
|
|
|
|
|
#define BQ27x00_REG_TEMP 0x06
|
|
|
|
#define BQ27x00_REG_VOLT 0x08
|
|
|
|
#define BQ27x00_REG_AI 0x14
|
|
|
|
#define BQ27x00_REG_FLAGS 0x0A
|
2010-02-27 18:06:09 +03:00
|
|
|
#define BQ27x00_REG_TTE 0x16
|
|
|
|
#define BQ27x00_REG_TTF 0x18
|
|
|
|
#define BQ27x00_REG_TTECP 0x26
|
2012-02-16 11:58:15 +04:00
|
|
|
#define BQ27x00_REG_NAC 0x0C /* Nominal available capacity */
|
2011-02-01 02:08:02 +03:00
|
|
|
#define BQ27x00_REG_LMD 0x12 /* Last measured discharge */
|
|
|
|
#define BQ27x00_REG_CYCT 0x2A /* Cycle count total */
|
2012-02-16 11:58:15 +04:00
|
|
|
#define BQ27x00_REG_AE 0x22 /* Available energy */
|
2012-05-17 11:21:15 +04:00
|
|
|
#define BQ27x00_POWER_AVG 0x24
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2010-02-13 00:57:23 +03:00
|
|
|
#define BQ27000_REG_RSOC 0x0B /* Relative State-of-Charge */
|
2011-02-01 02:08:02 +03:00
|
|
|
#define BQ27000_REG_ILMD 0x76 /* Initial last measured discharge */
|
2011-11-01 04:43:04 +04:00
|
|
|
#define BQ27000_FLAG_EDVF BIT(0) /* Final End-of-Discharge-Voltage flag */
|
|
|
|
#define BQ27000_FLAG_EDV1 BIT(1) /* First End-of-Discharge-Voltage flag */
|
2011-11-01 04:43:05 +04:00
|
|
|
#define BQ27000_FLAG_CI BIT(4) /* Capacity Inaccurate flag */
|
2010-09-18 19:31:16 +04:00
|
|
|
#define BQ27000_FLAG_FC BIT(5)
|
2011-11-01 04:43:04 +04:00
|
|
|
#define BQ27000_FLAG_CHGS BIT(7) /* Charge state flag */
|
2010-02-13 00:57:23 +03:00
|
|
|
|
2011-02-01 02:23:13 +03:00
|
|
|
#define BQ27500_REG_SOC 0x2C
|
2011-02-01 02:08:02 +03:00
|
|
|
#define BQ27500_REG_DCAP 0x3C /* Design capacity */
|
2012-02-01 21:20:15 +04:00
|
|
|
#define BQ27500_FLAG_DSC BIT(0)
|
2011-11-01 04:43:04 +04:00
|
|
|
#define BQ27500_FLAG_SOCF BIT(1) /* State-of-Charge threshold final */
|
|
|
|
#define BQ27500_FLAG_SOC1 BIT(2) /* State-of-Charge threshold 1 */
|
2012-02-01 21:20:15 +04:00
|
|
|
#define BQ27500_FLAG_FC BIT(9)
|
2012-05-17 11:21:15 +04:00
|
|
|
#define BQ27500_FLAG_OTC BIT(15)
|
2010-02-13 00:57:23 +03:00
|
|
|
|
2014-09-09 23:20:35 +04:00
|
|
|
#define BQ27742_POWER_AVG 0x76
|
|
|
|
|
2015-02-28 20:59:28 +03:00
|
|
|
#define BQ27510_REG_SOC 0x20
|
|
|
|
#define BQ27510_REG_DCAP 0x2E /* Design capacity */
|
|
|
|
#define BQ27510_REG_CYCT 0x1E /* Cycle count total */
|
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
/* bq27425 register addresses are same as bq27x00 addresses minus 4 */
|
|
|
|
#define BQ27425_REG_OFFSET 0x04
|
2014-11-13 01:04:08 +03:00
|
|
|
#define BQ27425_REG_SOC (0x1C + BQ27425_REG_OFFSET)
|
|
|
|
#define BQ27425_REG_DCAP (0x3C + BQ27425_REG_OFFSET)
|
2012-07-14 07:20:07 +04:00
|
|
|
|
2010-05-24 22:52:13 +04:00
|
|
|
#define BQ27000_RS 20 /* Resistor sense */
|
2012-05-17 11:21:15 +04:00
|
|
|
#define BQ27x00_POWER_CONSTANT (256 * 29200 / 1000)
|
2010-05-24 22:52:13 +04:00
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
struct bq27x00_device_info;
|
|
|
|
struct bq27x00_access_methods {
|
2011-01-07 22:12:47 +03:00
|
|
|
int (*read)(struct bq27x00_device_info *di, u8 reg, bool single);
|
2008-08-21 03:52:58 +04:00
|
|
|
};
|
|
|
|
|
2015-02-28 20:59:28 +03:00
|
|
|
enum bq27x00_chip { BQ27000, BQ27500, BQ27425, BQ27742, BQ27510};
|
2010-02-13 00:57:23 +03:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
struct bq27x00_reg_cache {
|
|
|
|
int temperature;
|
|
|
|
int time_to_empty;
|
|
|
|
int time_to_empty_avg;
|
|
|
|
int time_to_full;
|
2011-02-01 02:08:02 +03:00
|
|
|
int charge_full;
|
2011-05-01 01:59:35 +04:00
|
|
|
int cycle_count;
|
2011-01-07 22:12:47 +03:00
|
|
|
int capacity;
|
2011-11-01 04:43:06 +04:00
|
|
|
int energy;
|
2011-01-07 22:12:47 +03:00
|
|
|
int flags;
|
2012-05-17 11:21:15 +04:00
|
|
|
int power_avg;
|
|
|
|
int health;
|
2011-01-07 22:12:47 +03:00
|
|
|
};
|
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
struct bq27x00_device_info {
|
|
|
|
struct device *dev;
|
|
|
|
int id;
|
2010-02-13 00:57:23 +03:00
|
|
|
enum bq27x00_chip chip;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
struct bq27x00_reg_cache cache;
|
2011-02-01 02:08:02 +03:00
|
|
|
int charge_design_full;
|
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
unsigned long last_update;
|
2011-01-07 22:14:53 +03:00
|
|
|
struct delayed_work work;
|
2011-01-07 22:12:47 +03:00
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
struct power_supply *bat;
|
2010-05-24 21:37:58 +04:00
|
|
|
|
|
|
|
struct bq27x00_access_methods bus;
|
2011-01-07 22:14:53 +03:00
|
|
|
|
|
|
|
struct mutex lock;
|
2008-08-21 03:52:58 +04:00
|
|
|
};
|
|
|
|
|
|
|
|
static enum power_supply_property bq27x00_battery_props[] = {
|
2010-02-27 18:06:09 +03:00
|
|
|
POWER_SUPPLY_PROP_STATUS,
|
2008-08-21 03:52:58 +04:00
|
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
|
|
POWER_SUPPLY_PROP_VOLTAGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CURRENT_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CAPACITY,
|
2011-11-01 04:43:04 +04:00
|
|
|
POWER_SUPPLY_PROP_CAPACITY_LEVEL,
|
2008-08-21 03:52:58 +04:00
|
|
|
POWER_SUPPLY_PROP_TEMP,
|
2010-02-27 18:06:09 +03:00
|
|
|
POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
|
|
|
|
POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
|
|
|
|
POWER_SUPPLY_PROP_TIME_TO_FULL_NOW,
|
2010-05-24 22:36:52 +04:00
|
|
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
2011-02-01 02:08:02 +03:00
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
|
2011-05-01 01:59:35 +04:00
|
|
|
POWER_SUPPLY_PROP_CYCLE_COUNT,
|
2011-02-01 02:08:02 +03:00
|
|
|
POWER_SUPPLY_PROP_ENERGY_NOW,
|
2012-05-17 11:21:15 +04:00
|
|
|
POWER_SUPPLY_PROP_POWER_AVG,
|
|
|
|
POWER_SUPPLY_PROP_HEALTH,
|
2008-08-21 03:52:58 +04:00
|
|
|
};
|
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
static enum power_supply_property bq27425_battery_props[] = {
|
|
|
|
POWER_SUPPLY_PROP_STATUS,
|
|
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
|
|
POWER_SUPPLY_PROP_VOLTAGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CURRENT_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CAPACITY,
|
|
|
|
POWER_SUPPLY_PROP_CAPACITY_LEVEL,
|
|
|
|
POWER_SUPPLY_PROP_TEMP,
|
|
|
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
|
|
|
|
};
|
|
|
|
|
2014-09-09 23:20:35 +04:00
|
|
|
static enum power_supply_property bq27742_battery_props[] = {
|
|
|
|
POWER_SUPPLY_PROP_STATUS,
|
|
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
|
|
POWER_SUPPLY_PROP_VOLTAGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CURRENT_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CAPACITY,
|
|
|
|
POWER_SUPPLY_PROP_CAPACITY_LEVEL,
|
|
|
|
POWER_SUPPLY_PROP_TEMP,
|
|
|
|
POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
|
|
|
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
|
|
|
|
POWER_SUPPLY_PROP_CYCLE_COUNT,
|
|
|
|
POWER_SUPPLY_PROP_POWER_AVG,
|
|
|
|
POWER_SUPPLY_PROP_HEALTH,
|
|
|
|
};
|
|
|
|
|
2015-02-28 20:59:28 +03:00
|
|
|
static enum power_supply_property bq27510_battery_props[] = {
|
|
|
|
POWER_SUPPLY_PROP_STATUS,
|
|
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
|
|
POWER_SUPPLY_PROP_VOLTAGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CURRENT_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CAPACITY,
|
|
|
|
POWER_SUPPLY_PROP_CAPACITY_LEVEL,
|
|
|
|
POWER_SUPPLY_PROP_TEMP,
|
|
|
|
POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
|
|
|
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_NOW,
|
|
|
|
POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
|
|
|
|
POWER_SUPPLY_PROP_CYCLE_COUNT,
|
|
|
|
POWER_SUPPLY_PROP_POWER_AVG,
|
|
|
|
POWER_SUPPLY_PROP_HEALTH,
|
|
|
|
};
|
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
static unsigned int poll_interval = 360;
|
|
|
|
module_param(poll_interval, uint, 0644);
|
|
|
|
MODULE_PARM_DESC(poll_interval, "battery poll interval in seconds - " \
|
|
|
|
"0 disables polling");
|
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
/*
|
|
|
|
* Common code for BQ27x00 devices
|
|
|
|
*/
|
|
|
|
|
2010-05-24 21:37:58 +04:00
|
|
|
static inline int bq27x00_read(struct bq27x00_device_info *di, u8 reg,
|
2011-01-07 22:12:47 +03:00
|
|
|
bool single)
|
2008-08-21 03:52:58 +04:00
|
|
|
{
|
2012-07-14 07:20:07 +04:00
|
|
|
if (di->chip == BQ27425)
|
|
|
|
return di->bus.read(di, reg - BQ27425_REG_OFFSET, single);
|
2011-01-07 22:12:47 +03:00
|
|
|
return di->bus.read(di, reg, single);
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
/*
|
|
|
|
* Higher versions of the chip like BQ27425 and BQ27500
|
|
|
|
* differ from BQ27000 and BQ27200 in calculation of certain
|
|
|
|
* parameters. Hence we need to check for the chip type.
|
|
|
|
*/
|
|
|
|
static bool bq27xxx_is_chip_version_higher(struct bq27x00_device_info *di)
|
|
|
|
{
|
2015-02-28 20:59:28 +03:00
|
|
|
if (di->chip == BQ27425 || di->chip == BQ27500 || di->chip == BQ27742
|
|
|
|
|| di->chip == BQ27510)
|
2012-07-14 07:20:07 +04:00
|
|
|
return true;
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
/*
|
2011-01-07 22:12:47 +03:00
|
|
|
* Return the battery Relative State-of-Charge
|
2008-08-21 03:52:58 +04:00
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
2011-01-07 22:12:47 +03:00
|
|
|
static int bq27x00_battery_read_rsoc(struct bq27x00_device_info *di)
|
2008-08-21 03:52:58 +04:00
|
|
|
{
|
2011-01-07 22:12:47 +03:00
|
|
|
int rsoc;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2014-09-09 23:20:35 +04:00
|
|
|
if (di->chip == BQ27500 || di->chip == BQ27742)
|
2011-01-07 22:12:47 +03:00
|
|
|
rsoc = bq27x00_read(di, BQ27500_REG_SOC, false);
|
2015-02-28 20:59:28 +03:00
|
|
|
else if (di->chip == BQ27510)
|
|
|
|
rsoc = bq27x00_read(di, BQ27510_REG_SOC, false);
|
2012-07-14 07:20:07 +04:00
|
|
|
else if (di->chip == BQ27425)
|
|
|
|
rsoc = bq27x00_read(di, BQ27425_REG_SOC, false);
|
2010-02-13 00:57:23 +03:00
|
|
|
else
|
2011-01-07 22:12:47 +03:00
|
|
|
rsoc = bq27x00_read(di, BQ27000_REG_RSOC, true);
|
|
|
|
|
|
|
|
if (rsoc < 0)
|
2011-11-01 04:43:09 +04:00
|
|
|
dev_dbg(di->dev, "error reading relative State-of-Charge\n");
|
2011-01-07 22:12:47 +03:00
|
|
|
|
|
|
|
return rsoc;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2011-02-01 02:08:02 +03:00
|
|
|
/*
|
|
|
|
* Return a battery charge value in µAh
|
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static int bq27x00_battery_read_charge(struct bq27x00_device_info *di, u8 reg)
|
|
|
|
{
|
|
|
|
int charge;
|
|
|
|
|
|
|
|
charge = bq27x00_read(di, reg, false);
|
|
|
|
if (charge < 0) {
|
2011-11-01 04:43:09 +04:00
|
|
|
dev_dbg(di->dev, "error reading charge register %02x: %d\n",
|
|
|
|
reg, charge);
|
2011-02-01 02:08:02 +03:00
|
|
|
return charge;
|
|
|
|
}
|
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
if (bq27xxx_is_chip_version_higher(di))
|
2011-02-01 02:08:02 +03:00
|
|
|
charge *= 1000;
|
|
|
|
else
|
|
|
|
charge = charge * 3570 / BQ27000_RS;
|
|
|
|
|
|
|
|
return charge;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Return the battery Nominal available capaciy in µAh
|
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static inline int bq27x00_battery_read_nac(struct bq27x00_device_info *di)
|
|
|
|
{
|
2012-11-10 18:42:48 +04:00
|
|
|
int flags;
|
|
|
|
bool is_bq27500 = di->chip == BQ27500;
|
2014-09-30 22:18:56 +04:00
|
|
|
bool is_bq27742 = di->chip == BQ27742;
|
2012-11-10 18:42:48 +04:00
|
|
|
bool is_higher = bq27xxx_is_chip_version_higher(di);
|
2014-09-30 22:18:56 +04:00
|
|
|
bool flags_1b = !(is_bq27500 || is_bq27742);
|
2012-11-10 18:42:48 +04:00
|
|
|
|
2014-09-30 22:18:56 +04:00
|
|
|
flags = bq27x00_read(di, BQ27x00_REG_FLAGS, flags_1b);
|
2012-11-10 18:42:48 +04:00
|
|
|
if (flags >= 0 && !is_higher && (flags & BQ27000_FLAG_CI))
|
|
|
|
return -ENODATA;
|
|
|
|
|
2011-02-01 02:08:02 +03:00
|
|
|
return bq27x00_battery_read_charge(di, BQ27x00_REG_NAC);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Return the battery Last measured discharge in µAh
|
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static inline int bq27x00_battery_read_lmd(struct bq27x00_device_info *di)
|
|
|
|
{
|
|
|
|
return bq27x00_battery_read_charge(di, BQ27x00_REG_LMD);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Return the battery Initial last measured discharge in µAh
|
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static int bq27x00_battery_read_ilmd(struct bq27x00_device_info *di)
|
|
|
|
{
|
|
|
|
int ilmd;
|
|
|
|
|
2014-11-13 01:04:08 +03:00
|
|
|
if (bq27xxx_is_chip_version_higher(di)) {
|
|
|
|
if (di->chip == BQ27425)
|
|
|
|
ilmd = bq27x00_read(di, BQ27425_REG_DCAP, false);
|
2015-02-28 20:59:28 +03:00
|
|
|
else if (di->chip == BQ27510)
|
|
|
|
ilmd = bq27x00_read(di, BQ27510_REG_DCAP, false);
|
2014-11-13 01:04:08 +03:00
|
|
|
else
|
|
|
|
ilmd = bq27x00_read(di, BQ27500_REG_DCAP, false);
|
|
|
|
} else
|
2011-02-01 02:08:02 +03:00
|
|
|
ilmd = bq27x00_read(di, BQ27000_REG_ILMD, true);
|
|
|
|
|
|
|
|
if (ilmd < 0) {
|
2011-11-01 04:43:09 +04:00
|
|
|
dev_dbg(di->dev, "error reading initial last measured discharge\n");
|
2011-02-01 02:08:02 +03:00
|
|
|
return ilmd;
|
|
|
|
}
|
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
if (bq27xxx_is_chip_version_higher(di))
|
2011-02-01 02:08:02 +03:00
|
|
|
ilmd *= 1000;
|
|
|
|
else
|
|
|
|
ilmd = ilmd * 256 * 3570 / BQ27000_RS;
|
|
|
|
|
|
|
|
return ilmd;
|
|
|
|
}
|
|
|
|
|
2011-11-01 04:43:06 +04:00
|
|
|
/*
|
|
|
|
* Return the battery Available energy in µWh
|
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static int bq27x00_battery_read_energy(struct bq27x00_device_info *di)
|
|
|
|
{
|
|
|
|
int ae;
|
|
|
|
|
|
|
|
ae = bq27x00_read(di, BQ27x00_REG_AE, false);
|
|
|
|
if (ae < 0) {
|
2011-11-01 04:43:09 +04:00
|
|
|
dev_dbg(di->dev, "error reading available energy\n");
|
2011-11-01 04:43:06 +04:00
|
|
|
return ae;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (di->chip == BQ27500)
|
|
|
|
ae *= 1000;
|
|
|
|
else
|
|
|
|
ae = ae * 29200 / BQ27000_RS;
|
|
|
|
|
|
|
|
return ae;
|
|
|
|
}
|
|
|
|
|
2011-11-01 04:43:07 +04:00
|
|
|
/*
|
2013-02-02 14:06:09 +04:00
|
|
|
* Return the battery temperature in tenths of degree Kelvin
|
2011-11-01 04:43:07 +04:00
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static int bq27x00_battery_read_temperature(struct bq27x00_device_info *di)
|
|
|
|
{
|
|
|
|
int temp;
|
|
|
|
|
|
|
|
temp = bq27x00_read(di, BQ27x00_REG_TEMP, false);
|
|
|
|
if (temp < 0) {
|
|
|
|
dev_err(di->dev, "error reading temperature\n");
|
|
|
|
return temp;
|
|
|
|
}
|
|
|
|
|
2013-02-02 14:06:09 +04:00
|
|
|
if (!bq27xxx_is_chip_version_higher(di))
|
|
|
|
temp = 5 * temp / 2;
|
2011-11-01 04:43:07 +04:00
|
|
|
|
|
|
|
return temp;
|
|
|
|
}
|
|
|
|
|
2011-02-01 02:08:02 +03:00
|
|
|
/*
|
|
|
|
* Return the battery Cycle count total
|
|
|
|
* Or < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static int bq27x00_battery_read_cyct(struct bq27x00_device_info *di)
|
|
|
|
{
|
|
|
|
int cyct;
|
|
|
|
|
2015-02-28 20:59:28 +03:00
|
|
|
if (di->chip == BQ27510)
|
|
|
|
cyct = bq27x00_read(di, BQ27510_REG_CYCT, false);
|
|
|
|
else
|
|
|
|
cyct = bq27x00_read(di, BQ27x00_REG_CYCT, false);
|
2011-02-01 02:08:02 +03:00
|
|
|
if (cyct < 0)
|
|
|
|
dev_err(di->dev, "error reading cycle count total\n");
|
|
|
|
|
|
|
|
return cyct;
|
|
|
|
}
|
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
/*
|
2011-01-07 22:12:47 +03:00
|
|
|
* Read a time register.
|
|
|
|
* Return < 0 if something fails.
|
2008-08-21 03:52:58 +04:00
|
|
|
*/
|
2011-01-07 22:12:47 +03:00
|
|
|
static int bq27x00_battery_read_time(struct bq27x00_device_info *di, u8 reg)
|
2008-08-21 03:52:58 +04:00
|
|
|
{
|
2011-01-07 22:12:47 +03:00
|
|
|
int tval;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
tval = bq27x00_read(di, reg, false);
|
|
|
|
if (tval < 0) {
|
2011-11-01 04:43:09 +04:00
|
|
|
dev_dbg(di->dev, "error reading time register %02x: %d\n",
|
|
|
|
reg, tval);
|
2011-01-07 22:12:47 +03:00
|
|
|
return tval;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
if (tval == 65535)
|
|
|
|
return -ENODATA;
|
|
|
|
|
|
|
|
return tval * 60;
|
|
|
|
}
|
|
|
|
|
2012-05-17 11:21:15 +04:00
|
|
|
/*
|
|
|
|
* Read a power avg register.
|
|
|
|
* Return < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static int bq27x00_battery_read_pwr_avg(struct bq27x00_device_info *di, u8 reg)
|
|
|
|
{
|
|
|
|
int tval;
|
|
|
|
|
|
|
|
tval = bq27x00_read(di, reg, false);
|
|
|
|
if (tval < 0) {
|
|
|
|
dev_err(di->dev, "error reading power avg rgister %02x: %d\n",
|
|
|
|
reg, tval);
|
|
|
|
return tval;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (di->chip == BQ27500)
|
|
|
|
return tval;
|
|
|
|
else
|
|
|
|
return (tval * BQ27x00_POWER_CONSTANT) / BQ27000_RS;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Read flag register.
|
|
|
|
* Return < 0 if something fails.
|
|
|
|
*/
|
|
|
|
static int bq27x00_battery_read_health(struct bq27x00_device_info *di)
|
|
|
|
{
|
|
|
|
int tval;
|
|
|
|
|
|
|
|
tval = bq27x00_read(di, BQ27x00_REG_FLAGS, false);
|
|
|
|
if (tval < 0) {
|
|
|
|
dev_err(di->dev, "error reading flag register:%d\n", tval);
|
|
|
|
return tval;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((di->chip == BQ27500)) {
|
|
|
|
if (tval & BQ27500_FLAG_SOCF)
|
|
|
|
tval = POWER_SUPPLY_HEALTH_DEAD;
|
|
|
|
else if (tval & BQ27500_FLAG_OTC)
|
|
|
|
tval = POWER_SUPPLY_HEALTH_OVERHEAT;
|
|
|
|
else
|
|
|
|
tval = POWER_SUPPLY_HEALTH_GOOD;
|
|
|
|
return tval;
|
2015-02-28 20:59:28 +03:00
|
|
|
} else if (di->chip == BQ27510) {
|
|
|
|
if (tval & BQ27500_FLAG_OTC)
|
|
|
|
return POWER_SUPPLY_HEALTH_OVERHEAT;
|
|
|
|
return POWER_SUPPLY_HEALTH_GOOD;
|
2012-05-17 11:21:15 +04:00
|
|
|
} else {
|
|
|
|
if (tval & BQ27000_FLAG_EDV1)
|
|
|
|
tval = POWER_SUPPLY_HEALTH_DEAD;
|
|
|
|
else
|
|
|
|
tval = POWER_SUPPLY_HEALTH_GOOD;
|
|
|
|
return tval;
|
|
|
|
}
|
|
|
|
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
static void bq27x00_update(struct bq27x00_device_info *di)
|
|
|
|
{
|
|
|
|
struct bq27x00_reg_cache cache = {0, };
|
|
|
|
bool is_bq27500 = di->chip == BQ27500;
|
2015-02-28 20:59:28 +03:00
|
|
|
bool is_bq27510 = di->chip == BQ27510;
|
2012-07-14 07:20:07 +04:00
|
|
|
bool is_bq27425 = di->chip == BQ27425;
|
2014-09-09 23:20:35 +04:00
|
|
|
bool is_bq27742 = di->chip == BQ27742;
|
2014-09-30 22:18:56 +04:00
|
|
|
bool flags_1b = !(is_bq27500 || is_bq27742);
|
2011-01-07 22:12:47 +03:00
|
|
|
|
2014-09-30 22:18:56 +04:00
|
|
|
cache.flags = bq27x00_read(di, BQ27x00_REG_FLAGS, flags_1b);
|
2014-06-30 23:49:56 +04:00
|
|
|
if ((cache.flags & 0xff) == 0xff)
|
|
|
|
/* read error */
|
|
|
|
cache.flags = -1;
|
2011-01-07 22:12:47 +03:00
|
|
|
if (cache.flags >= 0) {
|
2015-02-28 20:59:28 +03:00
|
|
|
if (!is_bq27500 && !is_bq27425 && !is_bq27742 && !is_bq27510
|
2012-07-14 07:20:07 +04:00
|
|
|
&& (cache.flags & BQ27000_FLAG_CI)) {
|
2011-11-01 04:43:09 +04:00
|
|
|
dev_info(di->dev, "battery is not calibrated! ignoring capacity values\n");
|
2011-11-01 04:43:05 +04:00
|
|
|
cache.capacity = -ENODATA;
|
2011-11-01 04:43:06 +04:00
|
|
|
cache.energy = -ENODATA;
|
2011-11-01 04:43:05 +04:00
|
|
|
cache.time_to_empty = -ENODATA;
|
|
|
|
cache.time_to_empty_avg = -ENODATA;
|
|
|
|
cache.time_to_full = -ENODATA;
|
|
|
|
cache.charge_full = -ENODATA;
|
2012-05-17 11:21:15 +04:00
|
|
|
cache.health = -ENODATA;
|
2011-11-01 04:43:05 +04:00
|
|
|
} else {
|
|
|
|
cache.capacity = bq27x00_battery_read_rsoc(di);
|
2015-02-28 20:59:28 +03:00
|
|
|
if (is_bq27742 || is_bq27510)
|
2014-09-09 23:20:35 +04:00
|
|
|
cache.time_to_empty =
|
|
|
|
bq27x00_battery_read_time(di,
|
|
|
|
BQ27x00_REG_TTE);
|
|
|
|
else if (!is_bq27425) {
|
2012-07-14 07:20:07 +04:00
|
|
|
cache.energy = bq27x00_battery_read_energy(di);
|
|
|
|
cache.time_to_empty =
|
|
|
|
bq27x00_battery_read_time(di,
|
|
|
|
BQ27x00_REG_TTE);
|
|
|
|
cache.time_to_empty_avg =
|
|
|
|
bq27x00_battery_read_time(di,
|
|
|
|
BQ27x00_REG_TTECP);
|
|
|
|
cache.time_to_full =
|
|
|
|
bq27x00_battery_read_time(di,
|
|
|
|
BQ27x00_REG_TTF);
|
|
|
|
}
|
2014-09-30 22:18:56 +04:00
|
|
|
cache.charge_full = bq27x00_battery_read_lmd(di);
|
2012-05-17 11:21:15 +04:00
|
|
|
cache.health = bq27x00_battery_read_health(di);
|
2011-11-01 04:43:05 +04:00
|
|
|
}
|
2011-11-01 04:43:07 +04:00
|
|
|
cache.temperature = bq27x00_battery_read_temperature(di);
|
2012-07-14 07:20:07 +04:00
|
|
|
if (!is_bq27425)
|
|
|
|
cache.cycle_count = bq27x00_battery_read_cyct(di);
|
2014-09-09 23:20:35 +04:00
|
|
|
if (is_bq27742)
|
|
|
|
cache.power_avg =
|
|
|
|
bq27x00_battery_read_pwr_avg(di,
|
|
|
|
BQ27742_POWER_AVG);
|
|
|
|
else
|
|
|
|
cache.power_avg =
|
|
|
|
bq27x00_battery_read_pwr_avg(di,
|
|
|
|
BQ27x00_POWER_AVG);
|
2011-01-07 22:12:47 +03:00
|
|
|
|
2011-02-01 02:08:02 +03:00
|
|
|
/* We only have to read charge design full once */
|
|
|
|
if (di->charge_design_full <= 0)
|
|
|
|
di->charge_design_full = bq27x00_battery_read_ilmd(di);
|
2011-01-07 22:12:47 +03:00
|
|
|
}
|
|
|
|
|
2014-10-22 05:15:37 +04:00
|
|
|
if (di->cache.capacity != cache.capacity)
|
2015-03-12 10:44:11 +03:00
|
|
|
power_supply_changed(di->bat);
|
2014-10-22 05:15:37 +04:00
|
|
|
|
|
|
|
if (memcmp(&di->cache, &cache, sizeof(cache)) != 0)
|
|
|
|
di->cache = cache;
|
2011-01-07 22:12:47 +03:00
|
|
|
|
|
|
|
di->last_update = jiffies;
|
|
|
|
}
|
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
static void bq27x00_battery_poll(struct work_struct *work)
|
|
|
|
{
|
|
|
|
struct bq27x00_device_info *di =
|
|
|
|
container_of(work, struct bq27x00_device_info, work.work);
|
|
|
|
|
|
|
|
bq27x00_update(di);
|
|
|
|
|
|
|
|
if (poll_interval > 0) {
|
|
|
|
/* The timer does not have to be accurate. */
|
|
|
|
set_timer_slack(&di->work.timer, poll_interval * HZ / 4);
|
|
|
|
schedule_delayed_work(&di->work, poll_interval * HZ);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
/*
|
2011-02-01 02:23:13 +03:00
|
|
|
* Return the battery average current in µA
|
2008-08-21 03:52:58 +04:00
|
|
|
* Note that current can be negative signed as well
|
|
|
|
* Or 0 if something fails.
|
|
|
|
*/
|
2011-01-07 22:12:47 +03:00
|
|
|
static int bq27x00_battery_current(struct bq27x00_device_info *di,
|
|
|
|
union power_supply_propval *val)
|
2008-08-21 03:52:58 +04:00
|
|
|
{
|
2011-01-07 22:12:47 +03:00
|
|
|
int curr;
|
2011-11-01 04:43:03 +04:00
|
|
|
int flags;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2011-11-01 04:43:03 +04:00
|
|
|
curr = bq27x00_read(di, BQ27x00_REG_AI, false);
|
2011-11-01 04:43:09 +04:00
|
|
|
if (curr < 0) {
|
|
|
|
dev_err(di->dev, "error reading current\n");
|
2011-01-07 22:12:47 +03:00
|
|
|
return curr;
|
2011-11-01 04:43:09 +04:00
|
|
|
}
|
2010-02-13 00:57:23 +03:00
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
if (bq27xxx_is_chip_version_higher(di)) {
|
2010-02-13 00:57:23 +03:00
|
|
|
/* bq27500 returns signed value */
|
2011-01-07 22:12:47 +03:00
|
|
|
val->intval = (int)((s16)curr) * 1000;
|
2010-02-13 00:57:23 +03:00
|
|
|
} else {
|
2011-11-01 04:43:03 +04:00
|
|
|
flags = bq27x00_read(di, BQ27x00_REG_FLAGS, false);
|
|
|
|
if (flags & BQ27000_FLAG_CHGS) {
|
2010-02-13 00:57:23 +03:00
|
|
|
dev_dbg(di->dev, "negative current!\n");
|
2010-02-27 18:06:44 +03:00
|
|
|
curr = -curr;
|
2010-02-13 00:57:23 +03:00
|
|
|
}
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
val->intval = curr * 3570 / BQ27000_RS;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
return 0;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2010-02-27 18:06:09 +03:00
|
|
|
static int bq27x00_battery_status(struct bq27x00_device_info *di,
|
2011-01-07 22:12:47 +03:00
|
|
|
union power_supply_propval *val)
|
2010-02-27 18:06:09 +03:00
|
|
|
{
|
|
|
|
int status;
|
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
if (bq27xxx_is_chip_version_higher(di)) {
|
2011-01-07 22:12:47 +03:00
|
|
|
if (di->cache.flags & BQ27500_FLAG_FC)
|
2010-02-27 18:06:09 +03:00
|
|
|
status = POWER_SUPPLY_STATUS_FULL;
|
2012-02-01 21:20:15 +04:00
|
|
|
else if (di->cache.flags & BQ27500_FLAG_DSC)
|
2010-02-27 18:06:09 +03:00
|
|
|
status = POWER_SUPPLY_STATUS_DISCHARGING;
|
2011-11-01 04:43:08 +04:00
|
|
|
else
|
2012-02-01 21:20:15 +04:00
|
|
|
status = POWER_SUPPLY_STATUS_CHARGING;
|
2010-02-27 18:06:09 +03:00
|
|
|
} else {
|
2010-09-18 19:31:16 +04:00
|
|
|
if (di->cache.flags & BQ27000_FLAG_FC)
|
|
|
|
status = POWER_SUPPLY_STATUS_FULL;
|
|
|
|
else if (di->cache.flags & BQ27000_FLAG_CHGS)
|
2010-02-27 18:06:09 +03:00
|
|
|
status = POWER_SUPPLY_STATUS_CHARGING;
|
2015-03-12 10:44:11 +03:00
|
|
|
else if (power_supply_am_i_supplied(di->bat))
|
2010-09-18 19:31:16 +04:00
|
|
|
status = POWER_SUPPLY_STATUS_NOT_CHARGING;
|
2010-02-27 18:06:09 +03:00
|
|
|
else
|
|
|
|
status = POWER_SUPPLY_STATUS_DISCHARGING;
|
|
|
|
}
|
|
|
|
|
|
|
|
val->intval = status;
|
2011-01-07 22:12:47 +03:00
|
|
|
|
2010-02-27 18:06:09 +03:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-11-01 04:43:04 +04:00
|
|
|
static int bq27x00_battery_capacity_level(struct bq27x00_device_info *di,
|
|
|
|
union power_supply_propval *val)
|
|
|
|
{
|
|
|
|
int level;
|
|
|
|
|
2012-07-14 07:20:07 +04:00
|
|
|
if (bq27xxx_is_chip_version_higher(di)) {
|
2011-11-01 04:43:04 +04:00
|
|
|
if (di->cache.flags & BQ27500_FLAG_FC)
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_FULL;
|
|
|
|
else if (di->cache.flags & BQ27500_FLAG_SOC1)
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_LOW;
|
|
|
|
else if (di->cache.flags & BQ27500_FLAG_SOCF)
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;
|
|
|
|
else
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
|
|
|
|
} else {
|
|
|
|
if (di->cache.flags & BQ27000_FLAG_FC)
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_FULL;
|
|
|
|
else if (di->cache.flags & BQ27000_FLAG_EDV1)
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_LOW;
|
|
|
|
else if (di->cache.flags & BQ27000_FLAG_EDVF)
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;
|
|
|
|
else
|
|
|
|
level = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
val->intval = level;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-02-27 18:06:09 +03:00
|
|
|
/*
|
2012-02-17 20:46:21 +04:00
|
|
|
* Return the battery Voltage in millivolts
|
2011-01-07 22:12:47 +03:00
|
|
|
* Or < 0 if something fails.
|
2010-02-27 18:06:09 +03:00
|
|
|
*/
|
2011-01-07 22:12:47 +03:00
|
|
|
static int bq27x00_battery_voltage(struct bq27x00_device_info *di,
|
|
|
|
union power_supply_propval *val)
|
2010-02-27 18:06:09 +03:00
|
|
|
{
|
2011-01-07 22:12:47 +03:00
|
|
|
int volt;
|
2010-02-27 18:06:09 +03:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
volt = bq27x00_read(di, BQ27x00_REG_VOLT, false);
|
2011-11-01 04:43:09 +04:00
|
|
|
if (volt < 0) {
|
|
|
|
dev_err(di->dev, "error reading voltage\n");
|
2011-01-07 22:12:47 +03:00
|
|
|
return volt;
|
2011-11-01 04:43:09 +04:00
|
|
|
}
|
2010-02-27 18:06:09 +03:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
val->intval = volt * 1000;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int bq27x00_simple_value(int value,
|
|
|
|
union power_supply_propval *val)
|
|
|
|
{
|
|
|
|
if (value < 0)
|
|
|
|
return value;
|
|
|
|
|
|
|
|
val->intval = value;
|
2010-02-27 18:06:09 +03:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
static int bq27x00_battery_get_property(struct power_supply *psy,
|
|
|
|
enum power_supply_property psp,
|
|
|
|
union power_supply_propval *val)
|
|
|
|
{
|
2010-02-27 18:06:09 +03:00
|
|
|
int ret = 0;
|
2015-03-12 10:44:11 +03:00
|
|
|
struct bq27x00_device_info *di = power_supply_get_drvdata(psy);
|
2010-05-24 23:57:33 +04:00
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
mutex_lock(&di->lock);
|
|
|
|
if (time_is_before_jiffies(di->last_update + 5 * HZ)) {
|
|
|
|
cancel_delayed_work_sync(&di->work);
|
|
|
|
bq27x00_battery_poll(&di->work.work);
|
|
|
|
}
|
|
|
|
mutex_unlock(&di->lock);
|
2011-01-07 22:12:47 +03:00
|
|
|
|
|
|
|
if (psp != POWER_SUPPLY_PROP_PRESENT && di->cache.flags < 0)
|
2010-05-24 23:57:33 +04:00
|
|
|
return -ENODEV;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
|
|
|
switch (psp) {
|
2010-02-27 18:06:09 +03:00
|
|
|
case POWER_SUPPLY_PROP_STATUS:
|
|
|
|
ret = bq27x00_battery_status(di, val);
|
|
|
|
break;
|
2008-08-21 03:52:58 +04:00
|
|
|
case POWER_SUPPLY_PROP_VOLTAGE_NOW:
|
2011-01-07 22:12:47 +03:00
|
|
|
ret = bq27x00_battery_voltage(di, val);
|
2010-05-24 23:57:33 +04:00
|
|
|
break;
|
2008-08-21 03:52:58 +04:00
|
|
|
case POWER_SUPPLY_PROP_PRESENT:
|
2011-01-07 22:12:47 +03:00
|
|
|
val->intval = di->cache.flags < 0 ? 0 : 1;
|
2008-08-21 03:52:58 +04:00
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CURRENT_NOW:
|
2011-01-07 22:12:47 +03:00
|
|
|
ret = bq27x00_battery_current(di, val);
|
2008-08-21 03:52:58 +04:00
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CAPACITY:
|
2011-01-07 22:12:47 +03:00
|
|
|
ret = bq27x00_simple_value(di->cache.capacity, val);
|
2008-08-21 03:52:58 +04:00
|
|
|
break;
|
2011-11-01 04:43:04 +04:00
|
|
|
case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
|
|
|
|
ret = bq27x00_battery_capacity_level(di, val);
|
|
|
|
break;
|
2008-08-21 03:52:58 +04:00
|
|
|
case POWER_SUPPLY_PROP_TEMP:
|
2011-11-01 04:43:07 +04:00
|
|
|
ret = bq27x00_simple_value(di->cache.temperature, val);
|
2013-02-02 14:06:09 +04:00
|
|
|
if (ret == 0)
|
|
|
|
val->intval -= 2731;
|
2008-08-21 03:52:58 +04:00
|
|
|
break;
|
2010-02-27 18:06:09 +03:00
|
|
|
case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW:
|
2011-01-07 22:12:47 +03:00
|
|
|
ret = bq27x00_simple_value(di->cache.time_to_empty, val);
|
2010-02-27 18:06:09 +03:00
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
|
2011-01-07 22:12:47 +03:00
|
|
|
ret = bq27x00_simple_value(di->cache.time_to_empty_avg, val);
|
2010-02-27 18:06:09 +03:00
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_TIME_TO_FULL_NOW:
|
2011-01-07 22:12:47 +03:00
|
|
|
ret = bq27x00_simple_value(di->cache.time_to_full, val);
|
2010-02-27 18:06:09 +03:00
|
|
|
break;
|
2010-05-24 22:36:52 +04:00
|
|
|
case POWER_SUPPLY_PROP_TECHNOLOGY:
|
|
|
|
val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
|
|
|
|
break;
|
2011-02-01 02:08:02 +03:00
|
|
|
case POWER_SUPPLY_PROP_CHARGE_NOW:
|
|
|
|
ret = bq27x00_simple_value(bq27x00_battery_read_nac(di), val);
|
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CHARGE_FULL:
|
|
|
|
ret = bq27x00_simple_value(di->cache.charge_full, val);
|
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
|
|
|
|
ret = bq27x00_simple_value(di->charge_design_full, val);
|
|
|
|
break;
|
2011-05-01 01:59:35 +04:00
|
|
|
case POWER_SUPPLY_PROP_CYCLE_COUNT:
|
|
|
|
ret = bq27x00_simple_value(di->cache.cycle_count, val);
|
2011-02-01 02:08:02 +03:00
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_ENERGY_NOW:
|
2011-11-01 04:43:06 +04:00
|
|
|
ret = bq27x00_simple_value(di->cache.energy, val);
|
2011-02-01 02:08:02 +03:00
|
|
|
break;
|
2012-05-17 11:21:15 +04:00
|
|
|
case POWER_SUPPLY_PROP_POWER_AVG:
|
|
|
|
ret = bq27x00_simple_value(di->cache.power_avg, val);
|
|
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_HEALTH:
|
|
|
|
ret = bq27x00_simple_value(di->cache.health, val);
|
|
|
|
break;
|
2008-08-21 03:52:58 +04:00
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2010-02-27 18:06:09 +03:00
|
|
|
return ret;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
static void bq27x00_external_power_changed(struct power_supply *psy)
|
|
|
|
{
|
2015-03-12 10:44:11 +03:00
|
|
|
struct bq27x00_device_info *di = power_supply_get_drvdata(psy);
|
2011-01-07 22:14:53 +03:00
|
|
|
|
|
|
|
cancel_delayed_work_sync(&di->work);
|
|
|
|
schedule_delayed_work(&di->work, 0);
|
|
|
|
}
|
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
static int bq27x00_powersupply_init(struct bq27x00_device_info *di,
|
|
|
|
const char *name)
|
2008-08-21 03:52:58 +04:00
|
|
|
{
|
2010-05-24 21:37:58 +04:00
|
|
|
int ret;
|
2015-03-12 10:44:11 +03:00
|
|
|
struct power_supply_desc *psy_desc;
|
|
|
|
struct power_supply_config psy_cfg = { .drv_data = di, };
|
|
|
|
|
|
|
|
psy_desc = devm_kzalloc(di->dev, sizeof(*psy_desc), GFP_KERNEL);
|
|
|
|
if (!psy_desc)
|
|
|
|
return -ENOMEM;
|
2010-05-24 21:37:58 +04:00
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
psy_desc->name = name;
|
|
|
|
psy_desc->type = POWER_SUPPLY_TYPE_BATTERY;
|
2012-07-14 07:20:07 +04:00
|
|
|
if (di->chip == BQ27425) {
|
2015-03-12 10:44:11 +03:00
|
|
|
psy_desc->properties = bq27425_battery_props;
|
|
|
|
psy_desc->num_properties = ARRAY_SIZE(bq27425_battery_props);
|
2014-09-09 23:20:35 +04:00
|
|
|
} else if (di->chip == BQ27742) {
|
2015-03-12 10:44:11 +03:00
|
|
|
psy_desc->properties = bq27742_battery_props;
|
|
|
|
psy_desc->num_properties = ARRAY_SIZE(bq27742_battery_props);
|
2015-02-28 20:59:28 +03:00
|
|
|
} else if (di->chip == BQ27510) {
|
2015-03-12 10:44:11 +03:00
|
|
|
psy_desc->properties = bq27510_battery_props;
|
|
|
|
psy_desc->num_properties = ARRAY_SIZE(bq27510_battery_props);
|
2012-07-14 07:20:07 +04:00
|
|
|
} else {
|
2015-03-12 10:44:11 +03:00
|
|
|
psy_desc->properties = bq27x00_battery_props;
|
|
|
|
psy_desc->num_properties = ARRAY_SIZE(bq27x00_battery_props);
|
2012-07-14 07:20:07 +04:00
|
|
|
}
|
2015-03-12 10:44:11 +03:00
|
|
|
psy_desc->get_property = bq27x00_battery_get_property;
|
|
|
|
psy_desc->external_power_changed = bq27x00_external_power_changed;
|
2011-01-07 22:14:53 +03:00
|
|
|
|
|
|
|
INIT_DELAYED_WORK(&di->work, bq27x00_battery_poll);
|
|
|
|
mutex_init(&di->lock);
|
2010-05-24 21:37:58 +04:00
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
di->bat = power_supply_register_no_ws(di->dev, psy_desc, &psy_cfg);
|
|
|
|
if (IS_ERR(di->bat)) {
|
|
|
|
ret = PTR_ERR(di->bat);
|
2010-05-24 21:37:58 +04:00
|
|
|
dev_err(di->dev, "failed to register battery: %d\n", ret);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev_info(di->dev, "support ver. %s enabled\n", DRIVER_VERSION);
|
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
bq27x00_update(di);
|
|
|
|
|
2010-05-24 21:37:58 +04:00
|
|
|
return 0;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
static void bq27x00_powersupply_unregister(struct bq27x00_device_info *di)
|
|
|
|
{
|
2011-11-01 04:43:11 +04:00
|
|
|
/*
|
|
|
|
* power_supply_unregister call bq27x00_battery_get_property which
|
|
|
|
* call bq27x00_battery_poll.
|
|
|
|
* Make sure that bq27x00_battery_poll will not call
|
|
|
|
* schedule_delayed_work again after unregister (which cause OOPS).
|
|
|
|
*/
|
|
|
|
poll_interval = 0;
|
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
cancel_delayed_work_sync(&di->work);
|
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
power_supply_unregister(di->bat);
|
2011-01-07 22:14:53 +03:00
|
|
|
|
|
|
|
mutex_destroy(&di->lock);
|
|
|
|
}
|
|
|
|
|
2010-05-24 21:55:27 +04:00
|
|
|
|
|
|
|
/* i2c specific code */
|
|
|
|
#ifdef CONFIG_BATTERY_BQ27X00_I2C
|
|
|
|
|
|
|
|
/* If the system has several batteries we need a different name for each
|
|
|
|
* of them...
|
2008-08-21 03:52:58 +04:00
|
|
|
*/
|
2010-05-24 21:55:27 +04:00
|
|
|
static DEFINE_IDR(battery_id);
|
|
|
|
static DEFINE_MUTEX(battery_mutex);
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
static int bq27x00_read_i2c(struct bq27x00_device_info *di, u8 reg, bool single)
|
2008-08-21 03:52:58 +04:00
|
|
|
{
|
2010-05-24 21:37:58 +04:00
|
|
|
struct i2c_client *client = to_i2c_client(di->dev);
|
2011-02-16 00:27:35 +03:00
|
|
|
struct i2c_msg msg[2];
|
2008-08-21 03:52:58 +04:00
|
|
|
unsigned char data[2];
|
2011-01-07 22:12:47 +03:00
|
|
|
int ret;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
|
|
|
if (!client->adapter)
|
|
|
|
return -ENODEV;
|
|
|
|
|
2011-02-16 00:27:35 +03:00
|
|
|
msg[0].addr = client->addr;
|
|
|
|
msg[0].flags = 0;
|
|
|
|
msg[0].buf = ®
|
|
|
|
msg[0].len = sizeof(reg);
|
|
|
|
msg[1].addr = client->addr;
|
|
|
|
msg[1].flags = I2C_M_RD;
|
|
|
|
msg[1].buf = data;
|
2011-02-02 21:35:07 +03:00
|
|
|
if (single)
|
2011-02-16 00:27:35 +03:00
|
|
|
msg[1].len = 1;
|
2011-02-02 21:35:07 +03:00
|
|
|
else
|
2011-02-16 00:27:35 +03:00
|
|
|
msg[1].len = 2;
|
2011-02-02 21:35:07 +03:00
|
|
|
|
2011-02-16 00:27:35 +03:00
|
|
|
ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
|
2011-02-02 21:35:07 +03:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
if (!single)
|
|
|
|
ret = get_unaligned_le16(data);
|
|
|
|
else
|
|
|
|
ret = data[0];
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
return ret;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
2010-02-13 00:57:23 +03:00
|
|
|
static int bq27x00_battery_probe(struct i2c_client *client,
|
2008-08-21 03:52:58 +04:00
|
|
|
const struct i2c_device_id *id)
|
|
|
|
{
|
|
|
|
char *name;
|
|
|
|
struct bq27x00_device_info *di;
|
|
|
|
int num;
|
|
|
|
int retval = 0;
|
|
|
|
|
|
|
|
/* Get new ID for the new battery device */
|
|
|
|
mutex_lock(&battery_mutex);
|
2013-02-28 05:04:37 +04:00
|
|
|
num = idr_alloc(&battery_id, client, 0, 0, GFP_KERNEL);
|
2008-08-21 03:52:58 +04:00
|
|
|
mutex_unlock(&battery_mutex);
|
2013-02-28 05:04:37 +04:00
|
|
|
if (num < 0)
|
|
|
|
return num;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
name = devm_kasprintf(&client->dev, GFP_KERNEL, "%s-%d", id->name, num);
|
2008-08-21 03:52:58 +04:00
|
|
|
if (!name) {
|
|
|
|
dev_err(&client->dev, "failed to allocate device name\n");
|
|
|
|
retval = -ENOMEM;
|
2015-03-12 10:44:11 +03:00
|
|
|
goto batt_failed;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
|
bq27x00_battery: Introduce the use of the managed version of kzalloc
This patch moves data allocated using kzalloc to managed data allocated
using devm_kzalloc and cleans now unnecessary kfrees in probe and remove
functions for both platform and i2c drivers. Also, the unecessary
variable ret and labels batt_failed3, err_free were removed.
The following Coccinele script was used for making the change:
@platform@
identifier p, probefn, removefn;
@@
struct platform_driver p = {
.probe = probefn,
.remove = removefn,
};
@prb@
identifier platform.probefn, pdev;
expression e, e1, e2;
@@
probefn(struct platform_device *pdev, ...) {
<+...
- e = kzalloc(e1, e2)
+ e = devm_kzalloc(&pdev->dev, e1, e2)
...
?-kfree(e);
...+>
}
@rem depends on prb@
identifier platform.removefn;
expression e;
@@
removefn(...) {
<...
- kfree(e);
...>
}
Signed-off-by: Himangi Saraogi <himangi774@gmail.com>
Acked-by: Julia Lawall <julia.lawall@lip6.fr>
Signed-off-by: Sebastian Reichel <sre@kernel.org>
2014-05-28 21:28:49 +04:00
|
|
|
di = devm_kzalloc(&client->dev, sizeof(*di), GFP_KERNEL);
|
2008-08-21 03:52:58 +04:00
|
|
|
if (!di) {
|
|
|
|
dev_err(&client->dev, "failed to allocate device info data\n");
|
|
|
|
retval = -ENOMEM;
|
2015-03-12 10:44:11 +03:00
|
|
|
goto batt_failed;
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
2010-05-24 21:37:58 +04:00
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
di->id = num;
|
2010-05-24 21:37:58 +04:00
|
|
|
di->dev = &client->dev;
|
2010-02-13 00:57:23 +03:00
|
|
|
di->chip = id->driver_data;
|
2010-05-24 21:37:58 +04:00
|
|
|
di->bus.read = &bq27x00_read_i2c;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
retval = bq27x00_powersupply_init(di, name);
|
2012-08-19 12:44:20 +04:00
|
|
|
if (retval)
|
2015-03-12 10:44:11 +03:00
|
|
|
goto batt_failed;
|
2008-08-21 03:52:58 +04:00
|
|
|
|
|
|
|
i2c_set_clientdata(client, di);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
batt_failed:
|
2008-08-21 03:52:58 +04:00
|
|
|
mutex_lock(&battery_mutex);
|
|
|
|
idr_remove(&battery_id, num);
|
|
|
|
mutex_unlock(&battery_mutex);
|
|
|
|
|
|
|
|
return retval;
|
|
|
|
}
|
|
|
|
|
2010-02-13 00:57:23 +03:00
|
|
|
static int bq27x00_battery_remove(struct i2c_client *client)
|
2008-08-21 03:52:58 +04:00
|
|
|
{
|
|
|
|
struct bq27x00_device_info *di = i2c_get_clientdata(client);
|
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
bq27x00_powersupply_unregister(di);
|
2008-08-21 03:52:58 +04:00
|
|
|
|
|
|
|
mutex_lock(&battery_mutex);
|
|
|
|
idr_remove(&battery_id, di->id);
|
|
|
|
mutex_unlock(&battery_mutex);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-02-13 00:57:23 +03:00
|
|
|
static const struct i2c_device_id bq27x00_id[] = {
|
|
|
|
{ "bq27200", BQ27000 }, /* bq27200 is same as bq27000, but with i2c */
|
|
|
|
{ "bq27500", BQ27500 },
|
2012-07-14 07:20:07 +04:00
|
|
|
{ "bq27425", BQ27425 },
|
2014-09-09 23:20:35 +04:00
|
|
|
{ "bq27742", BQ27742 },
|
2015-02-28 20:59:28 +03:00
|
|
|
{ "bq27510", BQ27510 },
|
2008-08-21 03:52:58 +04:00
|
|
|
{},
|
|
|
|
};
|
2011-02-01 02:10:41 +03:00
|
|
|
MODULE_DEVICE_TABLE(i2c, bq27x00_id);
|
2008-08-21 03:52:58 +04:00
|
|
|
|
2010-02-13 00:57:23 +03:00
|
|
|
static struct i2c_driver bq27x00_battery_driver = {
|
2008-08-21 03:52:58 +04:00
|
|
|
.driver = {
|
2010-02-13 00:57:23 +03:00
|
|
|
.name = "bq27x00-battery",
|
2008-08-21 03:52:58 +04:00
|
|
|
},
|
2010-02-13 00:57:23 +03:00
|
|
|
.probe = bq27x00_battery_probe,
|
|
|
|
.remove = bq27x00_battery_remove,
|
|
|
|
.id_table = bq27x00_id,
|
2008-08-21 03:52:58 +04:00
|
|
|
};
|
|
|
|
|
2010-05-24 21:55:27 +04:00
|
|
|
static inline int bq27x00_battery_i2c_init(void)
|
|
|
|
{
|
|
|
|
int ret = i2c_add_driver(&bq27x00_battery_driver);
|
|
|
|
if (ret)
|
|
|
|
printk(KERN_ERR "Unable to register BQ27x00 i2c driver\n");
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void bq27x00_battery_i2c_exit(void)
|
|
|
|
{
|
|
|
|
i2c_del_driver(&bq27x00_battery_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
static inline int bq27x00_battery_i2c_init(void) { return 0; }
|
|
|
|
static inline void bq27x00_battery_i2c_exit(void) {};
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* platform specific code */
|
|
|
|
#ifdef CONFIG_BATTERY_BQ27X00_PLATFORM
|
|
|
|
|
|
|
|
static int bq27000_read_platform(struct bq27x00_device_info *di, u8 reg,
|
2011-01-07 22:12:47 +03:00
|
|
|
bool single)
|
2010-05-24 21:55:27 +04:00
|
|
|
{
|
|
|
|
struct device *dev = di->dev;
|
|
|
|
struct bq27000_platform_data *pdata = dev->platform_data;
|
|
|
|
unsigned int timeout = 3;
|
|
|
|
int upper, lower;
|
|
|
|
int temp;
|
|
|
|
|
|
|
|
if (!single) {
|
|
|
|
/* Make sure the value has not changed in between reading the
|
|
|
|
* lower and the upper part */
|
|
|
|
upper = pdata->read(dev, reg + 1);
|
|
|
|
do {
|
|
|
|
temp = upper;
|
|
|
|
if (upper < 0)
|
|
|
|
return upper;
|
|
|
|
|
|
|
|
lower = pdata->read(dev, reg);
|
|
|
|
if (lower < 0)
|
|
|
|
return lower;
|
|
|
|
|
|
|
|
upper = pdata->read(dev, reg + 1);
|
|
|
|
} while (temp != upper && --timeout);
|
|
|
|
|
|
|
|
if (timeout == 0)
|
|
|
|
return -EIO;
|
|
|
|
|
2011-01-07 22:12:47 +03:00
|
|
|
return (upper << 8) | lower;
|
2010-05-24 21:55:27 +04:00
|
|
|
}
|
2011-01-07 22:12:47 +03:00
|
|
|
|
|
|
|
return pdata->read(dev, reg);
|
2010-05-24 21:55:27 +04:00
|
|
|
}
|
|
|
|
|
2012-11-19 22:22:23 +04:00
|
|
|
static int bq27000_battery_probe(struct platform_device *pdev)
|
2010-05-24 21:55:27 +04:00
|
|
|
{
|
|
|
|
struct bq27x00_device_info *di;
|
|
|
|
struct bq27000_platform_data *pdata = pdev->dev.platform_data;
|
2015-03-12 10:44:11 +03:00
|
|
|
const char *name;
|
2010-05-24 21:55:27 +04:00
|
|
|
|
|
|
|
if (!pdata) {
|
|
|
|
dev_err(&pdev->dev, "no platform_data supplied\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!pdata->read) {
|
|
|
|
dev_err(&pdev->dev, "no hdq read callback supplied\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
bq27x00_battery: Introduce the use of the managed version of kzalloc
This patch moves data allocated using kzalloc to managed data allocated
using devm_kzalloc and cleans now unnecessary kfrees in probe and remove
functions for both platform and i2c drivers. Also, the unecessary
variable ret and labels batt_failed3, err_free were removed.
The following Coccinele script was used for making the change:
@platform@
identifier p, probefn, removefn;
@@
struct platform_driver p = {
.probe = probefn,
.remove = removefn,
};
@prb@
identifier platform.probefn, pdev;
expression e, e1, e2;
@@
probefn(struct platform_device *pdev, ...) {
<+...
- e = kzalloc(e1, e2)
+ e = devm_kzalloc(&pdev->dev, e1, e2)
...
?-kfree(e);
...+>
}
@rem depends on prb@
identifier platform.removefn;
expression e;
@@
removefn(...) {
<...
- kfree(e);
...>
}
Signed-off-by: Himangi Saraogi <himangi774@gmail.com>
Acked-by: Julia Lawall <julia.lawall@lip6.fr>
Signed-off-by: Sebastian Reichel <sre@kernel.org>
2014-05-28 21:28:49 +04:00
|
|
|
di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);
|
2010-05-24 21:55:27 +04:00
|
|
|
if (!di) {
|
|
|
|
dev_err(&pdev->dev, "failed to allocate device info data\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
platform_set_drvdata(pdev, di);
|
|
|
|
|
|
|
|
di->dev = &pdev->dev;
|
|
|
|
di->chip = BQ27000;
|
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
name = pdata->name ?: dev_name(&pdev->dev);
|
2010-05-24 21:55:27 +04:00
|
|
|
di->bus.read = &bq27000_read_platform;
|
|
|
|
|
2015-03-12 10:44:11 +03:00
|
|
|
return bq27x00_powersupply_init(di, name);
|
2010-05-24 21:55:27 +04:00
|
|
|
}
|
|
|
|
|
2012-11-19 22:26:07 +04:00
|
|
|
static int bq27000_battery_remove(struct platform_device *pdev)
|
2010-05-24 21:55:27 +04:00
|
|
|
{
|
|
|
|
struct bq27x00_device_info *di = platform_get_drvdata(pdev);
|
|
|
|
|
2011-01-07 22:14:53 +03:00
|
|
|
bq27x00_powersupply_unregister(di);
|
|
|
|
|
2010-05-24 21:55:27 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct platform_driver bq27000_battery_driver = {
|
|
|
|
.probe = bq27000_battery_probe,
|
2012-11-19 22:20:40 +04:00
|
|
|
.remove = bq27000_battery_remove,
|
2010-05-24 21:55:27 +04:00
|
|
|
.driver = {
|
|
|
|
.name = "bq27000-battery",
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static inline int bq27x00_battery_platform_init(void)
|
|
|
|
{
|
|
|
|
int ret = platform_driver_register(&bq27000_battery_driver);
|
|
|
|
if (ret)
|
|
|
|
printk(KERN_ERR "Unable to register BQ27000 platform driver\n");
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void bq27x00_battery_platform_exit(void)
|
|
|
|
{
|
|
|
|
platform_driver_unregister(&bq27000_battery_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
static inline int bq27x00_battery_platform_init(void) { return 0; }
|
|
|
|
static inline void bq27x00_battery_platform_exit(void) {};
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Module stuff
|
|
|
|
*/
|
|
|
|
|
2008-08-21 03:52:58 +04:00
|
|
|
static int __init bq27x00_battery_init(void)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
2010-05-24 21:55:27 +04:00
|
|
|
ret = bq27x00_battery_i2c_init();
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
ret = bq27x00_battery_platform_init();
|
2008-08-21 03:52:58 +04:00
|
|
|
if (ret)
|
2010-05-24 21:55:27 +04:00
|
|
|
bq27x00_battery_i2c_exit();
|
2008-08-21 03:52:58 +04:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
module_init(bq27x00_battery_init);
|
|
|
|
|
|
|
|
static void __exit bq27x00_battery_exit(void)
|
|
|
|
{
|
2010-05-24 21:55:27 +04:00
|
|
|
bq27x00_battery_platform_exit();
|
|
|
|
bq27x00_battery_i2c_exit();
|
2008-08-21 03:52:58 +04:00
|
|
|
}
|
|
|
|
module_exit(bq27x00_battery_exit);
|
|
|
|
|
|
|
|
MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>");
|
|
|
|
MODULE_DESCRIPTION("BQ27x00 battery monitor driver");
|
|
|
|
MODULE_LICENSE("GPL");
|