3256 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright (C) ST-Ericsson AB 20124 *5 * Main and Back-up battery management driver.6 *7 * Note: Backup battery management is required in case of Li-Ion battery and not8 * for capacitive battery. HREF boards have capacitive battery and hence backup9 * battery management is not used and the supported code is available in this10 * driver.11 *12 * Author:13 * Johan Palsson <johan.palsson@stericsson.com>14 * Karl Komierowski <karl.komierowski@stericsson.com>15 * Arun R Murthy <arun.murthy@stericsson.com>16 */17 18#include <linux/init.h>19#include <linux/module.h>20#include <linux/component.h>21#include <linux/device.h>22#include <linux/interrupt.h>23#include <linux/platform_device.h>24#include <linux/power_supply.h>25#include <linux/kobject.h>26#include <linux/slab.h>27#include <linux/delay.h>28#include <linux/time.h>29#include <linux/time64.h>30#include <linux/of.h>31#include <linux/completion.h>32#include <linux/mfd/core.h>33#include <linux/mfd/abx500.h>34#include <linux/mfd/abx500/ab8500.h>35#include <linux/iio/consumer.h>36#include <linux/kernel.h>37#include <linux/fixp-arith.h>38 39#include "ab8500-bm.h"40 41#define FG_LSB_IN_MA 162742#define QLSB_NANO_AMP_HOURS_X10 107143#define INS_CURR_TIMEOUT (3 * HZ)44 45#define SEC_TO_SAMPLE(S) (S * 4)46 47#define NBR_AVG_SAMPLES 2048#define WAIT_FOR_INST_CURRENT_MAX 7049/* Currents higher than -500mA (dissipating) will make compensation unstable */50#define IGNORE_VBAT_HIGHCUR -50000051 52#define LOW_BAT_CHECK_INTERVAL (HZ / 16) /* 62.5 ms */53 54#define VALID_CAPACITY_SEC (45 * 60) /* 45 minutes */55#define BATT_OK_MIN 2360 /* mV */56#define BATT_OK_INCREMENT 50 /* mV */57#define BATT_OK_MAX_NR_INCREMENTS 0xE58 59/* FG constants */60#define BATT_OVV 0x0161 62/**63 * struct ab8500_fg_interrupts - ab8500 fg interrupts64 * @name: name of the interrupt65 * @isr function pointer to the isr66 */67struct ab8500_fg_interrupts {68 char *name;69 irqreturn_t (*isr)(int irq, void *data);70};71 72enum ab8500_fg_discharge_state {73 AB8500_FG_DISCHARGE_INIT,74 AB8500_FG_DISCHARGE_INITMEASURING,75 AB8500_FG_DISCHARGE_INIT_RECOVERY,76 AB8500_FG_DISCHARGE_RECOVERY,77 AB8500_FG_DISCHARGE_READOUT_INIT,78 AB8500_FG_DISCHARGE_READOUT,79 AB8500_FG_DISCHARGE_WAKEUP,80};81 82static char *discharge_state[] = {83 "DISCHARGE_INIT",84 "DISCHARGE_INITMEASURING",85 "DISCHARGE_INIT_RECOVERY",86 "DISCHARGE_RECOVERY",87 "DISCHARGE_READOUT_INIT",88 "DISCHARGE_READOUT",89 "DISCHARGE_WAKEUP",90};91 92enum ab8500_fg_charge_state {93 AB8500_FG_CHARGE_INIT,94 AB8500_FG_CHARGE_READOUT,95};96 97static char *charge_state[] = {98 "CHARGE_INIT",99 "CHARGE_READOUT",100};101 102enum ab8500_fg_calibration_state {103 AB8500_FG_CALIB_INIT,104 AB8500_FG_CALIB_WAIT,105 AB8500_FG_CALIB_END,106};107 108struct ab8500_fg_avg_cap {109 int avg;110 int samples[NBR_AVG_SAMPLES];111 time64_t time_stamps[NBR_AVG_SAMPLES];112 int pos;113 int nbr_samples;114 int sum;115};116 117struct ab8500_fg_cap_scaling {118 bool enable;119 int cap_to_scale[2];120 int disable_cap_level;121 int scaled_cap;122};123 124struct ab8500_fg_battery_capacity {125 int max_mah_design;126 int max_mah;127 int mah;128 int permille;129 int level;130 int prev_mah;131 int prev_percent;132 int prev_level;133 int user_mah;134 struct ab8500_fg_cap_scaling cap_scale;135};136 137struct ab8500_fg_flags {138 bool fg_enabled;139 bool conv_done;140 bool charging;141 bool fully_charged;142 bool force_full;143 bool low_bat_delay;144 bool low_bat;145 bool bat_ovv;146 bool batt_unknown;147 bool calibrate;148 bool user_cap;149 bool batt_id_received;150};151 152/**153 * struct ab8500_fg - ab8500 FG device information154 * @dev: Pointer to the structure device155 * @node: a list of AB8500 FGs, hence prepared for reentrance156 * @irq holds the CCEOC interrupt number157 * @vbat_uv: Battery voltage in uV158 * @vbat_nom_uv: Nominal battery voltage in uV159 * @inst_curr_ua: Instantenous battery current in uA160 * @avg_curr_ua: Average battery current in uA161 * @bat_temp battery temperature162 * @fg_samples: Number of samples used in the FG accumulation163 * @accu_charge: Accumulated charge from the last conversion164 * @recovery_cnt: Counter for recovery mode165 * @high_curr_cnt: Counter for high current mode166 * @init_cnt: Counter for init mode167 * @low_bat_cnt Counter for number of consecutive low battery measures168 * @nbr_cceoc_irq_cnt Counter for number of CCEOC irqs received since enabled169 * @recovery_needed: Indicate if recovery is needed170 * @high_curr_mode: Indicate if we're in high current mode171 * @init_capacity: Indicate if initial capacity measuring should be done172 * @turn_off_fg: True if fg was off before current measurement173 * @calib_state State during offset calibration174 * @discharge_state: Current discharge state175 * @charge_state: Current charge state176 * @ab8500_fg_started Completion struct used for the instant current start177 * @ab8500_fg_complete Completion struct used for the instant current reading178 * @flags: Structure for information about events triggered179 * @bat_cap: Structure for battery capacity specific parameters180 * @avg_cap: Average capacity filter181 * @parent: Pointer to the struct ab8500182 * @main_bat_v: ADC channel for the main battery voltage183 * @bm: Platform specific battery management information184 * @fg_psy: Structure that holds the FG specific battery properties185 * @fg_wq: Work queue for running the FG algorithm186 * @fg_periodic_work: Work to run the FG algorithm periodically187 * @fg_low_bat_work: Work to check low bat condition188 * @fg_reinit_work Work used to reset and reinitialise the FG algorithm189 * @fg_work: Work to run the FG algorithm instantly190 * @fg_acc_cur_work: Work to read the FG accumulator191 * @fg_check_hw_failure_work: Work for checking HW state192 * @cc_lock: Mutex for locking the CC193 * @fg_kobject: Structure of type kobject194 */195struct ab8500_fg {196 struct device *dev;197 struct list_head node;198 int irq;199 int vbat_uv;200 int vbat_nom_uv;201 int inst_curr_ua;202 int avg_curr_ua;203 int bat_temp;204 int fg_samples;205 int accu_charge;206 int recovery_cnt;207 int high_curr_cnt;208 int init_cnt;209 int low_bat_cnt;210 int nbr_cceoc_irq_cnt;211 u32 line_impedance_uohm;212 bool recovery_needed;213 bool high_curr_mode;214 bool init_capacity;215 bool turn_off_fg;216 enum ab8500_fg_calibration_state calib_state;217 enum ab8500_fg_discharge_state discharge_state;218 enum ab8500_fg_charge_state charge_state;219 struct completion ab8500_fg_started;220 struct completion ab8500_fg_complete;221 struct ab8500_fg_flags flags;222 struct ab8500_fg_battery_capacity bat_cap;223 struct ab8500_fg_avg_cap avg_cap;224 struct ab8500 *parent;225 struct iio_channel *main_bat_v;226 struct ab8500_bm_data *bm;227 struct power_supply *fg_psy;228 struct workqueue_struct *fg_wq;229 struct delayed_work fg_periodic_work;230 struct delayed_work fg_low_bat_work;231 struct delayed_work fg_reinit_work;232 struct work_struct fg_work;233 struct work_struct fg_acc_cur_work;234 struct delayed_work fg_check_hw_failure_work;235 struct mutex cc_lock;236 struct kobject fg_kobject;237};238static LIST_HEAD(ab8500_fg_list);239 240/**241 * ab8500_fg_get() - returns a reference to the primary AB8500 fuel gauge242 * (i.e. the first fuel gauge in the instance list)243 */244struct ab8500_fg *ab8500_fg_get(void)245{246 return list_first_entry_or_null(&ab8500_fg_list, struct ab8500_fg,247 node);248}249 250/* Main battery properties */251static enum power_supply_property ab8500_fg_props[] = {252 POWER_SUPPLY_PROP_VOLTAGE_NOW,253 POWER_SUPPLY_PROP_CURRENT_NOW,254 POWER_SUPPLY_PROP_CURRENT_AVG,255 POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,256 POWER_SUPPLY_PROP_ENERGY_FULL,257 POWER_SUPPLY_PROP_ENERGY_NOW,258 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,259 POWER_SUPPLY_PROP_CHARGE_FULL,260 POWER_SUPPLY_PROP_CHARGE_NOW,261 POWER_SUPPLY_PROP_CAPACITY,262 POWER_SUPPLY_PROP_CAPACITY_LEVEL,263};264 265/*266 * This array maps the raw hex value to lowbat voltage used by the AB8500267 * Values taken from the UM0836, in microvolts.268 */269static int ab8500_fg_lowbat_voltage_map[] = {270 2300000,271 2325000,272 2350000,273 2375000,274 2400000,275 2425000,276 2450000,277 2475000,278 2500000,279 2525000,280 2550000,281 2575000,282 2600000,283 2625000,284 2650000,285 2675000,286 2700000,287 2725000,288 2750000,289 2775000,290 2800000,291 2825000,292 2850000,293 2875000,294 2900000,295 2925000,296 2950000,297 2975000,298 3000000,299 3025000,300 3050000,301 3075000,302 3100000,303 3125000,304 3150000,305 3175000,306 3200000,307 3225000,308 3250000,309 3275000,310 3300000,311 3325000,312 3350000,313 3375000,314 3400000,315 3425000,316 3450000,317 3475000,318 3500000,319 3525000,320 3550000,321 3575000,322 3600000,323 3625000,324 3650000,325 3675000,326 3700000,327 3725000,328 3750000,329 3775000,330 3800000,331 3825000,332 3850000,333 3850000,334};335 336static u8 ab8500_volt_to_regval(int voltage_uv)337{338 int i;339 340 if (voltage_uv < ab8500_fg_lowbat_voltage_map[0])341 return 0;342 343 for (i = 0; i < ARRAY_SIZE(ab8500_fg_lowbat_voltage_map); i++) {344 if (voltage_uv < ab8500_fg_lowbat_voltage_map[i])345 return (u8) i - 1;346 }347 348 /* If not captured above, return index of last element */349 return (u8) ARRAY_SIZE(ab8500_fg_lowbat_voltage_map) - 1;350}351 352/**353 * ab8500_fg_is_low_curr() - Low or high current mode354 * @di: pointer to the ab8500_fg structure355 * @curr_ua: the current to base or our decision on in microampere356 *357 * Low current mode if the current consumption is below a certain threshold358 */359static int ab8500_fg_is_low_curr(struct ab8500_fg *di, int curr_ua)360{361 /*362 * We want to know if we're in low current mode363 */364 if (curr_ua > -di->bm->fg_params->high_curr_threshold_ua)365 return true;366 else367 return false;368}369 370/**371 * ab8500_fg_add_cap_sample() - Add capacity to average filter372 * @di: pointer to the ab8500_fg structure373 * @sample: the capacity in mAh to add to the filter374 *375 * A capacity is added to the filter and a new mean capacity is calculated and376 * returned377 */378static int ab8500_fg_add_cap_sample(struct ab8500_fg *di, int sample)379{380 time64_t now = ktime_get_boottime_seconds();381 struct ab8500_fg_avg_cap *avg = &di->avg_cap;382 383 do {384 avg->sum += sample - avg->samples[avg->pos];385 avg->samples[avg->pos] = sample;386 avg->time_stamps[avg->pos] = now;387 avg->pos++;388 389 if (avg->pos == NBR_AVG_SAMPLES)390 avg->pos = 0;391 392 if (avg->nbr_samples < NBR_AVG_SAMPLES)393 avg->nbr_samples++;394 395 /*396 * Check the time stamp for each sample. If too old,397 * replace with latest sample398 */399 } while (now - VALID_CAPACITY_SEC > avg->time_stamps[avg->pos]);400 401 avg->avg = avg->sum / avg->nbr_samples;402 403 return avg->avg;404}405 406/**407 * ab8500_fg_clear_cap_samples() - Clear average filter408 * @di: pointer to the ab8500_fg structure409 *410 * The capacity filter is reset to zero.411 */412static void ab8500_fg_clear_cap_samples(struct ab8500_fg *di)413{414 int i;415 struct ab8500_fg_avg_cap *avg = &di->avg_cap;416 417 avg->pos = 0;418 avg->nbr_samples = 0;419 avg->sum = 0;420 avg->avg = 0;421 422 for (i = 0; i < NBR_AVG_SAMPLES; i++) {423 avg->samples[i] = 0;424 avg->time_stamps[i] = 0;425 }426}427 428/**429 * ab8500_fg_fill_cap_sample() - Fill average filter430 * @di: pointer to the ab8500_fg structure431 * @sample: the capacity in mAh to fill the filter with432 *433 * The capacity filter is filled with a capacity in mAh434 */435static void ab8500_fg_fill_cap_sample(struct ab8500_fg *di, int sample)436{437 int i;438 time64_t now;439 struct ab8500_fg_avg_cap *avg = &di->avg_cap;440 441 now = ktime_get_boottime_seconds();442 443 for (i = 0; i < NBR_AVG_SAMPLES; i++) {444 avg->samples[i] = sample;445 avg->time_stamps[i] = now;446 }447 448 avg->pos = 0;449 avg->nbr_samples = NBR_AVG_SAMPLES;450 avg->sum = sample * NBR_AVG_SAMPLES;451 avg->avg = sample;452}453 454/**455 * ab8500_fg_coulomb_counter() - enable coulomb counter456 * @di: pointer to the ab8500_fg structure457 * @enable: enable/disable458 *459 * Enable/Disable coulomb counter.460 * On failure returns negative value.461 */462static int ab8500_fg_coulomb_counter(struct ab8500_fg *di, bool enable)463{464 int ret = 0;465 mutex_lock(&di->cc_lock);466 if (enable) {467 /* To be able to reprogram the number of samples, we have to468 * first stop the CC and then enable it again */469 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,470 AB8500_RTC_CC_CONF_REG, 0x00);471 if (ret)472 goto cc_err;473 474 /* Program the samples */475 ret = abx500_set_register_interruptible(di->dev,476 AB8500_GAS_GAUGE, AB8500_GASG_CC_NCOV_ACCU,477 di->fg_samples);478 if (ret)479 goto cc_err;480 481 /* Start the CC */482 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,483 AB8500_RTC_CC_CONF_REG,484 (CC_DEEP_SLEEP_ENA | CC_PWR_UP_ENA));485 if (ret)486 goto cc_err;487 488 di->flags.fg_enabled = true;489 } else {490 /* Clear any pending read requests */491 ret = abx500_mask_and_set_register_interruptible(di->dev,492 AB8500_GAS_GAUGE, AB8500_GASG_CC_CTRL_REG,493 (RESET_ACCU | READ_REQ), 0);494 if (ret)495 goto cc_err;496 497 ret = abx500_set_register_interruptible(di->dev,498 AB8500_GAS_GAUGE, AB8500_GASG_CC_NCOV_ACCU_CTRL, 0);499 if (ret)500 goto cc_err;501 502 /* Stop the CC */503 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,504 AB8500_RTC_CC_CONF_REG, 0);505 if (ret)506 goto cc_err;507 508 di->flags.fg_enabled = false;509 510 }511 dev_dbg(di->dev, " CC enabled: %d Samples: %d\n",512 enable, di->fg_samples);513 514 mutex_unlock(&di->cc_lock);515 516 return ret;517cc_err:518 dev_err(di->dev, "%s Enabling coulomb counter failed\n", __func__);519 mutex_unlock(&di->cc_lock);520 return ret;521}522 523/**524 * ab8500_fg_inst_curr_start() - start battery instantaneous current525 * @di: pointer to the ab8500_fg structure526 *527 * Returns 0 or error code528 * Note: This is part "one" and has to be called before529 * ab8500_fg_inst_curr_finalize()530 */531int ab8500_fg_inst_curr_start(struct ab8500_fg *di)532{533 u8 reg_val;534 int ret;535 536 mutex_lock(&di->cc_lock);537 538 di->nbr_cceoc_irq_cnt = 0;539 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,540 AB8500_RTC_CC_CONF_REG, ®_val);541 if (ret < 0)542 goto fail;543 544 if (!(reg_val & CC_PWR_UP_ENA)) {545 dev_dbg(di->dev, "%s Enable FG\n", __func__);546 di->turn_off_fg = true;547 548 /* Program the samples */549 ret = abx500_set_register_interruptible(di->dev,550 AB8500_GAS_GAUGE, AB8500_GASG_CC_NCOV_ACCU,551 SEC_TO_SAMPLE(10));552 if (ret)553 goto fail;554 555 /* Start the CC */556 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,557 AB8500_RTC_CC_CONF_REG,558 (CC_DEEP_SLEEP_ENA | CC_PWR_UP_ENA));559 if (ret)560 goto fail;561 } else {562 di->turn_off_fg = false;563 }564 565 /* Return and WFI */566 reinit_completion(&di->ab8500_fg_started);567 reinit_completion(&di->ab8500_fg_complete);568 enable_irq(di->irq);569 570 /* Note: cc_lock is still locked */571 return 0;572fail:573 mutex_unlock(&di->cc_lock);574 return ret;575}576 577/**578 * ab8500_fg_inst_curr_started() - check if fg conversion has started579 * @di: pointer to the ab8500_fg structure580 *581 * Returns 1 if conversion started, 0 if still waiting582 */583int ab8500_fg_inst_curr_started(struct ab8500_fg *di)584{585 return completion_done(&di->ab8500_fg_started);586}587 588/**589 * ab8500_fg_inst_curr_done() - check if fg conversion is done590 * @di: pointer to the ab8500_fg structure591 *592 * Returns 1 if conversion done, 0 if still waiting593 */594int ab8500_fg_inst_curr_done(struct ab8500_fg *di)595{596 return completion_done(&di->ab8500_fg_complete);597}598 599/**600 * ab8500_fg_inst_curr_finalize() - battery instantaneous current601 * @di: pointer to the ab8500_fg structure602 * @curr_ua: battery instantenous current in microampere (on success)603 *604 * Returns 0 or an error code605 * Note: This is part "two" and has to be called at earliest 250 ms606 * after ab8500_fg_inst_curr_start()607 */608int ab8500_fg_inst_curr_finalize(struct ab8500_fg *di, int *curr_ua)609{610 u8 low, high;611 int val;612 int ret;613 unsigned long timeout;614 615 if (!completion_done(&di->ab8500_fg_complete)) {616 timeout = wait_for_completion_timeout(617 &di->ab8500_fg_complete,618 INS_CURR_TIMEOUT);619 dev_dbg(di->dev, "Finalize time: %d ms\n",620 jiffies_to_msecs(INS_CURR_TIMEOUT - timeout));621 if (!timeout) {622 ret = -ETIME;623 disable_irq(di->irq);624 di->nbr_cceoc_irq_cnt = 0;625 dev_err(di->dev, "completion timed out [%d]\n",626 __LINE__);627 goto fail;628 }629 }630 631 disable_irq(di->irq);632 di->nbr_cceoc_irq_cnt = 0;633 634 ret = abx500_mask_and_set_register_interruptible(di->dev,635 AB8500_GAS_GAUGE, AB8500_GASG_CC_CTRL_REG,636 READ_REQ, READ_REQ);637 638 /* 100uS between read request and read is needed */639 usleep_range(100, 100);640 641 /* Read CC Sample conversion value Low and high */642 ret = abx500_get_register_interruptible(di->dev, AB8500_GAS_GAUGE,643 AB8500_GASG_CC_SMPL_CNVL_REG, &low);644 if (ret < 0)645 goto fail;646 647 ret = abx500_get_register_interruptible(di->dev, AB8500_GAS_GAUGE,648 AB8500_GASG_CC_SMPL_CNVH_REG, &high);649 if (ret < 0)650 goto fail;651 652 /*653 * negative value for Discharging654 * convert 2's complement into decimal655 */656 if (high & 0x10)657 val = (low | (high << 8) | 0xFFFFE000);658 else659 val = (low | (high << 8));660 661 /*662 * Convert to unit value in mA663 * Full scale input voltage is664 * 63.160mV => LSB = 63.160mV/(4096*res) = 1.542.000 uA665 * Given a 250ms conversion cycle time the LSB corresponds666 * to 107.1 nAh. Convert to current by dividing by the conversion667 * time in hours (250ms = 1 / (3600 * 4)h)668 * 107.1nAh assumes 10mOhm, but fg_res is in 0.1mOhm669 */670 val = (val * QLSB_NANO_AMP_HOURS_X10 * 36 * 4) / di->bm->fg_res;671 672 if (di->turn_off_fg) {673 dev_dbg(di->dev, "%s Disable FG\n", __func__);674 675 /* Clear any pending read requests */676 ret = abx500_set_register_interruptible(di->dev,677 AB8500_GAS_GAUGE, AB8500_GASG_CC_CTRL_REG, 0);678 if (ret)679 goto fail;680 681 /* Stop the CC */682 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,683 AB8500_RTC_CC_CONF_REG, 0);684 if (ret)685 goto fail;686 }687 mutex_unlock(&di->cc_lock);688 *curr_ua = val;689 690 return 0;691fail:692 mutex_unlock(&di->cc_lock);693 return ret;694}695 696/**697 * ab8500_fg_inst_curr_blocking() - battery instantaneous current698 * @di: pointer to the ab8500_fg structure699 *700 * Returns battery instantenous current in microampere (on success)701 * else error code702 */703int ab8500_fg_inst_curr_blocking(struct ab8500_fg *di)704{705 int ret;706 unsigned long timeout;707 int curr_ua = 0;708 709 ret = ab8500_fg_inst_curr_start(di);710 if (ret) {711 dev_err(di->dev, "Failed to initialize fg_inst\n");712 return 0;713 }714 715 /* Wait for CC to actually start */716 if (!completion_done(&di->ab8500_fg_started)) {717 timeout = wait_for_completion_timeout(718 &di->ab8500_fg_started,719 INS_CURR_TIMEOUT);720 dev_dbg(di->dev, "Start time: %d ms\n",721 jiffies_to_msecs(INS_CURR_TIMEOUT - timeout));722 if (!timeout) {723 ret = -ETIME;724 dev_err(di->dev, "completion timed out [%d]\n",725 __LINE__);726 goto fail;727 }728 }729 730 ret = ab8500_fg_inst_curr_finalize(di, &curr_ua);731 if (ret) {732 dev_err(di->dev, "Failed to finalize fg_inst\n");733 return 0;734 }735 736 dev_dbg(di->dev, "%s instant current: %d uA", __func__, curr_ua);737 return curr_ua;738fail:739 disable_irq(di->irq);740 mutex_unlock(&di->cc_lock);741 return ret;742}743 744/**745 * ab8500_fg_acc_cur_work() - average battery current746 * @work: pointer to the work_struct structure747 *748 * Updated the average battery current obtained from the749 * coulomb counter.750 */751static void ab8500_fg_acc_cur_work(struct work_struct *work)752{753 int val;754 int ret;755 u8 low, med, high;756 757 struct ab8500_fg *di = container_of(work,758 struct ab8500_fg, fg_acc_cur_work);759 760 mutex_lock(&di->cc_lock);761 ret = abx500_set_register_interruptible(di->dev, AB8500_GAS_GAUGE,762 AB8500_GASG_CC_NCOV_ACCU_CTRL, RD_NCONV_ACCU_REQ);763 if (ret)764 goto exit;765 766 ret = abx500_get_register_interruptible(di->dev, AB8500_GAS_GAUGE,767 AB8500_GASG_CC_NCOV_ACCU_LOW, &low);768 if (ret < 0)769 goto exit;770 771 ret = abx500_get_register_interruptible(di->dev, AB8500_GAS_GAUGE,772 AB8500_GASG_CC_NCOV_ACCU_MED, &med);773 if (ret < 0)774 goto exit;775 776 ret = abx500_get_register_interruptible(di->dev, AB8500_GAS_GAUGE,777 AB8500_GASG_CC_NCOV_ACCU_HIGH, &high);778 if (ret < 0)779 goto exit;780 781 /* Check for sign bit in case of negative value, 2's complement */782 if (high & 0x10)783 val = (low | (med << 8) | (high << 16) | 0xFFE00000);784 else785 val = (low | (med << 8) | (high << 16));786 787 /*788 * Convert to uAh789 * Given a 250ms conversion cycle time the LSB corresponds790 * to 112.9 nAh.791 * 112.9nAh assumes 10mOhm, but fg_res is in 0.1mOhm792 */793 di->accu_charge = (val * QLSB_NANO_AMP_HOURS_X10) /794 (100 * di->bm->fg_res);795 796 /*797 * Convert to unit value in uA798 * by dividing by the conversion799 * time in hours (= samples / (3600 * 4)h)800 */801 di->avg_curr_ua = (val * QLSB_NANO_AMP_HOURS_X10 * 36) /802 (di->bm->fg_res * (di->fg_samples / 4));803 804 di->flags.conv_done = true;805 806 mutex_unlock(&di->cc_lock);807 808 queue_work(di->fg_wq, &di->fg_work);809 810 dev_dbg(di->dev, "fg_res: %d, fg_samples: %d, gasg: %d, accu_charge: %d \n",811 di->bm->fg_res, di->fg_samples, val, di->accu_charge);812 return;813exit:814 dev_err(di->dev,815 "Failed to read or write gas gauge registers\n");816 mutex_unlock(&di->cc_lock);817 queue_work(di->fg_wq, &di->fg_work);818}819 820/**821 * ab8500_fg_bat_voltage() - get battery voltage822 * @di: pointer to the ab8500_fg structure823 *824 * Returns battery voltage in microvolts (on success) else error code825 */826static int ab8500_fg_bat_voltage(struct ab8500_fg *di)827{828 int vbat, ret;829 static int prev;830 831 ret = iio_read_channel_processed(di->main_bat_v, &vbat);832 if (ret < 0) {833 dev_err(di->dev,834 "%s ADC conversion failed, using previous value\n",835 __func__);836 return prev;837 }838 839 /* IIO returns millivolts but we want microvolts */840 vbat *= 1000;841 prev = vbat;842 return vbat;843}844 845/**846 * ab8500_fg_volt_to_capacity() - Voltage based capacity847 * @di: pointer to the ab8500_fg structure848 * @voltage_uv: The voltage to convert to a capacity in microvolt849 *850 * Returns battery capacity in per mille based on voltage851 */852static int ab8500_fg_volt_to_capacity(struct ab8500_fg *di, int voltage_uv)853{854 struct power_supply_battery_info *bi = di->bm->bi;855 856 /* Multiply by 10 because the capacity is tracked in per mille */857 return power_supply_batinfo_ocv2cap(bi, voltage_uv, di->bat_temp) * 10;858}859 860/**861 * ab8500_fg_uncomp_volt_to_capacity() - Uncompensated voltage based capacity862 * @di: pointer to the ab8500_fg structure863 *864 * Returns battery capacity based on battery voltage that is not compensated865 * for the voltage drop due to the load866 */867static int ab8500_fg_uncomp_volt_to_capacity(struct ab8500_fg *di)868{869 di->vbat_uv = ab8500_fg_bat_voltage(di);870 return ab8500_fg_volt_to_capacity(di, di->vbat_uv);871}872 873/**874 * ab8500_fg_battery_resistance() - Returns the battery inner resistance875 * @di: pointer to the ab8500_fg structure876 * @vbat_uncomp_uv: Uncompensated VBAT voltage877 *878 * Returns battery inner resistance added with the fuel gauge resistor value879 * to get the total resistance in the whole link from gnd to bat+ node880 * in milliohm.881 */882static int ab8500_fg_battery_resistance(struct ab8500_fg *di, int vbat_uncomp_uv)883{884 struct power_supply_battery_info *bi = di->bm->bi;885 int resistance_percent = 0;886 int resistance;887 888 /*889 * Determine the resistance at this voltage. First try VBAT-to-Ri else890 * just infer it from the surrounding temperature, if nothing works just891 * use the internal resistance.892 */893 if (power_supply_supports_vbat2ri(bi)) {894 resistance = power_supply_vbat2ri(bi, vbat_uncomp_uv, di->flags.charging);895 /* Convert to milliohm */896 resistance = resistance / 1000;897 } else if (power_supply_supports_temp2ri(bi)) {898 resistance_percent = power_supply_temp2resist_simple(bi->resist_table,899 bi->resist_table_size,900 di->bat_temp / 10);901 /* Convert to milliohm */902 resistance = bi->factory_internal_resistance_uohm / 1000;903 resistance = resistance * resistance_percent / 100;904 } else {905 /* Last fallback */906 resistance = bi->factory_internal_resistance_uohm / 1000;907 }908 909 /* Compensate for line impedance */910 resistance += (di->line_impedance_uohm / 1000);911 912 dev_dbg(di->dev, "%s Temp: %d battery internal resistance: %d"913 " fg resistance %d, total: %d (mOhm)\n",914 __func__, di->bat_temp, resistance, di->bm->fg_res / 10,915 (di->bm->fg_res / 10) + resistance);916 917 /* fg_res variable is in 0.1mOhm */918 resistance += di->bm->fg_res / 10;919 920 return resistance;921}922 923/**924 * ab8500_load_comp_fg_bat_voltage() - get load compensated battery voltage925 * @di: pointer to the ab8500_fg structure926 * @always: always return a voltage, also uncompensated927 *928 * Returns compensated battery voltage (on success) else error code.929 * If always is specified, we always return a voltage but it may be930 * uncompensated.931 */932static int ab8500_load_comp_fg_bat_voltage(struct ab8500_fg *di, bool always)933{934 int i = 0;935 int vbat_uv = 0;936 int rcomp;937 938 /* Average the instant current to get a stable current measurement */939 ab8500_fg_inst_curr_start(di);940 941 do {942 vbat_uv += ab8500_fg_bat_voltage(di);943 i++;944 usleep_range(5000, 6000);945 } while (!ab8500_fg_inst_curr_done(di) &&946 i <= WAIT_FOR_INST_CURRENT_MAX);947 948 if (i > WAIT_FOR_INST_CURRENT_MAX) {949 dev_err(di->dev,950 "TIMEOUT: return uncompensated measurement of VBAT\n");951 di->vbat_uv = vbat_uv / i;952 return di->vbat_uv;953 }954 955 ab8500_fg_inst_curr_finalize(di, &di->inst_curr_ua);956 957 /*958 * If there is too high current dissipation, the compensation cannot be959 * trusted so return an error unless we must return something here, as960 * enforced by the "always" parameter.961 */962 if (!always && di->inst_curr_ua < IGNORE_VBAT_HIGHCUR)963 return -EINVAL;964 965 vbat_uv = vbat_uv / i;966 967 /* Next we apply voltage compensation from internal resistance */968 rcomp = ab8500_fg_battery_resistance(di, vbat_uv);969 vbat_uv = vbat_uv - (di->inst_curr_ua * rcomp) / 1000;970 971 /* Always keep this state at latest measurement */972 di->vbat_uv = vbat_uv;973 974 return vbat_uv;975}976 977/**978 * ab8500_fg_load_comp_volt_to_capacity() - Load compensated voltage based capacity979 * @di: pointer to the ab8500_fg structure980 *981 * Returns battery capacity based on battery voltage that is load compensated982 * for the voltage drop983 */984static int ab8500_fg_load_comp_volt_to_capacity(struct ab8500_fg *di)985{986 int vbat_comp_uv;987 988 vbat_comp_uv = ab8500_load_comp_fg_bat_voltage(di, true);989 990 return ab8500_fg_volt_to_capacity(di, vbat_comp_uv);991}992 993/**994 * ab8500_fg_convert_mah_to_permille() - Capacity in mAh to permille995 * @di: pointer to the ab8500_fg structure996 * @cap_mah: capacity in mAh997 *998 * Converts capacity in mAh to capacity in permille999 */1000static int ab8500_fg_convert_mah_to_permille(struct ab8500_fg *di, int cap_mah)1001{1002 return (cap_mah * 1000) / di->bat_cap.max_mah_design;1003}1004 1005/**1006 * ab8500_fg_convert_permille_to_mah() - Capacity in permille to mAh1007 * @di: pointer to the ab8500_fg structure1008 * @cap_pm: capacity in permille1009 *1010 * Converts capacity in permille to capacity in mAh1011 */1012static int ab8500_fg_convert_permille_to_mah(struct ab8500_fg *di, int cap_pm)1013{1014 return cap_pm * di->bat_cap.max_mah_design / 1000;1015}1016 1017/**1018 * ab8500_fg_convert_mah_to_uwh() - Capacity in mAh to uWh1019 * @di: pointer to the ab8500_fg structure1020 * @cap_mah: capacity in mAh1021 *1022 * Converts capacity in mAh to capacity in uWh1023 */1024static int ab8500_fg_convert_mah_to_uwh(struct ab8500_fg *di, int cap_mah)1025{1026 u64 div_res;1027 u32 div_rem;1028 1029 /*1030 * Capacity is in milli ampere hours (10^-3)Ah1031 * Nominal voltage is in microvolts (10^-6)V1032 * divide by 1000000 after multiplication to get to mWh1033 */1034 div_res = ((u64) cap_mah) * ((u64) di->vbat_nom_uv);1035 div_rem = do_div(div_res, 1000000);1036 1037 /* Make sure to round upwards if necessary */1038 if (div_rem >= 1000000 / 2)1039 div_res++;1040 1041 return (int) div_res;1042}1043 1044/**1045 * ab8500_fg_calc_cap_charging() - Calculate remaining capacity while charging1046 * @di: pointer to the ab8500_fg structure1047 *1048 * Return the capacity in mAh based on previous calculated capcity and the FG1049 * accumulator register value. The filter is filled with this capacity1050 */1051static int ab8500_fg_calc_cap_charging(struct ab8500_fg *di)1052{1053 dev_dbg(di->dev, "%s cap_mah %d accu_charge %d\n",1054 __func__,1055 di->bat_cap.mah,1056 di->accu_charge);1057 1058 /* Capacity should not be less than 0 */1059 if (di->bat_cap.mah + di->accu_charge > 0)1060 di->bat_cap.mah += di->accu_charge;1061 else1062 di->bat_cap.mah = 0;1063 /*1064 * We force capacity to 100% once when the algorithm1065 * reports that it's full.1066 */1067 if (di->bat_cap.mah >= di->bat_cap.max_mah_design ||1068 di->flags.force_full) {1069 di->bat_cap.mah = di->bat_cap.max_mah_design;1070 }1071 1072 ab8500_fg_fill_cap_sample(di, di->bat_cap.mah);1073 di->bat_cap.permille =1074 ab8500_fg_convert_mah_to_permille(di, di->bat_cap.mah);1075 1076 /* We need to update battery voltage and inst current when charging */1077 di->vbat_uv = ab8500_fg_bat_voltage(di);1078 di->inst_curr_ua = ab8500_fg_inst_curr_blocking(di);1079 1080 return di->bat_cap.mah;1081}1082 1083/**1084 * ab8500_fg_calc_cap_discharge_voltage() - Capacity in discharge with voltage1085 * @di: pointer to the ab8500_fg structure1086 *1087 * Return the capacity in mAh based on the load compensated battery voltage.1088 * This value is added to the filter and a new mean value is calculated and1089 * returned.1090 */1091static int ab8500_fg_calc_cap_discharge_voltage(struct ab8500_fg *di)1092{1093 int permille, mah;1094 1095 permille = ab8500_fg_load_comp_volt_to_capacity(di);1096 1097 mah = ab8500_fg_convert_permille_to_mah(di, permille);1098 1099 di->bat_cap.mah = ab8500_fg_add_cap_sample(di, mah);1100 di->bat_cap.permille =1101 ab8500_fg_convert_mah_to_permille(di, di->bat_cap.mah);1102 1103 return di->bat_cap.mah;1104}1105 1106/**1107 * ab8500_fg_calc_cap_discharge_fg() - Capacity in discharge with FG1108 * @di: pointer to the ab8500_fg structure1109 *1110 * Return the capacity in mAh based on previous calculated capcity and the FG1111 * accumulator register value. This value is added to the filter and a1112 * new mean value is calculated and returned.1113 */1114static int ab8500_fg_calc_cap_discharge_fg(struct ab8500_fg *di)1115{1116 int permille_volt, permille;1117 1118 dev_dbg(di->dev, "%s cap_mah %d accu_charge %d\n",1119 __func__,1120 di->bat_cap.mah,1121 di->accu_charge);1122 1123 /* Capacity should not be less than 0 */1124 if (di->bat_cap.mah + di->accu_charge > 0)1125 di->bat_cap.mah += di->accu_charge;1126 else1127 di->bat_cap.mah = 0;1128 1129 if (di->bat_cap.mah >= di->bat_cap.max_mah_design)1130 di->bat_cap.mah = di->bat_cap.max_mah_design;1131 1132 /*1133 * Check against voltage based capacity. It can not be lower1134 * than what the uncompensated voltage says1135 */1136 permille = ab8500_fg_convert_mah_to_permille(di, di->bat_cap.mah);1137 permille_volt = ab8500_fg_uncomp_volt_to_capacity(di);1138 1139 if (permille < permille_volt) {1140 di->bat_cap.permille = permille_volt;1141 di->bat_cap.mah = ab8500_fg_convert_permille_to_mah(di,1142 di->bat_cap.permille);1143 1144 dev_dbg(di->dev, "%s voltage based: perm %d perm_volt %d\n",1145 __func__,1146 permille,1147 permille_volt);1148 1149 ab8500_fg_fill_cap_sample(di, di->bat_cap.mah);1150 } else {1151 ab8500_fg_fill_cap_sample(di, di->bat_cap.mah);1152 di->bat_cap.permille =1153 ab8500_fg_convert_mah_to_permille(di, di->bat_cap.mah);1154 }1155 1156 return di->bat_cap.mah;1157}1158 1159/**1160 * ab8500_fg_capacity_level() - Get the battery capacity level1161 * @di: pointer to the ab8500_fg structure1162 *1163 * Get the battery capacity level based on the capacity in percent1164 */1165static int ab8500_fg_capacity_level(struct ab8500_fg *di)1166{1167 int ret, percent;1168 1169 percent = DIV_ROUND_CLOSEST(di->bat_cap.permille, 10);1170 1171 if (percent <= di->bm->cap_levels->critical ||1172 di->flags.low_bat)1173 ret = POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;1174 else if (percent <= di->bm->cap_levels->low)1175 ret = POWER_SUPPLY_CAPACITY_LEVEL_LOW;1176 else if (percent <= di->bm->cap_levels->normal)1177 ret = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;1178 else if (percent <= di->bm->cap_levels->high)1179 ret = POWER_SUPPLY_CAPACITY_LEVEL_HIGH;1180 else1181 ret = POWER_SUPPLY_CAPACITY_LEVEL_FULL;1182 1183 return ret;1184}1185 1186/**1187 * ab8500_fg_calculate_scaled_capacity() - Capacity scaling1188 * @di: pointer to the ab8500_fg structure1189 *1190 * Calculates the capacity to be shown to upper layers. Scales the capacity1191 * to have 100% as a reference from the actual capacity upon removal of charger1192 * when charging is in maintenance mode.1193 */1194static int ab8500_fg_calculate_scaled_capacity(struct ab8500_fg *di)1195{1196 struct ab8500_fg_cap_scaling *cs = &di->bat_cap.cap_scale;1197 int capacity = di->bat_cap.prev_percent;1198 1199 if (!cs->enable)1200 return capacity;1201 1202 /*1203 * As long as we are in fully charge mode scale the capacity1204 * to show 100%.1205 */1206 if (di->flags.fully_charged) {1207 cs->cap_to_scale[0] = 100;1208 cs->cap_to_scale[1] =1209 max(capacity, di->bm->fg_params->maint_thres);1210 dev_dbg(di->dev, "Scale cap with %d/%d\n",1211 cs->cap_to_scale[0], cs->cap_to_scale[1]);1212 }1213 1214 /* Calculates the scaled capacity. */1215 if ((cs->cap_to_scale[0] != cs->cap_to_scale[1])1216 && (cs->cap_to_scale[1] > 0))1217 capacity = min(100,1218 DIV_ROUND_CLOSEST(di->bat_cap.prev_percent *1219 cs->cap_to_scale[0],1220 cs->cap_to_scale[1]));1221 1222 if (di->flags.charging) {1223 if (capacity < cs->disable_cap_level) {1224 cs->disable_cap_level = capacity;1225 dev_dbg(di->dev, "Cap to stop scale lowered %d%%\n",1226 cs->disable_cap_level);1227 } else if (!di->flags.fully_charged) {1228 if (di->bat_cap.prev_percent >=1229 cs->disable_cap_level) {1230 dev_dbg(di->dev, "Disabling scaled capacity\n");1231 cs->enable = false;1232 capacity = di->bat_cap.prev_percent;1233 } else {1234 dev_dbg(di->dev,1235 "Waiting in cap to level %d%%\n",1236 cs->disable_cap_level);1237 capacity = cs->disable_cap_level;1238 }1239 }1240 }1241 1242 return capacity;1243}1244 1245/**1246 * ab8500_fg_update_cap_scalers() - Capacity scaling1247 * @di: pointer to the ab8500_fg structure1248 *1249 * To be called when state change from charge<->discharge to update1250 * the capacity scalers.1251 */1252static void ab8500_fg_update_cap_scalers(struct ab8500_fg *di)1253{1254 struct ab8500_fg_cap_scaling *cs = &di->bat_cap.cap_scale;1255 1256 if (!cs->enable)1257 return;1258 if (di->flags.charging) {1259 di->bat_cap.cap_scale.disable_cap_level =1260 di->bat_cap.cap_scale.scaled_cap;1261 dev_dbg(di->dev, "Cap to stop scale at charge %d%%\n",1262 di->bat_cap.cap_scale.disable_cap_level);1263 } else {1264 if (cs->scaled_cap != 100) {1265 cs->cap_to_scale[0] = cs->scaled_cap;1266 cs->cap_to_scale[1] = di->bat_cap.prev_percent;1267 } else {1268 cs->cap_to_scale[0] = 100;1269 cs->cap_to_scale[1] =1270 max(di->bat_cap.prev_percent,1271 di->bm->fg_params->maint_thres);1272 }1273 1274 dev_dbg(di->dev, "Cap to scale at discharge %d/%d\n",1275 cs->cap_to_scale[0], cs->cap_to_scale[1]);1276 }1277}1278 1279/**1280 * ab8500_fg_check_capacity_limits() - Check if capacity has changed1281 * @di: pointer to the ab8500_fg structure1282 * @init: capacity is allowed to go up in init mode1283 *1284 * Check if capacity or capacity limit has changed and notify the system1285 * about it using the power_supply framework1286 */1287static void ab8500_fg_check_capacity_limits(struct ab8500_fg *di, bool init)1288{1289 bool changed = false;1290 int percent = DIV_ROUND_CLOSEST(di->bat_cap.permille, 10);1291 1292 di->bat_cap.level = ab8500_fg_capacity_level(di);1293 1294 if (di->bat_cap.level != di->bat_cap.prev_level) {1295 /*1296 * We do not allow reported capacity level to go up1297 * unless we're charging or if we're in init1298 */1299 if (!(!di->flags.charging && di->bat_cap.level >1300 di->bat_cap.prev_level) || init) {1301 dev_dbg(di->dev, "level changed from %d to %d\n",1302 di->bat_cap.prev_level,1303 di->bat_cap.level);1304 di->bat_cap.prev_level = di->bat_cap.level;1305 changed = true;1306 } else {1307 dev_dbg(di->dev, "level not allowed to go up "1308 "since no charger is connected: %d to %d\n",1309 di->bat_cap.prev_level,1310 di->bat_cap.level);1311 }1312 }1313 1314 /*1315 * If we have received the LOW_BAT IRQ, set capacity to 0 to initiate1316 * shutdown1317 */1318 if (di->flags.low_bat) {1319 dev_dbg(di->dev, "Battery low, set capacity to 0\n");1320 di->bat_cap.prev_percent = 0;1321 di->bat_cap.permille = 0;1322 percent = 0;1323 di->bat_cap.prev_mah = 0;1324 di->bat_cap.mah = 0;1325 changed = true;1326 } else if (di->flags.fully_charged) {1327 /*1328 * We report 100% if algorithm reported fully charged1329 * and show 100% during maintenance charging (scaling).1330 */1331 if (di->flags.force_full) {1332 di->bat_cap.prev_percent = percent;1333 di->bat_cap.prev_mah = di->bat_cap.mah;1334 1335 changed = true;1336 1337 if (!di->bat_cap.cap_scale.enable &&1338 di->bm->capacity_scaling) {1339 di->bat_cap.cap_scale.enable = true;1340 di->bat_cap.cap_scale.cap_to_scale[0] = 100;1341 di->bat_cap.cap_scale.cap_to_scale[1] =1342 di->bat_cap.prev_percent;1343 di->bat_cap.cap_scale.disable_cap_level = 100;1344 }1345 } else if (di->bat_cap.prev_percent != percent) {1346 dev_dbg(di->dev,1347 "battery reported full "1348 "but capacity dropping: %d\n",1349 percent);1350 di->bat_cap.prev_percent = percent;1351 di->bat_cap.prev_mah = di->bat_cap.mah;1352 1353 changed = true;1354 }1355 } else if (di->bat_cap.prev_percent != percent) {1356 if (percent == 0) {1357 /*1358 * We will not report 0% unless we've got1359 * the LOW_BAT IRQ, no matter what the FG1360 * algorithm says.1361 */1362 di->bat_cap.prev_percent = 1;1363 percent = 1;1364 1365 changed = true;1366 } else if (!(!di->flags.charging &&1367 percent > di->bat_cap.prev_percent) || init) {1368 /*1369 * We do not allow reported capacity to go up1370 * unless we're charging or if we're in init1371 */1372 dev_dbg(di->dev,1373 "capacity changed from %d to %d (%d)\n",1374 di->bat_cap.prev_percent,1375 percent,1376 di->bat_cap.permille);1377 di->bat_cap.prev_percent = percent;1378 di->bat_cap.prev_mah = di->bat_cap.mah;1379 1380 changed = true;1381 } else {1382 dev_dbg(di->dev, "capacity not allowed to go up since "1383 "no charger is connected: %d to %d (%d)\n",1384 di->bat_cap.prev_percent,1385 percent,1386 di->bat_cap.permille);1387 }1388 }1389 1390 if (changed) {1391 if (di->bm->capacity_scaling) {1392 di->bat_cap.cap_scale.scaled_cap =1393 ab8500_fg_calculate_scaled_capacity(di);1394 1395 dev_info(di->dev, "capacity=%d (%d)\n",1396 di->bat_cap.prev_percent,1397 di->bat_cap.cap_scale.scaled_cap);1398 }1399 power_supply_changed(di->fg_psy);1400 if (di->flags.fully_charged && di->flags.force_full) {1401 dev_dbg(di->dev, "Battery full, notifying.\n");1402 di->flags.force_full = false;1403 sysfs_notify(&di->fg_kobject, NULL, "charge_full");1404 }1405 sysfs_notify(&di->fg_kobject, NULL, "charge_now");1406 }1407}1408 1409static void ab8500_fg_charge_state_to(struct ab8500_fg *di,1410 enum ab8500_fg_charge_state new_state)1411{1412 dev_dbg(di->dev, "Charge state from %d [%s] to %d [%s]\n",1413 di->charge_state,1414 charge_state[di->charge_state],1415 new_state,1416 charge_state[new_state]);1417 1418 di->charge_state = new_state;1419}1420 1421static void ab8500_fg_discharge_state_to(struct ab8500_fg *di,1422 enum ab8500_fg_discharge_state new_state)1423{1424 dev_dbg(di->dev, "Discharge state from %d [%s] to %d [%s]\n",1425 di->discharge_state,1426 discharge_state[di->discharge_state],1427 new_state,1428 discharge_state[new_state]);1429 1430 di->discharge_state = new_state;1431}1432 1433/**1434 * ab8500_fg_algorithm_charging() - FG algorithm for when charging1435 * @di: pointer to the ab8500_fg structure1436 *1437 * Battery capacity calculation state machine for when we're charging1438 */1439static void ab8500_fg_algorithm_charging(struct ab8500_fg *di)1440{1441 /*1442 * If we change to discharge mode1443 * we should start with recovery1444 */1445 if (di->discharge_state != AB8500_FG_DISCHARGE_INIT_RECOVERY)1446 ab8500_fg_discharge_state_to(di,1447 AB8500_FG_DISCHARGE_INIT_RECOVERY);1448 1449 switch (di->charge_state) {1450 case AB8500_FG_CHARGE_INIT:1451 di->fg_samples = SEC_TO_SAMPLE(1452 di->bm->fg_params->accu_charging);1453 1454 ab8500_fg_coulomb_counter(di, true);1455 ab8500_fg_charge_state_to(di, AB8500_FG_CHARGE_READOUT);1456 1457 break;1458 1459 case AB8500_FG_CHARGE_READOUT:1460 /*1461 * Read the FG and calculate the new capacity1462 */1463 mutex_lock(&di->cc_lock);1464 if (!di->flags.conv_done && !di->flags.force_full) {1465 /* Wasn't the CC IRQ that got us here */1466 mutex_unlock(&di->cc_lock);1467 dev_dbg(di->dev, "%s CC conv not done\n",1468 __func__);1469 1470 break;1471 }1472 di->flags.conv_done = false;1473 mutex_unlock(&di->cc_lock);1474 1475 ab8500_fg_calc_cap_charging(di);1476 1477 break;1478 1479 default:1480 break;1481 }1482 1483 /* Check capacity limits */1484 ab8500_fg_check_capacity_limits(di, false);1485}1486 1487static void force_capacity(struct ab8500_fg *di)1488{1489 int cap;1490 1491 ab8500_fg_clear_cap_samples(di);1492 cap = di->bat_cap.user_mah;1493 if (cap > di->bat_cap.max_mah_design) {1494 dev_dbg(di->dev, "Remaining cap %d can't be bigger than total"1495 " %d\n", cap, di->bat_cap.max_mah_design);1496 cap = di->bat_cap.max_mah_design;1497 }1498 ab8500_fg_fill_cap_sample(di, di->bat_cap.user_mah);1499 di->bat_cap.permille = ab8500_fg_convert_mah_to_permille(di, cap);1500 di->bat_cap.mah = cap;1501 ab8500_fg_check_capacity_limits(di, true);1502}1503 1504static bool check_sysfs_capacity(struct ab8500_fg *di)1505{1506 int cap, lower, upper;1507 int cap_permille;1508 1509 cap = di->bat_cap.user_mah;1510 1511 cap_permille = ab8500_fg_convert_mah_to_permille(di,1512 di->bat_cap.user_mah);1513 1514 lower = di->bat_cap.permille - di->bm->fg_params->user_cap_limit * 10;1515 upper = di->bat_cap.permille + di->bm->fg_params->user_cap_limit * 10;1516 1517 if (lower < 0)1518 lower = 0;1519 /* 1000 is permille, -> 100 percent */1520 if (upper > 1000)1521 upper = 1000;1522 1523 dev_dbg(di->dev, "Capacity limits:"1524 " (Lower: %d User: %d Upper: %d) [user: %d, was: %d]\n",1525 lower, cap_permille, upper, cap, di->bat_cap.mah);1526 1527 /* If within limits, use the saved capacity and exit estimation...*/1528 if (cap_permille > lower && cap_permille < upper) {1529 dev_dbg(di->dev, "OK! Using users cap %d uAh now\n", cap);1530 force_capacity(di);1531 return true;1532 }1533 dev_dbg(di->dev, "Capacity from user out of limits, ignoring");1534 return false;1535}1536 1537/**1538 * ab8500_fg_algorithm_discharging() - FG algorithm for when discharging1539 * @di: pointer to the ab8500_fg structure1540 *1541 * Battery capacity calculation state machine for when we're discharging1542 */1543static void ab8500_fg_algorithm_discharging(struct ab8500_fg *di)1544{1545 int sleep_time;1546 1547 /* If we change to charge mode we should start with init */1548 if (di->charge_state != AB8500_FG_CHARGE_INIT)1549 ab8500_fg_charge_state_to(di, AB8500_FG_CHARGE_INIT);1550 1551 switch (di->discharge_state) {1552 case AB8500_FG_DISCHARGE_INIT:1553 /* We use the FG IRQ to work on */1554 di->init_cnt = 0;1555 di->fg_samples = SEC_TO_SAMPLE(di->bm->fg_params->init_timer);1556 ab8500_fg_coulomb_counter(di, true);1557 ab8500_fg_discharge_state_to(di,1558 AB8500_FG_DISCHARGE_INITMEASURING);1559 1560 fallthrough;1561 case AB8500_FG_DISCHARGE_INITMEASURING:1562 /*1563 * Discard a number of samples during startup.1564 * After that, use compensated voltage for a few1565 * samples to get an initial capacity.1566 * Then go to READOUT1567 */1568 sleep_time = di->bm->fg_params->init_timer;1569 1570 /* Discard the first [x] seconds */1571 if (di->init_cnt > di->bm->fg_params->init_discard_time) {1572 ab8500_fg_calc_cap_discharge_voltage(di);1573 1574 ab8500_fg_check_capacity_limits(di, true);1575 }1576 1577 di->init_cnt += sleep_time;1578 if (di->init_cnt > di->bm->fg_params->init_total_time)1579 ab8500_fg_discharge_state_to(di,1580 AB8500_FG_DISCHARGE_READOUT_INIT);1581 1582 break;1583 1584 case AB8500_FG_DISCHARGE_INIT_RECOVERY:1585 di->recovery_cnt = 0;1586 di->recovery_needed = true;1587 ab8500_fg_discharge_state_to(di,1588 AB8500_FG_DISCHARGE_RECOVERY);1589 1590 fallthrough;1591 1592 case AB8500_FG_DISCHARGE_RECOVERY:1593 sleep_time = di->bm->fg_params->recovery_sleep_timer;1594 1595 /*1596 * We should check the power consumption1597 * If low, go to READOUT (after x min) or1598 * RECOVERY_SLEEP if time left.1599 * If high, go to READOUT1600 */1601 di->inst_curr_ua = ab8500_fg_inst_curr_blocking(di);1602 1603 if (ab8500_fg_is_low_curr(di, di->inst_curr_ua)) {1604 if (di->recovery_cnt >1605 di->bm->fg_params->recovery_total_time) {1606 di->fg_samples = SEC_TO_SAMPLE(1607 di->bm->fg_params->accu_high_curr);1608 ab8500_fg_coulomb_counter(di, true);1609 ab8500_fg_discharge_state_to(di,1610 AB8500_FG_DISCHARGE_READOUT);1611 di->recovery_needed = false;1612 } else {1613 queue_delayed_work(di->fg_wq,1614 &di->fg_periodic_work,1615 sleep_time * HZ);1616 }1617 di->recovery_cnt += sleep_time;1618 } else {1619 di->fg_samples = SEC_TO_SAMPLE(1620 di->bm->fg_params->accu_high_curr);1621 ab8500_fg_coulomb_counter(di, true);1622 ab8500_fg_discharge_state_to(di,1623 AB8500_FG_DISCHARGE_READOUT);1624 }1625 break;1626 1627 case AB8500_FG_DISCHARGE_READOUT_INIT:1628 di->fg_samples = SEC_TO_SAMPLE(1629 di->bm->fg_params->accu_high_curr);1630 ab8500_fg_coulomb_counter(di, true);1631 ab8500_fg_discharge_state_to(di,1632 AB8500_FG_DISCHARGE_READOUT);1633 break;1634 1635 case AB8500_FG_DISCHARGE_READOUT:1636 di->inst_curr_ua = ab8500_fg_inst_curr_blocking(di);1637 1638 if (ab8500_fg_is_low_curr(di, di->inst_curr_ua)) {1639 /* Detect mode change */1640 if (di->high_curr_mode) {1641 di->high_curr_mode = false;1642 di->high_curr_cnt = 0;1643 }1644 1645 if (di->recovery_needed) {1646 ab8500_fg_discharge_state_to(di,1647 AB8500_FG_DISCHARGE_INIT_RECOVERY);1648 1649 queue_delayed_work(di->fg_wq,1650 &di->fg_periodic_work, 0);1651 1652 break;1653 }1654 1655 ab8500_fg_calc_cap_discharge_voltage(di);1656 } else {1657 mutex_lock(&di->cc_lock);1658 if (!di->flags.conv_done) {1659 /* Wasn't the CC IRQ that got us here */1660 mutex_unlock(&di->cc_lock);1661 dev_dbg(di->dev, "%s CC conv not done\n",1662 __func__);1663 1664 break;1665 }1666 di->flags.conv_done = false;1667 mutex_unlock(&di->cc_lock);1668 1669 /* Detect mode change */1670 if (!di->high_curr_mode) {1671 di->high_curr_mode = true;1672 di->high_curr_cnt = 0;1673 }1674 1675 di->high_curr_cnt +=1676 di->bm->fg_params->accu_high_curr;1677 if (di->high_curr_cnt >1678 di->bm->fg_params->high_curr_time)1679 di->recovery_needed = true;1680 1681 ab8500_fg_calc_cap_discharge_fg(di);1682 }1683 1684 ab8500_fg_check_capacity_limits(di, false);1685 1686 break;1687 1688 case AB8500_FG_DISCHARGE_WAKEUP:1689 ab8500_fg_calc_cap_discharge_voltage(di);1690 1691 di->fg_samples = SEC_TO_SAMPLE(1692 di->bm->fg_params->accu_high_curr);1693 ab8500_fg_coulomb_counter(di, true);1694 ab8500_fg_discharge_state_to(di,1695 AB8500_FG_DISCHARGE_READOUT);1696 1697 ab8500_fg_check_capacity_limits(di, false);1698 1699 break;1700 1701 default:1702 break;1703 }1704}1705 1706/**1707 * ab8500_fg_algorithm_calibrate() - Internal columb counter offset calibration1708 * @di: pointer to the ab8500_fg structure1709 *1710 */1711static void ab8500_fg_algorithm_calibrate(struct ab8500_fg *di)1712{1713 int ret;1714 1715 switch (di->calib_state) {1716 case AB8500_FG_CALIB_INIT:1717 dev_dbg(di->dev, "Calibration ongoing...\n");1718 1719 ret = abx500_mask_and_set_register_interruptible(di->dev,1720 AB8500_GAS_GAUGE, AB8500_GASG_CC_CTRL_REG,1721 CC_INT_CAL_N_AVG_MASK, CC_INT_CAL_SAMPLES_8);1722 if (ret < 0)1723 goto err;1724 1725 ret = abx500_mask_and_set_register_interruptible(di->dev,1726 AB8500_GAS_GAUGE, AB8500_GASG_CC_CTRL_REG,1727 CC_INTAVGOFFSET_ENA, CC_INTAVGOFFSET_ENA);1728 if (ret < 0)1729 goto err;1730 di->calib_state = AB8500_FG_CALIB_WAIT;1731 break;1732 case AB8500_FG_CALIB_END:1733 ret = abx500_mask_and_set_register_interruptible(di->dev,1734 AB8500_GAS_GAUGE, AB8500_GASG_CC_CTRL_REG,1735 CC_MUXOFFSET, CC_MUXOFFSET);1736 if (ret < 0)1737 goto err;1738 di->flags.calibrate = false;1739 dev_dbg(di->dev, "Calibration done...\n");1740 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);1741 break;1742 case AB8500_FG_CALIB_WAIT:1743 dev_dbg(di->dev, "Calibration WFI\n");1744 break;1745 default:1746 break;1747 }1748 return;1749err:1750 /* Something went wrong, don't calibrate then */1751 dev_err(di->dev, "failed to calibrate the CC\n");1752 di->flags.calibrate = false;1753 di->calib_state = AB8500_FG_CALIB_INIT;1754 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);1755}1756 1757/**1758 * ab8500_fg_algorithm() - Entry point for the FG algorithm1759 * @di: pointer to the ab8500_fg structure1760 *1761 * Entry point for the battery capacity calculation state machine1762 */1763static void ab8500_fg_algorithm(struct ab8500_fg *di)1764{1765 if (di->flags.calibrate)1766 ab8500_fg_algorithm_calibrate(di);1767 else {1768 if (di->flags.charging)1769 ab8500_fg_algorithm_charging(di);1770 else1771 ab8500_fg_algorithm_discharging(di);1772 }1773 1774 dev_dbg(di->dev, "[FG_DATA] %d %d %d %d %d %d %d %d %d %d "1775 "%d %d %d %d %d %d %d\n",1776 di->bat_cap.max_mah_design,1777 di->bat_cap.max_mah,1778 di->bat_cap.mah,1779 di->bat_cap.permille,1780 di->bat_cap.level,1781 di->bat_cap.prev_mah,1782 di->bat_cap.prev_percent,1783 di->bat_cap.prev_level,1784 di->vbat_uv,1785 di->inst_curr_ua,1786 di->avg_curr_ua,1787 di->accu_charge,1788 di->flags.charging,1789 di->charge_state,1790 di->discharge_state,1791 di->high_curr_mode,1792 di->recovery_needed);1793}1794 1795/**1796 * ab8500_fg_periodic_work() - Run the FG state machine periodically1797 * @work: pointer to the work_struct structure1798 *1799 * Work queue function for periodic work1800 */1801static void ab8500_fg_periodic_work(struct work_struct *work)1802{1803 struct ab8500_fg *di = container_of(work, struct ab8500_fg,1804 fg_periodic_work.work);1805 1806 if (di->init_capacity) {1807 /* Get an initial capacity calculation */1808 ab8500_fg_calc_cap_discharge_voltage(di);1809 ab8500_fg_check_capacity_limits(di, true);1810 di->init_capacity = false;1811 1812 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);1813 } else if (di->flags.user_cap) {1814 if (check_sysfs_capacity(di)) {1815 ab8500_fg_check_capacity_limits(di, true);1816 if (di->flags.charging)1817 ab8500_fg_charge_state_to(di,1818 AB8500_FG_CHARGE_INIT);1819 else1820 ab8500_fg_discharge_state_to(di,1821 AB8500_FG_DISCHARGE_READOUT_INIT);1822 }1823 di->flags.user_cap = false;1824 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);1825 } else1826 ab8500_fg_algorithm(di);1827 1828}1829 1830/**1831 * ab8500_fg_check_hw_failure_work() - Check OVV_BAT condition1832 * @work: pointer to the work_struct structure1833 *1834 * Work queue function for checking the OVV_BAT condition1835 */1836static void ab8500_fg_check_hw_failure_work(struct work_struct *work)1837{1838 int ret;1839 u8 reg_value;1840 1841 struct ab8500_fg *di = container_of(work, struct ab8500_fg,1842 fg_check_hw_failure_work.work);1843 1844 /*1845 * If we have had a battery over-voltage situation,1846 * check ovv-bit to see if it should be reset.1847 */1848 ret = abx500_get_register_interruptible(di->dev,1849 AB8500_CHARGER, AB8500_CH_STAT_REG,1850 ®_value);1851 if (ret < 0) {1852 dev_err(di->dev, "%s ab8500 read failed\n", __func__);1853 return;1854 }1855 if ((reg_value & BATT_OVV) == BATT_OVV) {1856 if (!di->flags.bat_ovv) {1857 dev_dbg(di->dev, "Battery OVV\n");1858 di->flags.bat_ovv = true;1859 power_supply_changed(di->fg_psy);1860 }1861 /* Not yet recovered from ovv, reschedule this test */1862 queue_delayed_work(di->fg_wq, &di->fg_check_hw_failure_work,1863 HZ);1864 } else {1865 dev_dbg(di->dev, "Battery recovered from OVV\n");1866 di->flags.bat_ovv = false;1867 power_supply_changed(di->fg_psy);1868 }1869}1870 1871/**1872 * ab8500_fg_low_bat_work() - Check LOW_BAT condition1873 * @work: pointer to the work_struct structure1874 *1875 * Work queue function for checking the LOW_BAT condition1876 */1877static void ab8500_fg_low_bat_work(struct work_struct *work)1878{1879 int vbat_uv;1880 1881 struct ab8500_fg *di = container_of(work, struct ab8500_fg,1882 fg_low_bat_work.work);1883 1884 vbat_uv = ab8500_fg_bat_voltage(di);1885 1886 /* Check if LOW_BAT still fulfilled */1887 if (vbat_uv < di->bm->fg_params->lowbat_threshold_uv) {1888 /* Is it time to shut down? */1889 if (di->low_bat_cnt < 1) {1890 di->flags.low_bat = true;1891 dev_warn(di->dev, "Shut down pending...\n");1892 } else {1893 /*1894 * Else we need to re-schedule this check to be able to detect1895 * if the voltage increases again during charging or1896 * due to decreasing load.1897 */1898 di->low_bat_cnt--;1899 dev_warn(di->dev, "Battery voltage still LOW\n");1900 queue_delayed_work(di->fg_wq, &di->fg_low_bat_work,1901 round_jiffies(LOW_BAT_CHECK_INTERVAL));1902 }1903 } else {1904 di->flags.low_bat_delay = false;1905 di->low_bat_cnt = 10;1906 dev_warn(di->dev, "Battery voltage OK again\n");1907 }1908 1909 /* This is needed to dispatch LOW_BAT */1910 ab8500_fg_check_capacity_limits(di, false);1911}1912 1913/**1914 * ab8500_fg_battok_calc - calculate the bit pattern corresponding1915 * to the target voltage.1916 * @di: pointer to the ab8500_fg structure1917 * @target: target voltage1918 *1919 * Returns bit pattern closest to the target voltage1920 * valid return values are 0-14. (0-BATT_OK_MAX_NR_INCREMENTS)1921 */1922 1923static int ab8500_fg_battok_calc(struct ab8500_fg *di, int target)1924{1925 if (target > BATT_OK_MIN +1926 (BATT_OK_INCREMENT * BATT_OK_MAX_NR_INCREMENTS))1927 return BATT_OK_MAX_NR_INCREMENTS;1928 if (target < BATT_OK_MIN)1929 return 0;1930 return (target - BATT_OK_MIN) / BATT_OK_INCREMENT;1931}1932 1933/**1934 * ab8500_fg_battok_init_hw_register - init battok levels1935 * @di: pointer to the ab8500_fg structure1936 *1937 */1938 1939static int ab8500_fg_battok_init_hw_register(struct ab8500_fg *di)1940{1941 int selected;1942 int sel0;1943 int sel1;1944 int cbp_sel0;1945 int cbp_sel1;1946 int ret;1947 int new_val;1948 1949 sel0 = di->bm->fg_params->battok_falling_th_sel0;1950 sel1 = di->bm->fg_params->battok_raising_th_sel1;1951 1952 cbp_sel0 = ab8500_fg_battok_calc(di, sel0);1953 cbp_sel1 = ab8500_fg_battok_calc(di, sel1);1954 1955 selected = BATT_OK_MIN + cbp_sel0 * BATT_OK_INCREMENT;1956 1957 if (selected != sel0)1958 dev_warn(di->dev, "Invalid voltage step:%d, using %d %d\n",1959 sel0, selected, cbp_sel0);1960 1961 selected = BATT_OK_MIN + cbp_sel1 * BATT_OK_INCREMENT;1962 1963 if (selected != sel1)1964 dev_warn(di->dev, "Invalid voltage step:%d, using %d %d\n",1965 sel1, selected, cbp_sel1);1966 1967 new_val = cbp_sel0 | (cbp_sel1 << 4);1968 1969 dev_dbg(di->dev, "using: %x %d %d\n", new_val, cbp_sel0, cbp_sel1);1970 ret = abx500_set_register_interruptible(di->dev, AB8500_SYS_CTRL2_BLOCK,1971 AB8500_BATT_OK_REG, new_val);1972 return ret;1973}1974 1975/**1976 * ab8500_fg_instant_work() - Run the FG state machine instantly1977 * @work: pointer to the work_struct structure1978 *1979 * Work queue function for instant work1980 */1981static void ab8500_fg_instant_work(struct work_struct *work)1982{1983 struct ab8500_fg *di = container_of(work, struct ab8500_fg, fg_work);1984 1985 ab8500_fg_algorithm(di);1986}1987 1988/**1989 * ab8500_fg_cc_data_end_handler() - end of data conversion isr.1990 * @irq: interrupt number1991 * @_di: pointer to the ab8500_fg structure1992 *1993 * Returns IRQ status(IRQ_HANDLED)1994 */1995static irqreturn_t ab8500_fg_cc_data_end_handler(int irq, void *_di)1996{1997 struct ab8500_fg *di = _di;1998 if (!di->nbr_cceoc_irq_cnt) {1999 di->nbr_cceoc_irq_cnt++;2000 complete(&di->ab8500_fg_started);2001 } else {2002 di->nbr_cceoc_irq_cnt = 0;2003 complete(&di->ab8500_fg_complete);2004 }2005 return IRQ_HANDLED;2006}2007 2008/**2009 * ab8500_fg_cc_int_calib_handler () - end of calibration isr.2010 * @irq: interrupt number2011 * @_di: pointer to the ab8500_fg structure2012 *2013 * Returns IRQ status(IRQ_HANDLED)2014 */2015static irqreturn_t ab8500_fg_cc_int_calib_handler(int irq, void *_di)2016{2017 struct ab8500_fg *di = _di;2018 di->calib_state = AB8500_FG_CALIB_END;2019 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);2020 return IRQ_HANDLED;2021}2022 2023/**2024 * ab8500_fg_cc_convend_handler() - isr to get battery avg current.2025 * @irq: interrupt number2026 * @_di: pointer to the ab8500_fg structure2027 *2028 * Returns IRQ status(IRQ_HANDLED)2029 */2030static irqreturn_t ab8500_fg_cc_convend_handler(int irq, void *_di)2031{2032 struct ab8500_fg *di = _di;2033 2034 queue_work(di->fg_wq, &di->fg_acc_cur_work);2035 2036 return IRQ_HANDLED;2037}2038 2039/**2040 * ab8500_fg_batt_ovv_handler() - Battery OVV occured2041 * @irq: interrupt number2042 * @_di: pointer to the ab8500_fg structure2043 *2044 * Returns IRQ status(IRQ_HANDLED)2045 */2046static irqreturn_t ab8500_fg_batt_ovv_handler(int irq, void *_di)2047{2048 struct ab8500_fg *di = _di;2049 2050 dev_dbg(di->dev, "Battery OVV\n");2051 2052 /* Schedule a new HW failure check */2053 queue_delayed_work(di->fg_wq, &di->fg_check_hw_failure_work, 0);2054 2055 return IRQ_HANDLED;2056}2057 2058/**2059 * ab8500_fg_lowbatf_handler() - Battery voltage is below LOW threshold2060 * @irq: interrupt number2061 * @_di: pointer to the ab8500_fg structure2062 *2063 * Returns IRQ status(IRQ_HANDLED)2064 */2065static irqreturn_t ab8500_fg_lowbatf_handler(int irq, void *_di)2066{2067 struct ab8500_fg *di = _di;2068 2069 /* Initiate handling in ab8500_fg_low_bat_work() if not already initiated. */2070 if (!di->flags.low_bat_delay) {2071 dev_warn(di->dev, "Battery voltage is below LOW threshold\n");2072 di->flags.low_bat_delay = true;2073 /*2074 * Start a timer to check LOW_BAT again after some time2075 * This is done to avoid shutdown on single voltage dips2076 */2077 queue_delayed_work(di->fg_wq, &di->fg_low_bat_work,2078 round_jiffies(LOW_BAT_CHECK_INTERVAL));2079 }2080 return IRQ_HANDLED;2081}2082 2083/**2084 * ab8500_fg_get_property() - get the fg properties2085 * @psy: pointer to the power_supply structure2086 * @psp: pointer to the power_supply_property structure2087 * @val: pointer to the power_supply_propval union2088 *2089 * This function gets called when an application tries to get the2090 * fg properties by reading the sysfs files.2091 * voltage_now: battery voltage2092 * current_now: battery instant current2093 * current_avg: battery average current2094 * charge_full_design: capacity where battery is considered full2095 * charge_now: battery capacity in nAh2096 * capacity: capacity in percent2097 * capacity_level: capacity level2098 *2099 * Returns error code in case of failure else 0 on success2100 */2101static int ab8500_fg_get_property(struct power_supply *psy,2102 enum power_supply_property psp,2103 union power_supply_propval *val)2104{2105 struct ab8500_fg *di = power_supply_get_drvdata(psy);2106 2107 /*2108 * If battery is identified as unknown and charging of unknown2109 * batteries is disabled, we always report 100% capacity and2110 * capacity level UNKNOWN, since we can't calculate2111 * remaining capacity2112 */2113 2114 switch (psp) {2115 case POWER_SUPPLY_PROP_VOLTAGE_NOW:2116 if (di->flags.bat_ovv)2117 val->intval = BATT_OVV_VALUE;2118 else2119 val->intval = di->vbat_uv;2120 break;2121 case POWER_SUPPLY_PROP_CURRENT_NOW:2122 val->intval = di->inst_curr_ua;2123 break;2124 case POWER_SUPPLY_PROP_CURRENT_AVG:2125 val->intval = di->avg_curr_ua;2126 break;2127 case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:2128 val->intval = ab8500_fg_convert_mah_to_uwh(di,2129 di->bat_cap.max_mah_design);2130 break;2131 case POWER_SUPPLY_PROP_ENERGY_FULL:2132 val->intval = ab8500_fg_convert_mah_to_uwh(di,2133 di->bat_cap.max_mah);2134 break;2135 case POWER_SUPPLY_PROP_ENERGY_NOW:2136 if (di->flags.batt_unknown && !di->bm->chg_unknown_bat &&2137 di->flags.batt_id_received)2138 val->intval = ab8500_fg_convert_mah_to_uwh(di,2139 di->bat_cap.max_mah);2140 else2141 val->intval = ab8500_fg_convert_mah_to_uwh(di,2142 di->bat_cap.prev_mah);2143 break;2144 case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:2145 val->intval = di->bat_cap.max_mah_design;2146 break;2147 case POWER_SUPPLY_PROP_CHARGE_FULL:2148 val->intval = di->bat_cap.max_mah;2149 break;2150 case POWER_SUPPLY_PROP_CHARGE_NOW:2151 if (di->flags.batt_unknown && !di->bm->chg_unknown_bat &&2152 di->flags.batt_id_received)2153 val->intval = di->bat_cap.max_mah;2154 else2155 val->intval = di->bat_cap.prev_mah;2156 break;2157 case POWER_SUPPLY_PROP_CAPACITY:2158 if (di->flags.batt_unknown && !di->bm->chg_unknown_bat &&2159 di->flags.batt_id_received)2160 val->intval = 100;2161 else2162 val->intval = di->bat_cap.prev_percent;2163 break;2164 case POWER_SUPPLY_PROP_CAPACITY_LEVEL:2165 if (di->flags.batt_unknown && !di->bm->chg_unknown_bat &&2166 di->flags.batt_id_received)2167 val->intval = POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN;2168 else2169 val->intval = di->bat_cap.prev_level;2170 break;2171 default:2172 return -EINVAL;2173 }2174 return 0;2175}2176 2177static int ab8500_fg_get_ext_psy_data(struct device *dev, void *data)2178{2179 struct power_supply *psy;2180 struct power_supply *ext = dev_get_drvdata(dev);2181 const char **supplicants = (const char **)ext->supplied_to;2182 struct ab8500_fg *di;2183 struct power_supply_battery_info *bi;2184 union power_supply_propval ret;2185 int j;2186 2187 psy = (struct power_supply *)data;2188 di = power_supply_get_drvdata(psy);2189 bi = di->bm->bi;2190 2191 /*2192 * For all psy where the name of your driver2193 * appears in any supplied_to2194 */2195 j = match_string(supplicants, ext->num_supplicants, psy->desc->name);2196 if (j < 0)2197 return 0;2198 2199 /* Go through all properties for the psy */2200 for (j = 0; j < ext->desc->num_properties; j++) {2201 enum power_supply_property prop;2202 prop = ext->desc->properties[j];2203 2204 if (power_supply_get_property(ext, prop, &ret))2205 continue;2206 2207 switch (prop) {2208 case POWER_SUPPLY_PROP_STATUS:2209 switch (ext->desc->type) {2210 case POWER_SUPPLY_TYPE_BATTERY:2211 switch (ret.intval) {2212 case POWER_SUPPLY_STATUS_UNKNOWN:2213 case POWER_SUPPLY_STATUS_DISCHARGING:2214 case POWER_SUPPLY_STATUS_NOT_CHARGING:2215 if (!di->flags.charging)2216 break;2217 di->flags.charging = false;2218 di->flags.fully_charged = false;2219 if (di->bm->capacity_scaling)2220 ab8500_fg_update_cap_scalers(di);2221 queue_work(di->fg_wq, &di->fg_work);2222 break;2223 case POWER_SUPPLY_STATUS_FULL:2224 if (di->flags.fully_charged)2225 break;2226 di->flags.fully_charged = true;2227 di->flags.force_full = true;2228 /* Save current capacity as maximum */2229 di->bat_cap.max_mah = di->bat_cap.mah;2230 queue_work(di->fg_wq, &di->fg_work);2231 break;2232 case POWER_SUPPLY_STATUS_CHARGING:2233 if (di->flags.charging &&2234 !di->flags.fully_charged)2235 break;2236 di->flags.charging = true;2237 di->flags.fully_charged = false;2238 if (di->bm->capacity_scaling)2239 ab8500_fg_update_cap_scalers(di);2240 queue_work(di->fg_wq, &di->fg_work);2241 break;2242 }2243 break;2244 default:2245 break;2246 }2247 break;2248 case POWER_SUPPLY_PROP_TECHNOLOGY:2249 switch (ext->desc->type) {2250 case POWER_SUPPLY_TYPE_BATTERY:2251 if (!di->flags.batt_id_received &&2252 (bi && (bi->technology !=2253 POWER_SUPPLY_TECHNOLOGY_UNKNOWN))) {2254 di->flags.batt_id_received = true;2255 2256 di->bat_cap.max_mah_design =2257 di->bm->bi->charge_full_design_uah;2258 2259 di->bat_cap.max_mah =2260 di->bat_cap.max_mah_design;2261 2262 di->vbat_nom_uv =2263 di->bm->bi->voltage_max_design_uv;2264 }2265 2266 if (ret.intval)2267 di->flags.batt_unknown = false;2268 else2269 di->flags.batt_unknown = true;2270 break;2271 default:2272 break;2273 }2274 break;2275 case POWER_SUPPLY_PROP_TEMP:2276 switch (ext->desc->type) {2277 case POWER_SUPPLY_TYPE_BATTERY:2278 if (di->flags.batt_id_received)2279 di->bat_temp = ret.intval;2280 break;2281 default:2282 break;2283 }2284 break;2285 default:2286 break;2287 }2288 }2289 return 0;2290}2291 2292/**2293 * ab8500_fg_init_hw_registers() - Set up FG related registers2294 * @di: pointer to the ab8500_fg structure2295 *2296 * Set up battery OVV, low battery voltage registers2297 */2298static int ab8500_fg_init_hw_registers(struct ab8500_fg *di)2299{2300 int ret;2301 2302 /*2303 * Set VBAT OVV (overvoltage) threshold to 4.75V (typ) this is what2304 * the hardware supports, nothing else can be configured in hardware.2305 * See this as an "outer limit" where the charger will certainly2306 * shut down. Other (lower) overvoltage levels need to be implemented2307 * in software.2308 */2309 ret = abx500_mask_and_set_register_interruptible(di->dev,2310 AB8500_CHARGER,2311 AB8500_BATT_OVV,2312 BATT_OVV_TH_4P75,2313 BATT_OVV_TH_4P75);2314 if (ret) {2315 dev_err(di->dev, "failed to set BATT_OVV\n");2316 goto out;2317 }2318 2319 /* Enable VBAT OVV detection */2320 ret = abx500_mask_and_set_register_interruptible(di->dev,2321 AB8500_CHARGER,2322 AB8500_BATT_OVV,2323 BATT_OVV_ENA,2324 BATT_OVV_ENA);2325 if (ret) {2326 dev_err(di->dev, "failed to enable BATT_OVV\n");2327 goto out;2328 }2329 2330 /* Low Battery Voltage */2331 ret = abx500_set_register_interruptible(di->dev,2332 AB8500_SYS_CTRL2_BLOCK,2333 AB8500_LOW_BAT_REG,2334 ab8500_volt_to_regval(2335 di->bm->fg_params->lowbat_threshold_uv) << 1 |2336 LOW_BAT_ENABLE);2337 if (ret) {2338 dev_err(di->dev, "%s write failed\n", __func__);2339 goto out;2340 }2341 2342 /* Battery OK threshold */2343 ret = ab8500_fg_battok_init_hw_register(di);2344 if (ret) {2345 dev_err(di->dev, "BattOk init write failed.\n");2346 goto out;2347 }2348 2349 if (is_ab8505(di->parent)) {2350 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2351 AB8505_RTC_PCUT_MAX_TIME_REG, di->bm->fg_params->pcut_max_time);2352 2353 if (ret) {2354 dev_err(di->dev, "%s write failed AB8505_RTC_PCUT_MAX_TIME_REG\n", __func__);2355 goto out;2356 }2357 2358 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2359 AB8505_RTC_PCUT_FLAG_TIME_REG, di->bm->fg_params->pcut_flag_time);2360 2361 if (ret) {2362 dev_err(di->dev, "%s write failed AB8505_RTC_PCUT_FLAG_TIME_REG\n", __func__);2363 goto out;2364 }2365 2366 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2367 AB8505_RTC_PCUT_RESTART_REG, di->bm->fg_params->pcut_max_restart);2368 2369 if (ret) {2370 dev_err(di->dev, "%s write failed AB8505_RTC_PCUT_RESTART_REG\n", __func__);2371 goto out;2372 }2373 2374 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2375 AB8505_RTC_PCUT_DEBOUNCE_REG, di->bm->fg_params->pcut_debounce_time);2376 2377 if (ret) {2378 dev_err(di->dev, "%s write failed AB8505_RTC_PCUT_DEBOUNCE_REG\n", __func__);2379 goto out;2380 }2381 2382 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2383 AB8505_RTC_PCUT_CTL_STATUS_REG, di->bm->fg_params->pcut_enable);2384 2385 if (ret) {2386 dev_err(di->dev, "%s write failed AB8505_RTC_PCUT_CTL_STATUS_REG\n", __func__);2387 goto out;2388 }2389 }2390out:2391 return ret;2392}2393 2394/**2395 * ab8500_fg_external_power_changed() - callback for power supply changes2396 * @psy: pointer to the structure power_supply2397 *2398 * This function is the entry point of the pointer external_power_changed2399 * of the structure power_supply.2400 * This function gets executed when there is a change in any external power2401 * supply that this driver needs to be notified of.2402 */2403static void ab8500_fg_external_power_changed(struct power_supply *psy)2404{2405 power_supply_for_each_device(psy, ab8500_fg_get_ext_psy_data);2406}2407 2408/**2409 * ab8500_fg_reinit_work() - work to reset the FG algorithm2410 * @work: pointer to the work_struct structure2411 *2412 * Used to reset the current battery capacity to be able to2413 * retrigger a new voltage base capacity calculation. For2414 * test and verification purpose.2415 */2416static void ab8500_fg_reinit_work(struct work_struct *work)2417{2418 struct ab8500_fg *di = container_of(work, struct ab8500_fg,2419 fg_reinit_work.work);2420 2421 if (!di->flags.calibrate) {2422 dev_dbg(di->dev, "Resetting FG state machine to init.\n");2423 ab8500_fg_clear_cap_samples(di);2424 ab8500_fg_calc_cap_discharge_voltage(di);2425 ab8500_fg_charge_state_to(di, AB8500_FG_CHARGE_INIT);2426 ab8500_fg_discharge_state_to(di, AB8500_FG_DISCHARGE_INIT);2427 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);2428 2429 } else {2430 dev_err(di->dev, "Residual offset calibration ongoing "2431 "retrying..\n");2432 /* Wait one second until next try*/2433 queue_delayed_work(di->fg_wq, &di->fg_reinit_work,2434 round_jiffies(1));2435 }2436}2437 2438/* Exposure to the sysfs interface */2439 2440struct ab8500_fg_sysfs_entry {2441 struct attribute attr;2442 ssize_t (*show)(struct ab8500_fg *, char *);2443 ssize_t (*store)(struct ab8500_fg *, const char *, size_t);2444};2445 2446static ssize_t charge_full_show(struct ab8500_fg *di, char *buf)2447{2448 return sysfs_emit(buf, "%d\n", di->bat_cap.max_mah);2449}2450 2451static ssize_t charge_full_store(struct ab8500_fg *di, const char *buf,2452 size_t count)2453{2454 unsigned long charge_full;2455 int ret;2456 2457 ret = kstrtoul(buf, 10, &charge_full);2458 if (ret)2459 return ret;2460 2461 di->bat_cap.max_mah = (int) charge_full;2462 return count;2463}2464 2465static ssize_t charge_now_show(struct ab8500_fg *di, char *buf)2466{2467 return sysfs_emit(buf, "%d\n", di->bat_cap.prev_mah);2468}2469 2470static ssize_t charge_now_store(struct ab8500_fg *di, const char *buf,2471 size_t count)2472{2473 unsigned long charge_now;2474 int ret;2475 2476 ret = kstrtoul(buf, 10, &charge_now);2477 if (ret)2478 return ret;2479 2480 di->bat_cap.user_mah = (int) charge_now;2481 di->flags.user_cap = true;2482 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);2483 return count;2484}2485 2486static struct ab8500_fg_sysfs_entry charge_full_attr =2487 __ATTR(charge_full, 0644, charge_full_show, charge_full_store);2488 2489static struct ab8500_fg_sysfs_entry charge_now_attr =2490 __ATTR(charge_now, 0644, charge_now_show, charge_now_store);2491 2492static ssize_t2493ab8500_fg_show(struct kobject *kobj, struct attribute *attr, char *buf)2494{2495 struct ab8500_fg_sysfs_entry *entry;2496 struct ab8500_fg *di;2497 2498 entry = container_of(attr, struct ab8500_fg_sysfs_entry, attr);2499 di = container_of(kobj, struct ab8500_fg, fg_kobject);2500 2501 if (!entry->show)2502 return -EIO;2503 2504 return entry->show(di, buf);2505}2506static ssize_t2507ab8500_fg_store(struct kobject *kobj, struct attribute *attr, const char *buf,2508 size_t count)2509{2510 struct ab8500_fg_sysfs_entry *entry;2511 struct ab8500_fg *di;2512 2513 entry = container_of(attr, struct ab8500_fg_sysfs_entry, attr);2514 di = container_of(kobj, struct ab8500_fg, fg_kobject);2515 2516 if (!entry->store)2517 return -EIO;2518 2519 return entry->store(di, buf, count);2520}2521 2522static const struct sysfs_ops ab8500_fg_sysfs_ops = {2523 .show = ab8500_fg_show,2524 .store = ab8500_fg_store,2525};2526 2527static struct attribute *ab8500_fg_attrs[] = {2528 &charge_full_attr.attr,2529 &charge_now_attr.attr,2530 NULL,2531};2532ATTRIBUTE_GROUPS(ab8500_fg);2533 2534static const struct kobj_type ab8500_fg_ktype = {2535 .sysfs_ops = &ab8500_fg_sysfs_ops,2536 .default_groups = ab8500_fg_groups,2537};2538 2539/**2540 * ab8500_fg_sysfs_exit() - de-init of sysfs entry2541 * @di: pointer to the struct ab8500_chargalg2542 *2543 * This function removes the entry in sysfs.2544 */2545static void ab8500_fg_sysfs_exit(struct ab8500_fg *di)2546{2547 kobject_del(&di->fg_kobject);2548}2549 2550/**2551 * ab8500_fg_sysfs_init() - init of sysfs entry2552 * @di: pointer to the struct ab8500_chargalg2553 *2554 * This function adds an entry in sysfs.2555 * Returns error code in case of failure else 0(on success)2556 */2557static int ab8500_fg_sysfs_init(struct ab8500_fg *di)2558{2559 int ret = 0;2560 2561 ret = kobject_init_and_add(&di->fg_kobject,2562 &ab8500_fg_ktype,2563 NULL, "battery");2564 if (ret < 0) {2565 kobject_put(&di->fg_kobject);2566 dev_err(di->dev, "failed to create sysfs entry\n");2567 }2568 2569 return ret;2570}2571 2572static ssize_t ab8505_powercut_flagtime_read(struct device *dev,2573 struct device_attribute *attr,2574 char *buf)2575{2576 int ret;2577 u8 reg_value;2578 struct power_supply *psy = dev_get_drvdata(dev);2579 struct ab8500_fg *di = power_supply_get_drvdata(psy);2580 2581 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2582 AB8505_RTC_PCUT_FLAG_TIME_REG, ®_value);2583 2584 if (ret < 0) {2585 dev_err(dev, "Failed to read AB8505_RTC_PCUT_FLAG_TIME_REG\n");2586 goto fail;2587 }2588 2589 return sysfs_emit(buf, "%d\n", (reg_value & 0x7F));2590 2591fail:2592 return ret;2593}2594 2595static ssize_t ab8505_powercut_flagtime_write(struct device *dev,2596 struct device_attribute *attr,2597 const char *buf, size_t count)2598{2599 int ret;2600 int reg_value;2601 struct power_supply *psy = dev_get_drvdata(dev);2602 struct ab8500_fg *di = power_supply_get_drvdata(psy);2603 2604 if (kstrtoint(buf, 10, ®_value))2605 goto fail;2606 2607 if (reg_value > 0x7F) {2608 dev_err(dev, "Incorrect parameter, echo 0 (1.98s) - 127 (15.625ms) for flagtime\n");2609 goto fail;2610 }2611 2612 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2613 AB8505_RTC_PCUT_FLAG_TIME_REG, (u8)reg_value);2614 2615 if (ret < 0)2616 dev_err(dev, "Failed to set AB8505_RTC_PCUT_FLAG_TIME_REG\n");2617 2618fail:2619 return count;2620}2621 2622static ssize_t ab8505_powercut_maxtime_read(struct device *dev,2623 struct device_attribute *attr,2624 char *buf)2625{2626 int ret;2627 u8 reg_value;2628 struct power_supply *psy = dev_get_drvdata(dev);2629 struct ab8500_fg *di = power_supply_get_drvdata(psy);2630 2631 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2632 AB8505_RTC_PCUT_MAX_TIME_REG, ®_value);2633 2634 if (ret < 0) {2635 dev_err(dev, "Failed to read AB8505_RTC_PCUT_MAX_TIME_REG\n");2636 goto fail;2637 }2638 2639 return sysfs_emit(buf, "%d\n", (reg_value & 0x7F));2640 2641fail:2642 return ret;2643 2644}2645 2646static ssize_t ab8505_powercut_maxtime_write(struct device *dev,2647 struct device_attribute *attr,2648 const char *buf, size_t count)2649{2650 int ret;2651 int reg_value;2652 struct power_supply *psy = dev_get_drvdata(dev);2653 struct ab8500_fg *di = power_supply_get_drvdata(psy);2654 2655 if (kstrtoint(buf, 10, ®_value))2656 goto fail;2657 2658 if (reg_value > 0x7F) {2659 dev_err(dev, "Incorrect parameter, echo 0 (0.0s) - 127 (1.98s) for maxtime\n");2660 goto fail;2661 }2662 2663 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2664 AB8505_RTC_PCUT_MAX_TIME_REG, (u8)reg_value);2665 2666 if (ret < 0)2667 dev_err(dev, "Failed to set AB8505_RTC_PCUT_MAX_TIME_REG\n");2668 2669fail:2670 return count;2671}2672 2673static ssize_t ab8505_powercut_restart_read(struct device *dev,2674 struct device_attribute *attr,2675 char *buf)2676{2677 int ret;2678 u8 reg_value;2679 struct power_supply *psy = dev_get_drvdata(dev);2680 struct ab8500_fg *di = power_supply_get_drvdata(psy);2681 2682 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2683 AB8505_RTC_PCUT_RESTART_REG, ®_value);2684 2685 if (ret < 0) {2686 dev_err(dev, "Failed to read AB8505_RTC_PCUT_RESTART_REG\n");2687 goto fail;2688 }2689 2690 return sysfs_emit(buf, "%d\n", (reg_value & 0xF));2691 2692fail:2693 return ret;2694}2695 2696static ssize_t ab8505_powercut_restart_write(struct device *dev,2697 struct device_attribute *attr,2698 const char *buf, size_t count)2699{2700 int ret;2701 int reg_value;2702 struct power_supply *psy = dev_get_drvdata(dev);2703 struct ab8500_fg *di = power_supply_get_drvdata(psy);2704 2705 if (kstrtoint(buf, 10, ®_value))2706 goto fail;2707 2708 if (reg_value > 0xF) {2709 dev_err(dev, "Incorrect parameter, echo 0 - 15 for number of restart\n");2710 goto fail;2711 }2712 2713 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2714 AB8505_RTC_PCUT_RESTART_REG, (u8)reg_value);2715 2716 if (ret < 0)2717 dev_err(dev, "Failed to set AB8505_RTC_PCUT_RESTART_REG\n");2718 2719fail:2720 return count;2721 2722}2723 2724static ssize_t ab8505_powercut_timer_read(struct device *dev,2725 struct device_attribute *attr,2726 char *buf)2727{2728 int ret;2729 u8 reg_value;2730 struct power_supply *psy = dev_get_drvdata(dev);2731 struct ab8500_fg *di = power_supply_get_drvdata(psy);2732 2733 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2734 AB8505_RTC_PCUT_TIME_REG, ®_value);2735 2736 if (ret < 0) {2737 dev_err(dev, "Failed to read AB8505_RTC_PCUT_TIME_REG\n");2738 goto fail;2739 }2740 2741 return sysfs_emit(buf, "%d\n", (reg_value & 0x7F));2742 2743fail:2744 return ret;2745}2746 2747static ssize_t ab8505_powercut_restart_counter_read(struct device *dev,2748 struct device_attribute *attr,2749 char *buf)2750{2751 int ret;2752 u8 reg_value;2753 struct power_supply *psy = dev_get_drvdata(dev);2754 struct ab8500_fg *di = power_supply_get_drvdata(psy);2755 2756 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2757 AB8505_RTC_PCUT_RESTART_REG, ®_value);2758 2759 if (ret < 0) {2760 dev_err(dev, "Failed to read AB8505_RTC_PCUT_RESTART_REG\n");2761 goto fail;2762 }2763 2764 return sysfs_emit(buf, "%d\n", (reg_value & 0xF0) >> 4);2765 2766fail:2767 return ret;2768}2769 2770static ssize_t ab8505_powercut_read(struct device *dev,2771 struct device_attribute *attr,2772 char *buf)2773{2774 int ret;2775 u8 reg_value;2776 struct power_supply *psy = dev_get_drvdata(dev);2777 struct ab8500_fg *di = power_supply_get_drvdata(psy);2778 2779 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2780 AB8505_RTC_PCUT_CTL_STATUS_REG, ®_value);2781 2782 if (ret < 0)2783 goto fail;2784 2785 return sysfs_emit(buf, "%d\n", (reg_value & 0x1));2786 2787fail:2788 return ret;2789}2790 2791static ssize_t ab8505_powercut_write(struct device *dev,2792 struct device_attribute *attr,2793 const char *buf, size_t count)2794{2795 int ret;2796 int reg_value;2797 struct power_supply *psy = dev_get_drvdata(dev);2798 struct ab8500_fg *di = power_supply_get_drvdata(psy);2799 2800 if (kstrtoint(buf, 10, ®_value))2801 goto fail;2802 2803 if (reg_value > 0x1) {2804 dev_err(dev, "Incorrect parameter, echo 0/1 to disable/enable Pcut feature\n");2805 goto fail;2806 }2807 2808 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2809 AB8505_RTC_PCUT_CTL_STATUS_REG, (u8)reg_value);2810 2811 if (ret < 0)2812 dev_err(dev, "Failed to set AB8505_RTC_PCUT_CTL_STATUS_REG\n");2813 2814fail:2815 return count;2816}2817 2818static ssize_t ab8505_powercut_flag_read(struct device *dev,2819 struct device_attribute *attr,2820 char *buf)2821{2822 2823 int ret;2824 u8 reg_value;2825 struct power_supply *psy = dev_get_drvdata(dev);2826 struct ab8500_fg *di = power_supply_get_drvdata(psy);2827 2828 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2829 AB8505_RTC_PCUT_CTL_STATUS_REG, ®_value);2830 2831 if (ret < 0) {2832 dev_err(dev, "Failed to read AB8505_RTC_PCUT_CTL_STATUS_REG\n");2833 goto fail;2834 }2835 2836 return sysfs_emit(buf, "%d\n", ((reg_value & 0x10) >> 4));2837 2838fail:2839 return ret;2840}2841 2842static ssize_t ab8505_powercut_debounce_read(struct device *dev,2843 struct device_attribute *attr,2844 char *buf)2845{2846 int ret;2847 u8 reg_value;2848 struct power_supply *psy = dev_get_drvdata(dev);2849 struct ab8500_fg *di = power_supply_get_drvdata(psy);2850 2851 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2852 AB8505_RTC_PCUT_DEBOUNCE_REG, ®_value);2853 2854 if (ret < 0) {2855 dev_err(dev, "Failed to read AB8505_RTC_PCUT_DEBOUNCE_REG\n");2856 goto fail;2857 }2858 2859 return sysfs_emit(buf, "%d\n", (reg_value & 0x7));2860 2861fail:2862 return ret;2863}2864 2865static ssize_t ab8505_powercut_debounce_write(struct device *dev,2866 struct device_attribute *attr,2867 const char *buf, size_t count)2868{2869 int ret;2870 int reg_value;2871 struct power_supply *psy = dev_get_drvdata(dev);2872 struct ab8500_fg *di = power_supply_get_drvdata(psy);2873 2874 if (kstrtoint(buf, 10, ®_value))2875 goto fail;2876 2877 if (reg_value > 0x7) {2878 dev_err(dev, "Incorrect parameter, echo 0 to 7 for debounce setting\n");2879 goto fail;2880 }2881 2882 ret = abx500_set_register_interruptible(di->dev, AB8500_RTC,2883 AB8505_RTC_PCUT_DEBOUNCE_REG, (u8)reg_value);2884 2885 if (ret < 0)2886 dev_err(dev, "Failed to set AB8505_RTC_PCUT_DEBOUNCE_REG\n");2887 2888fail:2889 return count;2890}2891 2892static ssize_t ab8505_powercut_enable_status_read(struct device *dev,2893 struct device_attribute *attr,2894 char *buf)2895{2896 int ret;2897 u8 reg_value;2898 struct power_supply *psy = dev_get_drvdata(dev);2899 struct ab8500_fg *di = power_supply_get_drvdata(psy);2900 2901 ret = abx500_get_register_interruptible(di->dev, AB8500_RTC,2902 AB8505_RTC_PCUT_CTL_STATUS_REG, ®_value);2903 2904 if (ret < 0) {2905 dev_err(dev, "Failed to read AB8505_RTC_PCUT_CTL_STATUS_REG\n");2906 goto fail;2907 }2908 2909 return sysfs_emit(buf, "%d\n", ((reg_value & 0x20) >> 5));2910 2911fail:2912 return ret;2913}2914 2915static struct device_attribute ab8505_fg_sysfs_psy_attrs[] = {2916 __ATTR(powercut_flagtime, (S_IRUGO | S_IWUSR | S_IWGRP),2917 ab8505_powercut_flagtime_read, ab8505_powercut_flagtime_write),2918 __ATTR(powercut_maxtime, (S_IRUGO | S_IWUSR | S_IWGRP),2919 ab8505_powercut_maxtime_read, ab8505_powercut_maxtime_write),2920 __ATTR(powercut_restart_max, (S_IRUGO | S_IWUSR | S_IWGRP),2921 ab8505_powercut_restart_read, ab8505_powercut_restart_write),2922 __ATTR(powercut_timer, S_IRUGO, ab8505_powercut_timer_read, NULL),2923 __ATTR(powercut_restart_counter, S_IRUGO,2924 ab8505_powercut_restart_counter_read, NULL),2925 __ATTR(powercut_enable, (S_IRUGO | S_IWUSR | S_IWGRP),2926 ab8505_powercut_read, ab8505_powercut_write),2927 __ATTR(powercut_flag, S_IRUGO, ab8505_powercut_flag_read, NULL),2928 __ATTR(powercut_debounce_time, (S_IRUGO | S_IWUSR | S_IWGRP),2929 ab8505_powercut_debounce_read, ab8505_powercut_debounce_write),2930 __ATTR(powercut_enable_status, S_IRUGO,2931 ab8505_powercut_enable_status_read, NULL),2932};2933 2934static int ab8500_fg_sysfs_psy_create_attrs(struct ab8500_fg *di)2935{2936 unsigned int i;2937 2938 if (is_ab8505(di->parent)) {2939 for (i = 0; i < ARRAY_SIZE(ab8505_fg_sysfs_psy_attrs); i++)2940 if (device_create_file(&di->fg_psy->dev,2941 &ab8505_fg_sysfs_psy_attrs[i]))2942 goto sysfs_psy_create_attrs_failed_ab8505;2943 }2944 return 0;2945sysfs_psy_create_attrs_failed_ab8505:2946 dev_err(&di->fg_psy->dev, "Failed creating sysfs psy attrs for ab8505.\n");2947 while (i--)2948 device_remove_file(&di->fg_psy->dev,2949 &ab8505_fg_sysfs_psy_attrs[i]);2950 2951 return -EIO;2952}2953 2954static void ab8500_fg_sysfs_psy_remove_attrs(struct ab8500_fg *di)2955{2956 unsigned int i;2957 2958 if (is_ab8505(di->parent)) {2959 for (i = 0; i < ARRAY_SIZE(ab8505_fg_sysfs_psy_attrs); i++)2960 (void)device_remove_file(&di->fg_psy->dev,2961 &ab8505_fg_sysfs_psy_attrs[i]);2962 }2963}2964 2965/* Exposure to the sysfs interface <<END>> */2966 2967static int __maybe_unused ab8500_fg_resume(struct device *dev)2968{2969 struct ab8500_fg *di = dev_get_drvdata(dev);2970 2971 /*2972 * Change state if we're not charging. If we're charging we will wake2973 * up on the FG IRQ2974 */2975 if (!di->flags.charging) {2976 ab8500_fg_discharge_state_to(di, AB8500_FG_DISCHARGE_WAKEUP);2977 queue_work(di->fg_wq, &di->fg_work);2978 }2979 2980 return 0;2981}2982 2983static int __maybe_unused ab8500_fg_suspend(struct device *dev)2984{2985 struct ab8500_fg *di = dev_get_drvdata(dev);2986 2987 flush_delayed_work(&di->fg_periodic_work);2988 flush_work(&di->fg_work);2989 flush_work(&di->fg_acc_cur_work);2990 flush_delayed_work(&di->fg_reinit_work);2991 flush_delayed_work(&di->fg_low_bat_work);2992 flush_delayed_work(&di->fg_check_hw_failure_work);2993 2994 /*2995 * If the FG is enabled we will disable it before going to suspend2996 * only if we're not charging2997 */2998 if (di->flags.fg_enabled && !di->flags.charging)2999 ab8500_fg_coulomb_counter(di, false);3000 3001 return 0;3002}3003 3004/* ab8500 fg driver interrupts and their respective isr */3005static struct ab8500_fg_interrupts ab8500_fg_irq[] = {3006 {"NCONV_ACCU", ab8500_fg_cc_convend_handler},3007 {"BATT_OVV", ab8500_fg_batt_ovv_handler},3008 {"LOW_BAT_F", ab8500_fg_lowbatf_handler},3009 {"CC_INT_CALIB", ab8500_fg_cc_int_calib_handler},3010 {"CCEOC", ab8500_fg_cc_data_end_handler},3011};3012 3013static char *supply_interface[] = {3014 "ab8500_chargalg",3015 "ab8500_usb",3016};3017 3018static const struct power_supply_desc ab8500_fg_desc = {3019 .name = "ab8500_fg",3020 .type = POWER_SUPPLY_TYPE_BATTERY,3021 .properties = ab8500_fg_props,3022 .num_properties = ARRAY_SIZE(ab8500_fg_props),3023 .get_property = ab8500_fg_get_property,3024 .external_power_changed = ab8500_fg_external_power_changed,3025};3026 3027static int ab8500_fg_bind(struct device *dev, struct device *master,3028 void *data)3029{3030 struct ab8500_fg *di = dev_get_drvdata(dev);3031 3032 di->bat_cap.max_mah_design = di->bm->bi->charge_full_design_uah;3033 di->bat_cap.max_mah = di->bat_cap.max_mah_design;3034 di->vbat_nom_uv = di->bm->bi->voltage_max_design_uv;3035 3036 /* Start the coulomb counter */3037 ab8500_fg_coulomb_counter(di, true);3038 /* Run the FG algorithm */3039 queue_delayed_work(di->fg_wq, &di->fg_periodic_work, 0);3040 3041 return 0;3042}3043 3044static void ab8500_fg_unbind(struct device *dev, struct device *master,3045 void *data)3046{3047 struct ab8500_fg *di = dev_get_drvdata(dev);3048 int ret;3049 3050 /* Disable coulomb counter */3051 ret = ab8500_fg_coulomb_counter(di, false);3052 if (ret)3053 dev_err(dev, "failed to disable coulomb counter\n");3054 3055 flush_workqueue(di->fg_wq);3056}3057 3058static const struct component_ops ab8500_fg_component_ops = {3059 .bind = ab8500_fg_bind,3060 .unbind = ab8500_fg_unbind,3061};3062 3063static int ab8500_fg_probe(struct platform_device *pdev)3064{3065 struct device *dev = &pdev->dev;3066 struct power_supply_config psy_cfg = {};3067 struct ab8500_fg *di;3068 int i, irq;3069 int ret = 0;3070 3071 di = devm_kzalloc(dev, sizeof(*di), GFP_KERNEL);3072 if (!di)3073 return -ENOMEM;3074 3075 di->bm = &ab8500_bm_data;3076 3077 mutex_init(&di->cc_lock);3078 3079 /* get parent data */3080 di->dev = dev;3081 di->parent = dev_get_drvdata(pdev->dev.parent);3082 3083 di->main_bat_v = devm_iio_channel_get(dev, "main_bat_v");3084 if (IS_ERR(di->main_bat_v)) {3085 ret = dev_err_probe(dev, PTR_ERR(di->main_bat_v),3086 "failed to get main battery ADC channel\n");3087 return ret;3088 }3089 3090 if (!of_property_read_u32(dev->of_node, "line-impedance-micro-ohms",3091 &di->line_impedance_uohm))3092 dev_info(dev, "line impedance: %u uOhm\n",3093 di->line_impedance_uohm);3094 3095 psy_cfg.supplied_to = supply_interface;3096 psy_cfg.num_supplicants = ARRAY_SIZE(supply_interface);3097 psy_cfg.drv_data = di;3098 3099 di->init_capacity = true;3100 3101 ab8500_fg_charge_state_to(di, AB8500_FG_CHARGE_INIT);3102 ab8500_fg_discharge_state_to(di, AB8500_FG_DISCHARGE_INIT);3103 3104 /* Create a work queue for running the FG algorithm */3105 di->fg_wq = alloc_ordered_workqueue("ab8500_fg_wq", WQ_MEM_RECLAIM);3106 if (di->fg_wq == NULL) {3107 dev_err(dev, "failed to create work queue\n");3108 return -ENOMEM;3109 }3110 3111 /* Init work for running the fg algorithm instantly */3112 INIT_WORK(&di->fg_work, ab8500_fg_instant_work);3113 3114 /* Init work for getting the battery accumulated current */3115 INIT_WORK(&di->fg_acc_cur_work, ab8500_fg_acc_cur_work);3116 3117 /* Init work for reinitialising the fg algorithm */3118 INIT_DEFERRABLE_WORK(&di->fg_reinit_work,3119 ab8500_fg_reinit_work);3120 3121 /* Work delayed Queue to run the state machine */3122 INIT_DEFERRABLE_WORK(&di->fg_periodic_work,3123 ab8500_fg_periodic_work);3124 3125 /* Work to check low battery condition */3126 INIT_DEFERRABLE_WORK(&di->fg_low_bat_work,3127 ab8500_fg_low_bat_work);3128 3129 /* Init work for HW failure check */3130 INIT_DEFERRABLE_WORK(&di->fg_check_hw_failure_work,3131 ab8500_fg_check_hw_failure_work);3132 3133 /* Reset battery low voltage flag */3134 di->flags.low_bat = false;3135 3136 /* Initialize low battery counter */3137 di->low_bat_cnt = 10;3138 3139 /* Initialize OVV, and other registers */3140 ret = ab8500_fg_init_hw_registers(di);3141 if (ret) {3142 dev_err(dev, "failed to initialize registers\n");3143 destroy_workqueue(di->fg_wq);3144 return ret;3145 }3146 3147 /* Consider battery unknown until we're informed otherwise */3148 di->flags.batt_unknown = true;3149 di->flags.batt_id_received = false;3150 3151 /* Register FG power supply class */3152 di->fg_psy = devm_power_supply_register(dev, &ab8500_fg_desc, &psy_cfg);3153 if (IS_ERR(di->fg_psy)) {3154 dev_err(dev, "failed to register FG psy\n");3155 destroy_workqueue(di->fg_wq);3156 return PTR_ERR(di->fg_psy);3157 }3158 3159 di->fg_samples = SEC_TO_SAMPLE(di->bm->fg_params->init_timer);3160 3161 /*3162 * Initialize completion used to notify completion and start3163 * of inst current3164 */3165 init_completion(&di->ab8500_fg_started);3166 init_completion(&di->ab8500_fg_complete);3167 3168 /* Register primary interrupt handlers */3169 for (i = 0; i < ARRAY_SIZE(ab8500_fg_irq); i++) {3170 irq = platform_get_irq_byname(pdev, ab8500_fg_irq[i].name);3171 if (irq < 0) {3172 destroy_workqueue(di->fg_wq);3173 return irq;3174 }3175 3176 ret = devm_request_threaded_irq(dev, irq, NULL,3177 ab8500_fg_irq[i].isr,3178 IRQF_SHARED | IRQF_NO_SUSPEND | IRQF_ONESHOT,3179 ab8500_fg_irq[i].name, di);3180 3181 if (ret != 0) {3182 dev_err(dev, "failed to request %s IRQ %d: %d\n",3183 ab8500_fg_irq[i].name, irq, ret);3184 destroy_workqueue(di->fg_wq);3185 return ret;3186 }3187 dev_dbg(dev, "Requested %s IRQ %d: %d\n",3188 ab8500_fg_irq[i].name, irq, ret);3189 }3190 3191 di->irq = platform_get_irq_byname(pdev, "CCEOC");3192 disable_irq(di->irq);3193 di->nbr_cceoc_irq_cnt = 0;3194 3195 platform_set_drvdata(pdev, di);3196 3197 ret = ab8500_fg_sysfs_init(di);3198 if (ret) {3199 dev_err(dev, "failed to create sysfs entry\n");3200 destroy_workqueue(di->fg_wq);3201 return ret;3202 }3203 3204 ret = ab8500_fg_sysfs_psy_create_attrs(di);3205 if (ret) {3206 dev_err(dev, "failed to create FG psy\n");3207 ab8500_fg_sysfs_exit(di);3208 destroy_workqueue(di->fg_wq);3209 return ret;3210 }3211 3212 /* Calibrate the fg first time */3213 di->flags.calibrate = true;3214 di->calib_state = AB8500_FG_CALIB_INIT;3215 3216 /* Use room temp as default value until we get an update from driver. */3217 di->bat_temp = 210;3218 3219 list_add_tail(&di->node, &ab8500_fg_list);3220 3221 return component_add(dev, &ab8500_fg_component_ops);3222}3223 3224static void ab8500_fg_remove(struct platform_device *pdev)3225{3226 struct ab8500_fg *di = platform_get_drvdata(pdev);3227 3228 destroy_workqueue(di->fg_wq);3229 component_del(&pdev->dev, &ab8500_fg_component_ops);3230 list_del(&di->node);3231 ab8500_fg_sysfs_exit(di);3232 ab8500_fg_sysfs_psy_remove_attrs(di);3233}3234 3235static SIMPLE_DEV_PM_OPS(ab8500_fg_pm_ops, ab8500_fg_suspend, ab8500_fg_resume);3236 3237static const struct of_device_id ab8500_fg_match[] = {3238 { .compatible = "stericsson,ab8500-fg", },3239 { },3240};3241MODULE_DEVICE_TABLE(of, ab8500_fg_match);3242 3243struct platform_driver ab8500_fg_driver = {3244 .probe = ab8500_fg_probe,3245 .remove_new = ab8500_fg_remove,3246 .driver = {3247 .name = "ab8500-fg",3248 .of_match_table = ab8500_fg_match,3249 .pm = &ab8500_fg_pm_ops,3250 },3251};3252MODULE_LICENSE("GPL v2");3253MODULE_AUTHOR("Johan Palsson, Karl Komierowski");3254MODULE_ALIAS("platform:ab8500-fg");3255MODULE_DESCRIPTION("AB8500 Fuel Gauge driver");3256