treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / power / supply / abx500_chargalg.c
blob2fb33a07879a3b6af8a53df920e47bca119cf0a1
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) ST-Ericsson SA 2012
4 * Copyright (c) 2012 Sony Mobile Communications AB
6 * Charging algorithm driver for abx500 variants
8 * Authors:
9 * Johan Palsson <johan.palsson@stericsson.com>
10 * Karl Komierowski <karl.komierowski@stericsson.com>
11 * Arun R Murthy <arun.murthy@stericsson.com>
12 * Author: Imre Sunyi <imre.sunyi@sonymobile.com>
15 #include <linux/init.h>
16 #include <linux/module.h>
17 #include <linux/device.h>
18 #include <linux/hrtimer.h>
19 #include <linux/interrupt.h>
20 #include <linux/delay.h>
21 #include <linux/slab.h>
22 #include <linux/platform_device.h>
23 #include <linux/power_supply.h>
24 #include <linux/completion.h>
25 #include <linux/workqueue.h>
26 #include <linux/kobject.h>
27 #include <linux/of.h>
28 #include <linux/mfd/core.h>
29 #include <linux/mfd/abx500.h>
30 #include <linux/mfd/abx500/ab8500.h>
31 #include <linux/mfd/abx500/ux500_chargalg.h>
32 #include <linux/mfd/abx500/ab8500-bm.h>
33 #include <linux/notifier.h>
35 /* Watchdog kick interval */
36 #define CHG_WD_INTERVAL (6 * HZ)
38 /* End-of-charge criteria counter */
39 #define EOC_COND_CNT 10
41 /* One hour expressed in seconds */
42 #define ONE_HOUR_IN_SECONDS 3600
44 /* Five minutes expressed in seconds */
45 #define FIVE_MINUTES_IN_SECONDS 300
47 #define CHARGALG_CURR_STEP_LOW 0
48 #define CHARGALG_CURR_STEP_HIGH 100
50 enum abx500_chargers {
51 NO_CHG,
52 AC_CHG,
53 USB_CHG,
56 struct abx500_chargalg_charger_info {
57 enum abx500_chargers conn_chg;
58 enum abx500_chargers prev_conn_chg;
59 enum abx500_chargers online_chg;
60 enum abx500_chargers prev_online_chg;
61 enum abx500_chargers charger_type;
62 bool usb_chg_ok;
63 bool ac_chg_ok;
64 int usb_volt;
65 int usb_curr;
66 int ac_volt;
67 int ac_curr;
68 int usb_vset;
69 int usb_iset;
70 int ac_vset;
71 int ac_iset;
74 struct abx500_chargalg_suspension_status {
75 bool suspended_change;
76 bool ac_suspended;
77 bool usb_suspended;
80 struct abx500_chargalg_current_step_status {
81 bool curr_step_change;
82 int curr_step;
85 struct abx500_chargalg_battery_data {
86 int temp;
87 int volt;
88 int avg_curr;
89 int inst_curr;
90 int percent;
93 enum abx500_chargalg_states {
94 STATE_HANDHELD_INIT,
95 STATE_HANDHELD,
96 STATE_CHG_NOT_OK_INIT,
97 STATE_CHG_NOT_OK,
98 STATE_HW_TEMP_PROTECT_INIT,
99 STATE_HW_TEMP_PROTECT,
100 STATE_NORMAL_INIT,
101 STATE_NORMAL,
102 STATE_WAIT_FOR_RECHARGE_INIT,
103 STATE_WAIT_FOR_RECHARGE,
104 STATE_MAINTENANCE_A_INIT,
105 STATE_MAINTENANCE_A,
106 STATE_MAINTENANCE_B_INIT,
107 STATE_MAINTENANCE_B,
108 STATE_TEMP_UNDEROVER_INIT,
109 STATE_TEMP_UNDEROVER,
110 STATE_TEMP_LOWHIGH_INIT,
111 STATE_TEMP_LOWHIGH,
112 STATE_SUSPENDED_INIT,
113 STATE_SUSPENDED,
114 STATE_OVV_PROTECT_INIT,
115 STATE_OVV_PROTECT,
116 STATE_SAFETY_TIMER_EXPIRED_INIT,
117 STATE_SAFETY_TIMER_EXPIRED,
118 STATE_BATT_REMOVED_INIT,
119 STATE_BATT_REMOVED,
120 STATE_WD_EXPIRED_INIT,
121 STATE_WD_EXPIRED,
124 static const char *states[] = {
125 "HANDHELD_INIT",
126 "HANDHELD",
127 "CHG_NOT_OK_INIT",
128 "CHG_NOT_OK",
129 "HW_TEMP_PROTECT_INIT",
130 "HW_TEMP_PROTECT",
131 "NORMAL_INIT",
132 "NORMAL",
133 "WAIT_FOR_RECHARGE_INIT",
134 "WAIT_FOR_RECHARGE",
135 "MAINTENANCE_A_INIT",
136 "MAINTENANCE_A",
137 "MAINTENANCE_B_INIT",
138 "MAINTENANCE_B",
139 "TEMP_UNDEROVER_INIT",
140 "TEMP_UNDEROVER",
141 "TEMP_LOWHIGH_INIT",
142 "TEMP_LOWHIGH",
143 "SUSPENDED_INIT",
144 "SUSPENDED",
145 "OVV_PROTECT_INIT",
146 "OVV_PROTECT",
147 "SAFETY_TIMER_EXPIRED_INIT",
148 "SAFETY_TIMER_EXPIRED",
149 "BATT_REMOVED_INIT",
150 "BATT_REMOVED",
151 "WD_EXPIRED_INIT",
152 "WD_EXPIRED",
155 struct abx500_chargalg_events {
156 bool batt_unknown;
157 bool mainextchnotok;
158 bool batt_ovv;
159 bool batt_rem;
160 bool btemp_underover;
161 bool btemp_lowhigh;
162 bool main_thermal_prot;
163 bool usb_thermal_prot;
164 bool main_ovv;
165 bool vbus_ovv;
166 bool usbchargernotok;
167 bool safety_timer_expired;
168 bool maintenance_timer_expired;
169 bool ac_wd_expired;
170 bool usb_wd_expired;
171 bool ac_cv_active;
172 bool usb_cv_active;
173 bool vbus_collapsed;
177 * struct abx500_charge_curr_maximization - Charger maximization parameters
178 * @original_iset: the non optimized/maximised charger current
179 * @current_iset: the charging current used at this moment
180 * @test_delta_i: the delta between the current we want to charge and the
181 current that is really going into the battery
182 * @condition_cnt: number of iterations needed before a new charger current
183 is set
184 * @max_current: maximum charger current
185 * @wait_cnt: to avoid too fast current step down in case of charger
186 * voltage collapse, we insert this delay between step
187 * down
188 * @level: tells in how many steps the charging current has been
189 increased
191 struct abx500_charge_curr_maximization {
192 int original_iset;
193 int current_iset;
194 int test_delta_i;
195 int condition_cnt;
196 int max_current;
197 int wait_cnt;
198 u8 level;
201 enum maxim_ret {
202 MAXIM_RET_NOACTION,
203 MAXIM_RET_CHANGE,
204 MAXIM_RET_IBAT_TOO_HIGH,
208 * struct abx500_chargalg - abx500 Charging algorithm device information
209 * @dev: pointer to the structure device
210 * @charge_status: battery operating status
211 * @eoc_cnt: counter used to determine end-of_charge
212 * @maintenance_chg: indicate if maintenance charge is active
213 * @t_hyst_norm temperature hysteresis when the temperature has been
214 * over or under normal limits
215 * @t_hyst_lowhigh temperature hysteresis when the temperature has been
216 * over or under the high or low limits
217 * @charge_state: current state of the charging algorithm
218 * @ccm charging current maximization parameters
219 * @chg_info: information about connected charger types
220 * @batt_data: data of the battery
221 * @susp_status: current charger suspension status
222 * @bm: Platform specific battery management information
223 * @curr_status: Current step status for over-current protection
224 * @parent: pointer to the struct abx500
225 * @chargalg_psy: structure that holds the battery properties exposed by
226 * the charging algorithm
227 * @events: structure for information about events triggered
228 * @chargalg_wq: work queue for running the charging algorithm
229 * @chargalg_periodic_work: work to run the charging algorithm periodically
230 * @chargalg_wd_work: work to kick the charger watchdog periodically
231 * @chargalg_work: work to run the charging algorithm instantly
232 * @safety_timer: charging safety timer
233 * @maintenance_timer: maintenance charging timer
234 * @chargalg_kobject: structure of type kobject
236 struct abx500_chargalg {
237 struct device *dev;
238 int charge_status;
239 int eoc_cnt;
240 bool maintenance_chg;
241 int t_hyst_norm;
242 int t_hyst_lowhigh;
243 enum abx500_chargalg_states charge_state;
244 struct abx500_charge_curr_maximization ccm;
245 struct abx500_chargalg_charger_info chg_info;
246 struct abx500_chargalg_battery_data batt_data;
247 struct abx500_chargalg_suspension_status susp_status;
248 struct ab8500 *parent;
249 struct abx500_chargalg_current_step_status curr_status;
250 struct abx500_bm_data *bm;
251 struct power_supply *chargalg_psy;
252 struct ux500_charger *ac_chg;
253 struct ux500_charger *usb_chg;
254 struct abx500_chargalg_events events;
255 struct workqueue_struct *chargalg_wq;
256 struct delayed_work chargalg_periodic_work;
257 struct delayed_work chargalg_wd_work;
258 struct work_struct chargalg_work;
259 struct hrtimer safety_timer;
260 struct hrtimer maintenance_timer;
261 struct kobject chargalg_kobject;
264 /*External charger prepare notifier*/
265 BLOCKING_NOTIFIER_HEAD(charger_notifier_list);
267 /* Main battery properties */
268 static enum power_supply_property abx500_chargalg_props[] = {
269 POWER_SUPPLY_PROP_STATUS,
270 POWER_SUPPLY_PROP_HEALTH,
273 struct abx500_chargalg_sysfs_entry {
274 struct attribute attr;
275 ssize_t (*show)(struct abx500_chargalg *, char *);
276 ssize_t (*store)(struct abx500_chargalg *, const char *, size_t);
280 * abx500_chargalg_safety_timer_expired() - Expiration of the safety timer
281 * @timer: pointer to the hrtimer structure
283 * This function gets called when the safety timer for the charger
284 * expires
286 static enum hrtimer_restart
287 abx500_chargalg_safety_timer_expired(struct hrtimer *timer)
289 struct abx500_chargalg *di = container_of(timer, struct abx500_chargalg,
290 safety_timer);
291 dev_err(di->dev, "Safety timer expired\n");
292 di->events.safety_timer_expired = true;
294 /* Trigger execution of the algorithm instantly */
295 queue_work(di->chargalg_wq, &di->chargalg_work);
297 return HRTIMER_NORESTART;
301 * abx500_chargalg_maintenance_timer_expired() - Expiration of
302 * the maintenance timer
303 * @timer: pointer to the timer structure
305 * This function gets called when the maintenence timer
306 * expires
308 static enum hrtimer_restart
309 abx500_chargalg_maintenance_timer_expired(struct hrtimer *timer)
312 struct abx500_chargalg *di = container_of(timer, struct abx500_chargalg,
313 maintenance_timer);
315 dev_dbg(di->dev, "Maintenance timer expired\n");
316 di->events.maintenance_timer_expired = true;
318 /* Trigger execution of the algorithm instantly */
319 queue_work(di->chargalg_wq, &di->chargalg_work);
321 return HRTIMER_NORESTART;
325 * abx500_chargalg_state_to() - Change charge state
326 * @di: pointer to the abx500_chargalg structure
328 * This function gets called when a charge state change should occur
330 static void abx500_chargalg_state_to(struct abx500_chargalg *di,
331 enum abx500_chargalg_states state)
333 dev_dbg(di->dev,
334 "State changed: %s (From state: [%d] %s =to=> [%d] %s )\n",
335 di->charge_state == state ? "NO" : "YES",
336 di->charge_state,
337 states[di->charge_state],
338 state,
339 states[state]);
341 di->charge_state = state;
344 static int abx500_chargalg_check_charger_enable(struct abx500_chargalg *di)
346 switch (di->charge_state) {
347 case STATE_NORMAL:
348 case STATE_MAINTENANCE_A:
349 case STATE_MAINTENANCE_B:
350 break;
351 default:
352 return 0;
355 if (di->chg_info.charger_type & USB_CHG) {
356 return di->usb_chg->ops.check_enable(di->usb_chg,
357 di->bm->bat_type[di->bm->batt_id].normal_vol_lvl,
358 di->bm->bat_type[di->bm->batt_id].normal_cur_lvl);
359 } else if ((di->chg_info.charger_type & AC_CHG) &&
360 !(di->ac_chg->external)) {
361 return di->ac_chg->ops.check_enable(di->ac_chg,
362 di->bm->bat_type[di->bm->batt_id].normal_vol_lvl,
363 di->bm->bat_type[di->bm->batt_id].normal_cur_lvl);
365 return 0;
369 * abx500_chargalg_check_charger_connection() - Check charger connection change
370 * @di: pointer to the abx500_chargalg structure
372 * This function will check if there is a change in the charger connection
373 * and change charge state accordingly. AC has precedence over USB.
375 static int abx500_chargalg_check_charger_connection(struct abx500_chargalg *di)
377 if (di->chg_info.conn_chg != di->chg_info.prev_conn_chg ||
378 di->susp_status.suspended_change) {
380 * Charger state changed or suspension
381 * has changed since last update
383 if ((di->chg_info.conn_chg & AC_CHG) &&
384 !di->susp_status.ac_suspended) {
385 dev_dbg(di->dev, "Charging source is AC\n");
386 if (di->chg_info.charger_type != AC_CHG) {
387 di->chg_info.charger_type = AC_CHG;
388 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
390 } else if ((di->chg_info.conn_chg & USB_CHG) &&
391 !di->susp_status.usb_suspended) {
392 dev_dbg(di->dev, "Charging source is USB\n");
393 di->chg_info.charger_type = USB_CHG;
394 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
395 } else if (di->chg_info.conn_chg &&
396 (di->susp_status.ac_suspended ||
397 di->susp_status.usb_suspended)) {
398 dev_dbg(di->dev, "Charging is suspended\n");
399 di->chg_info.charger_type = NO_CHG;
400 abx500_chargalg_state_to(di, STATE_SUSPENDED_INIT);
401 } else {
402 dev_dbg(di->dev, "Charging source is OFF\n");
403 di->chg_info.charger_type = NO_CHG;
404 abx500_chargalg_state_to(di, STATE_HANDHELD_INIT);
406 di->chg_info.prev_conn_chg = di->chg_info.conn_chg;
407 di->susp_status.suspended_change = false;
409 return di->chg_info.conn_chg;
413 * abx500_chargalg_check_current_step_status() - Check charging current
414 * step status.
415 * @di: pointer to the abx500_chargalg structure
417 * This function will check if there is a change in the charging current step
418 * and change charge state accordingly.
420 static void abx500_chargalg_check_current_step_status
421 (struct abx500_chargalg *di)
423 if (di->curr_status.curr_step_change)
424 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
425 di->curr_status.curr_step_change = false;
429 * abx500_chargalg_start_safety_timer() - Start charging safety timer
430 * @di: pointer to the abx500_chargalg structure
432 * The safety timer is used to avoid overcharging of old or bad batteries.
433 * There are different timers for AC and USB
435 static void abx500_chargalg_start_safety_timer(struct abx500_chargalg *di)
437 /* Charger-dependent expiration time in hours*/
438 int timer_expiration = 0;
440 switch (di->chg_info.charger_type) {
441 case AC_CHG:
442 timer_expiration = di->bm->main_safety_tmr_h;
443 break;
445 case USB_CHG:
446 timer_expiration = di->bm->usb_safety_tmr_h;
447 break;
449 default:
450 dev_err(di->dev, "Unknown charger to charge from\n");
451 break;
454 di->events.safety_timer_expired = false;
455 hrtimer_set_expires_range(&di->safety_timer,
456 ktime_set(timer_expiration * ONE_HOUR_IN_SECONDS, 0),
457 ktime_set(FIVE_MINUTES_IN_SECONDS, 0));
458 hrtimer_start_expires(&di->safety_timer, HRTIMER_MODE_REL);
462 * abx500_chargalg_stop_safety_timer() - Stop charging safety timer
463 * @di: pointer to the abx500_chargalg structure
465 * The safety timer is stopped whenever the NORMAL state is exited
467 static void abx500_chargalg_stop_safety_timer(struct abx500_chargalg *di)
469 if (hrtimer_try_to_cancel(&di->safety_timer) >= 0)
470 di->events.safety_timer_expired = false;
474 * abx500_chargalg_start_maintenance_timer() - Start charging maintenance timer
475 * @di: pointer to the abx500_chargalg structure
476 * @duration: duration of ther maintenance timer in hours
478 * The maintenance timer is used to maintain the charge in the battery once
479 * the battery is considered full. These timers are chosen to match the
480 * discharge curve of the battery
482 static void abx500_chargalg_start_maintenance_timer(struct abx500_chargalg *di,
483 int duration)
485 hrtimer_set_expires_range(&di->maintenance_timer,
486 ktime_set(duration * ONE_HOUR_IN_SECONDS, 0),
487 ktime_set(FIVE_MINUTES_IN_SECONDS, 0));
488 di->events.maintenance_timer_expired = false;
489 hrtimer_start_expires(&di->maintenance_timer, HRTIMER_MODE_REL);
493 * abx500_chargalg_stop_maintenance_timer() - Stop maintenance timer
494 * @di: pointer to the abx500_chargalg structure
496 * The maintenance timer is stopped whenever maintenance ends or when another
497 * state is entered
499 static void abx500_chargalg_stop_maintenance_timer(struct abx500_chargalg *di)
501 if (hrtimer_try_to_cancel(&di->maintenance_timer) >= 0)
502 di->events.maintenance_timer_expired = false;
506 * abx500_chargalg_kick_watchdog() - Kick charger watchdog
507 * @di: pointer to the abx500_chargalg structure
509 * The charger watchdog have to be kicked periodically whenever the charger is
510 * on, else the ABB will reset the system
512 static int abx500_chargalg_kick_watchdog(struct abx500_chargalg *di)
514 /* Check if charger exists and kick watchdog if charging */
515 if (di->ac_chg && di->ac_chg->ops.kick_wd &&
516 di->chg_info.online_chg & AC_CHG) {
518 * If AB charger watchdog expired, pm2xxx charging
519 * gets disabled. To be safe, kick both AB charger watchdog
520 * and pm2xxx watchdog.
522 if (di->ac_chg->external &&
523 di->usb_chg && di->usb_chg->ops.kick_wd)
524 di->usb_chg->ops.kick_wd(di->usb_chg);
526 return di->ac_chg->ops.kick_wd(di->ac_chg);
528 else if (di->usb_chg && di->usb_chg->ops.kick_wd &&
529 di->chg_info.online_chg & USB_CHG)
530 return di->usb_chg->ops.kick_wd(di->usb_chg);
532 return -ENXIO;
536 * abx500_chargalg_ac_en() - Turn on/off the AC charger
537 * @di: pointer to the abx500_chargalg structure
538 * @enable: charger on/off
539 * @vset: requested charger output voltage
540 * @iset: requested charger output current
542 * The AC charger will be turned on/off with the requested charge voltage and
543 * current
545 static int abx500_chargalg_ac_en(struct abx500_chargalg *di, int enable,
546 int vset, int iset)
548 static int abx500_chargalg_ex_ac_enable_toggle;
550 if (!di->ac_chg || !di->ac_chg->ops.enable)
551 return -ENXIO;
553 /* Select maximum of what both the charger and the battery supports */
554 if (di->ac_chg->max_out_volt)
555 vset = min(vset, di->ac_chg->max_out_volt);
556 if (di->ac_chg->max_out_curr)
557 iset = min(iset, di->ac_chg->max_out_curr);
559 di->chg_info.ac_iset = iset;
560 di->chg_info.ac_vset = vset;
562 /* Enable external charger */
563 if (enable && di->ac_chg->external &&
564 !abx500_chargalg_ex_ac_enable_toggle) {
565 blocking_notifier_call_chain(&charger_notifier_list,
566 0, di->dev);
567 abx500_chargalg_ex_ac_enable_toggle++;
570 return di->ac_chg->ops.enable(di->ac_chg, enable, vset, iset);
574 * abx500_chargalg_usb_en() - Turn on/off the USB charger
575 * @di: pointer to the abx500_chargalg structure
576 * @enable: charger on/off
577 * @vset: requested charger output voltage
578 * @iset: requested charger output current
580 * The USB charger will be turned on/off with the requested charge voltage and
581 * current
583 static int abx500_chargalg_usb_en(struct abx500_chargalg *di, int enable,
584 int vset, int iset)
586 if (!di->usb_chg || !di->usb_chg->ops.enable)
587 return -ENXIO;
589 /* Select maximum of what both the charger and the battery supports */
590 if (di->usb_chg->max_out_volt)
591 vset = min(vset, di->usb_chg->max_out_volt);
592 if (di->usb_chg->max_out_curr)
593 iset = min(iset, di->usb_chg->max_out_curr);
595 di->chg_info.usb_iset = iset;
596 di->chg_info.usb_vset = vset;
598 return di->usb_chg->ops.enable(di->usb_chg, enable, vset, iset);
602 * abx500_chargalg_update_chg_curr() - Update charger current
603 * @di: pointer to the abx500_chargalg structure
604 * @iset: requested charger output current
606 * The charger output current will be updated for the charger
607 * that is currently in use
609 static int abx500_chargalg_update_chg_curr(struct abx500_chargalg *di,
610 int iset)
612 /* Check if charger exists and update current if charging */
613 if (di->ac_chg && di->ac_chg->ops.update_curr &&
614 di->chg_info.charger_type & AC_CHG) {
616 * Select maximum of what both the charger
617 * and the battery supports
619 if (di->ac_chg->max_out_curr)
620 iset = min(iset, di->ac_chg->max_out_curr);
622 di->chg_info.ac_iset = iset;
624 return di->ac_chg->ops.update_curr(di->ac_chg, iset);
625 } else if (di->usb_chg && di->usb_chg->ops.update_curr &&
626 di->chg_info.charger_type & USB_CHG) {
628 * Select maximum of what both the charger
629 * and the battery supports
631 if (di->usb_chg->max_out_curr)
632 iset = min(iset, di->usb_chg->max_out_curr);
634 di->chg_info.usb_iset = iset;
636 return di->usb_chg->ops.update_curr(di->usb_chg, iset);
639 return -ENXIO;
643 * abx500_chargalg_stop_charging() - Stop charging
644 * @di: pointer to the abx500_chargalg structure
646 * This function is called from any state where charging should be stopped.
647 * All charging is disabled and all status parameters and timers are changed
648 * accordingly
650 static void abx500_chargalg_stop_charging(struct abx500_chargalg *di)
652 abx500_chargalg_ac_en(di, false, 0, 0);
653 abx500_chargalg_usb_en(di, false, 0, 0);
654 abx500_chargalg_stop_safety_timer(di);
655 abx500_chargalg_stop_maintenance_timer(di);
656 di->charge_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
657 di->maintenance_chg = false;
658 cancel_delayed_work(&di->chargalg_wd_work);
659 power_supply_changed(di->chargalg_psy);
663 * abx500_chargalg_hold_charging() - Pauses charging
664 * @di: pointer to the abx500_chargalg structure
666 * This function is called in the case where maintenance charging has been
667 * disabled and instead a battery voltage mode is entered to check when the
668 * battery voltage has reached a certain recharge voltage
670 static void abx500_chargalg_hold_charging(struct abx500_chargalg *di)
672 abx500_chargalg_ac_en(di, false, 0, 0);
673 abx500_chargalg_usb_en(di, false, 0, 0);
674 abx500_chargalg_stop_safety_timer(di);
675 abx500_chargalg_stop_maintenance_timer(di);
676 di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
677 di->maintenance_chg = false;
678 cancel_delayed_work(&di->chargalg_wd_work);
679 power_supply_changed(di->chargalg_psy);
683 * abx500_chargalg_start_charging() - Start the charger
684 * @di: pointer to the abx500_chargalg structure
685 * @vset: requested charger output voltage
686 * @iset: requested charger output current
688 * A charger will be enabled depending on the requested charger type that was
689 * detected previously.
691 static void abx500_chargalg_start_charging(struct abx500_chargalg *di,
692 int vset, int iset)
694 switch (di->chg_info.charger_type) {
695 case AC_CHG:
696 dev_dbg(di->dev,
697 "AC parameters: Vset %d, Ich %d\n", vset, iset);
698 abx500_chargalg_usb_en(di, false, 0, 0);
699 abx500_chargalg_ac_en(di, true, vset, iset);
700 break;
702 case USB_CHG:
703 dev_dbg(di->dev,
704 "USB parameters: Vset %d, Ich %d\n", vset, iset);
705 abx500_chargalg_ac_en(di, false, 0, 0);
706 abx500_chargalg_usb_en(di, true, vset, iset);
707 break;
709 default:
710 dev_err(di->dev, "Unknown charger to charge from\n");
711 break;
716 * abx500_chargalg_check_temp() - Check battery temperature ranges
717 * @di: pointer to the abx500_chargalg structure
719 * The battery temperature is checked against the predefined limits and the
720 * charge state is changed accordingly
722 static void abx500_chargalg_check_temp(struct abx500_chargalg *di)
724 if (di->batt_data.temp > (di->bm->temp_low + di->t_hyst_norm) &&
725 di->batt_data.temp < (di->bm->temp_high - di->t_hyst_norm)) {
726 /* Temp OK! */
727 di->events.btemp_underover = false;
728 di->events.btemp_lowhigh = false;
729 di->t_hyst_norm = 0;
730 di->t_hyst_lowhigh = 0;
731 } else {
732 if (((di->batt_data.temp >= di->bm->temp_high) &&
733 (di->batt_data.temp <
734 (di->bm->temp_over - di->t_hyst_lowhigh))) ||
735 ((di->batt_data.temp >
736 (di->bm->temp_under + di->t_hyst_lowhigh)) &&
737 (di->batt_data.temp <= di->bm->temp_low))) {
738 /* TEMP minor!!!!! */
739 di->events.btemp_underover = false;
740 di->events.btemp_lowhigh = true;
741 di->t_hyst_norm = di->bm->temp_hysteresis;
742 di->t_hyst_lowhigh = 0;
743 } else if (di->batt_data.temp <= di->bm->temp_under ||
744 di->batt_data.temp >= di->bm->temp_over) {
745 /* TEMP major!!!!! */
746 di->events.btemp_underover = true;
747 di->events.btemp_lowhigh = false;
748 di->t_hyst_norm = 0;
749 di->t_hyst_lowhigh = di->bm->temp_hysteresis;
750 } else {
751 /* Within hysteresis */
752 dev_dbg(di->dev, "Within hysteresis limit temp: %d "
753 "hyst_lowhigh %d, hyst normal %d\n",
754 di->batt_data.temp, di->t_hyst_lowhigh,
755 di->t_hyst_norm);
761 * abx500_chargalg_check_charger_voltage() - Check charger voltage
762 * @di: pointer to the abx500_chargalg structure
764 * Charger voltage is checked against maximum limit
766 static void abx500_chargalg_check_charger_voltage(struct abx500_chargalg *di)
768 if (di->chg_info.usb_volt > di->bm->chg_params->usb_volt_max)
769 di->chg_info.usb_chg_ok = false;
770 else
771 di->chg_info.usb_chg_ok = true;
773 if (di->chg_info.ac_volt > di->bm->chg_params->ac_volt_max)
774 di->chg_info.ac_chg_ok = false;
775 else
776 di->chg_info.ac_chg_ok = true;
781 * abx500_chargalg_end_of_charge() - Check if end-of-charge criteria is fulfilled
782 * @di: pointer to the abx500_chargalg structure
784 * End-of-charge criteria is fulfilled when the battery voltage is above a
785 * certain limit and the battery current is below a certain limit for a
786 * predefined number of consecutive seconds. If true, the battery is full
788 static void abx500_chargalg_end_of_charge(struct abx500_chargalg *di)
790 if (di->charge_status == POWER_SUPPLY_STATUS_CHARGING &&
791 di->charge_state == STATE_NORMAL &&
792 !di->maintenance_chg && (di->batt_data.volt >=
793 di->bm->bat_type[di->bm->batt_id].termination_vol ||
794 di->events.usb_cv_active || di->events.ac_cv_active) &&
795 di->batt_data.avg_curr <
796 di->bm->bat_type[di->bm->batt_id].termination_curr &&
797 di->batt_data.avg_curr > 0) {
798 if (++di->eoc_cnt >= EOC_COND_CNT) {
799 di->eoc_cnt = 0;
800 di->charge_status = POWER_SUPPLY_STATUS_FULL;
801 di->maintenance_chg = true;
802 dev_dbg(di->dev, "EOC reached!\n");
803 power_supply_changed(di->chargalg_psy);
804 } else {
805 dev_dbg(di->dev,
806 " EOC limit reached for the %d"
807 " time, out of %d before EOC\n",
808 di->eoc_cnt,
809 EOC_COND_CNT);
811 } else {
812 di->eoc_cnt = 0;
816 static void init_maxim_chg_curr(struct abx500_chargalg *di)
818 di->ccm.original_iset =
819 di->bm->bat_type[di->bm->batt_id].normal_cur_lvl;
820 di->ccm.current_iset =
821 di->bm->bat_type[di->bm->batt_id].normal_cur_lvl;
822 di->ccm.test_delta_i = di->bm->maxi->charger_curr_step;
823 di->ccm.max_current = di->bm->maxi->chg_curr;
824 di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
825 di->ccm.level = 0;
829 * abx500_chargalg_chg_curr_maxim - increases the charger current to
830 * compensate for the system load
831 * @di pointer to the abx500_chargalg structure
833 * This maximization function is used to raise the charger current to get the
834 * battery current as close to the optimal value as possible. The battery
835 * current during charging is affected by the system load
837 static enum maxim_ret abx500_chargalg_chg_curr_maxim(struct abx500_chargalg *di)
839 int delta_i;
841 if (!di->bm->maxi->ena_maxi)
842 return MAXIM_RET_NOACTION;
844 delta_i = di->ccm.original_iset - di->batt_data.inst_curr;
846 if (di->events.vbus_collapsed) {
847 dev_dbg(di->dev, "Charger voltage has collapsed %d\n",
848 di->ccm.wait_cnt);
849 if (di->ccm.wait_cnt == 0) {
850 dev_dbg(di->dev, "lowering current\n");
851 di->ccm.wait_cnt++;
852 di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
853 di->ccm.max_current =
854 di->ccm.current_iset - di->ccm.test_delta_i;
855 di->ccm.current_iset = di->ccm.max_current;
856 di->ccm.level--;
857 return MAXIM_RET_CHANGE;
858 } else {
859 dev_dbg(di->dev, "waiting\n");
860 /* Let's go in here twice before lowering curr again */
861 di->ccm.wait_cnt = (di->ccm.wait_cnt + 1) % 3;
862 return MAXIM_RET_NOACTION;
866 di->ccm.wait_cnt = 0;
868 if ((di->batt_data.inst_curr > di->ccm.original_iset)) {
869 dev_dbg(di->dev, " Maximization Ibat (%dmA) too high"
870 " (limit %dmA) (current iset: %dmA)!\n",
871 di->batt_data.inst_curr, di->ccm.original_iset,
872 di->ccm.current_iset);
874 if (di->ccm.current_iset == di->ccm.original_iset)
875 return MAXIM_RET_NOACTION;
877 di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
878 di->ccm.current_iset = di->ccm.original_iset;
879 di->ccm.level = 0;
881 return MAXIM_RET_IBAT_TOO_HIGH;
884 if (delta_i > di->ccm.test_delta_i &&
885 (di->ccm.current_iset + di->ccm.test_delta_i) <
886 di->ccm.max_current) {
887 if (di->ccm.condition_cnt-- == 0) {
888 /* Increse the iset with cco.test_delta_i */
889 di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
890 di->ccm.current_iset += di->ccm.test_delta_i;
891 di->ccm.level++;
892 dev_dbg(di->dev, " Maximization needed, increase"
893 " with %d mA to %dmA (Optimal ibat: %d)"
894 " Level %d\n",
895 di->ccm.test_delta_i,
896 di->ccm.current_iset,
897 di->ccm.original_iset,
898 di->ccm.level);
899 return MAXIM_RET_CHANGE;
900 } else {
901 return MAXIM_RET_NOACTION;
903 } else {
904 di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
905 return MAXIM_RET_NOACTION;
909 static void handle_maxim_chg_curr(struct abx500_chargalg *di)
911 enum maxim_ret ret;
912 int result;
914 ret = abx500_chargalg_chg_curr_maxim(di);
915 switch (ret) {
916 case MAXIM_RET_CHANGE:
917 result = abx500_chargalg_update_chg_curr(di,
918 di->ccm.current_iset);
919 if (result)
920 dev_err(di->dev, "failed to set chg curr\n");
921 break;
922 case MAXIM_RET_IBAT_TOO_HIGH:
923 result = abx500_chargalg_update_chg_curr(di,
924 di->bm->bat_type[di->bm->batt_id].normal_cur_lvl);
925 if (result)
926 dev_err(di->dev, "failed to set chg curr\n");
927 break;
929 case MAXIM_RET_NOACTION:
930 default:
931 /* Do nothing..*/
932 break;
936 static int abx500_chargalg_get_ext_psy_data(struct device *dev, void *data)
938 struct power_supply *psy;
939 struct power_supply *ext = dev_get_drvdata(dev);
940 const char **supplicants = (const char **)ext->supplied_to;
941 struct abx500_chargalg *di;
942 union power_supply_propval ret;
943 int j;
944 bool capacity_updated = false;
946 psy = (struct power_supply *)data;
947 di = power_supply_get_drvdata(psy);
948 /* For all psy where the driver name appears in any supplied_to */
949 j = match_string(supplicants, ext->num_supplicants, psy->desc->name);
950 if (j < 0)
951 return 0;
954 * If external is not registering 'POWER_SUPPLY_PROP_CAPACITY' to its
955 * property because of handling that sysfs entry on its own, this is
956 * the place to get the battery capacity.
958 if (!power_supply_get_property(ext, POWER_SUPPLY_PROP_CAPACITY, &ret)) {
959 di->batt_data.percent = ret.intval;
960 capacity_updated = true;
963 /* Go through all properties for the psy */
964 for (j = 0; j < ext->desc->num_properties; j++) {
965 enum power_supply_property prop;
966 prop = ext->desc->properties[j];
969 * Initialize chargers if not already done.
970 * The ab8500_charger*/
971 if (!di->ac_chg &&
972 ext->desc->type == POWER_SUPPLY_TYPE_MAINS)
973 di->ac_chg = psy_to_ux500_charger(ext);
974 else if (!di->usb_chg &&
975 ext->desc->type == POWER_SUPPLY_TYPE_USB)
976 di->usb_chg = psy_to_ux500_charger(ext);
978 if (power_supply_get_property(ext, prop, &ret))
979 continue;
980 switch (prop) {
981 case POWER_SUPPLY_PROP_PRESENT:
982 switch (ext->desc->type) {
983 case POWER_SUPPLY_TYPE_BATTERY:
984 /* Battery present */
985 if (ret.intval)
986 di->events.batt_rem = false;
987 /* Battery removed */
988 else
989 di->events.batt_rem = true;
990 break;
991 case POWER_SUPPLY_TYPE_MAINS:
992 /* AC disconnected */
993 if (!ret.intval &&
994 (di->chg_info.conn_chg & AC_CHG)) {
995 di->chg_info.prev_conn_chg =
996 di->chg_info.conn_chg;
997 di->chg_info.conn_chg &= ~AC_CHG;
999 /* AC connected */
1000 else if (ret.intval &&
1001 !(di->chg_info.conn_chg & AC_CHG)) {
1002 di->chg_info.prev_conn_chg =
1003 di->chg_info.conn_chg;
1004 di->chg_info.conn_chg |= AC_CHG;
1006 break;
1007 case POWER_SUPPLY_TYPE_USB:
1008 /* USB disconnected */
1009 if (!ret.intval &&
1010 (di->chg_info.conn_chg & USB_CHG)) {
1011 di->chg_info.prev_conn_chg =
1012 di->chg_info.conn_chg;
1013 di->chg_info.conn_chg &= ~USB_CHG;
1015 /* USB connected */
1016 else if (ret.intval &&
1017 !(di->chg_info.conn_chg & USB_CHG)) {
1018 di->chg_info.prev_conn_chg =
1019 di->chg_info.conn_chg;
1020 di->chg_info.conn_chg |= USB_CHG;
1022 break;
1023 default:
1024 break;
1026 break;
1028 case POWER_SUPPLY_PROP_ONLINE:
1029 switch (ext->desc->type) {
1030 case POWER_SUPPLY_TYPE_BATTERY:
1031 break;
1032 case POWER_SUPPLY_TYPE_MAINS:
1033 /* AC offline */
1034 if (!ret.intval &&
1035 (di->chg_info.online_chg & AC_CHG)) {
1036 di->chg_info.prev_online_chg =
1037 di->chg_info.online_chg;
1038 di->chg_info.online_chg &= ~AC_CHG;
1040 /* AC online */
1041 else if (ret.intval &&
1042 !(di->chg_info.online_chg & AC_CHG)) {
1043 di->chg_info.prev_online_chg =
1044 di->chg_info.online_chg;
1045 di->chg_info.online_chg |= AC_CHG;
1046 queue_delayed_work(di->chargalg_wq,
1047 &di->chargalg_wd_work, 0);
1049 break;
1050 case POWER_SUPPLY_TYPE_USB:
1051 /* USB offline */
1052 if (!ret.intval &&
1053 (di->chg_info.online_chg & USB_CHG)) {
1054 di->chg_info.prev_online_chg =
1055 di->chg_info.online_chg;
1056 di->chg_info.online_chg &= ~USB_CHG;
1058 /* USB online */
1059 else if (ret.intval &&
1060 !(di->chg_info.online_chg & USB_CHG)) {
1061 di->chg_info.prev_online_chg =
1062 di->chg_info.online_chg;
1063 di->chg_info.online_chg |= USB_CHG;
1064 queue_delayed_work(di->chargalg_wq,
1065 &di->chargalg_wd_work, 0);
1067 break;
1068 default:
1069 break;
1071 break;
1073 case POWER_SUPPLY_PROP_HEALTH:
1074 switch (ext->desc->type) {
1075 case POWER_SUPPLY_TYPE_BATTERY:
1076 break;
1077 case POWER_SUPPLY_TYPE_MAINS:
1078 switch (ret.intval) {
1079 case POWER_SUPPLY_HEALTH_UNSPEC_FAILURE:
1080 di->events.mainextchnotok = true;
1081 di->events.main_thermal_prot = false;
1082 di->events.main_ovv = false;
1083 di->events.ac_wd_expired = false;
1084 break;
1085 case POWER_SUPPLY_HEALTH_DEAD:
1086 di->events.ac_wd_expired = true;
1087 di->events.mainextchnotok = false;
1088 di->events.main_ovv = false;
1089 di->events.main_thermal_prot = false;
1090 break;
1091 case POWER_SUPPLY_HEALTH_COLD:
1092 case POWER_SUPPLY_HEALTH_OVERHEAT:
1093 di->events.main_thermal_prot = true;
1094 di->events.mainextchnotok = false;
1095 di->events.main_ovv = false;
1096 di->events.ac_wd_expired = false;
1097 break;
1098 case POWER_SUPPLY_HEALTH_OVERVOLTAGE:
1099 di->events.main_ovv = true;
1100 di->events.mainextchnotok = false;
1101 di->events.main_thermal_prot = false;
1102 di->events.ac_wd_expired = false;
1103 break;
1104 case POWER_SUPPLY_HEALTH_GOOD:
1105 di->events.main_thermal_prot = false;
1106 di->events.mainextchnotok = false;
1107 di->events.main_ovv = false;
1108 di->events.ac_wd_expired = false;
1109 break;
1110 default:
1111 break;
1113 break;
1115 case POWER_SUPPLY_TYPE_USB:
1116 switch (ret.intval) {
1117 case POWER_SUPPLY_HEALTH_UNSPEC_FAILURE:
1118 di->events.usbchargernotok = true;
1119 di->events.usb_thermal_prot = false;
1120 di->events.vbus_ovv = false;
1121 di->events.usb_wd_expired = false;
1122 break;
1123 case POWER_SUPPLY_HEALTH_DEAD:
1124 di->events.usb_wd_expired = true;
1125 di->events.usbchargernotok = false;
1126 di->events.usb_thermal_prot = false;
1127 di->events.vbus_ovv = false;
1128 break;
1129 case POWER_SUPPLY_HEALTH_COLD:
1130 case POWER_SUPPLY_HEALTH_OVERHEAT:
1131 di->events.usb_thermal_prot = true;
1132 di->events.usbchargernotok = false;
1133 di->events.vbus_ovv = false;
1134 di->events.usb_wd_expired = false;
1135 break;
1136 case POWER_SUPPLY_HEALTH_OVERVOLTAGE:
1137 di->events.vbus_ovv = true;
1138 di->events.usbchargernotok = false;
1139 di->events.usb_thermal_prot = false;
1140 di->events.usb_wd_expired = false;
1141 break;
1142 case POWER_SUPPLY_HEALTH_GOOD:
1143 di->events.usbchargernotok = false;
1144 di->events.usb_thermal_prot = false;
1145 di->events.vbus_ovv = false;
1146 di->events.usb_wd_expired = false;
1147 break;
1148 default:
1149 break;
1151 default:
1152 break;
1154 break;
1156 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
1157 switch (ext->desc->type) {
1158 case POWER_SUPPLY_TYPE_BATTERY:
1159 di->batt_data.volt = ret.intval / 1000;
1160 break;
1161 case POWER_SUPPLY_TYPE_MAINS:
1162 di->chg_info.ac_volt = ret.intval / 1000;
1163 break;
1164 case POWER_SUPPLY_TYPE_USB:
1165 di->chg_info.usb_volt = ret.intval / 1000;
1166 break;
1167 default:
1168 break;
1170 break;
1172 case POWER_SUPPLY_PROP_VOLTAGE_AVG:
1173 switch (ext->desc->type) {
1174 case POWER_SUPPLY_TYPE_MAINS:
1175 /* AVG is used to indicate when we are
1176 * in CV mode */
1177 if (ret.intval)
1178 di->events.ac_cv_active = true;
1179 else
1180 di->events.ac_cv_active = false;
1182 break;
1183 case POWER_SUPPLY_TYPE_USB:
1184 /* AVG is used to indicate when we are
1185 * in CV mode */
1186 if (ret.intval)
1187 di->events.usb_cv_active = true;
1188 else
1189 di->events.usb_cv_active = false;
1191 break;
1192 default:
1193 break;
1195 break;
1197 case POWER_SUPPLY_PROP_TECHNOLOGY:
1198 switch (ext->desc->type) {
1199 case POWER_SUPPLY_TYPE_BATTERY:
1200 if (ret.intval)
1201 di->events.batt_unknown = false;
1202 else
1203 di->events.batt_unknown = true;
1205 break;
1206 default:
1207 break;
1209 break;
1211 case POWER_SUPPLY_PROP_TEMP:
1212 di->batt_data.temp = ret.intval / 10;
1213 break;
1215 case POWER_SUPPLY_PROP_CURRENT_NOW:
1216 switch (ext->desc->type) {
1217 case POWER_SUPPLY_TYPE_MAINS:
1218 di->chg_info.ac_curr =
1219 ret.intval / 1000;
1220 break;
1221 case POWER_SUPPLY_TYPE_USB:
1222 di->chg_info.usb_curr =
1223 ret.intval / 1000;
1224 break;
1225 case POWER_SUPPLY_TYPE_BATTERY:
1226 di->batt_data.inst_curr = ret.intval / 1000;
1227 break;
1228 default:
1229 break;
1231 break;
1233 case POWER_SUPPLY_PROP_CURRENT_AVG:
1234 switch (ext->desc->type) {
1235 case POWER_SUPPLY_TYPE_BATTERY:
1236 di->batt_data.avg_curr = ret.intval / 1000;
1237 break;
1238 case POWER_SUPPLY_TYPE_USB:
1239 if (ret.intval)
1240 di->events.vbus_collapsed = true;
1241 else
1242 di->events.vbus_collapsed = false;
1243 break;
1244 default:
1245 break;
1247 break;
1248 case POWER_SUPPLY_PROP_CAPACITY:
1249 if (!capacity_updated)
1250 di->batt_data.percent = ret.intval;
1251 break;
1252 default:
1253 break;
1256 return 0;
1260 * abx500_chargalg_external_power_changed() - callback for power supply changes
1261 * @psy: pointer to the structure power_supply
1263 * This function is the entry point of the pointer external_power_changed
1264 * of the structure power_supply.
1265 * This function gets executed when there is a change in any external power
1266 * supply that this driver needs to be notified of.
1268 static void abx500_chargalg_external_power_changed(struct power_supply *psy)
1270 struct abx500_chargalg *di = power_supply_get_drvdata(psy);
1273 * Trigger execution of the algorithm instantly and read
1274 * all power_supply properties there instead
1276 queue_work(di->chargalg_wq, &di->chargalg_work);
1280 * abx500_chargalg_algorithm() - Main function for the algorithm
1281 * @di: pointer to the abx500_chargalg structure
1283 * This is the main control function for the charging algorithm.
1284 * It is called periodically or when something happens that will
1285 * trigger a state change
1287 static void abx500_chargalg_algorithm(struct abx500_chargalg *di)
1289 int charger_status;
1290 int ret;
1291 int curr_step_lvl;
1293 /* Collect data from all power_supply class devices */
1294 class_for_each_device(power_supply_class, NULL,
1295 di->chargalg_psy, abx500_chargalg_get_ext_psy_data);
1297 abx500_chargalg_end_of_charge(di);
1298 abx500_chargalg_check_temp(di);
1299 abx500_chargalg_check_charger_voltage(di);
1301 charger_status = abx500_chargalg_check_charger_connection(di);
1302 abx500_chargalg_check_current_step_status(di);
1304 if (is_ab8500(di->parent)) {
1305 ret = abx500_chargalg_check_charger_enable(di);
1306 if (ret < 0)
1307 dev_err(di->dev, "Checking charger is enabled error"
1308 ": Returned Value %d\n", ret);
1312 * First check if we have a charger connected.
1313 * Also we don't allow charging of unknown batteries if configured
1314 * this way
1316 if (!charger_status ||
1317 (di->events.batt_unknown && !di->bm->chg_unknown_bat)) {
1318 if (di->charge_state != STATE_HANDHELD) {
1319 di->events.safety_timer_expired = false;
1320 abx500_chargalg_state_to(di, STATE_HANDHELD_INIT);
1324 /* If suspended, we should not continue checking the flags */
1325 else if (di->charge_state == STATE_SUSPENDED_INIT ||
1326 di->charge_state == STATE_SUSPENDED) {
1327 /* We don't do anything here, just don,t continue */
1330 /* Safety timer expiration */
1331 else if (di->events.safety_timer_expired) {
1332 if (di->charge_state != STATE_SAFETY_TIMER_EXPIRED)
1333 abx500_chargalg_state_to(di,
1334 STATE_SAFETY_TIMER_EXPIRED_INIT);
1337 * Check if any interrupts has occured
1338 * that will prevent us from charging
1341 /* Battery removed */
1342 else if (di->events.batt_rem) {
1343 if (di->charge_state != STATE_BATT_REMOVED)
1344 abx500_chargalg_state_to(di, STATE_BATT_REMOVED_INIT);
1346 /* Main or USB charger not ok. */
1347 else if (di->events.mainextchnotok || di->events.usbchargernotok) {
1349 * If vbus_collapsed is set, we have to lower the charger
1350 * current, which is done in the normal state below
1352 if (di->charge_state != STATE_CHG_NOT_OK &&
1353 !di->events.vbus_collapsed)
1354 abx500_chargalg_state_to(di, STATE_CHG_NOT_OK_INIT);
1356 /* VBUS, Main or VBAT OVV. */
1357 else if (di->events.vbus_ovv ||
1358 di->events.main_ovv ||
1359 di->events.batt_ovv ||
1360 !di->chg_info.usb_chg_ok ||
1361 !di->chg_info.ac_chg_ok) {
1362 if (di->charge_state != STATE_OVV_PROTECT)
1363 abx500_chargalg_state_to(di, STATE_OVV_PROTECT_INIT);
1365 /* USB Thermal, stop charging */
1366 else if (di->events.main_thermal_prot ||
1367 di->events.usb_thermal_prot) {
1368 if (di->charge_state != STATE_HW_TEMP_PROTECT)
1369 abx500_chargalg_state_to(di,
1370 STATE_HW_TEMP_PROTECT_INIT);
1372 /* Battery temp over/under */
1373 else if (di->events.btemp_underover) {
1374 if (di->charge_state != STATE_TEMP_UNDEROVER)
1375 abx500_chargalg_state_to(di,
1376 STATE_TEMP_UNDEROVER_INIT);
1378 /* Watchdog expired */
1379 else if (di->events.ac_wd_expired ||
1380 di->events.usb_wd_expired) {
1381 if (di->charge_state != STATE_WD_EXPIRED)
1382 abx500_chargalg_state_to(di, STATE_WD_EXPIRED_INIT);
1384 /* Battery temp high/low */
1385 else if (di->events.btemp_lowhigh) {
1386 if (di->charge_state != STATE_TEMP_LOWHIGH)
1387 abx500_chargalg_state_to(di, STATE_TEMP_LOWHIGH_INIT);
1390 dev_dbg(di->dev,
1391 "[CHARGALG] Vb %d Ib_avg %d Ib_inst %d Tb %d Cap %d Maint %d "
1392 "State %s Active_chg %d Chg_status %d AC %d USB %d "
1393 "AC_online %d USB_online %d AC_CV %d USB_CV %d AC_I %d "
1394 "USB_I %d AC_Vset %d AC_Iset %d USB_Vset %d USB_Iset %d\n",
1395 di->batt_data.volt,
1396 di->batt_data.avg_curr,
1397 di->batt_data.inst_curr,
1398 di->batt_data.temp,
1399 di->batt_data.percent,
1400 di->maintenance_chg,
1401 states[di->charge_state],
1402 di->chg_info.charger_type,
1403 di->charge_status,
1404 di->chg_info.conn_chg & AC_CHG,
1405 di->chg_info.conn_chg & USB_CHG,
1406 di->chg_info.online_chg & AC_CHG,
1407 di->chg_info.online_chg & USB_CHG,
1408 di->events.ac_cv_active,
1409 di->events.usb_cv_active,
1410 di->chg_info.ac_curr,
1411 di->chg_info.usb_curr,
1412 di->chg_info.ac_vset,
1413 di->chg_info.ac_iset,
1414 di->chg_info.usb_vset,
1415 di->chg_info.usb_iset);
1417 switch (di->charge_state) {
1418 case STATE_HANDHELD_INIT:
1419 abx500_chargalg_stop_charging(di);
1420 di->charge_status = POWER_SUPPLY_STATUS_DISCHARGING;
1421 abx500_chargalg_state_to(di, STATE_HANDHELD);
1422 /* Intentional fallthrough */
1424 case STATE_HANDHELD:
1425 break;
1427 case STATE_SUSPENDED_INIT:
1428 if (di->susp_status.ac_suspended)
1429 abx500_chargalg_ac_en(di, false, 0, 0);
1430 if (di->susp_status.usb_suspended)
1431 abx500_chargalg_usb_en(di, false, 0, 0);
1432 abx500_chargalg_stop_safety_timer(di);
1433 abx500_chargalg_stop_maintenance_timer(di);
1434 di->charge_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
1435 di->maintenance_chg = false;
1436 abx500_chargalg_state_to(di, STATE_SUSPENDED);
1437 power_supply_changed(di->chargalg_psy);
1438 /* Intentional fallthrough */
1440 case STATE_SUSPENDED:
1441 /* CHARGING is suspended */
1442 break;
1444 case STATE_BATT_REMOVED_INIT:
1445 abx500_chargalg_stop_charging(di);
1446 abx500_chargalg_state_to(di, STATE_BATT_REMOVED);
1447 /* Intentional fallthrough */
1449 case STATE_BATT_REMOVED:
1450 if (!di->events.batt_rem)
1451 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1452 break;
1454 case STATE_HW_TEMP_PROTECT_INIT:
1455 abx500_chargalg_stop_charging(di);
1456 abx500_chargalg_state_to(di, STATE_HW_TEMP_PROTECT);
1457 /* Intentional fallthrough */
1459 case STATE_HW_TEMP_PROTECT:
1460 if (!di->events.main_thermal_prot &&
1461 !di->events.usb_thermal_prot)
1462 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1463 break;
1465 case STATE_OVV_PROTECT_INIT:
1466 abx500_chargalg_stop_charging(di);
1467 abx500_chargalg_state_to(di, STATE_OVV_PROTECT);
1468 /* Intentional fallthrough */
1470 case STATE_OVV_PROTECT:
1471 if (!di->events.vbus_ovv &&
1472 !di->events.main_ovv &&
1473 !di->events.batt_ovv &&
1474 di->chg_info.usb_chg_ok &&
1475 di->chg_info.ac_chg_ok)
1476 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1477 break;
1479 case STATE_CHG_NOT_OK_INIT:
1480 abx500_chargalg_stop_charging(di);
1481 abx500_chargalg_state_to(di, STATE_CHG_NOT_OK);
1482 /* Intentional fallthrough */
1484 case STATE_CHG_NOT_OK:
1485 if (!di->events.mainextchnotok &&
1486 !di->events.usbchargernotok)
1487 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1488 break;
1490 case STATE_SAFETY_TIMER_EXPIRED_INIT:
1491 abx500_chargalg_stop_charging(di);
1492 abx500_chargalg_state_to(di, STATE_SAFETY_TIMER_EXPIRED);
1493 /* Intentional fallthrough */
1495 case STATE_SAFETY_TIMER_EXPIRED:
1496 /* We exit this state when charger is removed */
1497 break;
1499 case STATE_NORMAL_INIT:
1500 if (di->curr_status.curr_step == CHARGALG_CURR_STEP_LOW)
1501 abx500_chargalg_stop_charging(di);
1502 else {
1503 curr_step_lvl = di->bm->bat_type[
1504 di->bm->batt_id].normal_cur_lvl
1505 * di->curr_status.curr_step
1506 / CHARGALG_CURR_STEP_HIGH;
1507 abx500_chargalg_start_charging(di,
1508 di->bm->bat_type[di->bm->batt_id]
1509 .normal_vol_lvl, curr_step_lvl);
1512 abx500_chargalg_state_to(di, STATE_NORMAL);
1513 abx500_chargalg_start_safety_timer(di);
1514 abx500_chargalg_stop_maintenance_timer(di);
1515 init_maxim_chg_curr(di);
1516 di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
1517 di->eoc_cnt = 0;
1518 di->maintenance_chg = false;
1519 power_supply_changed(di->chargalg_psy);
1521 break;
1523 case STATE_NORMAL:
1524 handle_maxim_chg_curr(di);
1525 if (di->charge_status == POWER_SUPPLY_STATUS_FULL &&
1526 di->maintenance_chg) {
1527 if (di->bm->no_maintenance)
1528 abx500_chargalg_state_to(di,
1529 STATE_WAIT_FOR_RECHARGE_INIT);
1530 else
1531 abx500_chargalg_state_to(di,
1532 STATE_MAINTENANCE_A_INIT);
1534 break;
1536 /* This state will be used when the maintenance state is disabled */
1537 case STATE_WAIT_FOR_RECHARGE_INIT:
1538 abx500_chargalg_hold_charging(di);
1539 abx500_chargalg_state_to(di, STATE_WAIT_FOR_RECHARGE);
1540 /* Intentional fallthrough */
1542 case STATE_WAIT_FOR_RECHARGE:
1543 if (di->batt_data.percent <=
1544 di->bm->bat_type[di->bm->batt_id].
1545 recharge_cap)
1546 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1547 break;
1549 case STATE_MAINTENANCE_A_INIT:
1550 abx500_chargalg_stop_safety_timer(di);
1551 abx500_chargalg_start_maintenance_timer(di,
1552 di->bm->bat_type[
1553 di->bm->batt_id].maint_a_chg_timer_h);
1554 abx500_chargalg_start_charging(di,
1555 di->bm->bat_type[
1556 di->bm->batt_id].maint_a_vol_lvl,
1557 di->bm->bat_type[
1558 di->bm->batt_id].maint_a_cur_lvl);
1559 abx500_chargalg_state_to(di, STATE_MAINTENANCE_A);
1560 power_supply_changed(di->chargalg_psy);
1561 /* Intentional fallthrough*/
1563 case STATE_MAINTENANCE_A:
1564 if (di->events.maintenance_timer_expired) {
1565 abx500_chargalg_stop_maintenance_timer(di);
1566 abx500_chargalg_state_to(di, STATE_MAINTENANCE_B_INIT);
1568 break;
1570 case STATE_MAINTENANCE_B_INIT:
1571 abx500_chargalg_start_maintenance_timer(di,
1572 di->bm->bat_type[
1573 di->bm->batt_id].maint_b_chg_timer_h);
1574 abx500_chargalg_start_charging(di,
1575 di->bm->bat_type[
1576 di->bm->batt_id].maint_b_vol_lvl,
1577 di->bm->bat_type[
1578 di->bm->batt_id].maint_b_cur_lvl);
1579 abx500_chargalg_state_to(di, STATE_MAINTENANCE_B);
1580 power_supply_changed(di->chargalg_psy);
1581 /* Intentional fallthrough*/
1583 case STATE_MAINTENANCE_B:
1584 if (di->events.maintenance_timer_expired) {
1585 abx500_chargalg_stop_maintenance_timer(di);
1586 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1588 break;
1590 case STATE_TEMP_LOWHIGH_INIT:
1591 abx500_chargalg_start_charging(di,
1592 di->bm->bat_type[
1593 di->bm->batt_id].low_high_vol_lvl,
1594 di->bm->bat_type[
1595 di->bm->batt_id].low_high_cur_lvl);
1596 abx500_chargalg_stop_maintenance_timer(di);
1597 di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
1598 abx500_chargalg_state_to(di, STATE_TEMP_LOWHIGH);
1599 power_supply_changed(di->chargalg_psy);
1600 /* Intentional fallthrough */
1602 case STATE_TEMP_LOWHIGH:
1603 if (!di->events.btemp_lowhigh)
1604 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1605 break;
1607 case STATE_WD_EXPIRED_INIT:
1608 abx500_chargalg_stop_charging(di);
1609 abx500_chargalg_state_to(di, STATE_WD_EXPIRED);
1610 /* Intentional fallthrough */
1612 case STATE_WD_EXPIRED:
1613 if (!di->events.ac_wd_expired &&
1614 !di->events.usb_wd_expired)
1615 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1616 break;
1618 case STATE_TEMP_UNDEROVER_INIT:
1619 abx500_chargalg_stop_charging(di);
1620 abx500_chargalg_state_to(di, STATE_TEMP_UNDEROVER);
1621 /* Intentional fallthrough */
1623 case STATE_TEMP_UNDEROVER:
1624 if (!di->events.btemp_underover)
1625 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1626 break;
1629 /* Start charging directly if the new state is a charge state */
1630 if (di->charge_state == STATE_NORMAL_INIT ||
1631 di->charge_state == STATE_MAINTENANCE_A_INIT ||
1632 di->charge_state == STATE_MAINTENANCE_B_INIT)
1633 queue_work(di->chargalg_wq, &di->chargalg_work);
1637 * abx500_chargalg_periodic_work() - Periodic work for the algorithm
1638 * @work: pointer to the work_struct structure
1640 * Work queue function for the charging algorithm
1642 static void abx500_chargalg_periodic_work(struct work_struct *work)
1644 struct abx500_chargalg *di = container_of(work,
1645 struct abx500_chargalg, chargalg_periodic_work.work);
1647 abx500_chargalg_algorithm(di);
1650 * If a charger is connected then the battery has to be monitored
1651 * frequently, else the work can be delayed.
1653 if (di->chg_info.conn_chg)
1654 queue_delayed_work(di->chargalg_wq,
1655 &di->chargalg_periodic_work,
1656 di->bm->interval_charging * HZ);
1657 else
1658 queue_delayed_work(di->chargalg_wq,
1659 &di->chargalg_periodic_work,
1660 di->bm->interval_not_charging * HZ);
1664 * abx500_chargalg_wd_work() - periodic work to kick the charger watchdog
1665 * @work: pointer to the work_struct structure
1667 * Work queue function for kicking the charger watchdog
1669 static void abx500_chargalg_wd_work(struct work_struct *work)
1671 int ret;
1672 struct abx500_chargalg *di = container_of(work,
1673 struct abx500_chargalg, chargalg_wd_work.work);
1675 dev_dbg(di->dev, "abx500_chargalg_wd_work\n");
1677 ret = abx500_chargalg_kick_watchdog(di);
1678 if (ret < 0)
1679 dev_err(di->dev, "failed to kick watchdog\n");
1681 queue_delayed_work(di->chargalg_wq,
1682 &di->chargalg_wd_work, CHG_WD_INTERVAL);
1686 * abx500_chargalg_work() - Work to run the charging algorithm instantly
1687 * @work: pointer to the work_struct structure
1689 * Work queue function for calling the charging algorithm
1691 static void abx500_chargalg_work(struct work_struct *work)
1693 struct abx500_chargalg *di = container_of(work,
1694 struct abx500_chargalg, chargalg_work);
1696 abx500_chargalg_algorithm(di);
1700 * abx500_chargalg_get_property() - get the chargalg properties
1701 * @psy: pointer to the power_supply structure
1702 * @psp: pointer to the power_supply_property structure
1703 * @val: pointer to the power_supply_propval union
1705 * This function gets called when an application tries to get the
1706 * chargalg properties by reading the sysfs files.
1707 * status: charging/discharging/full/unknown
1708 * health: health of the battery
1709 * Returns error code in case of failure else 0 on success
1711 static int abx500_chargalg_get_property(struct power_supply *psy,
1712 enum power_supply_property psp,
1713 union power_supply_propval *val)
1715 struct abx500_chargalg *di = power_supply_get_drvdata(psy);
1717 switch (psp) {
1718 case POWER_SUPPLY_PROP_STATUS:
1719 val->intval = di->charge_status;
1720 break;
1721 case POWER_SUPPLY_PROP_HEALTH:
1722 if (di->events.batt_ovv) {
1723 val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
1724 } else if (di->events.btemp_underover) {
1725 if (di->batt_data.temp <= di->bm->temp_under)
1726 val->intval = POWER_SUPPLY_HEALTH_COLD;
1727 else
1728 val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
1729 } else if (di->charge_state == STATE_SAFETY_TIMER_EXPIRED ||
1730 di->charge_state == STATE_SAFETY_TIMER_EXPIRED_INIT) {
1731 val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
1732 } else {
1733 val->intval = POWER_SUPPLY_HEALTH_GOOD;
1735 break;
1736 default:
1737 return -EINVAL;
1739 return 0;
1742 /* Exposure to the sysfs interface */
1744 static ssize_t abx500_chargalg_curr_step_show(struct abx500_chargalg *di,
1745 char *buf)
1747 return sprintf(buf, "%d\n", di->curr_status.curr_step);
1750 static ssize_t abx500_chargalg_curr_step_store(struct abx500_chargalg *di,
1751 const char *buf, size_t length)
1753 long int param;
1754 int ret;
1756 ret = kstrtol(buf, 10, &param);
1757 if (ret < 0)
1758 return ret;
1760 di->curr_status.curr_step = param;
1761 if (di->curr_status.curr_step >= CHARGALG_CURR_STEP_LOW &&
1762 di->curr_status.curr_step <= CHARGALG_CURR_STEP_HIGH) {
1763 di->curr_status.curr_step_change = true;
1764 queue_work(di->chargalg_wq, &di->chargalg_work);
1765 } else
1766 dev_info(di->dev, "Wrong current step\n"
1767 "Enter 0. Disable AC/USB Charging\n"
1768 "1--100. Set AC/USB charging current step\n"
1769 "100. Enable AC/USB Charging\n");
1771 return strlen(buf);
1775 static ssize_t abx500_chargalg_en_show(struct abx500_chargalg *di,
1776 char *buf)
1778 return sprintf(buf, "%d\n",
1779 di->susp_status.ac_suspended &&
1780 di->susp_status.usb_suspended);
1783 static ssize_t abx500_chargalg_en_store(struct abx500_chargalg *di,
1784 const char *buf, size_t length)
1786 long int param;
1787 int ac_usb;
1788 int ret;
1790 ret = kstrtol(buf, 10, &param);
1791 if (ret < 0)
1792 return ret;
1794 ac_usb = param;
1795 switch (ac_usb) {
1796 case 0:
1797 /* Disable charging */
1798 di->susp_status.ac_suspended = true;
1799 di->susp_status.usb_suspended = true;
1800 di->susp_status.suspended_change = true;
1801 /* Trigger a state change */
1802 queue_work(di->chargalg_wq,
1803 &di->chargalg_work);
1804 break;
1805 case 1:
1806 /* Enable AC Charging */
1807 di->susp_status.ac_suspended = false;
1808 di->susp_status.suspended_change = true;
1809 /* Trigger a state change */
1810 queue_work(di->chargalg_wq,
1811 &di->chargalg_work);
1812 break;
1813 case 2:
1814 /* Enable USB charging */
1815 di->susp_status.usb_suspended = false;
1816 di->susp_status.suspended_change = true;
1817 /* Trigger a state change */
1818 queue_work(di->chargalg_wq,
1819 &di->chargalg_work);
1820 break;
1821 default:
1822 dev_info(di->dev, "Wrong input\n"
1823 "Enter 0. Disable AC/USB Charging\n"
1824 "1. Enable AC charging\n"
1825 "2. Enable USB Charging\n");
1827 return strlen(buf);
1830 static struct abx500_chargalg_sysfs_entry abx500_chargalg_en_charger =
1831 __ATTR(chargalg, 0644, abx500_chargalg_en_show,
1832 abx500_chargalg_en_store);
1834 static struct abx500_chargalg_sysfs_entry abx500_chargalg_curr_step =
1835 __ATTR(chargalg_curr_step, 0644, abx500_chargalg_curr_step_show,
1836 abx500_chargalg_curr_step_store);
1838 static ssize_t abx500_chargalg_sysfs_show(struct kobject *kobj,
1839 struct attribute *attr, char *buf)
1841 struct abx500_chargalg_sysfs_entry *entry = container_of(attr,
1842 struct abx500_chargalg_sysfs_entry, attr);
1844 struct abx500_chargalg *di = container_of(kobj,
1845 struct abx500_chargalg, chargalg_kobject);
1847 if (!entry->show)
1848 return -EIO;
1850 return entry->show(di, buf);
1853 static ssize_t abx500_chargalg_sysfs_charger(struct kobject *kobj,
1854 struct attribute *attr, const char *buf, size_t length)
1856 struct abx500_chargalg_sysfs_entry *entry = container_of(attr,
1857 struct abx500_chargalg_sysfs_entry, attr);
1859 struct abx500_chargalg *di = container_of(kobj,
1860 struct abx500_chargalg, chargalg_kobject);
1862 if (!entry->store)
1863 return -EIO;
1865 return entry->store(di, buf, length);
1868 static struct attribute *abx500_chargalg_chg[] = {
1869 &abx500_chargalg_en_charger.attr,
1870 &abx500_chargalg_curr_step.attr,
1871 NULL,
1874 static const struct sysfs_ops abx500_chargalg_sysfs_ops = {
1875 .show = abx500_chargalg_sysfs_show,
1876 .store = abx500_chargalg_sysfs_charger,
1879 static struct kobj_type abx500_chargalg_ktype = {
1880 .sysfs_ops = &abx500_chargalg_sysfs_ops,
1881 .default_attrs = abx500_chargalg_chg,
1885 * abx500_chargalg_sysfs_exit() - de-init of sysfs entry
1886 * @di: pointer to the struct abx500_chargalg
1888 * This function removes the entry in sysfs.
1890 static void abx500_chargalg_sysfs_exit(struct abx500_chargalg *di)
1892 kobject_del(&di->chargalg_kobject);
1896 * abx500_chargalg_sysfs_init() - init of sysfs entry
1897 * @di: pointer to the struct abx500_chargalg
1899 * This function adds an entry in sysfs.
1900 * Returns error code in case of failure else 0(on success)
1902 static int abx500_chargalg_sysfs_init(struct abx500_chargalg *di)
1904 int ret = 0;
1906 ret = kobject_init_and_add(&di->chargalg_kobject,
1907 &abx500_chargalg_ktype,
1908 NULL, "abx500_chargalg");
1909 if (ret < 0)
1910 dev_err(di->dev, "failed to create sysfs entry\n");
1912 return ret;
1914 /* Exposure to the sysfs interface <<END>> */
1916 #if defined(CONFIG_PM)
1917 static int abx500_chargalg_resume(struct platform_device *pdev)
1919 struct abx500_chargalg *di = platform_get_drvdata(pdev);
1921 /* Kick charger watchdog if charging (any charger online) */
1922 if (di->chg_info.online_chg)
1923 queue_delayed_work(di->chargalg_wq, &di->chargalg_wd_work, 0);
1926 * Run the charging algorithm directly to be sure we don't
1927 * do it too seldom
1929 queue_delayed_work(di->chargalg_wq, &di->chargalg_periodic_work, 0);
1931 return 0;
1934 static int abx500_chargalg_suspend(struct platform_device *pdev,
1935 pm_message_t state)
1937 struct abx500_chargalg *di = platform_get_drvdata(pdev);
1939 if (di->chg_info.online_chg)
1940 cancel_delayed_work_sync(&di->chargalg_wd_work);
1942 cancel_delayed_work_sync(&di->chargalg_periodic_work);
1944 return 0;
1946 #else
1947 #define abx500_chargalg_suspend NULL
1948 #define abx500_chargalg_resume NULL
1949 #endif
1951 static int abx500_chargalg_remove(struct platform_device *pdev)
1953 struct abx500_chargalg *di = platform_get_drvdata(pdev);
1955 /* sysfs interface to enable/disbale charging from user space */
1956 abx500_chargalg_sysfs_exit(di);
1958 hrtimer_cancel(&di->safety_timer);
1959 hrtimer_cancel(&di->maintenance_timer);
1961 cancel_delayed_work_sync(&di->chargalg_periodic_work);
1962 cancel_delayed_work_sync(&di->chargalg_wd_work);
1963 cancel_work_sync(&di->chargalg_work);
1965 /* Delete the work queue */
1966 destroy_workqueue(di->chargalg_wq);
1968 power_supply_unregister(di->chargalg_psy);
1970 return 0;
1973 static char *supply_interface[] = {
1974 "ab8500_fg",
1977 static const struct power_supply_desc abx500_chargalg_desc = {
1978 .name = "abx500_chargalg",
1979 .type = POWER_SUPPLY_TYPE_BATTERY,
1980 .properties = abx500_chargalg_props,
1981 .num_properties = ARRAY_SIZE(abx500_chargalg_props),
1982 .get_property = abx500_chargalg_get_property,
1983 .external_power_changed = abx500_chargalg_external_power_changed,
1986 static int abx500_chargalg_probe(struct platform_device *pdev)
1988 struct device_node *np = pdev->dev.of_node;
1989 struct abx500_bm_data *plat = pdev->dev.platform_data;
1990 struct power_supply_config psy_cfg = {};
1991 struct abx500_chargalg *di;
1992 int ret = 0;
1994 di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);
1995 if (!di) {
1996 dev_err(&pdev->dev, "%s no mem for ab8500_chargalg\n", __func__);
1997 return -ENOMEM;
2000 if (!plat) {
2001 dev_err(&pdev->dev, "no battery management data supplied\n");
2002 return -EINVAL;
2004 di->bm = plat;
2006 if (np) {
2007 ret = ab8500_bm_of_probe(&pdev->dev, np, di->bm);
2008 if (ret) {
2009 dev_err(&pdev->dev, "failed to get battery information\n");
2010 return ret;
2014 /* get device struct and parent */
2015 di->dev = &pdev->dev;
2016 di->parent = dev_get_drvdata(pdev->dev.parent);
2018 psy_cfg.supplied_to = supply_interface;
2019 psy_cfg.num_supplicants = ARRAY_SIZE(supply_interface);
2020 psy_cfg.drv_data = di;
2022 /* Initilialize safety timer */
2023 hrtimer_init(&di->safety_timer, CLOCK_REALTIME, HRTIMER_MODE_ABS);
2024 di->safety_timer.function = abx500_chargalg_safety_timer_expired;
2026 /* Initilialize maintenance timer */
2027 hrtimer_init(&di->maintenance_timer, CLOCK_REALTIME, HRTIMER_MODE_ABS);
2028 di->maintenance_timer.function =
2029 abx500_chargalg_maintenance_timer_expired;
2031 /* Create a work queue for the chargalg */
2032 di->chargalg_wq = alloc_ordered_workqueue("abx500_chargalg_wq",
2033 WQ_MEM_RECLAIM);
2034 if (di->chargalg_wq == NULL) {
2035 dev_err(di->dev, "failed to create work queue\n");
2036 return -ENOMEM;
2039 /* Init work for chargalg */
2040 INIT_DEFERRABLE_WORK(&di->chargalg_periodic_work,
2041 abx500_chargalg_periodic_work);
2042 INIT_DEFERRABLE_WORK(&di->chargalg_wd_work,
2043 abx500_chargalg_wd_work);
2045 /* Init work for chargalg */
2046 INIT_WORK(&di->chargalg_work, abx500_chargalg_work);
2048 /* To detect charger at startup */
2049 di->chg_info.prev_conn_chg = -1;
2051 /* Register chargalg power supply class */
2052 di->chargalg_psy = power_supply_register(di->dev, &abx500_chargalg_desc,
2053 &psy_cfg);
2054 if (IS_ERR(di->chargalg_psy)) {
2055 dev_err(di->dev, "failed to register chargalg psy\n");
2056 ret = PTR_ERR(di->chargalg_psy);
2057 goto free_chargalg_wq;
2060 platform_set_drvdata(pdev, di);
2062 /* sysfs interface to enable/disable charging from user space */
2063 ret = abx500_chargalg_sysfs_init(di);
2064 if (ret) {
2065 dev_err(di->dev, "failed to create sysfs entry\n");
2066 goto free_psy;
2068 di->curr_status.curr_step = CHARGALG_CURR_STEP_HIGH;
2070 /* Run the charging algorithm */
2071 queue_delayed_work(di->chargalg_wq, &di->chargalg_periodic_work, 0);
2073 dev_info(di->dev, "probe success\n");
2074 return ret;
2076 free_psy:
2077 power_supply_unregister(di->chargalg_psy);
2078 free_chargalg_wq:
2079 destroy_workqueue(di->chargalg_wq);
2080 return ret;
2083 static const struct of_device_id ab8500_chargalg_match[] = {
2084 { .compatible = "stericsson,ab8500-chargalg", },
2085 { },
2088 static struct platform_driver abx500_chargalg_driver = {
2089 .probe = abx500_chargalg_probe,
2090 .remove = abx500_chargalg_remove,
2091 .suspend = abx500_chargalg_suspend,
2092 .resume = abx500_chargalg_resume,
2093 .driver = {
2094 .name = "ab8500-chargalg",
2095 .of_match_table = ab8500_chargalg_match,
2099 module_platform_driver(abx500_chargalg_driver);
2101 MODULE_LICENSE("GPL v2");
2102 MODULE_AUTHOR("Johan Palsson, Karl Komierowski");
2103 MODULE_ALIAS("platform:abx500-chargalg");
2104 MODULE_DESCRIPTION("abx500 battery charging algorithm");