mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-21 14:09:55 +07:00
ddeeb8f973
The driver core clears the driver data to NULL after device_release or on
probe failure, since commit 0998d06310
(device-core: Ensure drvdata = NULL when no driver is bound). Thus, it is
not needed to manually clear the device driver data to NULL.
Signed-off-by: Jingoo Han <jg1.han@samsung.com>
Acked-by: Lee Jones <lee.jones@linaro.org>
Signed-off-by: Anton Vorontsov <anton@enomsg.org>
1220 lines
32 KiB
C
1220 lines
32 KiB
C
/*
|
|
* Copyright (C) ST-Ericsson SA 2012
|
|
*
|
|
* Battery temperature driver for AB8500
|
|
*
|
|
* License Terms: GNU General Public License v2
|
|
* Author:
|
|
* Johan Palsson <johan.palsson@stericsson.com>
|
|
* Karl Komierowski <karl.komierowski@stericsson.com>
|
|
* Arun R Murthy <arun.murthy@stericsson.com>
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/device.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/power_supply.h>
|
|
#include <linux/completion.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/of.h>
|
|
#include <linux/mfd/core.h>
|
|
#include <linux/mfd/abx500.h>
|
|
#include <linux/mfd/abx500/ab8500.h>
|
|
#include <linux/mfd/abx500/ab8500-bm.h>
|
|
#include <linux/mfd/abx500/ab8500-gpadc.h>
|
|
|
|
#define VTVOUT_V 1800
|
|
|
|
#define BTEMP_THERMAL_LOW_LIMIT -10
|
|
#define BTEMP_THERMAL_MED_LIMIT 0
|
|
#define BTEMP_THERMAL_HIGH_LIMIT_52 52
|
|
#define BTEMP_THERMAL_HIGH_LIMIT_57 57
|
|
#define BTEMP_THERMAL_HIGH_LIMIT_62 62
|
|
|
|
#define BTEMP_BATCTRL_CURR_SRC_7UA 7
|
|
#define BTEMP_BATCTRL_CURR_SRC_20UA 20
|
|
|
|
#define BTEMP_BATCTRL_CURR_SRC_16UA 16
|
|
#define BTEMP_BATCTRL_CURR_SRC_18UA 18
|
|
|
|
#define BTEMP_BATCTRL_CURR_SRC_60UA 60
|
|
#define BTEMP_BATCTRL_CURR_SRC_120UA 120
|
|
|
|
#define to_ab8500_btemp_device_info(x) container_of((x), \
|
|
struct ab8500_btemp, btemp_psy);
|
|
|
|
/**
|
|
* struct ab8500_btemp_interrupts - ab8500 interrupts
|
|
* @name: name of the interrupt
|
|
* @isr function pointer to the isr
|
|
*/
|
|
struct ab8500_btemp_interrupts {
|
|
char *name;
|
|
irqreturn_t (*isr)(int irq, void *data);
|
|
};
|
|
|
|
struct ab8500_btemp_events {
|
|
bool batt_rem;
|
|
bool btemp_high;
|
|
bool btemp_medhigh;
|
|
bool btemp_lowmed;
|
|
bool btemp_low;
|
|
bool ac_conn;
|
|
bool usb_conn;
|
|
};
|
|
|
|
struct ab8500_btemp_ranges {
|
|
int btemp_high_limit;
|
|
int btemp_med_limit;
|
|
int btemp_low_limit;
|
|
};
|
|
|
|
/**
|
|
* struct ab8500_btemp - ab8500 BTEMP device information
|
|
* @dev: Pointer to the structure device
|
|
* @node: List of AB8500 BTEMPs, hence prepared for reentrance
|
|
* @curr_source: What current source we use, in uA
|
|
* @bat_temp: Dispatched battery temperature in degree Celcius
|
|
* @prev_bat_temp Last measured battery temperature in degree Celcius
|
|
* @parent: Pointer to the struct ab8500
|
|
* @gpadc: Pointer to the struct gpadc
|
|
* @fg: Pointer to the struct fg
|
|
* @bm: Platform specific battery management information
|
|
* @btemp_psy: Structure for BTEMP specific battery properties
|
|
* @events: Structure for information about events triggered
|
|
* @btemp_ranges: Battery temperature range structure
|
|
* @btemp_wq: Work queue for measuring the temperature periodically
|
|
* @btemp_periodic_work: Work for measuring the temperature periodically
|
|
* @initialized: True if battery id read.
|
|
*/
|
|
struct ab8500_btemp {
|
|
struct device *dev;
|
|
struct list_head node;
|
|
int curr_source;
|
|
int bat_temp;
|
|
int prev_bat_temp;
|
|
struct ab8500 *parent;
|
|
struct ab8500_gpadc *gpadc;
|
|
struct ab8500_fg *fg;
|
|
struct abx500_bm_data *bm;
|
|
struct power_supply btemp_psy;
|
|
struct ab8500_btemp_events events;
|
|
struct ab8500_btemp_ranges btemp_ranges;
|
|
struct workqueue_struct *btemp_wq;
|
|
struct delayed_work btemp_periodic_work;
|
|
bool initialized;
|
|
};
|
|
|
|
/* BTEMP power supply properties */
|
|
static enum power_supply_property ab8500_btemp_props[] = {
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
POWER_SUPPLY_PROP_ONLINE,
|
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
|
POWER_SUPPLY_PROP_TEMP,
|
|
};
|
|
|
|
static LIST_HEAD(ab8500_btemp_list);
|
|
|
|
/**
|
|
* ab8500_btemp_get() - returns a reference to the primary AB8500 BTEMP
|
|
* (i.e. the first BTEMP in the instance list)
|
|
*/
|
|
struct ab8500_btemp *ab8500_btemp_get(void)
|
|
{
|
|
struct ab8500_btemp *btemp;
|
|
btemp = list_first_entry(&ab8500_btemp_list, struct ab8500_btemp, node);
|
|
|
|
return btemp;
|
|
}
|
|
EXPORT_SYMBOL(ab8500_btemp_get);
|
|
|
|
/**
|
|
* ab8500_btemp_batctrl_volt_to_res() - convert batctrl voltage to resistance
|
|
* @di: pointer to the ab8500_btemp structure
|
|
* @v_batctrl: measured batctrl voltage
|
|
* @inst_curr: measured instant current
|
|
*
|
|
* This function returns the battery resistance that is
|
|
* derived from the BATCTRL voltage.
|
|
* Returns value in Ohms.
|
|
*/
|
|
static int ab8500_btemp_batctrl_volt_to_res(struct ab8500_btemp *di,
|
|
int v_batctrl, int inst_curr)
|
|
{
|
|
int rbs;
|
|
|
|
if (is_ab8500_1p1_or_earlier(di->parent)) {
|
|
/*
|
|
* For ABB cut1.0 and 1.1 BAT_CTRL is internally
|
|
* connected to 1.8V through a 450k resistor
|
|
*/
|
|
return (450000 * (v_batctrl)) / (1800 - v_batctrl);
|
|
}
|
|
|
|
if (di->bm->adc_therm == ABx500_ADC_THERM_BATCTRL) {
|
|
/*
|
|
* If the battery has internal NTC, we use the current
|
|
* source to calculate the resistance.
|
|
*/
|
|
rbs = (v_batctrl * 1000
|
|
- di->bm->gnd_lift_resistance * inst_curr)
|
|
/ di->curr_source;
|
|
} else {
|
|
/*
|
|
* BAT_CTRL is internally
|
|
* connected to 1.8V through a 80k resistor
|
|
*/
|
|
rbs = (80000 * (v_batctrl)) / (1800 - v_batctrl);
|
|
}
|
|
|
|
return rbs;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_read_batctrl_voltage() - measure batctrl voltage
|
|
* @di: pointer to the ab8500_btemp structure
|
|
*
|
|
* This function returns the voltage on BATCTRL. Returns value in mV.
|
|
*/
|
|
static int ab8500_btemp_read_batctrl_voltage(struct ab8500_btemp *di)
|
|
{
|
|
int vbtemp;
|
|
static int prev;
|
|
|
|
vbtemp = ab8500_gpadc_convert(di->gpadc, BAT_CTRL);
|
|
if (vbtemp < 0) {
|
|
dev_err(di->dev,
|
|
"%s gpadc conversion failed, using previous value",
|
|
__func__);
|
|
return prev;
|
|
}
|
|
prev = vbtemp;
|
|
return vbtemp;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_curr_source_enable() - enable/disable batctrl current source
|
|
* @di: pointer to the ab8500_btemp structure
|
|
* @enable: enable or disable the current source
|
|
*
|
|
* Enable or disable the current sources for the BatCtrl AD channel
|
|
*/
|
|
static int ab8500_btemp_curr_source_enable(struct ab8500_btemp *di,
|
|
bool enable)
|
|
{
|
|
int curr;
|
|
int ret = 0;
|
|
|
|
/*
|
|
* BATCTRL current sources are included on AB8500 cut2.0
|
|
* and future versions
|
|
*/
|
|
if (is_ab8500_1p1_or_earlier(di->parent))
|
|
return 0;
|
|
|
|
/* Only do this for batteries with internal NTC */
|
|
if (di->bm->adc_therm == ABx500_ADC_THERM_BATCTRL && enable) {
|
|
|
|
if (is_ab8540(di->parent)) {
|
|
if (di->curr_source == BTEMP_BATCTRL_CURR_SRC_60UA)
|
|
curr = BAT_CTRL_60U_ENA;
|
|
else
|
|
curr = BAT_CTRL_120U_ENA;
|
|
} else if (is_ab9540(di->parent) || is_ab8505(di->parent)) {
|
|
if (di->curr_source == BTEMP_BATCTRL_CURR_SRC_16UA)
|
|
curr = BAT_CTRL_16U_ENA;
|
|
else
|
|
curr = BAT_CTRL_18U_ENA;
|
|
} else {
|
|
if (di->curr_source == BTEMP_BATCTRL_CURR_SRC_7UA)
|
|
curr = BAT_CTRL_7U_ENA;
|
|
else
|
|
curr = BAT_CTRL_20U_ENA;
|
|
}
|
|
|
|
dev_dbg(di->dev, "Set BATCTRL %duA\n", di->curr_source);
|
|
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
FORCE_BAT_CTRL_CMP_HIGH, FORCE_BAT_CTRL_CMP_HIGH);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed setting cmp_force\n",
|
|
__func__);
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* We have to wait one 32kHz cycle before enabling
|
|
* the current source, since ForceBatCtrlCmpHigh needs
|
|
* to be written in a separate cycle
|
|
*/
|
|
udelay(32);
|
|
|
|
ret = abx500_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
FORCE_BAT_CTRL_CMP_HIGH | curr);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed enabling current source\n",
|
|
__func__);
|
|
goto disable_curr_source;
|
|
}
|
|
} else if (di->bm->adc_therm == ABx500_ADC_THERM_BATCTRL && !enable) {
|
|
dev_dbg(di->dev, "Disable BATCTRL curr source\n");
|
|
|
|
if (is_ab8540(di->parent)) {
|
|
/* Write 0 to the curr bits */
|
|
ret = abx500_mask_and_set_register_interruptible(
|
|
di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_60U_ENA | BAT_CTRL_120U_ENA,
|
|
~(BAT_CTRL_60U_ENA | BAT_CTRL_120U_ENA));
|
|
} else if (is_ab9540(di->parent) || is_ab8505(di->parent)) {
|
|
/* Write 0 to the curr bits */
|
|
ret = abx500_mask_and_set_register_interruptible(
|
|
di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_16U_ENA | BAT_CTRL_18U_ENA,
|
|
~(BAT_CTRL_16U_ENA | BAT_CTRL_18U_ENA));
|
|
} else {
|
|
/* Write 0 to the curr bits */
|
|
ret = abx500_mask_and_set_register_interruptible(
|
|
di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_7U_ENA | BAT_CTRL_20U_ENA,
|
|
~(BAT_CTRL_7U_ENA | BAT_CTRL_20U_ENA));
|
|
}
|
|
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed disabling current source\n",
|
|
__func__);
|
|
goto disable_curr_source;
|
|
}
|
|
|
|
/* Enable Pull-Up and comparator */
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_PULL_UP_ENA | BAT_CTRL_CMP_ENA,
|
|
BAT_CTRL_PULL_UP_ENA | BAT_CTRL_CMP_ENA);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed enabling PU and comp\n",
|
|
__func__);
|
|
goto enable_pu_comp;
|
|
}
|
|
|
|
/*
|
|
* We have to wait one 32kHz cycle before disabling
|
|
* ForceBatCtrlCmpHigh since this needs to be written
|
|
* in a separate cycle
|
|
*/
|
|
udelay(32);
|
|
|
|
/* Disable 'force comparator' */
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
FORCE_BAT_CTRL_CMP_HIGH, ~FORCE_BAT_CTRL_CMP_HIGH);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed disabling force comp\n",
|
|
__func__);
|
|
goto disable_force_comp;
|
|
}
|
|
}
|
|
return ret;
|
|
|
|
/*
|
|
* We have to try unsetting FORCE_BAT_CTRL_CMP_HIGH one more time
|
|
* if we got an error above
|
|
*/
|
|
disable_curr_source:
|
|
if (is_ab8540(di->parent)) {
|
|
/* Write 0 to the curr bits */
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_60U_ENA | BAT_CTRL_120U_ENA,
|
|
~(BAT_CTRL_60U_ENA | BAT_CTRL_120U_ENA));
|
|
} else if (is_ab9540(di->parent) || is_ab8505(di->parent)) {
|
|
/* Write 0 to the curr bits */
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_16U_ENA | BAT_CTRL_18U_ENA,
|
|
~(BAT_CTRL_16U_ENA | BAT_CTRL_18U_ENA));
|
|
} else {
|
|
/* Write 0 to the curr bits */
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_7U_ENA | BAT_CTRL_20U_ENA,
|
|
~(BAT_CTRL_7U_ENA | BAT_CTRL_20U_ENA));
|
|
}
|
|
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed disabling current source\n",
|
|
__func__);
|
|
return ret;
|
|
}
|
|
enable_pu_comp:
|
|
/* Enable Pull-Up and comparator */
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
BAT_CTRL_PULL_UP_ENA | BAT_CTRL_CMP_ENA,
|
|
BAT_CTRL_PULL_UP_ENA | BAT_CTRL_CMP_ENA);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed enabling PU and comp\n",
|
|
__func__);
|
|
return ret;
|
|
}
|
|
|
|
disable_force_comp:
|
|
/*
|
|
* We have to wait one 32kHz cycle before disabling
|
|
* ForceBatCtrlCmpHigh since this needs to be written
|
|
* in a separate cycle
|
|
*/
|
|
udelay(32);
|
|
|
|
/* Disable 'force comparator' */
|
|
ret = abx500_mask_and_set_register_interruptible(di->dev,
|
|
AB8500_CHARGER, AB8500_BAT_CTRL_CURRENT_SOURCE,
|
|
FORCE_BAT_CTRL_CMP_HIGH, ~FORCE_BAT_CTRL_CMP_HIGH);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s failed disabling force comp\n",
|
|
__func__);
|
|
return ret;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_get_batctrl_res() - get battery resistance
|
|
* @di: pointer to the ab8500_btemp structure
|
|
*
|
|
* This function returns the battery pack identification resistance.
|
|
* Returns value in Ohms.
|
|
*/
|
|
static int ab8500_btemp_get_batctrl_res(struct ab8500_btemp *di)
|
|
{
|
|
int ret;
|
|
int batctrl = 0;
|
|
int res;
|
|
int inst_curr;
|
|
int i;
|
|
|
|
/*
|
|
* BATCTRL current sources are included on AB8500 cut2.0
|
|
* and future versions
|
|
*/
|
|
ret = ab8500_btemp_curr_source_enable(di, true);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s curr source enabled failed\n", __func__);
|
|
return ret;
|
|
}
|
|
|
|
if (!di->fg)
|
|
di->fg = ab8500_fg_get();
|
|
if (!di->fg) {
|
|
dev_err(di->dev, "No fg found\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = ab8500_fg_inst_curr_start(di->fg);
|
|
|
|
if (ret) {
|
|
dev_err(di->dev, "Failed to start current measurement\n");
|
|
return ret;
|
|
}
|
|
|
|
do {
|
|
msleep(20);
|
|
} while (!ab8500_fg_inst_curr_started(di->fg));
|
|
|
|
i = 0;
|
|
|
|
do {
|
|
batctrl += ab8500_btemp_read_batctrl_voltage(di);
|
|
i++;
|
|
msleep(20);
|
|
} while (!ab8500_fg_inst_curr_done(di->fg));
|
|
batctrl /= i;
|
|
|
|
ret = ab8500_fg_inst_curr_finalize(di->fg, &inst_curr);
|
|
if (ret) {
|
|
dev_err(di->dev, "Failed to finalize current measurement\n");
|
|
return ret;
|
|
}
|
|
|
|
res = ab8500_btemp_batctrl_volt_to_res(di, batctrl, inst_curr);
|
|
|
|
ret = ab8500_btemp_curr_source_enable(di, false);
|
|
if (ret) {
|
|
dev_err(di->dev, "%s curr source disable failed\n", __func__);
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(di->dev, "%s batctrl: %d res: %d inst_curr: %d samples: %d\n",
|
|
__func__, batctrl, res, inst_curr, i);
|
|
|
|
return res;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_res_to_temp() - resistance to temperature
|
|
* @di: pointer to the ab8500_btemp structure
|
|
* @tbl: pointer to the resiatance to temperature table
|
|
* @tbl_size: size of the resistance to temperature table
|
|
* @res: resistance to calculate the temperature from
|
|
*
|
|
* This function returns the battery temperature in degrees Celcius
|
|
* based on the NTC resistance.
|
|
*/
|
|
static int ab8500_btemp_res_to_temp(struct ab8500_btemp *di,
|
|
const struct abx500_res_to_temp *tbl, int tbl_size, int res)
|
|
{
|
|
int i, temp;
|
|
/*
|
|
* Calculate the formula for the straight line
|
|
* Simple interpolation if we are within
|
|
* the resistance table limits, extrapolate
|
|
* if resistance is outside the limits.
|
|
*/
|
|
if (res > tbl[0].resist)
|
|
i = 0;
|
|
else if (res <= tbl[tbl_size - 1].resist)
|
|
i = tbl_size - 2;
|
|
else {
|
|
i = 0;
|
|
while (!(res <= tbl[i].resist &&
|
|
res > tbl[i + 1].resist))
|
|
i++;
|
|
}
|
|
|
|
temp = tbl[i].temp + ((tbl[i + 1].temp - tbl[i].temp) *
|
|
(res - tbl[i].resist)) / (tbl[i + 1].resist - tbl[i].resist);
|
|
return temp;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_measure_temp() - measure battery temperature
|
|
* @di: pointer to the ab8500_btemp structure
|
|
*
|
|
* Returns battery temperature (on success) else the previous temperature
|
|
*/
|
|
static int ab8500_btemp_measure_temp(struct ab8500_btemp *di)
|
|
{
|
|
int temp;
|
|
static int prev;
|
|
int rbat, rntc, vntc;
|
|
u8 id;
|
|
|
|
id = di->bm->batt_id;
|
|
|
|
if (di->bm->adc_therm == ABx500_ADC_THERM_BATCTRL &&
|
|
id != BATTERY_UNKNOWN) {
|
|
|
|
rbat = ab8500_btemp_get_batctrl_res(di);
|
|
if (rbat < 0) {
|
|
dev_err(di->dev, "%s get batctrl res failed\n",
|
|
__func__);
|
|
/*
|
|
* Return out-of-range temperature so that
|
|
* charging is stopped
|
|
*/
|
|
return BTEMP_THERMAL_LOW_LIMIT;
|
|
}
|
|
|
|
temp = ab8500_btemp_res_to_temp(di,
|
|
di->bm->bat_type[id].r_to_t_tbl,
|
|
di->bm->bat_type[id].n_temp_tbl_elements, rbat);
|
|
} else {
|
|
vntc = ab8500_gpadc_convert(di->gpadc, BTEMP_BALL);
|
|
if (vntc < 0) {
|
|
dev_err(di->dev,
|
|
"%s gpadc conversion failed,"
|
|
" using previous value\n", __func__);
|
|
return prev;
|
|
}
|
|
/*
|
|
* The PCB NTC is sourced from VTVOUT via a 230kOhm
|
|
* resistor.
|
|
*/
|
|
rntc = 230000 * vntc / (VTVOUT_V - vntc);
|
|
|
|
temp = ab8500_btemp_res_to_temp(di,
|
|
di->bm->bat_type[id].r_to_t_tbl,
|
|
di->bm->bat_type[id].n_temp_tbl_elements, rntc);
|
|
prev = temp;
|
|
}
|
|
dev_dbg(di->dev, "Battery temperature is %d\n", temp);
|
|
return temp;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_id() - Identify the connected battery
|
|
* @di: pointer to the ab8500_btemp structure
|
|
*
|
|
* This function will try to identify the battery by reading the ID
|
|
* resistor. Some brands use a combined ID resistor with a NTC resistor to
|
|
* both be able to identify and to read the temperature of it.
|
|
*/
|
|
static int ab8500_btemp_id(struct ab8500_btemp *di)
|
|
{
|
|
int res;
|
|
u8 i;
|
|
if (is_ab8540(di->parent))
|
|
di->curr_source = BTEMP_BATCTRL_CURR_SRC_60UA;
|
|
else if (is_ab9540(di->parent) || is_ab8505(di->parent))
|
|
di->curr_source = BTEMP_BATCTRL_CURR_SRC_16UA;
|
|
else
|
|
di->curr_source = BTEMP_BATCTRL_CURR_SRC_7UA;
|
|
|
|
di->bm->batt_id = BATTERY_UNKNOWN;
|
|
|
|
res = ab8500_btemp_get_batctrl_res(di);
|
|
if (res < 0) {
|
|
dev_err(di->dev, "%s get batctrl res failed\n", __func__);
|
|
return -ENXIO;
|
|
}
|
|
|
|
/* BATTERY_UNKNOWN is defined on position 0, skip it! */
|
|
for (i = BATTERY_UNKNOWN + 1; i < di->bm->n_btypes; i++) {
|
|
if ((res <= di->bm->bat_type[i].resis_high) &&
|
|
(res >= di->bm->bat_type[i].resis_low)) {
|
|
dev_dbg(di->dev, "Battery detected on %s"
|
|
" low %d < res %d < high: %d"
|
|
" index: %d\n",
|
|
di->bm->adc_therm == ABx500_ADC_THERM_BATCTRL ?
|
|
"BATCTRL" : "BATTEMP",
|
|
di->bm->bat_type[i].resis_low, res,
|
|
di->bm->bat_type[i].resis_high, i);
|
|
|
|
di->bm->batt_id = i;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (di->bm->batt_id == BATTERY_UNKNOWN) {
|
|
dev_warn(di->dev, "Battery identified as unknown"
|
|
", resistance %d Ohm\n", res);
|
|
return -ENXIO;
|
|
}
|
|
|
|
/*
|
|
* We only have to change current source if the
|
|
* detected type is Type 1.
|
|
*/
|
|
if (di->bm->adc_therm == ABx500_ADC_THERM_BATCTRL &&
|
|
di->bm->batt_id == 1) {
|
|
if (is_ab8540(di->parent)) {
|
|
dev_dbg(di->dev,
|
|
"Set BATCTRL current source to 60uA\n");
|
|
di->curr_source = BTEMP_BATCTRL_CURR_SRC_60UA;
|
|
} else if (is_ab9540(di->parent) || is_ab8505(di->parent)) {
|
|
dev_dbg(di->dev,
|
|
"Set BATCTRL current source to 16uA\n");
|
|
di->curr_source = BTEMP_BATCTRL_CURR_SRC_16UA;
|
|
} else {
|
|
dev_dbg(di->dev, "Set BATCTRL current source to 20uA\n");
|
|
di->curr_source = BTEMP_BATCTRL_CURR_SRC_20UA;
|
|
}
|
|
}
|
|
|
|
return di->bm->batt_id;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_periodic_work() - Measuring the temperature periodically
|
|
* @work: pointer to the work_struct structure
|
|
*
|
|
* Work function for measuring the temperature periodically
|
|
*/
|
|
static void ab8500_btemp_periodic_work(struct work_struct *work)
|
|
{
|
|
int interval;
|
|
int bat_temp;
|
|
struct ab8500_btemp *di = container_of(work,
|
|
struct ab8500_btemp, btemp_periodic_work.work);
|
|
|
|
if (!di->initialized) {
|
|
/* Identify the battery */
|
|
if (ab8500_btemp_id(di) < 0)
|
|
dev_warn(di->dev, "failed to identify the battery\n");
|
|
}
|
|
|
|
bat_temp = ab8500_btemp_measure_temp(di);
|
|
/*
|
|
* Filter battery temperature.
|
|
* Allow direct updates on temperature only if two samples result in
|
|
* same temperature. Else only allow 1 degree change from previous
|
|
* reported value in the direction of the new measurement.
|
|
*/
|
|
if ((bat_temp == di->prev_bat_temp) || !di->initialized) {
|
|
if ((di->bat_temp != di->prev_bat_temp) || !di->initialized) {
|
|
di->initialized = true;
|
|
di->bat_temp = bat_temp;
|
|
power_supply_changed(&di->btemp_psy);
|
|
}
|
|
} else if (bat_temp < di->prev_bat_temp) {
|
|
di->bat_temp--;
|
|
power_supply_changed(&di->btemp_psy);
|
|
} else if (bat_temp > di->prev_bat_temp) {
|
|
di->bat_temp++;
|
|
power_supply_changed(&di->btemp_psy);
|
|
}
|
|
di->prev_bat_temp = bat_temp;
|
|
|
|
if (di->events.ac_conn || di->events.usb_conn)
|
|
interval = di->bm->temp_interval_chg;
|
|
else
|
|
interval = di->bm->temp_interval_nochg;
|
|
|
|
/* Schedule a new measurement */
|
|
queue_delayed_work(di->btemp_wq,
|
|
&di->btemp_periodic_work,
|
|
round_jiffies(interval * HZ));
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_batctrlindb_handler() - battery removal detected
|
|
* @irq: interrupt number
|
|
* @_di: void pointer that has to address of ab8500_btemp
|
|
*
|
|
* Returns IRQ status(IRQ_HANDLED)
|
|
*/
|
|
static irqreturn_t ab8500_btemp_batctrlindb_handler(int irq, void *_di)
|
|
{
|
|
struct ab8500_btemp *di = _di;
|
|
dev_err(di->dev, "Battery removal detected!\n");
|
|
|
|
di->events.batt_rem = true;
|
|
power_supply_changed(&di->btemp_psy);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_templow_handler() - battery temp lower than 10 degrees
|
|
* @irq: interrupt number
|
|
* @_di: void pointer that has to address of ab8500_btemp
|
|
*
|
|
* Returns IRQ status(IRQ_HANDLED)
|
|
*/
|
|
static irqreturn_t ab8500_btemp_templow_handler(int irq, void *_di)
|
|
{
|
|
struct ab8500_btemp *di = _di;
|
|
|
|
if (is_ab8500_3p3_or_earlier(di->parent)) {
|
|
dev_dbg(di->dev, "Ignore false btemp low irq"
|
|
" for ABB cut 1.0, 1.1, 2.0 and 3.3\n");
|
|
} else {
|
|
dev_crit(di->dev, "Battery temperature lower than -10deg c\n");
|
|
|
|
di->events.btemp_low = true;
|
|
di->events.btemp_high = false;
|
|
di->events.btemp_medhigh = false;
|
|
di->events.btemp_lowmed = false;
|
|
power_supply_changed(&di->btemp_psy);
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_temphigh_handler() - battery temp higher than max temp
|
|
* @irq: interrupt number
|
|
* @_di: void pointer that has to address of ab8500_btemp
|
|
*
|
|
* Returns IRQ status(IRQ_HANDLED)
|
|
*/
|
|
static irqreturn_t ab8500_btemp_temphigh_handler(int irq, void *_di)
|
|
{
|
|
struct ab8500_btemp *di = _di;
|
|
|
|
dev_crit(di->dev, "Battery temperature is higher than MAX temp\n");
|
|
|
|
di->events.btemp_high = true;
|
|
di->events.btemp_medhigh = false;
|
|
di->events.btemp_lowmed = false;
|
|
di->events.btemp_low = false;
|
|
power_supply_changed(&di->btemp_psy);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_lowmed_handler() - battery temp between low and medium
|
|
* @irq: interrupt number
|
|
* @_di: void pointer that has to address of ab8500_btemp
|
|
*
|
|
* Returns IRQ status(IRQ_HANDLED)
|
|
*/
|
|
static irqreturn_t ab8500_btemp_lowmed_handler(int irq, void *_di)
|
|
{
|
|
struct ab8500_btemp *di = _di;
|
|
|
|
dev_dbg(di->dev, "Battery temperature is between low and medium\n");
|
|
|
|
di->events.btemp_lowmed = true;
|
|
di->events.btemp_medhigh = false;
|
|
di->events.btemp_high = false;
|
|
di->events.btemp_low = false;
|
|
power_supply_changed(&di->btemp_psy);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_medhigh_handler() - battery temp between medium and high
|
|
* @irq: interrupt number
|
|
* @_di: void pointer that has to address of ab8500_btemp
|
|
*
|
|
* Returns IRQ status(IRQ_HANDLED)
|
|
*/
|
|
static irqreturn_t ab8500_btemp_medhigh_handler(int irq, void *_di)
|
|
{
|
|
struct ab8500_btemp *di = _di;
|
|
|
|
dev_dbg(di->dev, "Battery temperature is between medium and high\n");
|
|
|
|
di->events.btemp_medhigh = true;
|
|
di->events.btemp_lowmed = false;
|
|
di->events.btemp_high = false;
|
|
di->events.btemp_low = false;
|
|
power_supply_changed(&di->btemp_psy);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_periodic() - Periodic temperature measurements
|
|
* @di: pointer to the ab8500_btemp structure
|
|
* @enable: enable or disable periodic temperature measurements
|
|
*
|
|
* Starts of stops periodic temperature measurements. Periodic measurements
|
|
* should only be done when a charger is connected.
|
|
*/
|
|
static void ab8500_btemp_periodic(struct ab8500_btemp *di,
|
|
bool enable)
|
|
{
|
|
dev_dbg(di->dev, "Enable periodic temperature measurements: %d\n",
|
|
enable);
|
|
/*
|
|
* Make sure a new measurement is done directly by cancelling
|
|
* any pending work
|
|
*/
|
|
cancel_delayed_work_sync(&di->btemp_periodic_work);
|
|
|
|
if (enable)
|
|
queue_delayed_work(di->btemp_wq, &di->btemp_periodic_work, 0);
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_get_temp() - get battery temperature
|
|
* @di: pointer to the ab8500_btemp structure
|
|
*
|
|
* Returns battery temperature
|
|
*/
|
|
int ab8500_btemp_get_temp(struct ab8500_btemp *di)
|
|
{
|
|
int temp = 0;
|
|
|
|
/*
|
|
* The BTEMP events are not reliabe on AB8500 cut3.3
|
|
* and prior versions
|
|
*/
|
|
if (is_ab8500_3p3_or_earlier(di->parent)) {
|
|
temp = di->bat_temp * 10;
|
|
} else {
|
|
if (di->events.btemp_low) {
|
|
if (temp > di->btemp_ranges.btemp_low_limit)
|
|
temp = di->btemp_ranges.btemp_low_limit * 10;
|
|
else
|
|
temp = di->bat_temp * 10;
|
|
} else if (di->events.btemp_high) {
|
|
if (temp < di->btemp_ranges.btemp_high_limit)
|
|
temp = di->btemp_ranges.btemp_high_limit * 10;
|
|
else
|
|
temp = di->bat_temp * 10;
|
|
} else if (di->events.btemp_lowmed) {
|
|
if (temp > di->btemp_ranges.btemp_med_limit)
|
|
temp = di->btemp_ranges.btemp_med_limit * 10;
|
|
else
|
|
temp = di->bat_temp * 10;
|
|
} else if (di->events.btemp_medhigh) {
|
|
if (temp < di->btemp_ranges.btemp_med_limit)
|
|
temp = di->btemp_ranges.btemp_med_limit * 10;
|
|
else
|
|
temp = di->bat_temp * 10;
|
|
} else
|
|
temp = di->bat_temp * 10;
|
|
}
|
|
return temp;
|
|
}
|
|
EXPORT_SYMBOL(ab8500_btemp_get_temp);
|
|
|
|
/**
|
|
* ab8500_btemp_get_batctrl_temp() - get the temperature
|
|
* @btemp: pointer to the btemp structure
|
|
*
|
|
* Returns the batctrl temperature in millidegrees
|
|
*/
|
|
int ab8500_btemp_get_batctrl_temp(struct ab8500_btemp *btemp)
|
|
{
|
|
return btemp->bat_temp * 1000;
|
|
}
|
|
EXPORT_SYMBOL(ab8500_btemp_get_batctrl_temp);
|
|
|
|
/**
|
|
* ab8500_btemp_get_property() - get the btemp properties
|
|
* @psy: pointer to the power_supply structure
|
|
* @psp: pointer to the power_supply_property structure
|
|
* @val: pointer to the power_supply_propval union
|
|
*
|
|
* This function gets called when an application tries to get the btemp
|
|
* properties by reading the sysfs files.
|
|
* online: presence of the battery
|
|
* present: presence of the battery
|
|
* technology: battery technology
|
|
* temp: battery temperature
|
|
* Returns error code in case of failure else 0(on success)
|
|
*/
|
|
static int ab8500_btemp_get_property(struct power_supply *psy,
|
|
enum power_supply_property psp,
|
|
union power_supply_propval *val)
|
|
{
|
|
struct ab8500_btemp *di;
|
|
|
|
di = to_ab8500_btemp_device_info(psy);
|
|
|
|
switch (psp) {
|
|
case POWER_SUPPLY_PROP_PRESENT:
|
|
case POWER_SUPPLY_PROP_ONLINE:
|
|
if (di->events.batt_rem)
|
|
val->intval = 0;
|
|
else
|
|
val->intval = 1;
|
|
break;
|
|
case POWER_SUPPLY_PROP_TECHNOLOGY:
|
|
val->intval = di->bm->bat_type[di->bm->batt_id].name;
|
|
break;
|
|
case POWER_SUPPLY_PROP_TEMP:
|
|
val->intval = ab8500_btemp_get_temp(di);
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int ab8500_btemp_get_ext_psy_data(struct device *dev, void *data)
|
|
{
|
|
struct power_supply *psy;
|
|
struct power_supply *ext;
|
|
struct ab8500_btemp *di;
|
|
union power_supply_propval ret;
|
|
int i, j;
|
|
bool psy_found = false;
|
|
|
|
psy = (struct power_supply *)data;
|
|
ext = dev_get_drvdata(dev);
|
|
di = to_ab8500_btemp_device_info(psy);
|
|
|
|
/*
|
|
* For all psy where the name of your driver
|
|
* appears in any supplied_to
|
|
*/
|
|
for (i = 0; i < ext->num_supplicants; i++) {
|
|
if (!strcmp(ext->supplied_to[i], psy->name))
|
|
psy_found = true;
|
|
}
|
|
|
|
if (!psy_found)
|
|
return 0;
|
|
|
|
/* Go through all properties for the psy */
|
|
for (j = 0; j < ext->num_properties; j++) {
|
|
enum power_supply_property prop;
|
|
prop = ext->properties[j];
|
|
|
|
if (ext->get_property(ext, prop, &ret))
|
|
continue;
|
|
|
|
switch (prop) {
|
|
case POWER_SUPPLY_PROP_PRESENT:
|
|
switch (ext->type) {
|
|
case POWER_SUPPLY_TYPE_MAINS:
|
|
/* AC disconnected */
|
|
if (!ret.intval && di->events.ac_conn) {
|
|
di->events.ac_conn = false;
|
|
}
|
|
/* AC connected */
|
|
else if (ret.intval && !di->events.ac_conn) {
|
|
di->events.ac_conn = true;
|
|
if (!di->events.usb_conn)
|
|
ab8500_btemp_periodic(di, true);
|
|
}
|
|
break;
|
|
case POWER_SUPPLY_TYPE_USB:
|
|
/* USB disconnected */
|
|
if (!ret.intval && di->events.usb_conn) {
|
|
di->events.usb_conn = false;
|
|
}
|
|
/* USB connected */
|
|
else if (ret.intval && !di->events.usb_conn) {
|
|
di->events.usb_conn = true;
|
|
if (!di->events.ac_conn)
|
|
ab8500_btemp_periodic(di, true);
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ab8500_btemp_external_power_changed() - callback for power supply changes
|
|
* @psy: pointer to the structure power_supply
|
|
*
|
|
* This function is pointing to the function pointer external_power_changed
|
|
* of the structure power_supply.
|
|
* This function gets executed when there is a change in the external power
|
|
* supply to the btemp.
|
|
*/
|
|
static void ab8500_btemp_external_power_changed(struct power_supply *psy)
|
|
{
|
|
struct ab8500_btemp *di = to_ab8500_btemp_device_info(psy);
|
|
|
|
class_for_each_device(power_supply_class, NULL,
|
|
&di->btemp_psy, ab8500_btemp_get_ext_psy_data);
|
|
}
|
|
|
|
/* ab8500 btemp driver interrupts and their respective isr */
|
|
static struct ab8500_btemp_interrupts ab8500_btemp_irq[] = {
|
|
{"BAT_CTRL_INDB", ab8500_btemp_batctrlindb_handler},
|
|
{"BTEMP_LOW", ab8500_btemp_templow_handler},
|
|
{"BTEMP_HIGH", ab8500_btemp_temphigh_handler},
|
|
{"BTEMP_LOW_MEDIUM", ab8500_btemp_lowmed_handler},
|
|
{"BTEMP_MEDIUM_HIGH", ab8500_btemp_medhigh_handler},
|
|
};
|
|
|
|
#if defined(CONFIG_PM)
|
|
static int ab8500_btemp_resume(struct platform_device *pdev)
|
|
{
|
|
struct ab8500_btemp *di = platform_get_drvdata(pdev);
|
|
|
|
ab8500_btemp_periodic(di, true);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ab8500_btemp_suspend(struct platform_device *pdev,
|
|
pm_message_t state)
|
|
{
|
|
struct ab8500_btemp *di = platform_get_drvdata(pdev);
|
|
|
|
ab8500_btemp_periodic(di, false);
|
|
|
|
return 0;
|
|
}
|
|
#else
|
|
#define ab8500_btemp_suspend NULL
|
|
#define ab8500_btemp_resume NULL
|
|
#endif
|
|
|
|
static int ab8500_btemp_remove(struct platform_device *pdev)
|
|
{
|
|
struct ab8500_btemp *di = platform_get_drvdata(pdev);
|
|
int i, irq;
|
|
|
|
/* Disable interrupts */
|
|
for (i = 0; i < ARRAY_SIZE(ab8500_btemp_irq); i++) {
|
|
irq = platform_get_irq_byname(pdev, ab8500_btemp_irq[i].name);
|
|
free_irq(irq, di);
|
|
}
|
|
|
|
/* Delete the work queue */
|
|
destroy_workqueue(di->btemp_wq);
|
|
|
|
flush_scheduled_work();
|
|
power_supply_unregister(&di->btemp_psy);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static char *supply_interface[] = {
|
|
"ab8500_chargalg",
|
|
"ab8500_fg",
|
|
};
|
|
|
|
static int ab8500_btemp_probe(struct platform_device *pdev)
|
|
{
|
|
struct device_node *np = pdev->dev.of_node;
|
|
struct abx500_bm_data *plat = pdev->dev.platform_data;
|
|
struct ab8500_btemp *di;
|
|
int irq, i, ret = 0;
|
|
u8 val;
|
|
|
|
di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);
|
|
if (!di) {
|
|
dev_err(&pdev->dev, "%s no mem for ab8500_btemp\n", __func__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (!plat) {
|
|
dev_err(&pdev->dev, "no battery management data supplied\n");
|
|
return -EINVAL;
|
|
}
|
|
di->bm = plat;
|
|
|
|
if (np) {
|
|
ret = ab8500_bm_of_probe(&pdev->dev, np, di->bm);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "failed to get battery information\n");
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
/* get parent data */
|
|
di->dev = &pdev->dev;
|
|
di->parent = dev_get_drvdata(pdev->dev.parent);
|
|
di->gpadc = ab8500_gpadc_get("ab8500-gpadc.0");
|
|
|
|
di->initialized = false;
|
|
|
|
/* BTEMP supply */
|
|
di->btemp_psy.name = "ab8500_btemp";
|
|
di->btemp_psy.type = POWER_SUPPLY_TYPE_BATTERY;
|
|
di->btemp_psy.properties = ab8500_btemp_props;
|
|
di->btemp_psy.num_properties = ARRAY_SIZE(ab8500_btemp_props);
|
|
di->btemp_psy.get_property = ab8500_btemp_get_property;
|
|
di->btemp_psy.supplied_to = supply_interface;
|
|
di->btemp_psy.num_supplicants = ARRAY_SIZE(supply_interface);
|
|
di->btemp_psy.external_power_changed =
|
|
ab8500_btemp_external_power_changed;
|
|
|
|
|
|
/* Create a work queue for the btemp */
|
|
di->btemp_wq =
|
|
create_singlethread_workqueue("ab8500_btemp_wq");
|
|
if (di->btemp_wq == NULL) {
|
|
dev_err(di->dev, "failed to create work queue\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* Init work for measuring temperature periodically */
|
|
INIT_DEFERRABLE_WORK(&di->btemp_periodic_work,
|
|
ab8500_btemp_periodic_work);
|
|
|
|
/* Set BTEMP thermal limits. Low and Med are fixed */
|
|
di->btemp_ranges.btemp_low_limit = BTEMP_THERMAL_LOW_LIMIT;
|
|
di->btemp_ranges.btemp_med_limit = BTEMP_THERMAL_MED_LIMIT;
|
|
|
|
ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
|
|
AB8500_BTEMP_HIGH_TH, &val);
|
|
if (ret < 0) {
|
|
dev_err(di->dev, "%s ab8500 read failed\n", __func__);
|
|
goto free_btemp_wq;
|
|
}
|
|
switch (val) {
|
|
case BTEMP_HIGH_TH_57_0:
|
|
case BTEMP_HIGH_TH_57_1:
|
|
di->btemp_ranges.btemp_high_limit =
|
|
BTEMP_THERMAL_HIGH_LIMIT_57;
|
|
break;
|
|
case BTEMP_HIGH_TH_52:
|
|
di->btemp_ranges.btemp_high_limit =
|
|
BTEMP_THERMAL_HIGH_LIMIT_52;
|
|
break;
|
|
case BTEMP_HIGH_TH_62:
|
|
di->btemp_ranges.btemp_high_limit =
|
|
BTEMP_THERMAL_HIGH_LIMIT_62;
|
|
break;
|
|
}
|
|
|
|
/* Register BTEMP power supply class */
|
|
ret = power_supply_register(di->dev, &di->btemp_psy);
|
|
if (ret) {
|
|
dev_err(di->dev, "failed to register BTEMP psy\n");
|
|
goto free_btemp_wq;
|
|
}
|
|
|
|
/* Register interrupts */
|
|
for (i = 0; i < ARRAY_SIZE(ab8500_btemp_irq); i++) {
|
|
irq = platform_get_irq_byname(pdev, ab8500_btemp_irq[i].name);
|
|
ret = request_threaded_irq(irq, NULL, ab8500_btemp_irq[i].isr,
|
|
IRQF_SHARED | IRQF_NO_SUSPEND,
|
|
ab8500_btemp_irq[i].name, di);
|
|
|
|
if (ret) {
|
|
dev_err(di->dev, "failed to request %s IRQ %d: %d\n"
|
|
, ab8500_btemp_irq[i].name, irq, ret);
|
|
goto free_irq;
|
|
}
|
|
dev_dbg(di->dev, "Requested %s IRQ %d: %d\n",
|
|
ab8500_btemp_irq[i].name, irq, ret);
|
|
}
|
|
|
|
platform_set_drvdata(pdev, di);
|
|
|
|
/* Kick off periodic temperature measurements */
|
|
ab8500_btemp_periodic(di, true);
|
|
list_add_tail(&di->node, &ab8500_btemp_list);
|
|
|
|
return ret;
|
|
|
|
free_irq:
|
|
power_supply_unregister(&di->btemp_psy);
|
|
|
|
/* We also have to free all successfully registered irqs */
|
|
for (i = i - 1; i >= 0; i--) {
|
|
irq = platform_get_irq_byname(pdev, ab8500_btemp_irq[i].name);
|
|
free_irq(irq, di);
|
|
}
|
|
free_btemp_wq:
|
|
destroy_workqueue(di->btemp_wq);
|
|
return ret;
|
|
}
|
|
|
|
static const struct of_device_id ab8500_btemp_match[] = {
|
|
{ .compatible = "stericsson,ab8500-btemp", },
|
|
{ },
|
|
};
|
|
|
|
static struct platform_driver ab8500_btemp_driver = {
|
|
.probe = ab8500_btemp_probe,
|
|
.remove = ab8500_btemp_remove,
|
|
.suspend = ab8500_btemp_suspend,
|
|
.resume = ab8500_btemp_resume,
|
|
.driver = {
|
|
.name = "ab8500-btemp",
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = ab8500_btemp_match,
|
|
},
|
|
};
|
|
|
|
static int __init ab8500_btemp_init(void)
|
|
{
|
|
return platform_driver_register(&ab8500_btemp_driver);
|
|
}
|
|
|
|
static void __exit ab8500_btemp_exit(void)
|
|
{
|
|
platform_driver_unregister(&ab8500_btemp_driver);
|
|
}
|
|
|
|
device_initcall(ab8500_btemp_init);
|
|
module_exit(ab8500_btemp_exit);
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_AUTHOR("Johan Palsson, Karl Komierowski, Arun R Murthy");
|
|
MODULE_ALIAS("platform:ab8500-btemp");
|
|
MODULE_DESCRIPTION("AB8500 battery temperature driver");
|