| 1 |
// SPDX-License-Identifier: GPL-2.0-only |
| 2 |
/* |
| 3 |
* Battery driver for CPCAP PMIC |
| 4 |
* |
| 5 |
* Copyright (C) 2017 Tony Lindgren <[email protected]> |
| 6 |
* |
| 7 |
* Some parts of the code based on earlier Motorola mapphone Linux kernel |
| 8 |
* drivers: |
| 9 |
* |
| 10 |
* Copyright (C) 2009-2010 Motorola, Inc. |
| 11 |
*/ |
| 12 |
|
| 13 |
#include <linux/delay.h> |
| 14 |
#include <linux/err.h> |
| 15 |
#include <linux/interrupt.h> |
| 16 |
#include <linux/kernel.h> |
| 17 |
#include <linux/module.h> |
| 18 |
#include <linux/of.h> |
| 19 |
#include <linux/platform_device.h> |
| 20 |
#include <linux/power_supply.h> |
| 21 |
#include <linux/reboot.h> |
| 22 |
#include <linux/regmap.h> |
| 23 |
#include <linux/nvmem-consumer.h> |
| 24 |
#include <linux/moduleparam.h> |
| 25 |
|
| 26 |
#include <linux/iio/consumer.h> |
| 27 |
#include <linux/iio/types.h> |
| 28 |
#include <linux/mfd/motorola-cpcap.h> |
| 29 |
|
| 30 |
/* |
| 31 |
* Register bit defines for CPCAP_REG_BPEOL. Some of these seem to |
| 32 |
* map to MC13783UG.pdf "Table 5-19. Register 13, Power Control 0" |
| 33 |
* to enable BATTDETEN, LOBAT and EOL features. We currently use |
| 34 |
* LOBAT interrupts instead of EOL. |
| 35 |
*/ |
| 36 |
#define CPCAP_REG_BPEOL_BIT_EOL9 BIT(9) /* Set for EOL irq */ |
| 37 |
#define CPCAP_REG_BPEOL_BIT_EOL8 BIT(8) /* Set for EOL irq */ |
| 38 |
#define CPCAP_REG_BPEOL_BIT_UNKNOWN7 BIT(7) |
| 39 |
#define CPCAP_REG_BPEOL_BIT_UNKNOWN6 BIT(6) |
| 40 |
#define CPCAP_REG_BPEOL_BIT_UNKNOWN5 BIT(5) |
| 41 |
#define CPCAP_REG_BPEOL_BIT_EOL_MULTI BIT(4) /* Set for multiple EOL irqs */ |
| 42 |
#define CPCAP_REG_BPEOL_BIT_UNKNOWN3 BIT(3) |
| 43 |
#define CPCAP_REG_BPEOL_BIT_UNKNOWN2 BIT(2) |
| 44 |
#define CPCAP_REG_BPEOL_BIT_BATTDETEN BIT(1) /* Enable battery detect */ |
| 45 |
#define CPCAP_REG_BPEOL_BIT_EOLSEL BIT(0) /* BPDET = 0, EOL = 1 */ |
| 46 |
|
| 47 |
/* |
| 48 |
* Register bit defines for CPCAP_REG_CCC1. These seem similar to the twl6030 |
| 49 |
* coulomb counter registers rather than the mc13892 registers. Both twl6030 |
| 50 |
* and mc13892 set bits 2 and 1 to reset and clear registers. But mc13892 |
| 51 |
* sets bit 0 to start the coulomb counter while twl6030 sets bit 0 to stop |
| 52 |
* the coulomb counter like cpcap does. So for now, we use the twl6030 style |
| 53 |
* naming for the registers. |
| 54 |
*/ |
| 55 |
#define CPCAP_REG_CCC1_ACTIVE_MODE1 BIT(4) /* Update rate */ |
| 56 |
#define CPCAP_REG_CCC1_ACTIVE_MODE0 BIT(3) /* Update rate */ |
| 57 |
#define CPCAP_REG_CCC1_AUTOCLEAR BIT(2) /* Resets sample registers */ |
| 58 |
#define CPCAP_REG_CCC1_CAL_EN BIT(1) /* Clears after write in 1s */ |
| 59 |
#define CPCAP_REG_CCC1_PAUSE BIT(0) /* Stop counters, allow write */ |
| 60 |
#define CPCAP_REG_CCC1_RESET_MASK (CPCAP_REG_CCC1_AUTOCLEAR | \ |
| 61 |
CPCAP_REG_CCC1_CAL_EN) |
| 62 |
|
| 63 |
#define CPCAP_REG_CCCC2_RATE1 BIT(5) |
| 64 |
#define CPCAP_REG_CCCC2_RATE0 BIT(4) |
| 65 |
#define CPCAP_REG_CCCC2_ENABLE BIT(3) |
| 66 |
|
| 67 |
#define CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS 250 |
| 68 |
|
| 69 |
#define CPCAP_BATTERY_EB41_HW4X_ID 0x9E |
| 70 |
#define CPCAP_BATTERY_BW8X_ID 0x98 |
| 71 |
|
| 72 |
enum { |
| 73 |
CPCAP_BATTERY_IIO_BATTDET, |
| 74 |
CPCAP_BATTERY_IIO_VOLTAGE, |
| 75 |
CPCAP_BATTERY_IIO_CHRG_CURRENT, |
| 76 |
CPCAP_BATTERY_IIO_BATT_CURRENT, |
| 77 |
CPCAP_BATTERY_IIO_NR, |
| 78 |
}; |
| 79 |
|
| 80 |
enum cpcap_battery_irq_action { |
| 81 |
CPCAP_BATTERY_IRQ_ACTION_NONE, |
| 82 |
CPCAP_BATTERY_IRQ_ACTION_CC_CAL_DONE, |
| 83 |
CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW, |
| 84 |
CPCAP_BATTERY_IRQ_ACTION_POWEROFF, |
| 85 |
}; |
| 86 |
|
| 87 |
struct cpcap_interrupt_desc { |
| 88 |
const char *name; |
| 89 |
struct list_head node; |
| 90 |
int irq; |
| 91 |
enum cpcap_battery_irq_action action; |
| 92 |
}; |
| 93 |
|
| 94 |
struct cpcap_battery_config { |
| 95 |
int cd_factor; |
| 96 |
struct power_supply_info info; |
| 97 |
struct power_supply_battery_info bat; |
| 98 |
}; |
| 99 |
|
| 100 |
struct cpcap_coulomb_counter_data { |
| 101 |
s32 sample; /* 24 or 32 bits */ |
| 102 |
s32 accumulator; |
| 103 |
s16 offset; /* 9 bits */ |
| 104 |
s16 integrator; /* 13 or 16 bits */ |
| 105 |
}; |
| 106 |
|
| 107 |
enum cpcap_battery_state { |
| 108 |
CPCAP_BATTERY_STATE_PREVIOUS, |
| 109 |
CPCAP_BATTERY_STATE_LATEST, |
| 110 |
CPCAP_BATTERY_STATE_EMPTY, |
| 111 |
CPCAP_BATTERY_STATE_FULL, |
| 112 |
CPCAP_BATTERY_STATE_NR, |
| 113 |
}; |
| 114 |
|
| 115 |
struct cpcap_battery_state_data { |
| 116 |
int voltage; |
| 117 |
int current_ua; |
| 118 |
int counter_uah; |
| 119 |
int temperature; |
| 120 |
ktime_t time; |
| 121 |
struct cpcap_coulomb_counter_data cc; |
| 122 |
}; |
| 123 |
|
| 124 |
struct cpcap_battery_ddata { |
| 125 |
struct device *dev; |
| 126 |
struct regmap *reg; |
| 127 |
struct list_head irq_list; |
| 128 |
struct iio_channel *channels[CPCAP_BATTERY_IIO_NR]; |
| 129 |
struct power_supply *psy; |
| 130 |
struct cpcap_battery_config config; |
| 131 |
struct cpcap_battery_state_data state[CPCAP_BATTERY_STATE_NR]; |
| 132 |
u32 cc_lsb; /* μAms per LSB */ |
| 133 |
atomic_t active; |
| 134 |
int charge_full; |
| 135 |
int status; |
| 136 |
u16 vendor; |
| 137 |
bool check_nvmem; |
| 138 |
unsigned int is_full:1; |
| 139 |
}; |
| 140 |
|
| 141 |
#define CPCAP_NO_BATTERY -400 |
| 142 |
|
| 143 |
static bool ignore_temperature_probe; |
| 144 |
module_param(ignore_temperature_probe, bool, 0660); |
| 145 |
|
| 146 |
static struct cpcap_battery_state_data * |
| 147 |
cpcap_battery_get_state(struct cpcap_battery_ddata *ddata, |
| 148 |
enum cpcap_battery_state state) |
| 149 |
{ |
| 150 |
if (state >= CPCAP_BATTERY_STATE_NR) |
| 151 |
return NULL; |
| 152 |
|
| 153 |
return &ddata->state[state]; |
| 154 |
} |
| 155 |
|
| 156 |
static struct cpcap_battery_state_data * |
| 157 |
cpcap_battery_latest(struct cpcap_battery_ddata *ddata) |
| 158 |
{ |
| 159 |
return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_LATEST); |
| 160 |
} |
| 161 |
|
| 162 |
static struct cpcap_battery_state_data * |
| 163 |
cpcap_battery_previous(struct cpcap_battery_ddata *ddata) |
| 164 |
{ |
| 165 |
return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_PREVIOUS); |
| 166 |
} |
| 167 |
|
| 168 |
static struct cpcap_battery_state_data * |
| 169 |
cpcap_battery_get_empty(struct cpcap_battery_ddata *ddata) |
| 170 |
{ |
| 171 |
return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_EMPTY); |
| 172 |
} |
| 173 |
|
| 174 |
static struct cpcap_battery_state_data * |
| 175 |
cpcap_battery_get_full(struct cpcap_battery_ddata *ddata) |
| 176 |
{ |
| 177 |
return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_FULL); |
| 178 |
} |
| 179 |
|
| 180 |
static int cpcap_charger_battery_temperature(struct cpcap_battery_ddata *ddata, |
| 181 |
int *value) |
| 182 |
{ |
| 183 |
struct iio_channel *channel; |
| 184 |
int error; |
| 185 |
|
| 186 |
channel = ddata->channels[CPCAP_BATTERY_IIO_BATTDET]; |
| 187 |
error = iio_read_channel_processed(channel, value); |
| 188 |
if (error < 0) { |
| 189 |
if (!ignore_temperature_probe) |
| 190 |
dev_warn(ddata->dev, "%s failed: %i\n", __func__, error); |
| 191 |
*value = CPCAP_NO_BATTERY; |
| 192 |
|
| 193 |
return error; |
| 194 |
} |
| 195 |
|
| 196 |
*value /= 100; |
| 197 |
|
| 198 |
return 0; |
| 199 |
} |
| 200 |
|
| 201 |
static int cpcap_battery_get_voltage(struct cpcap_battery_ddata *ddata) |
| 202 |
{ |
| 203 |
struct iio_channel *channel; |
| 204 |
int error, value = 0; |
| 205 |
|
| 206 |
channel = ddata->channels[CPCAP_BATTERY_IIO_VOLTAGE]; |
| 207 |
error = iio_read_channel_processed(channel, &value); |
| 208 |
if (error < 0) { |
| 209 |
dev_warn(ddata->dev, "%s failed: %i\n", __func__, error); |
| 210 |
|
| 211 |
return 0; |
| 212 |
} |
| 213 |
|
| 214 |
return value * 1000; |
| 215 |
} |
| 216 |
|
| 217 |
static int cpcap_battery_get_current(struct cpcap_battery_ddata *ddata) |
| 218 |
{ |
| 219 |
struct iio_channel *channel; |
| 220 |
int error, value = 0; |
| 221 |
|
| 222 |
channel = ddata->channels[CPCAP_BATTERY_IIO_BATT_CURRENT]; |
| 223 |
error = iio_read_channel_processed(channel, &value); |
| 224 |
if (error < 0) { |
| 225 |
dev_warn(ddata->dev, "%s failed: %i\n", __func__, error); |
| 226 |
|
| 227 |
return 0; |
| 228 |
} |
| 229 |
|
| 230 |
return value * 1000; |
| 231 |
} |
| 232 |
|
| 233 |
/** |
| 234 |
* cpcap_battery_cc_raw_div - calculate and divide coulomb counter μAms values |
| 235 |
* @ddata: device driver data |
| 236 |
* @sample: coulomb counter sample value |
| 237 |
* @accumulator: coulomb counter integrator value |
| 238 |
* @offset: coulomb counter offset value |
| 239 |
* @divider: conversion divider |
| 240 |
* |
| 241 |
* Note that cc_lsb and cc_dur values are from Motorola Linux kernel |
| 242 |
* function data_get_avg_curr_ua() and seem to be based on measured test |
| 243 |
* results. It also has the following comment: |
| 244 |
* |
| 245 |
* Adjustment factors are applied here as a temp solution per the test |
| 246 |
* results. Need to work out a formal solution for this adjustment. |
| 247 |
* |
| 248 |
* A coulomb counter for similar hardware seems to be documented in |
| 249 |
* "TWL6030 Gas Gauging Basics (Rev. A)" swca095a.pdf in chapter |
| 250 |
* "10 Calculating Accumulated Current". We however follow what the |
| 251 |
* Motorola mapphone Linux kernel is doing as there may be either a |
| 252 |
* TI or ST coulomb counter in the PMIC. |
| 253 |
*/ |
| 254 |
static int cpcap_battery_cc_raw_div(struct cpcap_battery_ddata *ddata, |
| 255 |
s32 sample, s32 accumulator, |
| 256 |
s16 offset, u32 divider) |
| 257 |
{ |
| 258 |
s64 acc; |
| 259 |
|
| 260 |
if (!divider) |
| 261 |
return 0; |
| 262 |
|
| 263 |
acc = accumulator; |
| 264 |
acc -= (s64)sample * offset; |
| 265 |
acc *= ddata->cc_lsb; |
| 266 |
acc *= -1; |
| 267 |
acc = div_s64(acc, divider); |
| 268 |
|
| 269 |
return acc; |
| 270 |
} |
| 271 |
|
| 272 |
/* 3600000μAms = 1μAh */ |
| 273 |
static int cpcap_battery_cc_to_uah(struct cpcap_battery_ddata *ddata, |
| 274 |
s32 sample, s32 accumulator, |
| 275 |
s16 offset) |
| 276 |
{ |
| 277 |
return cpcap_battery_cc_raw_div(ddata, sample, |
| 278 |
accumulator, offset, |
| 279 |
3600000); |
| 280 |
} |
| 281 |
|
| 282 |
static int cpcap_battery_cc_to_ua(struct cpcap_battery_ddata *ddata, |
| 283 |
s32 sample, s32 accumulator, |
| 284 |
s16 offset) |
| 285 |
{ |
| 286 |
return cpcap_battery_cc_raw_div(ddata, sample, |
| 287 |
accumulator, offset, |
| 288 |
sample * |
| 289 |
CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS); |
| 290 |
} |
| 291 |
|
| 292 |
/** |
| 293 |
* cpcap_battery_read_accumulated - reads cpcap coulomb counter |
| 294 |
* @ddata: device driver data |
| 295 |
* @ccd: coulomb counter values |
| 296 |
* |
| 297 |
* Based on Motorola mapphone kernel function data_read_regs(). |
| 298 |
* Looking at the registers, the coulomb counter seems similar to |
| 299 |
* the coulomb counter in TWL6030. See "TWL6030 Gas Gauging Basics |
| 300 |
* (Rev. A) swca095a.pdf for "10 Calculating Accumulated Current". |
| 301 |
* |
| 302 |
* Note that swca095a.pdf instructs to stop the coulomb counter |
| 303 |
* before reading to avoid values changing. Motorola mapphone |
| 304 |
* Linux kernel does not do it, so let's assume they've verified |
| 305 |
* the data produced is correct. |
| 306 |
*/ |
| 307 |
static int |
| 308 |
cpcap_battery_read_accumulated(struct cpcap_battery_ddata *ddata, |
| 309 |
struct cpcap_coulomb_counter_data *ccd) |
| 310 |
{ |
| 311 |
u16 buf[7]; /* CPCAP_REG_CCS1 to CCI */ |
| 312 |
int error; |
| 313 |
|
| 314 |
ccd->sample = 0; |
| 315 |
ccd->accumulator = 0; |
| 316 |
ccd->offset = 0; |
| 317 |
ccd->integrator = 0; |
| 318 |
|
| 319 |
/* Read coulomb counter register range */ |
| 320 |
error = regmap_bulk_read(ddata->reg, CPCAP_REG_CCS1, |
| 321 |
buf, ARRAY_SIZE(buf)); |
| 322 |
if (error) |
| 323 |
return 0; |
| 324 |
|
| 325 |
/* Sample value CPCAP_REG_CCS1 & 2 */ |
| 326 |
ccd->sample = (buf[1] & 0x0fff) << 16; |
| 327 |
ccd->sample |= buf[0]; |
| 328 |
if (ddata->vendor == CPCAP_VENDOR_TI) |
| 329 |
ccd->sample = sign_extend32(24, ccd->sample); |
| 330 |
|
| 331 |
/* Accumulator value CPCAP_REG_CCA1 & 2 */ |
| 332 |
ccd->accumulator = ((s16)buf[3]) << 16; |
| 333 |
ccd->accumulator |= buf[2]; |
| 334 |
|
| 335 |
/* |
| 336 |
* Coulomb counter calibration offset is CPCAP_REG_CCM, |
| 337 |
* REG_CCO seems unused |
| 338 |
*/ |
| 339 |
ccd->offset = buf[4]; |
| 340 |
ccd->offset = sign_extend32(ccd->offset, 9); |
| 341 |
|
| 342 |
/* Integrator register CPCAP_REG_CCI */ |
| 343 |
if (ddata->vendor == CPCAP_VENDOR_TI) |
| 344 |
ccd->integrator = sign_extend32(buf[6], 13); |
| 345 |
else |
| 346 |
ccd->integrator = (s16)buf[6]; |
| 347 |
|
| 348 |
return cpcap_battery_cc_to_uah(ddata, |
| 349 |
ccd->sample, |
| 350 |
ccd->accumulator, |
| 351 |
ccd->offset); |
| 352 |
} |
| 353 |
|
| 354 |
|
| 355 |
/* |
| 356 |
* Based on the values from Motorola mapphone Linux kernel for the |
| 357 |
* stock Droid 4 battery eb41. In the Motorola mapphone Linux |
| 358 |
* kernel tree the value for pm_cd_factor is passed to the kernel |
| 359 |
* via device tree. If it turns out to be something device specific |
| 360 |
* we can consider that too later. These values are also fine for |
| 361 |
* Bionic's hw4x. |
| 362 |
* |
| 363 |
* And looking at the battery full and shutdown values for the stock |
| 364 |
* kernel on droid 4, full is 4351000 and software initiates shutdown |
| 365 |
* at 3078000. The device will die around 2743000. |
| 366 |
*/ |
| 367 |
static const struct cpcap_battery_config cpcap_battery_eb41_data = { |
| 368 |
.cd_factor = 0x3cc, |
| 369 |
.info.technology = POWER_SUPPLY_TECHNOLOGY_LION, |
| 370 |
.info.voltage_max_design = 4351000, |
| 371 |
.info.voltage_min_design = 3100000, |
| 372 |
.info.charge_full_design = 1740000, |
| 373 |
.bat.constant_charge_voltage_max_uv = 4200000, |
| 374 |
}; |
| 375 |
|
| 376 |
/* Values for the extended Droid Bionic battery bw8x. */ |
| 377 |
static const struct cpcap_battery_config cpcap_battery_bw8x_data = { |
| 378 |
.cd_factor = 0x3cc, |
| 379 |
.info.technology = POWER_SUPPLY_TECHNOLOGY_LION, |
| 380 |
.info.voltage_max_design = 4200000, |
| 381 |
.info.voltage_min_design = 3200000, |
| 382 |
.info.charge_full_design = 2760000, |
| 383 |
.bat.constant_charge_voltage_max_uv = 4200000, |
| 384 |
}; |
| 385 |
|
| 386 |
/* |
| 387 |
* Safe values for any lipo battery likely to fit into a mapphone |
| 388 |
* battery bay. |
| 389 |
*/ |
| 390 |
static const struct cpcap_battery_config cpcap_battery_unkown_data = { |
| 391 |
.cd_factor = 0x3cc, |
| 392 |
.info.technology = POWER_SUPPLY_TECHNOLOGY_LION, |
| 393 |
.info.voltage_max_design = 4200000, |
| 394 |
.info.voltage_min_design = 3200000, |
| 395 |
.info.charge_full_design = 3000000, |
| 396 |
.bat.constant_charge_voltage_max_uv = 4200000, |
| 397 |
}; |
| 398 |
|
| 399 |
static int cpcap_battery_match_nvmem(struct device *dev, const void *data) |
| 400 |
{ |
| 401 |
if (strcmp(dev_name(dev), "89-500029ba0f73") == 0) |
| 402 |
return 1; |
| 403 |
else |
| 404 |
return 0; |
| 405 |
} |
| 406 |
|
| 407 |
static void cpcap_battery_detect_battery_type(struct cpcap_battery_ddata *ddata) |
| 408 |
{ |
| 409 |
struct nvmem_device *nvmem; |
| 410 |
u8 battery_id = 0; |
| 411 |
|
| 412 |
ddata->check_nvmem = false; |
| 413 |
|
| 414 |
nvmem = nvmem_device_find(NULL, &cpcap_battery_match_nvmem); |
| 415 |
if (IS_ERR_OR_NULL(nvmem)) { |
| 416 |
ddata->check_nvmem = true; |
| 417 |
dev_info_once(ddata->dev, "Can not find battery nvmem device. Assuming generic lipo battery\n"); |
| 418 |
} else if (nvmem_device_read(nvmem, 2, 1, &battery_id) < 0) { |
| 419 |
battery_id = 0; |
| 420 |
ddata->check_nvmem = true; |
| 421 |
dev_warn(ddata->dev, "Can not read battery nvmem device. Assuming generic lipo battery\n"); |
| 422 |
} |
| 423 |
|
| 424 |
switch (battery_id) { |
| 425 |
case CPCAP_BATTERY_EB41_HW4X_ID: |
| 426 |
ddata->config = cpcap_battery_eb41_data; |
| 427 |
break; |
| 428 |
case CPCAP_BATTERY_BW8X_ID: |
| 429 |
ddata->config = cpcap_battery_bw8x_data; |
| 430 |
break; |
| 431 |
default: |
| 432 |
ddata->config = cpcap_battery_unkown_data; |
| 433 |
} |
| 434 |
} |
| 435 |
|
| 436 |
/** |
| 437 |
* cpcap_battery_cc_get_avg_current - read cpcap coulumb counter |
| 438 |
* @ddata: cpcap battery driver device data |
| 439 |
*/ |
| 440 |
static int cpcap_battery_cc_get_avg_current(struct cpcap_battery_ddata *ddata) |
| 441 |
{ |
| 442 |
int value, acc, error; |
| 443 |
s32 sample; |
| 444 |
s16 offset; |
| 445 |
|
| 446 |
/* Coulomb counter integrator */ |
| 447 |
error = regmap_read(ddata->reg, CPCAP_REG_CCI, &value); |
| 448 |
if (error) |
| 449 |
return error; |
| 450 |
|
| 451 |
if (ddata->vendor == CPCAP_VENDOR_TI) { |
| 452 |
acc = sign_extend32(value, 13); |
| 453 |
sample = 1; |
| 454 |
} else { |
| 455 |
acc = (s16)value; |
| 456 |
sample = 4; |
| 457 |
} |
| 458 |
|
| 459 |
/* Coulomb counter calibration offset */ |
| 460 |
error = regmap_read(ddata->reg, CPCAP_REG_CCM, &value); |
| 461 |
if (error) |
| 462 |
return error; |
| 463 |
|
| 464 |
offset = sign_extend32(value, 9); |
| 465 |
|
| 466 |
return cpcap_battery_cc_to_ua(ddata, sample, acc, offset); |
| 467 |
} |
| 468 |
|
| 469 |
static int cpcap_battery_get_charger_status(struct cpcap_battery_ddata *ddata, |
| 470 |
int *val) |
| 471 |
{ |
| 472 |
union power_supply_propval prop; |
| 473 |
struct power_supply *charger; |
| 474 |
int error; |
| 475 |
|
| 476 |
charger = power_supply_get_by_name("usb"); |
| 477 |
if (!charger) |
| 478 |
return -ENODEV; |
| 479 |
|
| 480 |
error = power_supply_get_property(charger, POWER_SUPPLY_PROP_STATUS, |
| 481 |
&prop); |
| 482 |
if (error) |
| 483 |
*val = POWER_SUPPLY_STATUS_UNKNOWN; |
| 484 |
else |
| 485 |
*val = prop.intval; |
| 486 |
|
| 487 |
power_supply_put(charger); |
| 488 |
|
| 489 |
return error; |
| 490 |
} |
| 491 |
|
| 492 |
static bool cpcap_battery_full(struct cpcap_battery_ddata *ddata) |
| 493 |
{ |
| 494 |
struct cpcap_battery_state_data *state = cpcap_battery_latest(ddata); |
| 495 |
unsigned int vfull; |
| 496 |
int error, val; |
| 497 |
|
| 498 |
error = cpcap_battery_get_charger_status(ddata, &val); |
| 499 |
if (!error) { |
| 500 |
switch (val) { |
| 501 |
case POWER_SUPPLY_STATUS_DISCHARGING: |
| 502 |
dev_dbg(ddata->dev, "charger disconnected\n"); |
| 503 |
ddata->is_full = 0; |
| 504 |
break; |
| 505 |
case POWER_SUPPLY_STATUS_FULL: |
| 506 |
dev_dbg(ddata->dev, "charger full status\n"); |
| 507 |
ddata->is_full = 1; |
| 508 |
break; |
| 509 |
default: |
| 510 |
break; |
| 511 |
} |
| 512 |
} |
| 513 |
|
| 514 |
/* |
| 515 |
* The full battery voltage here can be inaccurate, it's used just to |
| 516 |
* filter out any trickle charging events. We clear the is_full status |
| 517 |
* on charger disconnect above anyways. |
| 518 |
*/ |
| 519 |
vfull = ddata->config.bat.constant_charge_voltage_max_uv - 120000; |
| 520 |
|
| 521 |
if (ddata->is_full && state->voltage < vfull) |
| 522 |
ddata->is_full = 0; |
| 523 |
|
| 524 |
return ddata->is_full; |
| 525 |
} |
| 526 |
|
| 527 |
static bool cpcap_battery_low(struct cpcap_battery_ddata *ddata) |
| 528 |
{ |
| 529 |
struct cpcap_battery_state_data *state = cpcap_battery_latest(ddata); |
| 530 |
static bool is_low; |
| 531 |
|
| 532 |
if (state->current_ua > 0 && (state->voltage <= 3350000 || is_low)) |
| 533 |
is_low = true; |
| 534 |
else |
| 535 |
is_low = false; |
| 536 |
|
| 537 |
return is_low; |
| 538 |
} |
| 539 |
|
| 540 |
static int cpcap_battery_update_status(struct cpcap_battery_ddata *ddata) |
| 541 |
{ |
| 542 |
struct cpcap_battery_state_data state, *latest, *previous, |
| 543 |
*empty, *full; |
| 544 |
ktime_t now; |
| 545 |
int error; |
| 546 |
|
| 547 |
memset(&state, 0, sizeof(state)); |
| 548 |
now = ktime_get(); |
| 549 |
|
| 550 |
latest = cpcap_battery_latest(ddata); |
| 551 |
if (latest) { |
| 552 |
s64 delta_ms = ktime_to_ms(ktime_sub(now, latest->time)); |
| 553 |
|
| 554 |
if (delta_ms < CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS) |
| 555 |
return delta_ms; |
| 556 |
} |
| 557 |
|
| 558 |
state.time = now; |
| 559 |
state.voltage = cpcap_battery_get_voltage(ddata); |
| 560 |
state.current_ua = cpcap_battery_get_current(ddata); |
| 561 |
state.counter_uah = cpcap_battery_read_accumulated(ddata, &state.cc); |
| 562 |
|
| 563 |
error = cpcap_charger_battery_temperature(ddata, |
| 564 |
&state.temperature); |
| 565 |
if (error) |
| 566 |
return error; |
| 567 |
|
| 568 |
previous = cpcap_battery_previous(ddata); |
| 569 |
memcpy(previous, latest, sizeof(*previous)); |
| 570 |
memcpy(latest, &state, sizeof(*latest)); |
| 571 |
|
| 572 |
if (cpcap_battery_full(ddata)) { |
| 573 |
full = cpcap_battery_get_full(ddata); |
| 574 |
memcpy(full, latest, sizeof(*full)); |
| 575 |
|
| 576 |
empty = cpcap_battery_get_empty(ddata); |
| 577 |
if (empty->voltage && empty->voltage != -1) { |
| 578 |
empty->voltage = -1; |
| 579 |
ddata->charge_full = |
| 580 |
empty->counter_uah - full->counter_uah; |
| 581 |
} else if (ddata->charge_full) { |
| 582 |
empty->voltage = -1; |
| 583 |
empty->counter_uah = |
| 584 |
full->counter_uah + ddata->charge_full; |
| 585 |
} |
| 586 |
} else if (cpcap_battery_low(ddata)) { |
| 587 |
empty = cpcap_battery_get_empty(ddata); |
| 588 |
memcpy(empty, latest, sizeof(*empty)); |
| 589 |
|
| 590 |
full = cpcap_battery_get_full(ddata); |
| 591 |
if (full->voltage) { |
| 592 |
full->voltage = 0; |
| 593 |
ddata->charge_full = |
| 594 |
empty->counter_uah - full->counter_uah; |
| 595 |
} |
| 596 |
} |
| 597 |
|
| 598 |
return 0; |
| 599 |
} |
| 600 |
|
| 601 |
/* |
| 602 |
* Update battery status when cpcap-charger calls power_supply_changed(). |
| 603 |
* This allows us to detect battery full condition before the charger |
| 604 |
* disconnects. |
| 605 |
*/ |
| 606 |
static void cpcap_battery_external_power_changed(struct power_supply *psy) |
| 607 |
{ |
| 608 |
union power_supply_propval prop; |
| 609 |
|
| 610 |
power_supply_get_property(psy, POWER_SUPPLY_PROP_STATUS, &prop); |
| 611 |
} |
| 612 |
|
| 613 |
static enum power_supply_property cpcap_battery_props[] = { |
| 614 |
POWER_SUPPLY_PROP_STATUS, |
| 615 |
POWER_SUPPLY_PROP_PRESENT, |
| 616 |
POWER_SUPPLY_PROP_TECHNOLOGY, |
| 617 |
POWER_SUPPLY_PROP_VOLTAGE_NOW, |
| 618 |
POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, |
| 619 |
POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, |
| 620 |
POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE, |
| 621 |
POWER_SUPPLY_PROP_CURRENT_AVG, |
| 622 |
POWER_SUPPLY_PROP_CURRENT_NOW, |
| 623 |
POWER_SUPPLY_PROP_CHARGE_FULL, |
| 624 |
POWER_SUPPLY_PROP_CHARGE_NOW, |
| 625 |
POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, |
| 626 |
POWER_SUPPLY_PROP_CHARGE_COUNTER, |
| 627 |
POWER_SUPPLY_PROP_POWER_NOW, |
| 628 |
POWER_SUPPLY_PROP_POWER_AVG, |
| 629 |
POWER_SUPPLY_PROP_CAPACITY, |
| 630 |
POWER_SUPPLY_PROP_CAPACITY_LEVEL, |
| 631 |
POWER_SUPPLY_PROP_SCOPE, |
| 632 |
POWER_SUPPLY_PROP_TEMP, |
| 633 |
}; |
| 634 |
|
| 635 |
static int cpcap_battery_get_property(struct power_supply *psy, |
| 636 |
enum power_supply_property psp, |
| 637 |
union power_supply_propval *val) |
| 638 |
{ |
| 639 |
struct cpcap_battery_ddata *ddata = power_supply_get_drvdata(psy); |
| 640 |
struct cpcap_battery_state_data *latest, *previous, *empty; |
| 641 |
u32 sample; |
| 642 |
s32 accumulator; |
| 643 |
int cached; |
| 644 |
s64 tmp; |
| 645 |
|
| 646 |
cached = cpcap_battery_update_status(ddata); |
| 647 |
if (cached < 0) |
| 648 |
return cached; |
| 649 |
|
| 650 |
latest = cpcap_battery_latest(ddata); |
| 651 |
previous = cpcap_battery_previous(ddata); |
| 652 |
|
| 653 |
if (ddata->check_nvmem) |
| 654 |
cpcap_battery_detect_battery_type(ddata); |
| 655 |
|
| 656 |
switch (psp) { |
| 657 |
case POWER_SUPPLY_PROP_PRESENT: |
| 658 |
if (latest->temperature > CPCAP_NO_BATTERY || ignore_temperature_probe) |
| 659 |
val->intval = 1; |
| 660 |
else |
| 661 |
val->intval = 0; |
| 662 |
break; |
| 663 |
case POWER_SUPPLY_PROP_STATUS: |
| 664 |
if (cpcap_battery_full(ddata)) { |
| 665 |
val->intval = POWER_SUPPLY_STATUS_FULL; |
| 666 |
break; |
| 667 |
} |
| 668 |
if (cpcap_battery_cc_get_avg_current(ddata) < 0) |
| 669 |
val->intval = POWER_SUPPLY_STATUS_CHARGING; |
| 670 |
else |
| 671 |
val->intval = POWER_SUPPLY_STATUS_DISCHARGING; |
| 672 |
break; |
| 673 |
case POWER_SUPPLY_PROP_TECHNOLOGY: |
| 674 |
val->intval = ddata->config.info.technology; |
| 675 |
break; |
| 676 |
case POWER_SUPPLY_PROP_VOLTAGE_NOW: |
| 677 |
val->intval = cpcap_battery_get_voltage(ddata); |
| 678 |
break; |
| 679 |
case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: |
| 680 |
val->intval = ddata->config.info.voltage_max_design; |
| 681 |
break; |
| 682 |
case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: |
| 683 |
val->intval = ddata->config.info.voltage_min_design; |
| 684 |
break; |
| 685 |
case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE: |
| 686 |
val->intval = ddata->config.bat.constant_charge_voltage_max_uv; |
| 687 |
break; |
| 688 |
case POWER_SUPPLY_PROP_CURRENT_AVG: |
| 689 |
sample = latest->cc.sample - previous->cc.sample; |
| 690 |
if (!sample) { |
| 691 |
val->intval = cpcap_battery_cc_get_avg_current(ddata); |
| 692 |
break; |
| 693 |
} |
| 694 |
accumulator = latest->cc.accumulator - previous->cc.accumulator; |
| 695 |
val->intval = cpcap_battery_cc_to_ua(ddata, sample, |
| 696 |
accumulator, |
| 697 |
latest->cc.offset); |
| 698 |
break; |
| 699 |
case POWER_SUPPLY_PROP_CURRENT_NOW: |
| 700 |
val->intval = latest->current_ua; |
| 701 |
break; |
| 702 |
case POWER_SUPPLY_PROP_CHARGE_COUNTER: |
| 703 |
val->intval = latest->counter_uah; |
| 704 |
break; |
| 705 |
case POWER_SUPPLY_PROP_POWER_NOW: |
| 706 |
tmp = (latest->voltage / 10000) * latest->current_ua; |
| 707 |
val->intval = div64_s64(tmp, 100); |
| 708 |
break; |
| 709 |
case POWER_SUPPLY_PROP_POWER_AVG: |
| 710 |
sample = latest->cc.sample - previous->cc.sample; |
| 711 |
if (!sample) { |
| 712 |
tmp = cpcap_battery_cc_get_avg_current(ddata); |
| 713 |
tmp *= (latest->voltage / 10000); |
| 714 |
val->intval = div64_s64(tmp, 100); |
| 715 |
break; |
| 716 |
} |
| 717 |
accumulator = latest->cc.accumulator - previous->cc.accumulator; |
| 718 |
tmp = cpcap_battery_cc_to_ua(ddata, sample, accumulator, |
| 719 |
latest->cc.offset); |
| 720 |
tmp *= ((latest->voltage + previous->voltage) / 20000); |
| 721 |
val->intval = div64_s64(tmp, 100); |
| 722 |
break; |
| 723 |
case POWER_SUPPLY_PROP_CAPACITY: |
| 724 |
empty = cpcap_battery_get_empty(ddata); |
| 725 |
if (!empty->voltage || !ddata->charge_full) |
| 726 |
return -ENODATA; |
| 727 |
/* (ddata->charge_full / 200) is needed for rounding */ |
| 728 |
val->intval = empty->counter_uah - latest->counter_uah + |
| 729 |
ddata->charge_full / 200; |
| 730 |
val->intval = clamp(val->intval, 0, ddata->charge_full); |
| 731 |
val->intval = val->intval * 100 / ddata->charge_full; |
| 732 |
break; |
| 733 |
case POWER_SUPPLY_PROP_CAPACITY_LEVEL: |
| 734 |
if (cpcap_battery_full(ddata)) |
| 735 |
val->intval = POWER_SUPPLY_CAPACITY_LEVEL_FULL; |
| 736 |
else if (latest->voltage >= 3750000) |
| 737 |
val->intval = POWER_SUPPLY_CAPACITY_LEVEL_HIGH; |
| 738 |
else if (latest->voltage >= 3300000) |
| 739 |
val->intval = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL; |
| 740 |
else if (latest->voltage > 3100000) |
| 741 |
val->intval = POWER_SUPPLY_CAPACITY_LEVEL_LOW; |
| 742 |
else if (latest->voltage <= 3100000) |
| 743 |
val->intval = POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL; |
| 744 |
else |
| 745 |
val->intval = POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN; |
| 746 |
break; |
| 747 |
case POWER_SUPPLY_PROP_CHARGE_NOW: |
| 748 |
empty = cpcap_battery_get_empty(ddata); |
| 749 |
if (!empty->voltage) |
| 750 |
return -ENODATA; |
| 751 |
val->intval = empty->counter_uah - latest->counter_uah; |
| 752 |
if (val->intval < 0) { |
| 753 |
/* Assume invalid config if CHARGE_NOW is -20% */ |
| 754 |
if (ddata->charge_full && abs(val->intval) > ddata->charge_full/5) { |
| 755 |
empty->voltage = 0; |
| 756 |
ddata->charge_full = 0; |
| 757 |
return -ENODATA; |
| 758 |
} |
| 759 |
val->intval = 0; |
| 760 |
} else if (ddata->charge_full && ddata->charge_full < val->intval) { |
| 761 |
/* Assume invalid config if CHARGE_NOW exceeds CHARGE_FULL by 20% */ |
| 762 |
if (val->intval > (6*ddata->charge_full)/5) { |
| 763 |
empty->voltage = 0; |
| 764 |
ddata->charge_full = 0; |
| 765 |
return -ENODATA; |
| 766 |
} |
| 767 |
val->intval = ddata->charge_full; |
| 768 |
} |
| 769 |
break; |
| 770 |
case POWER_SUPPLY_PROP_CHARGE_FULL: |
| 771 |
if (!ddata->charge_full) |
| 772 |
return -ENODATA; |
| 773 |
val->intval = ddata->charge_full; |
| 774 |
break; |
| 775 |
case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: |
| 776 |
val->intval = ddata->config.info.charge_full_design; |
| 777 |
break; |
| 778 |
case POWER_SUPPLY_PROP_SCOPE: |
| 779 |
val->intval = POWER_SUPPLY_SCOPE_SYSTEM; |
| 780 |
break; |
| 781 |
case POWER_SUPPLY_PROP_TEMP: |
| 782 |
if (ignore_temperature_probe) |
| 783 |
return -ENODATA; |
| 784 |
val->intval = latest->temperature; |
| 785 |
break; |
| 786 |
default: |
| 787 |
return -EINVAL; |
| 788 |
} |
| 789 |
|
| 790 |
return 0; |
| 791 |
} |
| 792 |
|
| 793 |
static int cpcap_battery_update_charger(struct cpcap_battery_ddata *ddata, |
| 794 |
int const_charge_voltage) |
| 795 |
{ |
| 796 |
union power_supply_propval prop; |
| 797 |
union power_supply_propval val; |
| 798 |
struct power_supply *charger; |
| 799 |
int error; |
| 800 |
|
| 801 |
charger = power_supply_get_by_name("usb"); |
| 802 |
if (!charger) |
| 803 |
return -ENODEV; |
| 804 |
|
| 805 |
error = power_supply_get_property(charger, |
| 806 |
POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE, |
| 807 |
&prop); |
| 808 |
if (error) |
| 809 |
goto out_put; |
| 810 |
|
| 811 |
/* Allow charger const voltage lower than battery const voltage */ |
| 812 |
if (const_charge_voltage > prop.intval) |
| 813 |
goto out_put; |
| 814 |
|
| 815 |
val.intval = const_charge_voltage; |
| 816 |
|
| 817 |
error = power_supply_set_property(charger, |
| 818 |
POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE, |
| 819 |
&val); |
| 820 |
out_put: |
| 821 |
power_supply_put(charger); |
| 822 |
|
| 823 |
return error; |
| 824 |
} |
| 825 |
|
| 826 |
static int cpcap_battery_set_property(struct power_supply *psy, |
| 827 |
enum power_supply_property psp, |
| 828 |
const union power_supply_propval *val) |
| 829 |
{ |
| 830 |
struct cpcap_battery_ddata *ddata = power_supply_get_drvdata(psy); |
| 831 |
|
| 832 |
switch (psp) { |
| 833 |
case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE: |
| 834 |
if (val->intval < ddata->config.info.voltage_min_design) |
| 835 |
return -EINVAL; |
| 836 |
if (val->intval > ddata->config.info.voltage_max_design) |
| 837 |
return -EINVAL; |
| 838 |
|
| 839 |
ddata->config.bat.constant_charge_voltage_max_uv = val->intval; |
| 840 |
|
| 841 |
return cpcap_battery_update_charger(ddata, val->intval); |
| 842 |
case POWER_SUPPLY_PROP_CHARGE_FULL: |
| 843 |
if (val->intval < 0) |
| 844 |
return -EINVAL; |
| 845 |
if (val->intval > (6*ddata->config.info.charge_full_design)/5) |
| 846 |
return -EINVAL; |
| 847 |
|
| 848 |
ddata->charge_full = val->intval; |
| 849 |
|
| 850 |
return 0; |
| 851 |
default: |
| 852 |
return -EINVAL; |
| 853 |
} |
| 854 |
|
| 855 |
return 0; |
| 856 |
} |
| 857 |
|
| 858 |
static int cpcap_battery_property_is_writeable(struct power_supply *psy, |
| 859 |
enum power_supply_property psp) |
| 860 |
{ |
| 861 |
switch (psp) { |
| 862 |
case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE: |
| 863 |
case POWER_SUPPLY_PROP_CHARGE_FULL: |
| 864 |
return 1; |
| 865 |
default: |
| 866 |
return 0; |
| 867 |
} |
| 868 |
} |
| 869 |
|
| 870 |
static irqreturn_t cpcap_battery_irq_thread(int irq, void *data) |
| 871 |
{ |
| 872 |
struct cpcap_battery_ddata *ddata = data; |
| 873 |
struct cpcap_battery_state_data *latest; |
| 874 |
struct cpcap_interrupt_desc *d; |
| 875 |
|
| 876 |
if (!atomic_read(&ddata->active)) |
| 877 |
return IRQ_NONE; |
| 878 |
|
| 879 |
list_for_each_entry(d, &ddata->irq_list, node) { |
| 880 |
if (irq == d->irq) |
| 881 |
break; |
| 882 |
} |
| 883 |
|
| 884 |
if (list_entry_is_head(d, &ddata->irq_list, node)) |
| 885 |
return IRQ_NONE; |
| 886 |
|
| 887 |
latest = cpcap_battery_latest(ddata); |
| 888 |
|
| 889 |
switch (d->action) { |
| 890 |
case CPCAP_BATTERY_IRQ_ACTION_CC_CAL_DONE: |
| 891 |
dev_info(ddata->dev, "Coulomb counter calibration done\n"); |
| 892 |
break; |
| 893 |
case CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW: |
| 894 |
if (latest->current_ua >= 0) |
| 895 |
dev_warn(ddata->dev, "Battery low at %imV!\n", |
| 896 |
latest->voltage / 1000); |
| 897 |
break; |
| 898 |
case CPCAP_BATTERY_IRQ_ACTION_POWEROFF: |
| 899 |
if (latest->current_ua >= 0 && latest->voltage <= 3200000) { |
| 900 |
dev_emerg(ddata->dev, |
| 901 |
"Battery empty at %imV, powering off\n", |
| 902 |
latest->voltage / 1000); |
| 903 |
orderly_poweroff(true); |
| 904 |
} |
| 905 |
break; |
| 906 |
default: |
| 907 |
break; |
| 908 |
} |
| 909 |
|
| 910 |
power_supply_changed(ddata->psy); |
| 911 |
|
| 912 |
return IRQ_HANDLED; |
| 913 |
} |
| 914 |
|
| 915 |
static int cpcap_battery_init_irq(struct platform_device *pdev, |
| 916 |
struct cpcap_battery_ddata *ddata, |
| 917 |
const char *name) |
| 918 |
{ |
| 919 |
struct cpcap_interrupt_desc *d; |
| 920 |
int irq, error; |
| 921 |
|
| 922 |
irq = platform_get_irq_byname(pdev, name); |
| 923 |
if (irq < 0) |
| 924 |
return irq; |
| 925 |
|
| 926 |
error = devm_request_threaded_irq(ddata->dev, irq, NULL, |
| 927 |
cpcap_battery_irq_thread, |
| 928 |
IRQF_SHARED | IRQF_ONESHOT, |
| 929 |
name, ddata); |
| 930 |
if (error) { |
| 931 |
dev_err(ddata->dev, "could not get irq %s: %i\n", |
| 932 |
name, error); |
| 933 |
|
| 934 |
return error; |
| 935 |
} |
| 936 |
|
| 937 |
d = devm_kzalloc(ddata->dev, sizeof(*d), GFP_KERNEL); |
| 938 |
if (!d) |
| 939 |
return -ENOMEM; |
| 940 |
|
| 941 |
d->name = name; |
| 942 |
d->irq = irq; |
| 943 |
|
| 944 |
if (!strncmp(name, "cccal", 5)) |
| 945 |
d->action = CPCAP_BATTERY_IRQ_ACTION_CC_CAL_DONE; |
| 946 |
else if (!strncmp(name, "lowbph", 6)) |
| 947 |
d->action = CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW; |
| 948 |
else if (!strncmp(name, "lowbpl", 6)) |
| 949 |
d->action = CPCAP_BATTERY_IRQ_ACTION_POWEROFF; |
| 950 |
|
| 951 |
list_add(&d->node, &ddata->irq_list); |
| 952 |
|
| 953 |
return 0; |
| 954 |
} |
| 955 |
|
| 956 |
static int cpcap_battery_init_interrupts(struct platform_device *pdev, |
| 957 |
struct cpcap_battery_ddata *ddata) |
| 958 |
{ |
| 959 |
static const char * const cpcap_battery_irqs[] = { |
| 960 |
"eol", "lowbph", "lowbpl", |
| 961 |
"chrgcurr1", "battdetb" |
| 962 |
}; |
| 963 |
int i, error; |
| 964 |
|
| 965 |
for (i = 0; i < ARRAY_SIZE(cpcap_battery_irqs); i++) { |
| 966 |
error = cpcap_battery_init_irq(pdev, ddata, |
| 967 |
cpcap_battery_irqs[i]); |
| 968 |
if (error) |
| 969 |
return error; |
| 970 |
} |
| 971 |
|
| 972 |
/* Enable calibration interrupt if already available in dts */ |
| 973 |
cpcap_battery_init_irq(pdev, ddata, "cccal"); |
| 974 |
|
| 975 |
/* Enable low battery interrupts for 3.3V high and 3.1V low */ |
| 976 |
error = regmap_update_bits(ddata->reg, CPCAP_REG_BPEOL, |
| 977 |
0xffff, |
| 978 |
CPCAP_REG_BPEOL_BIT_BATTDETEN); |
| 979 |
if (error) |
| 980 |
return error; |
| 981 |
|
| 982 |
return 0; |
| 983 |
} |
| 984 |
|
| 985 |
static int cpcap_battery_init_iio(struct cpcap_battery_ddata *ddata) |
| 986 |
{ |
| 987 |
const char * const names[CPCAP_BATTERY_IIO_NR] = { |
| 988 |
"battdetb", "battp", "chg_isense", "batti", |
| 989 |
}; |
| 990 |
int error, i; |
| 991 |
|
| 992 |
for (i = 0; i < CPCAP_BATTERY_IIO_NR; i++) { |
| 993 |
ddata->channels[i] = devm_iio_channel_get(ddata->dev, |
| 994 |
names[i]); |
| 995 |
if (IS_ERR(ddata->channels[i])) { |
| 996 |
error = PTR_ERR(ddata->channels[i]); |
| 997 |
goto out_err; |
| 998 |
} |
| 999 |
|
| 1000 |
if (!ddata->channels[i]->indio_dev) { |
| 1001 |
error = -ENXIO; |
| 1002 |
goto out_err; |
| 1003 |
} |
| 1004 |
} |
| 1005 |
|
| 1006 |
return 0; |
| 1007 |
|
| 1008 |
out_err: |
| 1009 |
return dev_err_probe(ddata->dev, error, |
| 1010 |
"could not initialize VBUS or ID IIO\n"); |
| 1011 |
} |
| 1012 |
|
| 1013 |
/* Calibrate coulomb counter */ |
| 1014 |
static int cpcap_battery_calibrate(struct cpcap_battery_ddata *ddata) |
| 1015 |
{ |
| 1016 |
int error, ccc1, value; |
| 1017 |
unsigned long timeout; |
| 1018 |
|
| 1019 |
error = regmap_read(ddata->reg, CPCAP_REG_CCC1, &ccc1); |
| 1020 |
if (error) |
| 1021 |
return error; |
| 1022 |
|
| 1023 |
timeout = jiffies + msecs_to_jiffies(6000); |
| 1024 |
|
| 1025 |
/* Start calibration */ |
| 1026 |
error = regmap_update_bits(ddata->reg, CPCAP_REG_CCC1, |
| 1027 |
0xffff, |
| 1028 |
CPCAP_REG_CCC1_CAL_EN); |
| 1029 |
if (error) |
| 1030 |
goto restore; |
| 1031 |
|
| 1032 |
while (time_before(jiffies, timeout)) { |
| 1033 |
error = regmap_read(ddata->reg, CPCAP_REG_CCC1, &value); |
| 1034 |
if (error) |
| 1035 |
goto restore; |
| 1036 |
|
| 1037 |
if (!(value & CPCAP_REG_CCC1_CAL_EN)) |
| 1038 |
break; |
| 1039 |
|
| 1040 |
error = regmap_read(ddata->reg, CPCAP_REG_CCM, &value); |
| 1041 |
if (error) |
| 1042 |
goto restore; |
| 1043 |
|
| 1044 |
msleep(300); |
| 1045 |
} |
| 1046 |
|
| 1047 |
/* Read calibration offset from CCM */ |
| 1048 |
error = regmap_read(ddata->reg, CPCAP_REG_CCM, &value); |
| 1049 |
if (error) |
| 1050 |
goto restore; |
| 1051 |
|
| 1052 |
dev_info(ddata->dev, "calibration done: 0x%04x\n", value); |
| 1053 |
|
| 1054 |
restore: |
| 1055 |
if (error) |
| 1056 |
dev_err(ddata->dev, "%s: error %i\n", __func__, error); |
| 1057 |
|
| 1058 |
error = regmap_update_bits(ddata->reg, CPCAP_REG_CCC1, |
| 1059 |
0xffff, ccc1); |
| 1060 |
if (error) |
| 1061 |
dev_err(ddata->dev, "%s: restore error %i\n", |
| 1062 |
__func__, error); |
| 1063 |
|
| 1064 |
return error; |
| 1065 |
} |
| 1066 |
|
| 1067 |
#ifdef CONFIG_OF |
| 1068 |
static const struct of_device_id cpcap_battery_id_table[] = { |
| 1069 |
{ |
| 1070 |
.compatible = "motorola,cpcap-battery", |
| 1071 |
}, |
| 1072 |
{}, |
| 1073 |
}; |
| 1074 |
MODULE_DEVICE_TABLE(of, cpcap_battery_id_table); |
| 1075 |
#endif |
| 1076 |
|
| 1077 |
static const struct power_supply_desc cpcap_charger_battery_desc = { |
| 1078 |
.name = "battery", |
| 1079 |
.type = POWER_SUPPLY_TYPE_BATTERY, |
| 1080 |
.properties = cpcap_battery_props, |
| 1081 |
.num_properties = ARRAY_SIZE(cpcap_battery_props), |
| 1082 |
.get_property = cpcap_battery_get_property, |
| 1083 |
.set_property = cpcap_battery_set_property, |
| 1084 |
.property_is_writeable = cpcap_battery_property_is_writeable, |
| 1085 |
.external_power_changed = cpcap_battery_external_power_changed, |
| 1086 |
}; |
| 1087 |
|
| 1088 |
static int cpcap_battery_probe(struct platform_device *pdev) |
| 1089 |
{ |
| 1090 |
struct cpcap_battery_ddata *ddata; |
| 1091 |
struct power_supply_config psy_cfg = {}; |
| 1092 |
int error; |
| 1093 |
|
| 1094 |
ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL); |
| 1095 |
if (!ddata) |
| 1096 |
return -ENOMEM; |
| 1097 |
|
| 1098 |
cpcap_battery_detect_battery_type(ddata); |
| 1099 |
|
| 1100 |
INIT_LIST_HEAD(&ddata->irq_list); |
| 1101 |
ddata->dev = &pdev->dev; |
| 1102 |
|
| 1103 |
ddata->reg = dev_get_regmap(ddata->dev->parent, NULL); |
| 1104 |
if (!ddata->reg) |
| 1105 |
return -ENODEV; |
| 1106 |
|
| 1107 |
error = cpcap_get_vendor(ddata->dev, ddata->reg, &ddata->vendor); |
| 1108 |
if (error) |
| 1109 |
return error; |
| 1110 |
|
| 1111 |
switch (ddata->vendor) { |
| 1112 |
case CPCAP_VENDOR_ST: |
| 1113 |
ddata->cc_lsb = 95374; /* μAms per LSB */ |
| 1114 |
break; |
| 1115 |
case CPCAP_VENDOR_TI: |
| 1116 |
ddata->cc_lsb = 91501; /* μAms per LSB */ |
| 1117 |
break; |
| 1118 |
default: |
| 1119 |
return -EINVAL; |
| 1120 |
} |
| 1121 |
ddata->cc_lsb = (ddata->cc_lsb * ddata->config.cd_factor) / 1000; |
| 1122 |
|
| 1123 |
platform_set_drvdata(pdev, ddata); |
| 1124 |
|
| 1125 |
error = cpcap_battery_init_iio(ddata); |
| 1126 |
if (error) |
| 1127 |
return error; |
| 1128 |
|
| 1129 |
psy_cfg.fwnode = dev_fwnode(&pdev->dev); |
| 1130 |
psy_cfg.drv_data = ddata; |
| 1131 |
|
| 1132 |
ddata->psy = devm_power_supply_register(ddata->dev, |
| 1133 |
&cpcap_charger_battery_desc, |
| 1134 |
&psy_cfg); |
| 1135 |
error = PTR_ERR_OR_ZERO(ddata->psy); |
| 1136 |
if (error) { |
| 1137 |
dev_err(ddata->dev, "failed to register power supply\n"); |
| 1138 |
return error; |
| 1139 |
} |
| 1140 |
|
| 1141 |
error = cpcap_battery_init_interrupts(pdev, ddata); |
| 1142 |
if (error) |
| 1143 |
return error; |
| 1144 |
|
| 1145 |
atomic_set(&ddata->active, 1); |
| 1146 |
|
| 1147 |
error = cpcap_battery_calibrate(ddata); |
| 1148 |
if (error) |
| 1149 |
return error; |
| 1150 |
|
| 1151 |
return 0; |
| 1152 |
} |
| 1153 |
|
| 1154 |
static void cpcap_battery_remove(struct platform_device *pdev) |
| 1155 |
{ |
| 1156 |
struct cpcap_battery_ddata *ddata = platform_get_drvdata(pdev); |
| 1157 |
int error; |
| 1158 |
|
| 1159 |
atomic_set(&ddata->active, 0); |
| 1160 |
error = regmap_update_bits(ddata->reg, CPCAP_REG_BPEOL, |
| 1161 |
0xffff, 0); |
| 1162 |
if (error) |
| 1163 |
dev_err(&pdev->dev, "could not disable: %i\n", error); |
| 1164 |
} |
| 1165 |
|
| 1166 |
static struct platform_driver cpcap_battery_driver = { |
| 1167 |
.driver = { |
| 1168 |
.name = "cpcap_battery", |
| 1169 |
.of_match_table = of_match_ptr(cpcap_battery_id_table), |
| 1170 |
}, |
| 1171 |
.probe = cpcap_battery_probe, |
| 1172 |
.remove = cpcap_battery_remove, |
| 1173 |
}; |
| 1174 |
module_platform_driver(cpcap_battery_driver); |
| 1175 |
|
| 1176 |
MODULE_LICENSE("GPL v2"); |
| 1177 |
MODULE_AUTHOR("Tony Lindgren <[email protected]>"); |
| 1178 |
MODULE_DESCRIPTION("CPCAP PMIC Battery Driver"); |