162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Battery driver for CPCAP PMIC 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2017 Tony Lindgren <tony@atomide.com> 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * Some parts of the code based on earlier Motorola mapphone Linux kernel 862306a36Sopenharmony_ci * drivers: 962306a36Sopenharmony_ci * 1062306a36Sopenharmony_ci * Copyright (C) 2009-2010 Motorola, Inc. 1162306a36Sopenharmony_ci */ 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci#include <linux/delay.h> 1462306a36Sopenharmony_ci#include <linux/err.h> 1562306a36Sopenharmony_ci#include <linux/interrupt.h> 1662306a36Sopenharmony_ci#include <linux/kernel.h> 1762306a36Sopenharmony_ci#include <linux/module.h> 1862306a36Sopenharmony_ci#include <linux/of.h> 1962306a36Sopenharmony_ci#include <linux/platform_device.h> 2062306a36Sopenharmony_ci#include <linux/power_supply.h> 2162306a36Sopenharmony_ci#include <linux/reboot.h> 2262306a36Sopenharmony_ci#include <linux/regmap.h> 2362306a36Sopenharmony_ci#include <linux/nvmem-consumer.h> 2462306a36Sopenharmony_ci#include <linux/moduleparam.h> 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci#include <linux/iio/consumer.h> 2762306a36Sopenharmony_ci#include <linux/iio/types.h> 2862306a36Sopenharmony_ci#include <linux/mfd/motorola-cpcap.h> 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ci/* 3162306a36Sopenharmony_ci * Register bit defines for CPCAP_REG_BPEOL. Some of these seem to 3262306a36Sopenharmony_ci * map to MC13783UG.pdf "Table 5-19. Register 13, Power Control 0" 3362306a36Sopenharmony_ci * to enable BATTDETEN, LOBAT and EOL features. We currently use 3462306a36Sopenharmony_ci * LOBAT interrupts instead of EOL. 3562306a36Sopenharmony_ci */ 3662306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_EOL9 BIT(9) /* Set for EOL irq */ 3762306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_EOL8 BIT(8) /* Set for EOL irq */ 3862306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_UNKNOWN7 BIT(7) 3962306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_UNKNOWN6 BIT(6) 4062306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_UNKNOWN5 BIT(5) 4162306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_EOL_MULTI BIT(4) /* Set for multiple EOL irqs */ 4262306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_UNKNOWN3 BIT(3) 4362306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_UNKNOWN2 BIT(2) 4462306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_BATTDETEN BIT(1) /* Enable battery detect */ 4562306a36Sopenharmony_ci#define CPCAP_REG_BPEOL_BIT_EOLSEL BIT(0) /* BPDET = 0, EOL = 1 */ 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci/* 4862306a36Sopenharmony_ci * Register bit defines for CPCAP_REG_CCC1. These seem similar to the twl6030 4962306a36Sopenharmony_ci * coulomb counter registers rather than the mc13892 registers. Both twl6030 5062306a36Sopenharmony_ci * and mc13892 set bits 2 and 1 to reset and clear registers. But mc13892 5162306a36Sopenharmony_ci * sets bit 0 to start the coulomb counter while twl6030 sets bit 0 to stop 5262306a36Sopenharmony_ci * the coulomb counter like cpcap does. So for now, we use the twl6030 style 5362306a36Sopenharmony_ci * naming for the registers. 5462306a36Sopenharmony_ci */ 5562306a36Sopenharmony_ci#define CPCAP_REG_CCC1_ACTIVE_MODE1 BIT(4) /* Update rate */ 5662306a36Sopenharmony_ci#define CPCAP_REG_CCC1_ACTIVE_MODE0 BIT(3) /* Update rate */ 5762306a36Sopenharmony_ci#define CPCAP_REG_CCC1_AUTOCLEAR BIT(2) /* Resets sample registers */ 5862306a36Sopenharmony_ci#define CPCAP_REG_CCC1_CAL_EN BIT(1) /* Clears after write in 1s */ 5962306a36Sopenharmony_ci#define CPCAP_REG_CCC1_PAUSE BIT(0) /* Stop counters, allow write */ 6062306a36Sopenharmony_ci#define CPCAP_REG_CCC1_RESET_MASK (CPCAP_REG_CCC1_AUTOCLEAR | \ 6162306a36Sopenharmony_ci CPCAP_REG_CCC1_CAL_EN) 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_ci#define CPCAP_REG_CCCC2_RATE1 BIT(5) 6462306a36Sopenharmony_ci#define CPCAP_REG_CCCC2_RATE0 BIT(4) 6562306a36Sopenharmony_ci#define CPCAP_REG_CCCC2_ENABLE BIT(3) 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci#define CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS 250 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_ci#define CPCAP_BATTERY_EB41_HW4X_ID 0x9E 7062306a36Sopenharmony_ci#define CPCAP_BATTERY_BW8X_ID 0x98 7162306a36Sopenharmony_ci 7262306a36Sopenharmony_cienum { 7362306a36Sopenharmony_ci CPCAP_BATTERY_IIO_BATTDET, 7462306a36Sopenharmony_ci CPCAP_BATTERY_IIO_VOLTAGE, 7562306a36Sopenharmony_ci CPCAP_BATTERY_IIO_CHRG_CURRENT, 7662306a36Sopenharmony_ci CPCAP_BATTERY_IIO_BATT_CURRENT, 7762306a36Sopenharmony_ci CPCAP_BATTERY_IIO_NR, 7862306a36Sopenharmony_ci}; 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_cienum cpcap_battery_irq_action { 8162306a36Sopenharmony_ci CPCAP_BATTERY_IRQ_ACTION_NONE, 8262306a36Sopenharmony_ci CPCAP_BATTERY_IRQ_ACTION_CC_CAL_DONE, 8362306a36Sopenharmony_ci CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW, 8462306a36Sopenharmony_ci CPCAP_BATTERY_IRQ_ACTION_POWEROFF, 8562306a36Sopenharmony_ci}; 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_cistruct cpcap_interrupt_desc { 8862306a36Sopenharmony_ci const char *name; 8962306a36Sopenharmony_ci struct list_head node; 9062306a36Sopenharmony_ci int irq; 9162306a36Sopenharmony_ci enum cpcap_battery_irq_action action; 9262306a36Sopenharmony_ci}; 9362306a36Sopenharmony_ci 9462306a36Sopenharmony_cistruct cpcap_battery_config { 9562306a36Sopenharmony_ci int cd_factor; 9662306a36Sopenharmony_ci struct power_supply_info info; 9762306a36Sopenharmony_ci struct power_supply_battery_info bat; 9862306a36Sopenharmony_ci}; 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_cistruct cpcap_coulomb_counter_data { 10162306a36Sopenharmony_ci s32 sample; /* 24 or 32 bits */ 10262306a36Sopenharmony_ci s32 accumulator; 10362306a36Sopenharmony_ci s16 offset; /* 9 bits */ 10462306a36Sopenharmony_ci s16 integrator; /* 13 or 16 bits */ 10562306a36Sopenharmony_ci}; 10662306a36Sopenharmony_ci 10762306a36Sopenharmony_cienum cpcap_battery_state { 10862306a36Sopenharmony_ci CPCAP_BATTERY_STATE_PREVIOUS, 10962306a36Sopenharmony_ci CPCAP_BATTERY_STATE_LATEST, 11062306a36Sopenharmony_ci CPCAP_BATTERY_STATE_EMPTY, 11162306a36Sopenharmony_ci CPCAP_BATTERY_STATE_FULL, 11262306a36Sopenharmony_ci CPCAP_BATTERY_STATE_NR, 11362306a36Sopenharmony_ci}; 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_cistruct cpcap_battery_state_data { 11662306a36Sopenharmony_ci int voltage; 11762306a36Sopenharmony_ci int current_ua; 11862306a36Sopenharmony_ci int counter_uah; 11962306a36Sopenharmony_ci int temperature; 12062306a36Sopenharmony_ci ktime_t time; 12162306a36Sopenharmony_ci struct cpcap_coulomb_counter_data cc; 12262306a36Sopenharmony_ci}; 12362306a36Sopenharmony_ci 12462306a36Sopenharmony_cistruct cpcap_battery_ddata { 12562306a36Sopenharmony_ci struct device *dev; 12662306a36Sopenharmony_ci struct regmap *reg; 12762306a36Sopenharmony_ci struct list_head irq_list; 12862306a36Sopenharmony_ci struct iio_channel *channels[CPCAP_BATTERY_IIO_NR]; 12962306a36Sopenharmony_ci struct power_supply *psy; 13062306a36Sopenharmony_ci struct cpcap_battery_config config; 13162306a36Sopenharmony_ci struct cpcap_battery_state_data state[CPCAP_BATTERY_STATE_NR]; 13262306a36Sopenharmony_ci u32 cc_lsb; /* μAms per LSB */ 13362306a36Sopenharmony_ci atomic_t active; 13462306a36Sopenharmony_ci int charge_full; 13562306a36Sopenharmony_ci int status; 13662306a36Sopenharmony_ci u16 vendor; 13762306a36Sopenharmony_ci bool check_nvmem; 13862306a36Sopenharmony_ci unsigned int is_full:1; 13962306a36Sopenharmony_ci}; 14062306a36Sopenharmony_ci 14162306a36Sopenharmony_ci#define CPCAP_NO_BATTERY -400 14262306a36Sopenharmony_ci 14362306a36Sopenharmony_cistatic bool ignore_temperature_probe; 14462306a36Sopenharmony_cimodule_param(ignore_temperature_probe, bool, 0660); 14562306a36Sopenharmony_ci 14662306a36Sopenharmony_cistatic struct cpcap_battery_state_data * 14762306a36Sopenharmony_cicpcap_battery_get_state(struct cpcap_battery_ddata *ddata, 14862306a36Sopenharmony_ci enum cpcap_battery_state state) 14962306a36Sopenharmony_ci{ 15062306a36Sopenharmony_ci if (state >= CPCAP_BATTERY_STATE_NR) 15162306a36Sopenharmony_ci return NULL; 15262306a36Sopenharmony_ci 15362306a36Sopenharmony_ci return &ddata->state[state]; 15462306a36Sopenharmony_ci} 15562306a36Sopenharmony_ci 15662306a36Sopenharmony_cistatic struct cpcap_battery_state_data * 15762306a36Sopenharmony_cicpcap_battery_latest(struct cpcap_battery_ddata *ddata) 15862306a36Sopenharmony_ci{ 15962306a36Sopenharmony_ci return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_LATEST); 16062306a36Sopenharmony_ci} 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_cistatic struct cpcap_battery_state_data * 16362306a36Sopenharmony_cicpcap_battery_previous(struct cpcap_battery_ddata *ddata) 16462306a36Sopenharmony_ci{ 16562306a36Sopenharmony_ci return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_PREVIOUS); 16662306a36Sopenharmony_ci} 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_cistatic struct cpcap_battery_state_data * 16962306a36Sopenharmony_cicpcap_battery_get_empty(struct cpcap_battery_ddata *ddata) 17062306a36Sopenharmony_ci{ 17162306a36Sopenharmony_ci return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_EMPTY); 17262306a36Sopenharmony_ci} 17362306a36Sopenharmony_ci 17462306a36Sopenharmony_cistatic struct cpcap_battery_state_data * 17562306a36Sopenharmony_cicpcap_battery_get_full(struct cpcap_battery_ddata *ddata) 17662306a36Sopenharmony_ci{ 17762306a36Sopenharmony_ci return cpcap_battery_get_state(ddata, CPCAP_BATTERY_STATE_FULL); 17862306a36Sopenharmony_ci} 17962306a36Sopenharmony_ci 18062306a36Sopenharmony_cistatic int cpcap_charger_battery_temperature(struct cpcap_battery_ddata *ddata, 18162306a36Sopenharmony_ci int *value) 18262306a36Sopenharmony_ci{ 18362306a36Sopenharmony_ci struct iio_channel *channel; 18462306a36Sopenharmony_ci int error; 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci channel = ddata->channels[CPCAP_BATTERY_IIO_BATTDET]; 18762306a36Sopenharmony_ci error = iio_read_channel_processed(channel, value); 18862306a36Sopenharmony_ci if (error < 0) { 18962306a36Sopenharmony_ci if (!ignore_temperature_probe) 19062306a36Sopenharmony_ci dev_warn(ddata->dev, "%s failed: %i\n", __func__, error); 19162306a36Sopenharmony_ci *value = CPCAP_NO_BATTERY; 19262306a36Sopenharmony_ci 19362306a36Sopenharmony_ci return error; 19462306a36Sopenharmony_ci } 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci *value /= 100; 19762306a36Sopenharmony_ci 19862306a36Sopenharmony_ci return 0; 19962306a36Sopenharmony_ci} 20062306a36Sopenharmony_ci 20162306a36Sopenharmony_cistatic int cpcap_battery_get_voltage(struct cpcap_battery_ddata *ddata) 20262306a36Sopenharmony_ci{ 20362306a36Sopenharmony_ci struct iio_channel *channel; 20462306a36Sopenharmony_ci int error, value = 0; 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci channel = ddata->channels[CPCAP_BATTERY_IIO_VOLTAGE]; 20762306a36Sopenharmony_ci error = iio_read_channel_processed(channel, &value); 20862306a36Sopenharmony_ci if (error < 0) { 20962306a36Sopenharmony_ci dev_warn(ddata->dev, "%s failed: %i\n", __func__, error); 21062306a36Sopenharmony_ci 21162306a36Sopenharmony_ci return 0; 21262306a36Sopenharmony_ci } 21362306a36Sopenharmony_ci 21462306a36Sopenharmony_ci return value * 1000; 21562306a36Sopenharmony_ci} 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_cistatic int cpcap_battery_get_current(struct cpcap_battery_ddata *ddata) 21862306a36Sopenharmony_ci{ 21962306a36Sopenharmony_ci struct iio_channel *channel; 22062306a36Sopenharmony_ci int error, value = 0; 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_ci channel = ddata->channels[CPCAP_BATTERY_IIO_BATT_CURRENT]; 22362306a36Sopenharmony_ci error = iio_read_channel_processed(channel, &value); 22462306a36Sopenharmony_ci if (error < 0) { 22562306a36Sopenharmony_ci dev_warn(ddata->dev, "%s failed: %i\n", __func__, error); 22662306a36Sopenharmony_ci 22762306a36Sopenharmony_ci return 0; 22862306a36Sopenharmony_ci } 22962306a36Sopenharmony_ci 23062306a36Sopenharmony_ci return value * 1000; 23162306a36Sopenharmony_ci} 23262306a36Sopenharmony_ci 23362306a36Sopenharmony_ci/** 23462306a36Sopenharmony_ci * cpcap_battery_cc_raw_div - calculate and divide coulomb counter μAms values 23562306a36Sopenharmony_ci * @ddata: device driver data 23662306a36Sopenharmony_ci * @sample: coulomb counter sample value 23762306a36Sopenharmony_ci * @accumulator: coulomb counter integrator value 23862306a36Sopenharmony_ci * @offset: coulomb counter offset value 23962306a36Sopenharmony_ci * @divider: conversion divider 24062306a36Sopenharmony_ci * 24162306a36Sopenharmony_ci * Note that cc_lsb and cc_dur values are from Motorola Linux kernel 24262306a36Sopenharmony_ci * function data_get_avg_curr_ua() and seem to be based on measured test 24362306a36Sopenharmony_ci * results. It also has the following comment: 24462306a36Sopenharmony_ci * 24562306a36Sopenharmony_ci * Adjustment factors are applied here as a temp solution per the test 24662306a36Sopenharmony_ci * results. Need to work out a formal solution for this adjustment. 24762306a36Sopenharmony_ci * 24862306a36Sopenharmony_ci * A coulomb counter for similar hardware seems to be documented in 24962306a36Sopenharmony_ci * "TWL6030 Gas Gauging Basics (Rev. A)" swca095a.pdf in chapter 25062306a36Sopenharmony_ci * "10 Calculating Accumulated Current". We however follow what the 25162306a36Sopenharmony_ci * Motorola mapphone Linux kernel is doing as there may be either a 25262306a36Sopenharmony_ci * TI or ST coulomb counter in the PMIC. 25362306a36Sopenharmony_ci */ 25462306a36Sopenharmony_cistatic int cpcap_battery_cc_raw_div(struct cpcap_battery_ddata *ddata, 25562306a36Sopenharmony_ci s32 sample, s32 accumulator, 25662306a36Sopenharmony_ci s16 offset, u32 divider) 25762306a36Sopenharmony_ci{ 25862306a36Sopenharmony_ci s64 acc; 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ci if (!divider) 26162306a36Sopenharmony_ci return 0; 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci acc = accumulator; 26462306a36Sopenharmony_ci acc -= (s64)sample * offset; 26562306a36Sopenharmony_ci acc *= ddata->cc_lsb; 26662306a36Sopenharmony_ci acc *= -1; 26762306a36Sopenharmony_ci acc = div_s64(acc, divider); 26862306a36Sopenharmony_ci 26962306a36Sopenharmony_ci return acc; 27062306a36Sopenharmony_ci} 27162306a36Sopenharmony_ci 27262306a36Sopenharmony_ci/* 3600000μAms = 1μAh */ 27362306a36Sopenharmony_cistatic int cpcap_battery_cc_to_uah(struct cpcap_battery_ddata *ddata, 27462306a36Sopenharmony_ci s32 sample, s32 accumulator, 27562306a36Sopenharmony_ci s16 offset) 27662306a36Sopenharmony_ci{ 27762306a36Sopenharmony_ci return cpcap_battery_cc_raw_div(ddata, sample, 27862306a36Sopenharmony_ci accumulator, offset, 27962306a36Sopenharmony_ci 3600000); 28062306a36Sopenharmony_ci} 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_cistatic int cpcap_battery_cc_to_ua(struct cpcap_battery_ddata *ddata, 28362306a36Sopenharmony_ci s32 sample, s32 accumulator, 28462306a36Sopenharmony_ci s16 offset) 28562306a36Sopenharmony_ci{ 28662306a36Sopenharmony_ci return cpcap_battery_cc_raw_div(ddata, sample, 28762306a36Sopenharmony_ci accumulator, offset, 28862306a36Sopenharmony_ci sample * 28962306a36Sopenharmony_ci CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS); 29062306a36Sopenharmony_ci} 29162306a36Sopenharmony_ci 29262306a36Sopenharmony_ci/** 29362306a36Sopenharmony_ci * cpcap_battery_read_accumulated - reads cpcap coulomb counter 29462306a36Sopenharmony_ci * @ddata: device driver data 29562306a36Sopenharmony_ci * @ccd: coulomb counter values 29662306a36Sopenharmony_ci * 29762306a36Sopenharmony_ci * Based on Motorola mapphone kernel function data_read_regs(). 29862306a36Sopenharmony_ci * Looking at the registers, the coulomb counter seems similar to 29962306a36Sopenharmony_ci * the coulomb counter in TWL6030. See "TWL6030 Gas Gauging Basics 30062306a36Sopenharmony_ci * (Rev. A) swca095a.pdf for "10 Calculating Accumulated Current". 30162306a36Sopenharmony_ci * 30262306a36Sopenharmony_ci * Note that swca095a.pdf instructs to stop the coulomb counter 30362306a36Sopenharmony_ci * before reading to avoid values changing. Motorola mapphone 30462306a36Sopenharmony_ci * Linux kernel does not do it, so let's assume they've verified 30562306a36Sopenharmony_ci * the data produced is correct. 30662306a36Sopenharmony_ci */ 30762306a36Sopenharmony_cistatic int 30862306a36Sopenharmony_cicpcap_battery_read_accumulated(struct cpcap_battery_ddata *ddata, 30962306a36Sopenharmony_ci struct cpcap_coulomb_counter_data *ccd) 31062306a36Sopenharmony_ci{ 31162306a36Sopenharmony_ci u16 buf[7]; /* CPCAP_REG_CCS1 to CCI */ 31262306a36Sopenharmony_ci int error; 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci ccd->sample = 0; 31562306a36Sopenharmony_ci ccd->accumulator = 0; 31662306a36Sopenharmony_ci ccd->offset = 0; 31762306a36Sopenharmony_ci ccd->integrator = 0; 31862306a36Sopenharmony_ci 31962306a36Sopenharmony_ci /* Read coulomb counter register range */ 32062306a36Sopenharmony_ci error = regmap_bulk_read(ddata->reg, CPCAP_REG_CCS1, 32162306a36Sopenharmony_ci buf, ARRAY_SIZE(buf)); 32262306a36Sopenharmony_ci if (error) 32362306a36Sopenharmony_ci return 0; 32462306a36Sopenharmony_ci 32562306a36Sopenharmony_ci /* Sample value CPCAP_REG_CCS1 & 2 */ 32662306a36Sopenharmony_ci ccd->sample = (buf[1] & 0x0fff) << 16; 32762306a36Sopenharmony_ci ccd->sample |= buf[0]; 32862306a36Sopenharmony_ci if (ddata->vendor == CPCAP_VENDOR_TI) 32962306a36Sopenharmony_ci ccd->sample = sign_extend32(24, ccd->sample); 33062306a36Sopenharmony_ci 33162306a36Sopenharmony_ci /* Accumulator value CPCAP_REG_CCA1 & 2 */ 33262306a36Sopenharmony_ci ccd->accumulator = ((s16)buf[3]) << 16; 33362306a36Sopenharmony_ci ccd->accumulator |= buf[2]; 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci /* 33662306a36Sopenharmony_ci * Coulomb counter calibration offset is CPCAP_REG_CCM, 33762306a36Sopenharmony_ci * REG_CCO seems unused 33862306a36Sopenharmony_ci */ 33962306a36Sopenharmony_ci ccd->offset = buf[4]; 34062306a36Sopenharmony_ci ccd->offset = sign_extend32(ccd->offset, 9); 34162306a36Sopenharmony_ci 34262306a36Sopenharmony_ci /* Integrator register CPCAP_REG_CCI */ 34362306a36Sopenharmony_ci if (ddata->vendor == CPCAP_VENDOR_TI) 34462306a36Sopenharmony_ci ccd->integrator = sign_extend32(buf[6], 13); 34562306a36Sopenharmony_ci else 34662306a36Sopenharmony_ci ccd->integrator = (s16)buf[6]; 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci return cpcap_battery_cc_to_uah(ddata, 34962306a36Sopenharmony_ci ccd->sample, 35062306a36Sopenharmony_ci ccd->accumulator, 35162306a36Sopenharmony_ci ccd->offset); 35262306a36Sopenharmony_ci} 35362306a36Sopenharmony_ci 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci/* 35662306a36Sopenharmony_ci * Based on the values from Motorola mapphone Linux kernel for the 35762306a36Sopenharmony_ci * stock Droid 4 battery eb41. In the Motorola mapphone Linux 35862306a36Sopenharmony_ci * kernel tree the value for pm_cd_factor is passed to the kernel 35962306a36Sopenharmony_ci * via device tree. If it turns out to be something device specific 36062306a36Sopenharmony_ci * we can consider that too later. These values are also fine for 36162306a36Sopenharmony_ci * Bionic's hw4x. 36262306a36Sopenharmony_ci * 36362306a36Sopenharmony_ci * And looking at the battery full and shutdown values for the stock 36462306a36Sopenharmony_ci * kernel on droid 4, full is 4351000 and software initiates shutdown 36562306a36Sopenharmony_ci * at 3078000. The device will die around 2743000. 36662306a36Sopenharmony_ci */ 36762306a36Sopenharmony_cistatic const struct cpcap_battery_config cpcap_battery_eb41_data = { 36862306a36Sopenharmony_ci .cd_factor = 0x3cc, 36962306a36Sopenharmony_ci .info.technology = POWER_SUPPLY_TECHNOLOGY_LION, 37062306a36Sopenharmony_ci .info.voltage_max_design = 4351000, 37162306a36Sopenharmony_ci .info.voltage_min_design = 3100000, 37262306a36Sopenharmony_ci .info.charge_full_design = 1740000, 37362306a36Sopenharmony_ci .bat.constant_charge_voltage_max_uv = 4200000, 37462306a36Sopenharmony_ci}; 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_ci/* Values for the extended Droid Bionic battery bw8x. */ 37762306a36Sopenharmony_cistatic const struct cpcap_battery_config cpcap_battery_bw8x_data = { 37862306a36Sopenharmony_ci .cd_factor = 0x3cc, 37962306a36Sopenharmony_ci .info.technology = POWER_SUPPLY_TECHNOLOGY_LION, 38062306a36Sopenharmony_ci .info.voltage_max_design = 4200000, 38162306a36Sopenharmony_ci .info.voltage_min_design = 3200000, 38262306a36Sopenharmony_ci .info.charge_full_design = 2760000, 38362306a36Sopenharmony_ci .bat.constant_charge_voltage_max_uv = 4200000, 38462306a36Sopenharmony_ci}; 38562306a36Sopenharmony_ci 38662306a36Sopenharmony_ci/* 38762306a36Sopenharmony_ci * Safe values for any lipo battery likely to fit into a mapphone 38862306a36Sopenharmony_ci * battery bay. 38962306a36Sopenharmony_ci */ 39062306a36Sopenharmony_cistatic const struct cpcap_battery_config cpcap_battery_unkown_data = { 39162306a36Sopenharmony_ci .cd_factor = 0x3cc, 39262306a36Sopenharmony_ci .info.technology = POWER_SUPPLY_TECHNOLOGY_LION, 39362306a36Sopenharmony_ci .info.voltage_max_design = 4200000, 39462306a36Sopenharmony_ci .info.voltage_min_design = 3200000, 39562306a36Sopenharmony_ci .info.charge_full_design = 3000000, 39662306a36Sopenharmony_ci .bat.constant_charge_voltage_max_uv = 4200000, 39762306a36Sopenharmony_ci}; 39862306a36Sopenharmony_ci 39962306a36Sopenharmony_cistatic int cpcap_battery_match_nvmem(struct device *dev, const void *data) 40062306a36Sopenharmony_ci{ 40162306a36Sopenharmony_ci if (strcmp(dev_name(dev), "89-500029ba0f73") == 0) 40262306a36Sopenharmony_ci return 1; 40362306a36Sopenharmony_ci else 40462306a36Sopenharmony_ci return 0; 40562306a36Sopenharmony_ci} 40662306a36Sopenharmony_ci 40762306a36Sopenharmony_cistatic void cpcap_battery_detect_battery_type(struct cpcap_battery_ddata *ddata) 40862306a36Sopenharmony_ci{ 40962306a36Sopenharmony_ci struct nvmem_device *nvmem; 41062306a36Sopenharmony_ci u8 battery_id = 0; 41162306a36Sopenharmony_ci 41262306a36Sopenharmony_ci ddata->check_nvmem = false; 41362306a36Sopenharmony_ci 41462306a36Sopenharmony_ci nvmem = nvmem_device_find(NULL, &cpcap_battery_match_nvmem); 41562306a36Sopenharmony_ci if (IS_ERR_OR_NULL(nvmem)) { 41662306a36Sopenharmony_ci ddata->check_nvmem = true; 41762306a36Sopenharmony_ci dev_info_once(ddata->dev, "Can not find battery nvmem device. Assuming generic lipo battery\n"); 41862306a36Sopenharmony_ci } else if (nvmem_device_read(nvmem, 2, 1, &battery_id) < 0) { 41962306a36Sopenharmony_ci battery_id = 0; 42062306a36Sopenharmony_ci ddata->check_nvmem = true; 42162306a36Sopenharmony_ci dev_warn(ddata->dev, "Can not read battery nvmem device. Assuming generic lipo battery\n"); 42262306a36Sopenharmony_ci } 42362306a36Sopenharmony_ci 42462306a36Sopenharmony_ci switch (battery_id) { 42562306a36Sopenharmony_ci case CPCAP_BATTERY_EB41_HW4X_ID: 42662306a36Sopenharmony_ci ddata->config = cpcap_battery_eb41_data; 42762306a36Sopenharmony_ci break; 42862306a36Sopenharmony_ci case CPCAP_BATTERY_BW8X_ID: 42962306a36Sopenharmony_ci ddata->config = cpcap_battery_bw8x_data; 43062306a36Sopenharmony_ci break; 43162306a36Sopenharmony_ci default: 43262306a36Sopenharmony_ci ddata->config = cpcap_battery_unkown_data; 43362306a36Sopenharmony_ci } 43462306a36Sopenharmony_ci} 43562306a36Sopenharmony_ci 43662306a36Sopenharmony_ci/** 43762306a36Sopenharmony_ci * cpcap_battery_cc_get_avg_current - read cpcap coulumb counter 43862306a36Sopenharmony_ci * @ddata: cpcap battery driver device data 43962306a36Sopenharmony_ci */ 44062306a36Sopenharmony_cistatic int cpcap_battery_cc_get_avg_current(struct cpcap_battery_ddata *ddata) 44162306a36Sopenharmony_ci{ 44262306a36Sopenharmony_ci int value, acc, error; 44362306a36Sopenharmony_ci s32 sample; 44462306a36Sopenharmony_ci s16 offset; 44562306a36Sopenharmony_ci 44662306a36Sopenharmony_ci /* Coulomb counter integrator */ 44762306a36Sopenharmony_ci error = regmap_read(ddata->reg, CPCAP_REG_CCI, &value); 44862306a36Sopenharmony_ci if (error) 44962306a36Sopenharmony_ci return error; 45062306a36Sopenharmony_ci 45162306a36Sopenharmony_ci if (ddata->vendor == CPCAP_VENDOR_TI) { 45262306a36Sopenharmony_ci acc = sign_extend32(value, 13); 45362306a36Sopenharmony_ci sample = 1; 45462306a36Sopenharmony_ci } else { 45562306a36Sopenharmony_ci acc = (s16)value; 45662306a36Sopenharmony_ci sample = 4; 45762306a36Sopenharmony_ci } 45862306a36Sopenharmony_ci 45962306a36Sopenharmony_ci /* Coulomb counter calibration offset */ 46062306a36Sopenharmony_ci error = regmap_read(ddata->reg, CPCAP_REG_CCM, &value); 46162306a36Sopenharmony_ci if (error) 46262306a36Sopenharmony_ci return error; 46362306a36Sopenharmony_ci 46462306a36Sopenharmony_ci offset = sign_extend32(value, 9); 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_ci return cpcap_battery_cc_to_ua(ddata, sample, acc, offset); 46762306a36Sopenharmony_ci} 46862306a36Sopenharmony_ci 46962306a36Sopenharmony_cistatic int cpcap_battery_get_charger_status(struct cpcap_battery_ddata *ddata, 47062306a36Sopenharmony_ci int *val) 47162306a36Sopenharmony_ci{ 47262306a36Sopenharmony_ci union power_supply_propval prop; 47362306a36Sopenharmony_ci struct power_supply *charger; 47462306a36Sopenharmony_ci int error; 47562306a36Sopenharmony_ci 47662306a36Sopenharmony_ci charger = power_supply_get_by_name("usb"); 47762306a36Sopenharmony_ci if (!charger) 47862306a36Sopenharmony_ci return -ENODEV; 47962306a36Sopenharmony_ci 48062306a36Sopenharmony_ci error = power_supply_get_property(charger, POWER_SUPPLY_PROP_STATUS, 48162306a36Sopenharmony_ci &prop); 48262306a36Sopenharmony_ci if (error) 48362306a36Sopenharmony_ci *val = POWER_SUPPLY_STATUS_UNKNOWN; 48462306a36Sopenharmony_ci else 48562306a36Sopenharmony_ci *val = prop.intval; 48662306a36Sopenharmony_ci 48762306a36Sopenharmony_ci power_supply_put(charger); 48862306a36Sopenharmony_ci 48962306a36Sopenharmony_ci return error; 49062306a36Sopenharmony_ci} 49162306a36Sopenharmony_ci 49262306a36Sopenharmony_cistatic bool cpcap_battery_full(struct cpcap_battery_ddata *ddata) 49362306a36Sopenharmony_ci{ 49462306a36Sopenharmony_ci struct cpcap_battery_state_data *state = cpcap_battery_latest(ddata); 49562306a36Sopenharmony_ci unsigned int vfull; 49662306a36Sopenharmony_ci int error, val; 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci error = cpcap_battery_get_charger_status(ddata, &val); 49962306a36Sopenharmony_ci if (!error) { 50062306a36Sopenharmony_ci switch (val) { 50162306a36Sopenharmony_ci case POWER_SUPPLY_STATUS_DISCHARGING: 50262306a36Sopenharmony_ci dev_dbg(ddata->dev, "charger disconnected\n"); 50362306a36Sopenharmony_ci ddata->is_full = 0; 50462306a36Sopenharmony_ci break; 50562306a36Sopenharmony_ci case POWER_SUPPLY_STATUS_FULL: 50662306a36Sopenharmony_ci dev_dbg(ddata->dev, "charger full status\n"); 50762306a36Sopenharmony_ci ddata->is_full = 1; 50862306a36Sopenharmony_ci break; 50962306a36Sopenharmony_ci default: 51062306a36Sopenharmony_ci break; 51162306a36Sopenharmony_ci } 51262306a36Sopenharmony_ci } 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci /* 51562306a36Sopenharmony_ci * The full battery voltage here can be inaccurate, it's used just to 51662306a36Sopenharmony_ci * filter out any trickle charging events. We clear the is_full status 51762306a36Sopenharmony_ci * on charger disconnect above anyways. 51862306a36Sopenharmony_ci */ 51962306a36Sopenharmony_ci vfull = ddata->config.bat.constant_charge_voltage_max_uv - 120000; 52062306a36Sopenharmony_ci 52162306a36Sopenharmony_ci if (ddata->is_full && state->voltage < vfull) 52262306a36Sopenharmony_ci ddata->is_full = 0; 52362306a36Sopenharmony_ci 52462306a36Sopenharmony_ci return ddata->is_full; 52562306a36Sopenharmony_ci} 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_cistatic bool cpcap_battery_low(struct cpcap_battery_ddata *ddata) 52862306a36Sopenharmony_ci{ 52962306a36Sopenharmony_ci struct cpcap_battery_state_data *state = cpcap_battery_latest(ddata); 53062306a36Sopenharmony_ci static bool is_low; 53162306a36Sopenharmony_ci 53262306a36Sopenharmony_ci if (state->current_ua > 0 && (state->voltage <= 3350000 || is_low)) 53362306a36Sopenharmony_ci is_low = true; 53462306a36Sopenharmony_ci else 53562306a36Sopenharmony_ci is_low = false; 53662306a36Sopenharmony_ci 53762306a36Sopenharmony_ci return is_low; 53862306a36Sopenharmony_ci} 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_cistatic int cpcap_battery_update_status(struct cpcap_battery_ddata *ddata) 54162306a36Sopenharmony_ci{ 54262306a36Sopenharmony_ci struct cpcap_battery_state_data state, *latest, *previous, 54362306a36Sopenharmony_ci *empty, *full; 54462306a36Sopenharmony_ci ktime_t now; 54562306a36Sopenharmony_ci int error; 54662306a36Sopenharmony_ci 54762306a36Sopenharmony_ci memset(&state, 0, sizeof(state)); 54862306a36Sopenharmony_ci now = ktime_get(); 54962306a36Sopenharmony_ci 55062306a36Sopenharmony_ci latest = cpcap_battery_latest(ddata); 55162306a36Sopenharmony_ci if (latest) { 55262306a36Sopenharmony_ci s64 delta_ms = ktime_to_ms(ktime_sub(now, latest->time)); 55362306a36Sopenharmony_ci 55462306a36Sopenharmony_ci if (delta_ms < CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS) 55562306a36Sopenharmony_ci return delta_ms; 55662306a36Sopenharmony_ci } 55762306a36Sopenharmony_ci 55862306a36Sopenharmony_ci state.time = now; 55962306a36Sopenharmony_ci state.voltage = cpcap_battery_get_voltage(ddata); 56062306a36Sopenharmony_ci state.current_ua = cpcap_battery_get_current(ddata); 56162306a36Sopenharmony_ci state.counter_uah = cpcap_battery_read_accumulated(ddata, &state.cc); 56262306a36Sopenharmony_ci 56362306a36Sopenharmony_ci error = cpcap_charger_battery_temperature(ddata, 56462306a36Sopenharmony_ci &state.temperature); 56562306a36Sopenharmony_ci if (error) 56662306a36Sopenharmony_ci return error; 56762306a36Sopenharmony_ci 56862306a36Sopenharmony_ci previous = cpcap_battery_previous(ddata); 56962306a36Sopenharmony_ci memcpy(previous, latest, sizeof(*previous)); 57062306a36Sopenharmony_ci memcpy(latest, &state, sizeof(*latest)); 57162306a36Sopenharmony_ci 57262306a36Sopenharmony_ci if (cpcap_battery_full(ddata)) { 57362306a36Sopenharmony_ci full = cpcap_battery_get_full(ddata); 57462306a36Sopenharmony_ci memcpy(full, latest, sizeof(*full)); 57562306a36Sopenharmony_ci 57662306a36Sopenharmony_ci empty = cpcap_battery_get_empty(ddata); 57762306a36Sopenharmony_ci if (empty->voltage && empty->voltage != -1) { 57862306a36Sopenharmony_ci empty->voltage = -1; 57962306a36Sopenharmony_ci ddata->charge_full = 58062306a36Sopenharmony_ci empty->counter_uah - full->counter_uah; 58162306a36Sopenharmony_ci } else if (ddata->charge_full) { 58262306a36Sopenharmony_ci empty->voltage = -1; 58362306a36Sopenharmony_ci empty->counter_uah = 58462306a36Sopenharmony_ci full->counter_uah + ddata->charge_full; 58562306a36Sopenharmony_ci } 58662306a36Sopenharmony_ci } else if (cpcap_battery_low(ddata)) { 58762306a36Sopenharmony_ci empty = cpcap_battery_get_empty(ddata); 58862306a36Sopenharmony_ci memcpy(empty, latest, sizeof(*empty)); 58962306a36Sopenharmony_ci 59062306a36Sopenharmony_ci full = cpcap_battery_get_full(ddata); 59162306a36Sopenharmony_ci if (full->voltage) { 59262306a36Sopenharmony_ci full->voltage = 0; 59362306a36Sopenharmony_ci ddata->charge_full = 59462306a36Sopenharmony_ci empty->counter_uah - full->counter_uah; 59562306a36Sopenharmony_ci } 59662306a36Sopenharmony_ci } 59762306a36Sopenharmony_ci 59862306a36Sopenharmony_ci return 0; 59962306a36Sopenharmony_ci} 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_ci/* 60262306a36Sopenharmony_ci * Update battery status when cpcap-charger calls power_supply_changed(). 60362306a36Sopenharmony_ci * This allows us to detect battery full condition before the charger 60462306a36Sopenharmony_ci * disconnects. 60562306a36Sopenharmony_ci */ 60662306a36Sopenharmony_cistatic void cpcap_battery_external_power_changed(struct power_supply *psy) 60762306a36Sopenharmony_ci{ 60862306a36Sopenharmony_ci union power_supply_propval prop; 60962306a36Sopenharmony_ci 61062306a36Sopenharmony_ci power_supply_get_property(psy, POWER_SUPPLY_PROP_STATUS, &prop); 61162306a36Sopenharmony_ci} 61262306a36Sopenharmony_ci 61362306a36Sopenharmony_cistatic enum power_supply_property cpcap_battery_props[] = { 61462306a36Sopenharmony_ci POWER_SUPPLY_PROP_STATUS, 61562306a36Sopenharmony_ci POWER_SUPPLY_PROP_PRESENT, 61662306a36Sopenharmony_ci POWER_SUPPLY_PROP_TECHNOLOGY, 61762306a36Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_NOW, 61862306a36Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, 61962306a36Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, 62062306a36Sopenharmony_ci POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE, 62162306a36Sopenharmony_ci POWER_SUPPLY_PROP_CURRENT_AVG, 62262306a36Sopenharmony_ci POWER_SUPPLY_PROP_CURRENT_NOW, 62362306a36Sopenharmony_ci POWER_SUPPLY_PROP_CHARGE_FULL, 62462306a36Sopenharmony_ci POWER_SUPPLY_PROP_CHARGE_NOW, 62562306a36Sopenharmony_ci POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, 62662306a36Sopenharmony_ci POWER_SUPPLY_PROP_CHARGE_COUNTER, 62762306a36Sopenharmony_ci POWER_SUPPLY_PROP_POWER_NOW, 62862306a36Sopenharmony_ci POWER_SUPPLY_PROP_POWER_AVG, 62962306a36Sopenharmony_ci POWER_SUPPLY_PROP_CAPACITY, 63062306a36Sopenharmony_ci POWER_SUPPLY_PROP_CAPACITY_LEVEL, 63162306a36Sopenharmony_ci POWER_SUPPLY_PROP_SCOPE, 63262306a36Sopenharmony_ci POWER_SUPPLY_PROP_TEMP, 63362306a36Sopenharmony_ci}; 63462306a36Sopenharmony_ci 63562306a36Sopenharmony_cistatic int cpcap_battery_get_property(struct power_supply *psy, 63662306a36Sopenharmony_ci enum power_supply_property psp, 63762306a36Sopenharmony_ci union power_supply_propval *val) 63862306a36Sopenharmony_ci{ 63962306a36Sopenharmony_ci struct cpcap_battery_ddata *ddata = power_supply_get_drvdata(psy); 64062306a36Sopenharmony_ci struct cpcap_battery_state_data *latest, *previous, *empty; 64162306a36Sopenharmony_ci u32 sample; 64262306a36Sopenharmony_ci s32 accumulator; 64362306a36Sopenharmony_ci int cached; 64462306a36Sopenharmony_ci s64 tmp; 64562306a36Sopenharmony_ci 64662306a36Sopenharmony_ci cached = cpcap_battery_update_status(ddata); 64762306a36Sopenharmony_ci if (cached < 0) 64862306a36Sopenharmony_ci return cached; 64962306a36Sopenharmony_ci 65062306a36Sopenharmony_ci latest = cpcap_battery_latest(ddata); 65162306a36Sopenharmony_ci previous = cpcap_battery_previous(ddata); 65262306a36Sopenharmony_ci 65362306a36Sopenharmony_ci if (ddata->check_nvmem) 65462306a36Sopenharmony_ci cpcap_battery_detect_battery_type(ddata); 65562306a36Sopenharmony_ci 65662306a36Sopenharmony_ci switch (psp) { 65762306a36Sopenharmony_ci case POWER_SUPPLY_PROP_PRESENT: 65862306a36Sopenharmony_ci if (latest->temperature > CPCAP_NO_BATTERY || ignore_temperature_probe) 65962306a36Sopenharmony_ci val->intval = 1; 66062306a36Sopenharmony_ci else 66162306a36Sopenharmony_ci val->intval = 0; 66262306a36Sopenharmony_ci break; 66362306a36Sopenharmony_ci case POWER_SUPPLY_PROP_STATUS: 66462306a36Sopenharmony_ci if (cpcap_battery_full(ddata)) { 66562306a36Sopenharmony_ci val->intval = POWER_SUPPLY_STATUS_FULL; 66662306a36Sopenharmony_ci break; 66762306a36Sopenharmony_ci } 66862306a36Sopenharmony_ci if (cpcap_battery_cc_get_avg_current(ddata) < 0) 66962306a36Sopenharmony_ci val->intval = POWER_SUPPLY_STATUS_CHARGING; 67062306a36Sopenharmony_ci else 67162306a36Sopenharmony_ci val->intval = POWER_SUPPLY_STATUS_DISCHARGING; 67262306a36Sopenharmony_ci break; 67362306a36Sopenharmony_ci case POWER_SUPPLY_PROP_TECHNOLOGY: 67462306a36Sopenharmony_ci val->intval = ddata->config.info.technology; 67562306a36Sopenharmony_ci break; 67662306a36Sopenharmony_ci case POWER_SUPPLY_PROP_VOLTAGE_NOW: 67762306a36Sopenharmony_ci val->intval = cpcap_battery_get_voltage(ddata); 67862306a36Sopenharmony_ci break; 67962306a36Sopenharmony_ci case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: 68062306a36Sopenharmony_ci val->intval = ddata->config.info.voltage_max_design; 68162306a36Sopenharmony_ci break; 68262306a36Sopenharmony_ci case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: 68362306a36Sopenharmony_ci val->intval = ddata->config.info.voltage_min_design; 68462306a36Sopenharmony_ci break; 68562306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE: 68662306a36Sopenharmony_ci val->intval = ddata->config.bat.constant_charge_voltage_max_uv; 68762306a36Sopenharmony_ci break; 68862306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CURRENT_AVG: 68962306a36Sopenharmony_ci sample = latest->cc.sample - previous->cc.sample; 69062306a36Sopenharmony_ci if (!sample) { 69162306a36Sopenharmony_ci val->intval = cpcap_battery_cc_get_avg_current(ddata); 69262306a36Sopenharmony_ci break; 69362306a36Sopenharmony_ci } 69462306a36Sopenharmony_ci accumulator = latest->cc.accumulator - previous->cc.accumulator; 69562306a36Sopenharmony_ci val->intval = cpcap_battery_cc_to_ua(ddata, sample, 69662306a36Sopenharmony_ci accumulator, 69762306a36Sopenharmony_ci latest->cc.offset); 69862306a36Sopenharmony_ci break; 69962306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CURRENT_NOW: 70062306a36Sopenharmony_ci val->intval = latest->current_ua; 70162306a36Sopenharmony_ci break; 70262306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_COUNTER: 70362306a36Sopenharmony_ci val->intval = latest->counter_uah; 70462306a36Sopenharmony_ci break; 70562306a36Sopenharmony_ci case POWER_SUPPLY_PROP_POWER_NOW: 70662306a36Sopenharmony_ci tmp = (latest->voltage / 10000) * latest->current_ua; 70762306a36Sopenharmony_ci val->intval = div64_s64(tmp, 100); 70862306a36Sopenharmony_ci break; 70962306a36Sopenharmony_ci case POWER_SUPPLY_PROP_POWER_AVG: 71062306a36Sopenharmony_ci sample = latest->cc.sample - previous->cc.sample; 71162306a36Sopenharmony_ci if (!sample) { 71262306a36Sopenharmony_ci tmp = cpcap_battery_cc_get_avg_current(ddata); 71362306a36Sopenharmony_ci tmp *= (latest->voltage / 10000); 71462306a36Sopenharmony_ci val->intval = div64_s64(tmp, 100); 71562306a36Sopenharmony_ci break; 71662306a36Sopenharmony_ci } 71762306a36Sopenharmony_ci accumulator = latest->cc.accumulator - previous->cc.accumulator; 71862306a36Sopenharmony_ci tmp = cpcap_battery_cc_to_ua(ddata, sample, accumulator, 71962306a36Sopenharmony_ci latest->cc.offset); 72062306a36Sopenharmony_ci tmp *= ((latest->voltage + previous->voltage) / 20000); 72162306a36Sopenharmony_ci val->intval = div64_s64(tmp, 100); 72262306a36Sopenharmony_ci break; 72362306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CAPACITY: 72462306a36Sopenharmony_ci empty = cpcap_battery_get_empty(ddata); 72562306a36Sopenharmony_ci if (!empty->voltage || !ddata->charge_full) 72662306a36Sopenharmony_ci return -ENODATA; 72762306a36Sopenharmony_ci /* (ddata->charge_full / 200) is needed for rounding */ 72862306a36Sopenharmony_ci val->intval = empty->counter_uah - latest->counter_uah + 72962306a36Sopenharmony_ci ddata->charge_full / 200; 73062306a36Sopenharmony_ci val->intval = clamp(val->intval, 0, ddata->charge_full); 73162306a36Sopenharmony_ci val->intval = val->intval * 100 / ddata->charge_full; 73262306a36Sopenharmony_ci break; 73362306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CAPACITY_LEVEL: 73462306a36Sopenharmony_ci if (cpcap_battery_full(ddata)) 73562306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CAPACITY_LEVEL_FULL; 73662306a36Sopenharmony_ci else if (latest->voltage >= 3750000) 73762306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CAPACITY_LEVEL_HIGH; 73862306a36Sopenharmony_ci else if (latest->voltage >= 3300000) 73962306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL; 74062306a36Sopenharmony_ci else if (latest->voltage > 3100000) 74162306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CAPACITY_LEVEL_LOW; 74262306a36Sopenharmony_ci else if (latest->voltage <= 3100000) 74362306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL; 74462306a36Sopenharmony_ci else 74562306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN; 74662306a36Sopenharmony_ci break; 74762306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_NOW: 74862306a36Sopenharmony_ci empty = cpcap_battery_get_empty(ddata); 74962306a36Sopenharmony_ci if (!empty->voltage) 75062306a36Sopenharmony_ci return -ENODATA; 75162306a36Sopenharmony_ci val->intval = empty->counter_uah - latest->counter_uah; 75262306a36Sopenharmony_ci if (val->intval < 0) { 75362306a36Sopenharmony_ci /* Assume invalid config if CHARGE_NOW is -20% */ 75462306a36Sopenharmony_ci if (ddata->charge_full && abs(val->intval) > ddata->charge_full/5) { 75562306a36Sopenharmony_ci empty->voltage = 0; 75662306a36Sopenharmony_ci ddata->charge_full = 0; 75762306a36Sopenharmony_ci return -ENODATA; 75862306a36Sopenharmony_ci } 75962306a36Sopenharmony_ci val->intval = 0; 76062306a36Sopenharmony_ci } else if (ddata->charge_full && ddata->charge_full < val->intval) { 76162306a36Sopenharmony_ci /* Assume invalid config if CHARGE_NOW exceeds CHARGE_FULL by 20% */ 76262306a36Sopenharmony_ci if (val->intval > (6*ddata->charge_full)/5) { 76362306a36Sopenharmony_ci empty->voltage = 0; 76462306a36Sopenharmony_ci ddata->charge_full = 0; 76562306a36Sopenharmony_ci return -ENODATA; 76662306a36Sopenharmony_ci } 76762306a36Sopenharmony_ci val->intval = ddata->charge_full; 76862306a36Sopenharmony_ci } 76962306a36Sopenharmony_ci break; 77062306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_FULL: 77162306a36Sopenharmony_ci if (!ddata->charge_full) 77262306a36Sopenharmony_ci return -ENODATA; 77362306a36Sopenharmony_ci val->intval = ddata->charge_full; 77462306a36Sopenharmony_ci break; 77562306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: 77662306a36Sopenharmony_ci val->intval = ddata->config.info.charge_full_design; 77762306a36Sopenharmony_ci break; 77862306a36Sopenharmony_ci case POWER_SUPPLY_PROP_SCOPE: 77962306a36Sopenharmony_ci val->intval = POWER_SUPPLY_SCOPE_SYSTEM; 78062306a36Sopenharmony_ci break; 78162306a36Sopenharmony_ci case POWER_SUPPLY_PROP_TEMP: 78262306a36Sopenharmony_ci if (ignore_temperature_probe) 78362306a36Sopenharmony_ci return -ENODATA; 78462306a36Sopenharmony_ci val->intval = latest->temperature; 78562306a36Sopenharmony_ci break; 78662306a36Sopenharmony_ci default: 78762306a36Sopenharmony_ci return -EINVAL; 78862306a36Sopenharmony_ci } 78962306a36Sopenharmony_ci 79062306a36Sopenharmony_ci return 0; 79162306a36Sopenharmony_ci} 79262306a36Sopenharmony_ci 79362306a36Sopenharmony_cistatic int cpcap_battery_update_charger(struct cpcap_battery_ddata *ddata, 79462306a36Sopenharmony_ci int const_charge_voltage) 79562306a36Sopenharmony_ci{ 79662306a36Sopenharmony_ci union power_supply_propval prop; 79762306a36Sopenharmony_ci union power_supply_propval val; 79862306a36Sopenharmony_ci struct power_supply *charger; 79962306a36Sopenharmony_ci int error; 80062306a36Sopenharmony_ci 80162306a36Sopenharmony_ci charger = power_supply_get_by_name("usb"); 80262306a36Sopenharmony_ci if (!charger) 80362306a36Sopenharmony_ci return -ENODEV; 80462306a36Sopenharmony_ci 80562306a36Sopenharmony_ci error = power_supply_get_property(charger, 80662306a36Sopenharmony_ci POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE, 80762306a36Sopenharmony_ci &prop); 80862306a36Sopenharmony_ci if (error) 80962306a36Sopenharmony_ci goto out_put; 81062306a36Sopenharmony_ci 81162306a36Sopenharmony_ci /* Allow charger const voltage lower than battery const voltage */ 81262306a36Sopenharmony_ci if (const_charge_voltage > prop.intval) 81362306a36Sopenharmony_ci goto out_put; 81462306a36Sopenharmony_ci 81562306a36Sopenharmony_ci val.intval = const_charge_voltage; 81662306a36Sopenharmony_ci 81762306a36Sopenharmony_ci error = power_supply_set_property(charger, 81862306a36Sopenharmony_ci POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE, 81962306a36Sopenharmony_ci &val); 82062306a36Sopenharmony_ciout_put: 82162306a36Sopenharmony_ci power_supply_put(charger); 82262306a36Sopenharmony_ci 82362306a36Sopenharmony_ci return error; 82462306a36Sopenharmony_ci} 82562306a36Sopenharmony_ci 82662306a36Sopenharmony_cistatic int cpcap_battery_set_property(struct power_supply *psy, 82762306a36Sopenharmony_ci enum power_supply_property psp, 82862306a36Sopenharmony_ci const union power_supply_propval *val) 82962306a36Sopenharmony_ci{ 83062306a36Sopenharmony_ci struct cpcap_battery_ddata *ddata = power_supply_get_drvdata(psy); 83162306a36Sopenharmony_ci 83262306a36Sopenharmony_ci switch (psp) { 83362306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE: 83462306a36Sopenharmony_ci if (val->intval < ddata->config.info.voltage_min_design) 83562306a36Sopenharmony_ci return -EINVAL; 83662306a36Sopenharmony_ci if (val->intval > ddata->config.info.voltage_max_design) 83762306a36Sopenharmony_ci return -EINVAL; 83862306a36Sopenharmony_ci 83962306a36Sopenharmony_ci ddata->config.bat.constant_charge_voltage_max_uv = val->intval; 84062306a36Sopenharmony_ci 84162306a36Sopenharmony_ci return cpcap_battery_update_charger(ddata, val->intval); 84262306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_FULL: 84362306a36Sopenharmony_ci if (val->intval < 0) 84462306a36Sopenharmony_ci return -EINVAL; 84562306a36Sopenharmony_ci if (val->intval > (6*ddata->config.info.charge_full_design)/5) 84662306a36Sopenharmony_ci return -EINVAL; 84762306a36Sopenharmony_ci 84862306a36Sopenharmony_ci ddata->charge_full = val->intval; 84962306a36Sopenharmony_ci 85062306a36Sopenharmony_ci return 0; 85162306a36Sopenharmony_ci default: 85262306a36Sopenharmony_ci return -EINVAL; 85362306a36Sopenharmony_ci } 85462306a36Sopenharmony_ci 85562306a36Sopenharmony_ci return 0; 85662306a36Sopenharmony_ci} 85762306a36Sopenharmony_ci 85862306a36Sopenharmony_cistatic int cpcap_battery_property_is_writeable(struct power_supply *psy, 85962306a36Sopenharmony_ci enum power_supply_property psp) 86062306a36Sopenharmony_ci{ 86162306a36Sopenharmony_ci switch (psp) { 86262306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE: 86362306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_FULL: 86462306a36Sopenharmony_ci return 1; 86562306a36Sopenharmony_ci default: 86662306a36Sopenharmony_ci return 0; 86762306a36Sopenharmony_ci } 86862306a36Sopenharmony_ci} 86962306a36Sopenharmony_ci 87062306a36Sopenharmony_cistatic irqreturn_t cpcap_battery_irq_thread(int irq, void *data) 87162306a36Sopenharmony_ci{ 87262306a36Sopenharmony_ci struct cpcap_battery_ddata *ddata = data; 87362306a36Sopenharmony_ci struct cpcap_battery_state_data *latest; 87462306a36Sopenharmony_ci struct cpcap_interrupt_desc *d; 87562306a36Sopenharmony_ci 87662306a36Sopenharmony_ci if (!atomic_read(&ddata->active)) 87762306a36Sopenharmony_ci return IRQ_NONE; 87862306a36Sopenharmony_ci 87962306a36Sopenharmony_ci list_for_each_entry(d, &ddata->irq_list, node) { 88062306a36Sopenharmony_ci if (irq == d->irq) 88162306a36Sopenharmony_ci break; 88262306a36Sopenharmony_ci } 88362306a36Sopenharmony_ci 88462306a36Sopenharmony_ci if (list_entry_is_head(d, &ddata->irq_list, node)) 88562306a36Sopenharmony_ci return IRQ_NONE; 88662306a36Sopenharmony_ci 88762306a36Sopenharmony_ci latest = cpcap_battery_latest(ddata); 88862306a36Sopenharmony_ci 88962306a36Sopenharmony_ci switch (d->action) { 89062306a36Sopenharmony_ci case CPCAP_BATTERY_IRQ_ACTION_CC_CAL_DONE: 89162306a36Sopenharmony_ci dev_info(ddata->dev, "Coulomb counter calibration done\n"); 89262306a36Sopenharmony_ci break; 89362306a36Sopenharmony_ci case CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW: 89462306a36Sopenharmony_ci if (latest->current_ua >= 0) 89562306a36Sopenharmony_ci dev_warn(ddata->dev, "Battery low at %imV!\n", 89662306a36Sopenharmony_ci latest->voltage / 1000); 89762306a36Sopenharmony_ci break; 89862306a36Sopenharmony_ci case CPCAP_BATTERY_IRQ_ACTION_POWEROFF: 89962306a36Sopenharmony_ci if (latest->current_ua >= 0 && latest->voltage <= 3200000) { 90062306a36Sopenharmony_ci dev_emerg(ddata->dev, 90162306a36Sopenharmony_ci "Battery empty at %imV, powering off\n", 90262306a36Sopenharmony_ci latest->voltage / 1000); 90362306a36Sopenharmony_ci orderly_poweroff(true); 90462306a36Sopenharmony_ci } 90562306a36Sopenharmony_ci break; 90662306a36Sopenharmony_ci default: 90762306a36Sopenharmony_ci break; 90862306a36Sopenharmony_ci } 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci power_supply_changed(ddata->psy); 91162306a36Sopenharmony_ci 91262306a36Sopenharmony_ci return IRQ_HANDLED; 91362306a36Sopenharmony_ci} 91462306a36Sopenharmony_ci 91562306a36Sopenharmony_cistatic int cpcap_battery_init_irq(struct platform_device *pdev, 91662306a36Sopenharmony_ci struct cpcap_battery_ddata *ddata, 91762306a36Sopenharmony_ci const char *name) 91862306a36Sopenharmony_ci{ 91962306a36Sopenharmony_ci struct cpcap_interrupt_desc *d; 92062306a36Sopenharmony_ci int irq, error; 92162306a36Sopenharmony_ci 92262306a36Sopenharmony_ci irq = platform_get_irq_byname(pdev, name); 92362306a36Sopenharmony_ci if (irq < 0) 92462306a36Sopenharmony_ci return irq; 92562306a36Sopenharmony_ci 92662306a36Sopenharmony_ci error = devm_request_threaded_irq(ddata->dev, irq, NULL, 92762306a36Sopenharmony_ci cpcap_battery_irq_thread, 92862306a36Sopenharmony_ci IRQF_SHARED | IRQF_ONESHOT, 92962306a36Sopenharmony_ci name, ddata); 93062306a36Sopenharmony_ci if (error) { 93162306a36Sopenharmony_ci dev_err(ddata->dev, "could not get irq %s: %i\n", 93262306a36Sopenharmony_ci name, error); 93362306a36Sopenharmony_ci 93462306a36Sopenharmony_ci return error; 93562306a36Sopenharmony_ci } 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_ci d = devm_kzalloc(ddata->dev, sizeof(*d), GFP_KERNEL); 93862306a36Sopenharmony_ci if (!d) 93962306a36Sopenharmony_ci return -ENOMEM; 94062306a36Sopenharmony_ci 94162306a36Sopenharmony_ci d->name = name; 94262306a36Sopenharmony_ci d->irq = irq; 94362306a36Sopenharmony_ci 94462306a36Sopenharmony_ci if (!strncmp(name, "cccal", 5)) 94562306a36Sopenharmony_ci d->action = CPCAP_BATTERY_IRQ_ACTION_CC_CAL_DONE; 94662306a36Sopenharmony_ci else if (!strncmp(name, "lowbph", 6)) 94762306a36Sopenharmony_ci d->action = CPCAP_BATTERY_IRQ_ACTION_BATTERY_LOW; 94862306a36Sopenharmony_ci else if (!strncmp(name, "lowbpl", 6)) 94962306a36Sopenharmony_ci d->action = CPCAP_BATTERY_IRQ_ACTION_POWEROFF; 95062306a36Sopenharmony_ci 95162306a36Sopenharmony_ci list_add(&d->node, &ddata->irq_list); 95262306a36Sopenharmony_ci 95362306a36Sopenharmony_ci return 0; 95462306a36Sopenharmony_ci} 95562306a36Sopenharmony_ci 95662306a36Sopenharmony_cistatic int cpcap_battery_init_interrupts(struct platform_device *pdev, 95762306a36Sopenharmony_ci struct cpcap_battery_ddata *ddata) 95862306a36Sopenharmony_ci{ 95962306a36Sopenharmony_ci static const char * const cpcap_battery_irqs[] = { 96062306a36Sopenharmony_ci "eol", "lowbph", "lowbpl", 96162306a36Sopenharmony_ci "chrgcurr1", "battdetb" 96262306a36Sopenharmony_ci }; 96362306a36Sopenharmony_ci int i, error; 96462306a36Sopenharmony_ci 96562306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(cpcap_battery_irqs); i++) { 96662306a36Sopenharmony_ci error = cpcap_battery_init_irq(pdev, ddata, 96762306a36Sopenharmony_ci cpcap_battery_irqs[i]); 96862306a36Sopenharmony_ci if (error) 96962306a36Sopenharmony_ci return error; 97062306a36Sopenharmony_ci } 97162306a36Sopenharmony_ci 97262306a36Sopenharmony_ci /* Enable calibration interrupt if already available in dts */ 97362306a36Sopenharmony_ci cpcap_battery_init_irq(pdev, ddata, "cccal"); 97462306a36Sopenharmony_ci 97562306a36Sopenharmony_ci /* Enable low battery interrupts for 3.3V high and 3.1V low */ 97662306a36Sopenharmony_ci error = regmap_update_bits(ddata->reg, CPCAP_REG_BPEOL, 97762306a36Sopenharmony_ci 0xffff, 97862306a36Sopenharmony_ci CPCAP_REG_BPEOL_BIT_BATTDETEN); 97962306a36Sopenharmony_ci if (error) 98062306a36Sopenharmony_ci return error; 98162306a36Sopenharmony_ci 98262306a36Sopenharmony_ci return 0; 98362306a36Sopenharmony_ci} 98462306a36Sopenharmony_ci 98562306a36Sopenharmony_cistatic int cpcap_battery_init_iio(struct cpcap_battery_ddata *ddata) 98662306a36Sopenharmony_ci{ 98762306a36Sopenharmony_ci const char * const names[CPCAP_BATTERY_IIO_NR] = { 98862306a36Sopenharmony_ci "battdetb", "battp", "chg_isense", "batti", 98962306a36Sopenharmony_ci }; 99062306a36Sopenharmony_ci int error, i; 99162306a36Sopenharmony_ci 99262306a36Sopenharmony_ci for (i = 0; i < CPCAP_BATTERY_IIO_NR; i++) { 99362306a36Sopenharmony_ci ddata->channels[i] = devm_iio_channel_get(ddata->dev, 99462306a36Sopenharmony_ci names[i]); 99562306a36Sopenharmony_ci if (IS_ERR(ddata->channels[i])) { 99662306a36Sopenharmony_ci error = PTR_ERR(ddata->channels[i]); 99762306a36Sopenharmony_ci goto out_err; 99862306a36Sopenharmony_ci } 99962306a36Sopenharmony_ci 100062306a36Sopenharmony_ci if (!ddata->channels[i]->indio_dev) { 100162306a36Sopenharmony_ci error = -ENXIO; 100262306a36Sopenharmony_ci goto out_err; 100362306a36Sopenharmony_ci } 100462306a36Sopenharmony_ci } 100562306a36Sopenharmony_ci 100662306a36Sopenharmony_ci return 0; 100762306a36Sopenharmony_ci 100862306a36Sopenharmony_ciout_err: 100962306a36Sopenharmony_ci return dev_err_probe(ddata->dev, error, 101062306a36Sopenharmony_ci "could not initialize VBUS or ID IIO\n"); 101162306a36Sopenharmony_ci} 101262306a36Sopenharmony_ci 101362306a36Sopenharmony_ci/* Calibrate coulomb counter */ 101462306a36Sopenharmony_cistatic int cpcap_battery_calibrate(struct cpcap_battery_ddata *ddata) 101562306a36Sopenharmony_ci{ 101662306a36Sopenharmony_ci int error, ccc1, value; 101762306a36Sopenharmony_ci unsigned long timeout; 101862306a36Sopenharmony_ci 101962306a36Sopenharmony_ci error = regmap_read(ddata->reg, CPCAP_REG_CCC1, &ccc1); 102062306a36Sopenharmony_ci if (error) 102162306a36Sopenharmony_ci return error; 102262306a36Sopenharmony_ci 102362306a36Sopenharmony_ci timeout = jiffies + msecs_to_jiffies(6000); 102462306a36Sopenharmony_ci 102562306a36Sopenharmony_ci /* Start calibration */ 102662306a36Sopenharmony_ci error = regmap_update_bits(ddata->reg, CPCAP_REG_CCC1, 102762306a36Sopenharmony_ci 0xffff, 102862306a36Sopenharmony_ci CPCAP_REG_CCC1_CAL_EN); 102962306a36Sopenharmony_ci if (error) 103062306a36Sopenharmony_ci goto restore; 103162306a36Sopenharmony_ci 103262306a36Sopenharmony_ci while (time_before(jiffies, timeout)) { 103362306a36Sopenharmony_ci error = regmap_read(ddata->reg, CPCAP_REG_CCC1, &value); 103462306a36Sopenharmony_ci if (error) 103562306a36Sopenharmony_ci goto restore; 103662306a36Sopenharmony_ci 103762306a36Sopenharmony_ci if (!(value & CPCAP_REG_CCC1_CAL_EN)) 103862306a36Sopenharmony_ci break; 103962306a36Sopenharmony_ci 104062306a36Sopenharmony_ci error = regmap_read(ddata->reg, CPCAP_REG_CCM, &value); 104162306a36Sopenharmony_ci if (error) 104262306a36Sopenharmony_ci goto restore; 104362306a36Sopenharmony_ci 104462306a36Sopenharmony_ci msleep(300); 104562306a36Sopenharmony_ci } 104662306a36Sopenharmony_ci 104762306a36Sopenharmony_ci /* Read calibration offset from CCM */ 104862306a36Sopenharmony_ci error = regmap_read(ddata->reg, CPCAP_REG_CCM, &value); 104962306a36Sopenharmony_ci if (error) 105062306a36Sopenharmony_ci goto restore; 105162306a36Sopenharmony_ci 105262306a36Sopenharmony_ci dev_info(ddata->dev, "calibration done: 0x%04x\n", value); 105362306a36Sopenharmony_ci 105462306a36Sopenharmony_cirestore: 105562306a36Sopenharmony_ci if (error) 105662306a36Sopenharmony_ci dev_err(ddata->dev, "%s: error %i\n", __func__, error); 105762306a36Sopenharmony_ci 105862306a36Sopenharmony_ci error = regmap_update_bits(ddata->reg, CPCAP_REG_CCC1, 105962306a36Sopenharmony_ci 0xffff, ccc1); 106062306a36Sopenharmony_ci if (error) 106162306a36Sopenharmony_ci dev_err(ddata->dev, "%s: restore error %i\n", 106262306a36Sopenharmony_ci __func__, error); 106362306a36Sopenharmony_ci 106462306a36Sopenharmony_ci return error; 106562306a36Sopenharmony_ci} 106662306a36Sopenharmony_ci 106762306a36Sopenharmony_ci#ifdef CONFIG_OF 106862306a36Sopenharmony_cistatic const struct of_device_id cpcap_battery_id_table[] = { 106962306a36Sopenharmony_ci { 107062306a36Sopenharmony_ci .compatible = "motorola,cpcap-battery", 107162306a36Sopenharmony_ci }, 107262306a36Sopenharmony_ci {}, 107362306a36Sopenharmony_ci}; 107462306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, cpcap_battery_id_table); 107562306a36Sopenharmony_ci#endif 107662306a36Sopenharmony_ci 107762306a36Sopenharmony_cistatic const struct power_supply_desc cpcap_charger_battery_desc = { 107862306a36Sopenharmony_ci .name = "battery", 107962306a36Sopenharmony_ci .type = POWER_SUPPLY_TYPE_BATTERY, 108062306a36Sopenharmony_ci .properties = cpcap_battery_props, 108162306a36Sopenharmony_ci .num_properties = ARRAY_SIZE(cpcap_battery_props), 108262306a36Sopenharmony_ci .get_property = cpcap_battery_get_property, 108362306a36Sopenharmony_ci .set_property = cpcap_battery_set_property, 108462306a36Sopenharmony_ci .property_is_writeable = cpcap_battery_property_is_writeable, 108562306a36Sopenharmony_ci .external_power_changed = cpcap_battery_external_power_changed, 108662306a36Sopenharmony_ci}; 108762306a36Sopenharmony_ci 108862306a36Sopenharmony_cistatic int cpcap_battery_probe(struct platform_device *pdev) 108962306a36Sopenharmony_ci{ 109062306a36Sopenharmony_ci struct cpcap_battery_ddata *ddata; 109162306a36Sopenharmony_ci struct power_supply_config psy_cfg = {}; 109262306a36Sopenharmony_ci int error; 109362306a36Sopenharmony_ci 109462306a36Sopenharmony_ci ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL); 109562306a36Sopenharmony_ci if (!ddata) 109662306a36Sopenharmony_ci return -ENOMEM; 109762306a36Sopenharmony_ci 109862306a36Sopenharmony_ci cpcap_battery_detect_battery_type(ddata); 109962306a36Sopenharmony_ci 110062306a36Sopenharmony_ci INIT_LIST_HEAD(&ddata->irq_list); 110162306a36Sopenharmony_ci ddata->dev = &pdev->dev; 110262306a36Sopenharmony_ci 110362306a36Sopenharmony_ci ddata->reg = dev_get_regmap(ddata->dev->parent, NULL); 110462306a36Sopenharmony_ci if (!ddata->reg) 110562306a36Sopenharmony_ci return -ENODEV; 110662306a36Sopenharmony_ci 110762306a36Sopenharmony_ci error = cpcap_get_vendor(ddata->dev, ddata->reg, &ddata->vendor); 110862306a36Sopenharmony_ci if (error) 110962306a36Sopenharmony_ci return error; 111062306a36Sopenharmony_ci 111162306a36Sopenharmony_ci switch (ddata->vendor) { 111262306a36Sopenharmony_ci case CPCAP_VENDOR_ST: 111362306a36Sopenharmony_ci ddata->cc_lsb = 95374; /* μAms per LSB */ 111462306a36Sopenharmony_ci break; 111562306a36Sopenharmony_ci case CPCAP_VENDOR_TI: 111662306a36Sopenharmony_ci ddata->cc_lsb = 91501; /* μAms per LSB */ 111762306a36Sopenharmony_ci break; 111862306a36Sopenharmony_ci default: 111962306a36Sopenharmony_ci return -EINVAL; 112062306a36Sopenharmony_ci } 112162306a36Sopenharmony_ci ddata->cc_lsb = (ddata->cc_lsb * ddata->config.cd_factor) / 1000; 112262306a36Sopenharmony_ci 112362306a36Sopenharmony_ci platform_set_drvdata(pdev, ddata); 112462306a36Sopenharmony_ci 112562306a36Sopenharmony_ci error = cpcap_battery_init_interrupts(pdev, ddata); 112662306a36Sopenharmony_ci if (error) 112762306a36Sopenharmony_ci return error; 112862306a36Sopenharmony_ci 112962306a36Sopenharmony_ci error = cpcap_battery_init_iio(ddata); 113062306a36Sopenharmony_ci if (error) 113162306a36Sopenharmony_ci return error; 113262306a36Sopenharmony_ci 113362306a36Sopenharmony_ci psy_cfg.of_node = pdev->dev.of_node; 113462306a36Sopenharmony_ci psy_cfg.drv_data = ddata; 113562306a36Sopenharmony_ci 113662306a36Sopenharmony_ci ddata->psy = devm_power_supply_register(ddata->dev, 113762306a36Sopenharmony_ci &cpcap_charger_battery_desc, 113862306a36Sopenharmony_ci &psy_cfg); 113962306a36Sopenharmony_ci error = PTR_ERR_OR_ZERO(ddata->psy); 114062306a36Sopenharmony_ci if (error) { 114162306a36Sopenharmony_ci dev_err(ddata->dev, "failed to register power supply\n"); 114262306a36Sopenharmony_ci return error; 114362306a36Sopenharmony_ci } 114462306a36Sopenharmony_ci 114562306a36Sopenharmony_ci atomic_set(&ddata->active, 1); 114662306a36Sopenharmony_ci 114762306a36Sopenharmony_ci error = cpcap_battery_calibrate(ddata); 114862306a36Sopenharmony_ci if (error) 114962306a36Sopenharmony_ci return error; 115062306a36Sopenharmony_ci 115162306a36Sopenharmony_ci return 0; 115262306a36Sopenharmony_ci} 115362306a36Sopenharmony_ci 115462306a36Sopenharmony_cistatic int cpcap_battery_remove(struct platform_device *pdev) 115562306a36Sopenharmony_ci{ 115662306a36Sopenharmony_ci struct cpcap_battery_ddata *ddata = platform_get_drvdata(pdev); 115762306a36Sopenharmony_ci int error; 115862306a36Sopenharmony_ci 115962306a36Sopenharmony_ci atomic_set(&ddata->active, 0); 116062306a36Sopenharmony_ci error = regmap_update_bits(ddata->reg, CPCAP_REG_BPEOL, 116162306a36Sopenharmony_ci 0xffff, 0); 116262306a36Sopenharmony_ci if (error) 116362306a36Sopenharmony_ci dev_err(&pdev->dev, "could not disable: %i\n", error); 116462306a36Sopenharmony_ci 116562306a36Sopenharmony_ci return 0; 116662306a36Sopenharmony_ci} 116762306a36Sopenharmony_ci 116862306a36Sopenharmony_cistatic struct platform_driver cpcap_battery_driver = { 116962306a36Sopenharmony_ci .driver = { 117062306a36Sopenharmony_ci .name = "cpcap_battery", 117162306a36Sopenharmony_ci .of_match_table = of_match_ptr(cpcap_battery_id_table), 117262306a36Sopenharmony_ci }, 117362306a36Sopenharmony_ci .probe = cpcap_battery_probe, 117462306a36Sopenharmony_ci .remove = cpcap_battery_remove, 117562306a36Sopenharmony_ci}; 117662306a36Sopenharmony_cimodule_platform_driver(cpcap_battery_driver); 117762306a36Sopenharmony_ci 117862306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 117962306a36Sopenharmony_ciMODULE_AUTHOR("Tony Lindgren <tony@atomide.com>"); 118062306a36Sopenharmony_ciMODULE_DESCRIPTION("CPCAP PMIC Battery Driver"); 1181