abx500-chargalg: Use module_platform_driver() rather
[cascardo/linux.git] / drivers / power / abx500_chargalg.c
1 /*
2  * Copyright (C) ST-Ericsson SA 2012
3  * Copyright (c) 2012 Sony Mobile Communications AB
4  *
5  * Charging algorithm driver for abx500 variants
6  *
7  * License Terms: GNU General Public License v2
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>
13  */
14
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>
34
35 /* Watchdog kick interval */
36 #define CHG_WD_INTERVAL                 (6 * HZ)
37
38 /* End-of-charge criteria counter */
39 #define EOC_COND_CNT                    10
40
41 /* One hour expressed in seconds */
42 #define ONE_HOUR_IN_SECONDS            3600
43
44 /* Five minutes expressed in seconds */
45 #define FIVE_MINUTES_IN_SECONDS        300
46
47 /* Plus margin for the low battery threshold */
48 #define BAT_PLUS_MARGIN                (100)
49
50 #define to_abx500_chargalg_device_info(x) container_of((x), \
51         struct abx500_chargalg, chargalg_psy);
52
53 enum abx500_chargers {
54         NO_CHG,
55         AC_CHG,
56         USB_CHG,
57 };
58
59 struct abx500_chargalg_charger_info {
60         enum abx500_chargers conn_chg;
61         enum abx500_chargers prev_conn_chg;
62         enum abx500_chargers online_chg;
63         enum abx500_chargers prev_online_chg;
64         enum abx500_chargers charger_type;
65         bool usb_chg_ok;
66         bool ac_chg_ok;
67         int usb_volt;
68         int usb_curr;
69         int ac_volt;
70         int ac_curr;
71         int usb_vset;
72         int usb_iset;
73         int ac_vset;
74         int ac_iset;
75 };
76
77 struct abx500_chargalg_suspension_status {
78         bool suspended_change;
79         bool ac_suspended;
80         bool usb_suspended;
81 };
82
83 struct abx500_chargalg_battery_data {
84         int temp;
85         int volt;
86         int avg_curr;
87         int inst_curr;
88         int percent;
89 };
90
91 enum abx500_chargalg_states {
92         STATE_HANDHELD_INIT,
93         STATE_HANDHELD,
94         STATE_CHG_NOT_OK_INIT,
95         STATE_CHG_NOT_OK,
96         STATE_HW_TEMP_PROTECT_INIT,
97         STATE_HW_TEMP_PROTECT,
98         STATE_NORMAL_INIT,
99         STATE_USB_PP_PRE_CHARGE,
100         STATE_NORMAL,
101         STATE_WAIT_FOR_RECHARGE_INIT,
102         STATE_WAIT_FOR_RECHARGE,
103         STATE_MAINTENANCE_A_INIT,
104         STATE_MAINTENANCE_A,
105         STATE_MAINTENANCE_B_INIT,
106         STATE_MAINTENANCE_B,
107         STATE_TEMP_UNDEROVER_INIT,
108         STATE_TEMP_UNDEROVER,
109         STATE_TEMP_LOWHIGH_INIT,
110         STATE_TEMP_LOWHIGH,
111         STATE_SUSPENDED_INIT,
112         STATE_SUSPENDED,
113         STATE_OVV_PROTECT_INIT,
114         STATE_OVV_PROTECT,
115         STATE_SAFETY_TIMER_EXPIRED_INIT,
116         STATE_SAFETY_TIMER_EXPIRED,
117         STATE_BATT_REMOVED_INIT,
118         STATE_BATT_REMOVED,
119         STATE_WD_EXPIRED_INIT,
120         STATE_WD_EXPIRED,
121 };
122
123 static const char *states[] = {
124         "HANDHELD_INIT",
125         "HANDHELD",
126         "CHG_NOT_OK_INIT",
127         "CHG_NOT_OK",
128         "HW_TEMP_PROTECT_INIT",
129         "HW_TEMP_PROTECT",
130         "NORMAL_INIT",
131         "USB_PP_PRE_CHARGE",
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",
153 };
154
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;
174 };
175
176 /**
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
190  */
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;
199 };
200
201 enum maxim_ret {
202         MAXIM_RET_NOACTION,
203         MAXIM_RET_CHANGE,
204         MAXIM_RET_IBAT_TOO_HIGH,
205 };
206
207 /**
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  * @parent:             pointer to the struct abx500
224  * @chargalg_psy:       structure that holds the battery properties exposed by
225  *                      the charging algorithm
226  * @events:             structure for information about events triggered
227  * @chargalg_wq:                work queue for running the charging algorithm
228  * @chargalg_periodic_work:     work to run the charging algorithm periodically
229  * @chargalg_wd_work:           work to kick the charger watchdog periodically
230  * @chargalg_work:              work to run the charging algorithm instantly
231  * @safety_timer:               charging safety timer
232  * @maintenance_timer:          maintenance charging timer
233  * @chargalg_kobject:           structure of type kobject
234  */
235 struct abx500_chargalg {
236         struct device *dev;
237         int charge_status;
238         int eoc_cnt;
239         bool maintenance_chg;
240         int t_hyst_norm;
241         int t_hyst_lowhigh;
242         enum abx500_chargalg_states charge_state;
243         struct abx500_charge_curr_maximization ccm;
244         struct abx500_chargalg_charger_info chg_info;
245         struct abx500_chargalg_battery_data batt_data;
246         struct abx500_chargalg_suspension_status susp_status;
247         struct ab8500 *parent;
248         struct abx500_bm_data *bm;
249         struct power_supply chargalg_psy;
250         struct ux500_charger *ac_chg;
251         struct ux500_charger *usb_chg;
252         struct abx500_chargalg_events events;
253         struct workqueue_struct *chargalg_wq;
254         struct delayed_work chargalg_periodic_work;
255         struct delayed_work chargalg_wd_work;
256         struct work_struct chargalg_work;
257         struct hrtimer safety_timer;
258         struct hrtimer maintenance_timer;
259         struct kobject chargalg_kobject;
260 };
261
262 /*External charger prepare notifier*/
263 BLOCKING_NOTIFIER_HEAD(charger_notifier_list);
264
265 /* Main battery properties */
266 static enum power_supply_property abx500_chargalg_props[] = {
267         POWER_SUPPLY_PROP_STATUS,
268         POWER_SUPPLY_PROP_HEALTH,
269 };
270
271 /**
272  * abx500_chargalg_safety_timer_expired() - Expiration of the safety timer
273  * @timer:     pointer to the hrtimer structure
274  *
275  * This function gets called when the safety timer for the charger
276  * expires
277  */
278 static enum hrtimer_restart
279 abx500_chargalg_safety_timer_expired(struct hrtimer *timer)
280 {
281         struct abx500_chargalg *di = container_of(timer, struct abx500_chargalg,
282                                                   safety_timer);
283         dev_err(di->dev, "Safety timer expired\n");
284         di->events.safety_timer_expired = true;
285
286         /* Trigger execution of the algorithm instantly */
287         queue_work(di->chargalg_wq, &di->chargalg_work);
288
289         return HRTIMER_NORESTART;
290 }
291
292 /**
293  * abx500_chargalg_maintenance_timer_expired() - Expiration of
294  * the maintenance timer
295  * @timer:     pointer to the timer structure
296  *
297  * This function gets called when the maintenence timer
298  * expires
299  */
300 static enum hrtimer_restart
301 abx500_chargalg_maintenance_timer_expired(struct hrtimer *timer)
302 {
303
304         struct abx500_chargalg *di = container_of(timer, struct abx500_chargalg,
305                                                   maintenance_timer);
306
307         dev_dbg(di->dev, "Maintenance timer expired\n");
308         di->events.maintenance_timer_expired = true;
309
310         /* Trigger execution of the algorithm instantly */
311         queue_work(di->chargalg_wq, &di->chargalg_work);
312
313         return HRTIMER_NORESTART;
314 }
315
316 /**
317  * abx500_chargalg_state_to() - Change charge state
318  * @di:         pointer to the abx500_chargalg structure
319  *
320  * This function gets called when a charge state change should occur
321  */
322 static void abx500_chargalg_state_to(struct abx500_chargalg *di,
323         enum abx500_chargalg_states state)
324 {
325         dev_dbg(di->dev,
326                 "State changed: %s (From state: [%d] %s =to=> [%d] %s )\n",
327                 di->charge_state == state ? "NO" : "YES",
328                 di->charge_state,
329                 states[di->charge_state],
330                 state,
331                 states[state]);
332
333         di->charge_state = state;
334 }
335
336 static int abx500_chargalg_check_charger_enable(struct abx500_chargalg *di)
337 {
338         switch (di->charge_state) {
339         case STATE_NORMAL:
340         case STATE_MAINTENANCE_A:
341         case STATE_MAINTENANCE_B:
342                 break;
343         default:
344                 return 0;
345         }
346
347         if (di->chg_info.charger_type & USB_CHG) {
348                 return di->usb_chg->ops.check_enable(di->usb_chg,
349                          di->bm->bat_type[di->bm->batt_id].normal_vol_lvl,
350                          di->bm->bat_type[di->bm->batt_id].normal_cur_lvl);
351         } else if ((di->chg_info.charger_type & AC_CHG) &&
352                    !(di->ac_chg->external)) {
353                 return di->ac_chg->ops.check_enable(di->ac_chg,
354                          di->bm->bat_type[di->bm->batt_id].normal_vol_lvl,
355                          di->bm->bat_type[di->bm->batt_id].normal_cur_lvl);
356         }
357         return 0;
358 }
359
360 /**
361  * abx500_chargalg_check_charger_connection() - Check charger connection change
362  * @di:         pointer to the abx500_chargalg structure
363  *
364  * This function will check if there is a change in the charger connection
365  * and change charge state accordingly. AC has precedence over USB.
366  */
367 static int abx500_chargalg_check_charger_connection(struct abx500_chargalg *di)
368 {
369         if (di->chg_info.conn_chg != di->chg_info.prev_conn_chg ||
370                 di->susp_status.suspended_change) {
371                 /*
372                  * Charger state changed or suspension
373                  * has changed since last update
374                  */
375                 if ((di->chg_info.conn_chg & AC_CHG) &&
376                         !di->susp_status.ac_suspended) {
377                         dev_dbg(di->dev, "Charging source is AC\n");
378                         if (di->chg_info.charger_type != AC_CHG) {
379                                 di->chg_info.charger_type = AC_CHG;
380                                 abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
381                         }
382                 } else if ((di->chg_info.conn_chg & USB_CHG) &&
383                         !di->susp_status.usb_suspended) {
384                         dev_dbg(di->dev, "Charging source is USB\n");
385                         di->chg_info.charger_type = USB_CHG;
386                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
387                 } else if (di->chg_info.conn_chg &&
388                         (di->susp_status.ac_suspended ||
389                         di->susp_status.usb_suspended)) {
390                         dev_dbg(di->dev, "Charging is suspended\n");
391                         di->chg_info.charger_type = NO_CHG;
392                         abx500_chargalg_state_to(di, STATE_SUSPENDED_INIT);
393                 } else {
394                         dev_dbg(di->dev, "Charging source is OFF\n");
395                         di->chg_info.charger_type = NO_CHG;
396                         abx500_chargalg_state_to(di, STATE_HANDHELD_INIT);
397                 }
398                 di->chg_info.prev_conn_chg = di->chg_info.conn_chg;
399                 di->susp_status.suspended_change = false;
400         }
401         return di->chg_info.conn_chg;
402 }
403
404 /**
405  * abx500_chargalg_start_safety_timer() - Start charging safety timer
406  * @di:         pointer to the abx500_chargalg structure
407  *
408  * The safety timer is used to avoid overcharging of old or bad batteries.
409  * There are different timers for AC and USB
410  */
411 static void abx500_chargalg_start_safety_timer(struct abx500_chargalg *di)
412 {
413         /* Charger-dependent expiration time in hours*/
414         int timer_expiration = 0;
415
416         switch (di->chg_info.charger_type) {
417         case AC_CHG:
418                 timer_expiration = di->bm->main_safety_tmr_h;
419                 break;
420
421         case USB_CHG:
422                 timer_expiration = di->bm->usb_safety_tmr_h;
423                 break;
424
425         default:
426                 dev_err(di->dev, "Unknown charger to charge from\n");
427                 break;
428         }
429
430         di->events.safety_timer_expired = false;
431         hrtimer_set_expires_range(&di->safety_timer,
432                 ktime_set(timer_expiration * ONE_HOUR_IN_SECONDS, 0),
433                 ktime_set(FIVE_MINUTES_IN_SECONDS, 0));
434         hrtimer_start_expires(&di->safety_timer, HRTIMER_MODE_REL);
435 }
436
437 /**
438  * abx500_chargalg_stop_safety_timer() - Stop charging safety timer
439  * @di:         pointer to the abx500_chargalg structure
440  *
441  * The safety timer is stopped whenever the NORMAL state is exited
442  */
443 static void abx500_chargalg_stop_safety_timer(struct abx500_chargalg *di)
444 {
445         if (hrtimer_try_to_cancel(&di->safety_timer) >= 0)
446                 di->events.safety_timer_expired = false;
447 }
448
449 /**
450  * abx500_chargalg_start_maintenance_timer() - Start charging maintenance timer
451  * @di:         pointer to the abx500_chargalg structure
452  * @duration:   duration of ther maintenance timer in hours
453  *
454  * The maintenance timer is used to maintain the charge in the battery once
455  * the battery is considered full. These timers are chosen to match the
456  * discharge curve of the battery
457  */
458 static void abx500_chargalg_start_maintenance_timer(struct abx500_chargalg *di,
459         int duration)
460 {
461         hrtimer_set_expires_range(&di->maintenance_timer,
462                 ktime_set(duration * ONE_HOUR_IN_SECONDS, 0),
463                 ktime_set(FIVE_MINUTES_IN_SECONDS, 0));
464         di->events.maintenance_timer_expired = false;
465         hrtimer_start_expires(&di->maintenance_timer, HRTIMER_MODE_REL);
466 }
467
468 /**
469  * abx500_chargalg_stop_maintenance_timer() - Stop maintenance timer
470  * @di:         pointer to the abx500_chargalg structure
471  *
472  * The maintenance timer is stopped whenever maintenance ends or when another
473  * state is entered
474  */
475 static void abx500_chargalg_stop_maintenance_timer(struct abx500_chargalg *di)
476 {
477         if (hrtimer_try_to_cancel(&di->maintenance_timer) >= 0)
478                 di->events.maintenance_timer_expired = false;
479 }
480
481 /**
482  * abx500_chargalg_kick_watchdog() - Kick charger watchdog
483  * @di:         pointer to the abx500_chargalg structure
484  *
485  * The charger watchdog have to be kicked periodically whenever the charger is
486  * on, else the ABB will reset the system
487  */
488 static int abx500_chargalg_kick_watchdog(struct abx500_chargalg *di)
489 {
490         /* Check if charger exists and kick watchdog if charging */
491         if (di->ac_chg && di->ac_chg->ops.kick_wd &&
492             di->chg_info.online_chg & AC_CHG) {
493                 /*
494                  * If AB charger watchdog expired, pm2xxx charging
495                  * gets disabled. To be safe, kick both AB charger watchdog
496                  * and pm2xxx watchdog.
497                  */
498                 if (di->ac_chg->external &&
499                     di->usb_chg && di->usb_chg->ops.kick_wd)
500                         di->usb_chg->ops.kick_wd(di->usb_chg);
501
502                 return di->ac_chg->ops.kick_wd(di->ac_chg);
503         }
504         else if (di->usb_chg && di->usb_chg->ops.kick_wd &&
505                         di->chg_info.online_chg & USB_CHG)
506                 return di->usb_chg->ops.kick_wd(di->usb_chg);
507
508         return -ENXIO;
509 }
510
511 /**
512  * abx500_chargalg_ac_en() - Turn on/off the AC charger
513  * @di:         pointer to the abx500_chargalg structure
514  * @enable:     charger on/off
515  * @vset:       requested charger output voltage
516  * @iset:       requested charger output current
517  *
518  * The AC charger will be turned on/off with the requested charge voltage and
519  * current
520  */
521 static int abx500_chargalg_ac_en(struct abx500_chargalg *di, int enable,
522         int vset, int iset)
523 {
524         static int abx500_chargalg_ex_ac_enable_toggle;
525
526         if (!di->ac_chg || !di->ac_chg->ops.enable)
527                 return -ENXIO;
528
529         /* Select maximum of what both the charger and the battery supports */
530         if (di->ac_chg->max_out_volt)
531                 vset = min(vset, di->ac_chg->max_out_volt);
532         if (di->ac_chg->max_out_curr)
533                 iset = min(iset, di->ac_chg->max_out_curr);
534
535         di->chg_info.ac_iset = iset;
536         di->chg_info.ac_vset = vset;
537
538         /* Enable external charger */
539         if (enable && di->ac_chg->external &&
540             !abx500_chargalg_ex_ac_enable_toggle) {
541                 blocking_notifier_call_chain(&charger_notifier_list,
542                                              0, di->dev);
543                 abx500_chargalg_ex_ac_enable_toggle++;
544         }
545
546         return di->ac_chg->ops.enable(di->ac_chg, enable, vset, iset);
547 }
548
549 /**
550  * abx500_chargalg_usb_en() - Turn on/off the USB charger
551  * @di:         pointer to the abx500_chargalg structure
552  * @enable:     charger on/off
553  * @vset:       requested charger output voltage
554  * @iset:       requested charger output current
555  *
556  * The USB charger will be turned on/off with the requested charge voltage and
557  * current
558  */
559 static int abx500_chargalg_usb_en(struct abx500_chargalg *di, int enable,
560         int vset, int iset)
561 {
562         if (!di->usb_chg || !di->usb_chg->ops.enable)
563                 return -ENXIO;
564
565         /* Select maximum of what both the charger and the battery supports */
566         if (di->usb_chg->max_out_volt)
567                 vset = min(vset, di->usb_chg->max_out_volt);
568         if (di->usb_chg->max_out_curr)
569                 iset = min(iset, di->usb_chg->max_out_curr);
570
571         di->chg_info.usb_iset = iset;
572         di->chg_info.usb_vset = vset;
573
574         return di->usb_chg->ops.enable(di->usb_chg, enable, vset, iset);
575 }
576
577  /**
578  * ab8540_chargalg_usb_pp_en() - Enable/ disable USB power path
579  * @di:                pointer to the abx500_chargalg structure
580  * @enable:    power path enable/disable
581  *
582  * The USB power path will be enable/ disable
583  */
584 static int ab8540_chargalg_usb_pp_en(struct abx500_chargalg *di, bool enable)
585 {
586         if (!di->usb_chg || !di->usb_chg->ops.pp_enable)
587                 return -ENXIO;
588
589         return di->usb_chg->ops.pp_enable(di->usb_chg, enable);
590 }
591
592 /**
593  * ab8540_chargalg_usb_pre_chg_en() - Enable/ disable USB pre-charge
594  * @di:                pointer to the abx500_chargalg structure
595  * @enable:    USB pre-charge enable/disable
596  *
597  * The USB USB pre-charge will be enable/ disable
598  */
599 static int ab8540_chargalg_usb_pre_chg_en(struct abx500_chargalg *di,
600                                           bool enable)
601 {
602         if (!di->usb_chg || !di->usb_chg->ops.pre_chg_enable)
603                 return -ENXIO;
604
605         return di->usb_chg->ops.pre_chg_enable(di->usb_chg, enable);
606 }
607
608 /**
609  * abx500_chargalg_update_chg_curr() - Update charger current
610  * @di:         pointer to the abx500_chargalg structure
611  * @iset:       requested charger output current
612  *
613  * The charger output current will be updated for the charger
614  * that is currently in use
615  */
616 static int abx500_chargalg_update_chg_curr(struct abx500_chargalg *di,
617                 int iset)
618 {
619         /* Check if charger exists and update current if charging */
620         if (di->ac_chg && di->ac_chg->ops.update_curr &&
621                         di->chg_info.charger_type & AC_CHG) {
622                 /*
623                  * Select maximum of what both the charger
624                  * and the battery supports
625                  */
626                 if (di->ac_chg->max_out_curr)
627                         iset = min(iset, di->ac_chg->max_out_curr);
628
629                 di->chg_info.ac_iset = iset;
630
631                 return di->ac_chg->ops.update_curr(di->ac_chg, iset);
632         } else if (di->usb_chg && di->usb_chg->ops.update_curr &&
633                         di->chg_info.charger_type & USB_CHG) {
634                 /*
635                  * Select maximum of what both the charger
636                  * and the battery supports
637                  */
638                 if (di->usb_chg->max_out_curr)
639                         iset = min(iset, di->usb_chg->max_out_curr);
640
641                 di->chg_info.usb_iset = iset;
642
643                 return di->usb_chg->ops.update_curr(di->usb_chg, iset);
644         }
645
646         return -ENXIO;
647 }
648
649 /**
650  * abx500_chargalg_stop_charging() - Stop charging
651  * @di:         pointer to the abx500_chargalg structure
652  *
653  * This function is called from any state where charging should be stopped.
654  * All charging is disabled and all status parameters and timers are changed
655  * accordingly
656  */
657 static void abx500_chargalg_stop_charging(struct abx500_chargalg *di)
658 {
659         abx500_chargalg_ac_en(di, false, 0, 0);
660         abx500_chargalg_usb_en(di, false, 0, 0);
661         abx500_chargalg_stop_safety_timer(di);
662         abx500_chargalg_stop_maintenance_timer(di);
663         di->charge_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
664         di->maintenance_chg = false;
665         cancel_delayed_work(&di->chargalg_wd_work);
666         power_supply_changed(&di->chargalg_psy);
667 }
668
669 /**
670  * abx500_chargalg_hold_charging() - Pauses charging
671  * @di:         pointer to the abx500_chargalg structure
672  *
673  * This function is called in the case where maintenance charging has been
674  * disabled and instead a battery voltage mode is entered to check when the
675  * battery voltage has reached a certain recharge voltage
676  */
677 static void abx500_chargalg_hold_charging(struct abx500_chargalg *di)
678 {
679         abx500_chargalg_ac_en(di, false, 0, 0);
680         abx500_chargalg_usb_en(di, false, 0, 0);
681         abx500_chargalg_stop_safety_timer(di);
682         abx500_chargalg_stop_maintenance_timer(di);
683         di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
684         di->maintenance_chg = false;
685         cancel_delayed_work(&di->chargalg_wd_work);
686         power_supply_changed(&di->chargalg_psy);
687 }
688
689 /**
690  * abx500_chargalg_start_charging() - Start the charger
691  * @di:         pointer to the abx500_chargalg structure
692  * @vset:       requested charger output voltage
693  * @iset:       requested charger output current
694  *
695  * A charger will be enabled depending on the requested charger type that was
696  * detected previously.
697  */
698 static void abx500_chargalg_start_charging(struct abx500_chargalg *di,
699         int vset, int iset)
700 {
701         switch (di->chg_info.charger_type) {
702         case AC_CHG:
703                 dev_dbg(di->dev,
704                         "AC parameters: Vset %d, Ich %d\n", vset, iset);
705                 abx500_chargalg_usb_en(di, false, 0, 0);
706                 abx500_chargalg_ac_en(di, true, vset, iset);
707                 break;
708
709         case USB_CHG:
710                 dev_dbg(di->dev,
711                         "USB parameters: Vset %d, Ich %d\n", vset, iset);
712                 abx500_chargalg_ac_en(di, false, 0, 0);
713                 abx500_chargalg_usb_en(di, true, vset, iset);
714                 break;
715
716         default:
717                 dev_err(di->dev, "Unknown charger to charge from\n");
718                 break;
719         }
720 }
721
722 /**
723  * abx500_chargalg_check_temp() - Check battery temperature ranges
724  * @di:         pointer to the abx500_chargalg structure
725  *
726  * The battery temperature is checked against the predefined limits and the
727  * charge state is changed accordingly
728  */
729 static void abx500_chargalg_check_temp(struct abx500_chargalg *di)
730 {
731         if (di->batt_data.temp > (di->bm->temp_low + di->t_hyst_norm) &&
732                 di->batt_data.temp < (di->bm->temp_high - di->t_hyst_norm)) {
733                 /* Temp OK! */
734                 di->events.btemp_underover = false;
735                 di->events.btemp_lowhigh = false;
736                 di->t_hyst_norm = 0;
737                 di->t_hyst_lowhigh = 0;
738         } else {
739                 if (((di->batt_data.temp >= di->bm->temp_high) &&
740                         (di->batt_data.temp <
741                                 (di->bm->temp_over - di->t_hyst_lowhigh))) ||
742                         ((di->batt_data.temp >
743                                 (di->bm->temp_under + di->t_hyst_lowhigh)) &&
744                         (di->batt_data.temp <= di->bm->temp_low))) {
745                         /* TEMP minor!!!!! */
746                         di->events.btemp_underover = false;
747                         di->events.btemp_lowhigh = true;
748                         di->t_hyst_norm = di->bm->temp_hysteresis;
749                         di->t_hyst_lowhigh = 0;
750                 } else if (di->batt_data.temp <= di->bm->temp_under ||
751                         di->batt_data.temp >= di->bm->temp_over) {
752                         /* TEMP major!!!!! */
753                         di->events.btemp_underover = true;
754                         di->events.btemp_lowhigh = false;
755                         di->t_hyst_norm = 0;
756                         di->t_hyst_lowhigh = di->bm->temp_hysteresis;
757                 } else {
758                 /* Within hysteresis */
759                 dev_dbg(di->dev, "Within hysteresis limit temp: %d "
760                                 "hyst_lowhigh %d, hyst normal %d\n",
761                                 di->batt_data.temp, di->t_hyst_lowhigh,
762                                 di->t_hyst_norm);
763                 }
764         }
765 }
766
767 /**
768  * abx500_chargalg_check_charger_voltage() - Check charger voltage
769  * @di:         pointer to the abx500_chargalg structure
770  *
771  * Charger voltage is checked against maximum limit
772  */
773 static void abx500_chargalg_check_charger_voltage(struct abx500_chargalg *di)
774 {
775         if (di->chg_info.usb_volt > di->bm->chg_params->usb_volt_max)
776                 di->chg_info.usb_chg_ok = false;
777         else
778                 di->chg_info.usb_chg_ok = true;
779
780         if (di->chg_info.ac_volt > di->bm->chg_params->ac_volt_max)
781                 di->chg_info.ac_chg_ok = false;
782         else
783                 di->chg_info.ac_chg_ok = true;
784
785 }
786
787 /**
788  * abx500_chargalg_end_of_charge() - Check if end-of-charge criteria is fulfilled
789  * @di:         pointer to the abx500_chargalg structure
790  *
791  * End-of-charge criteria is fulfilled when the battery voltage is above a
792  * certain limit and the battery current is below a certain limit for a
793  * predefined number of consecutive seconds. If true, the battery is full
794  */
795 static void abx500_chargalg_end_of_charge(struct abx500_chargalg *di)
796 {
797         if (di->charge_status == POWER_SUPPLY_STATUS_CHARGING &&
798                 di->charge_state == STATE_NORMAL &&
799                 !di->maintenance_chg && (di->batt_data.volt >=
800                 di->bm->bat_type[di->bm->batt_id].termination_vol ||
801                 di->events.usb_cv_active || di->events.ac_cv_active) &&
802                 di->batt_data.avg_curr <
803                 di->bm->bat_type[di->bm->batt_id].termination_curr &&
804                 di->batt_data.avg_curr > 0) {
805                 if (++di->eoc_cnt >= EOC_COND_CNT) {
806                         di->eoc_cnt = 0;
807                         if ((di->chg_info.charger_type & USB_CHG) &&
808                            (di->usb_chg->power_path))
809                                 ab8540_chargalg_usb_pp_en(di, true);
810                         di->charge_status = POWER_SUPPLY_STATUS_FULL;
811                         di->maintenance_chg = true;
812                         dev_dbg(di->dev, "EOC reached!\n");
813                         power_supply_changed(&di->chargalg_psy);
814                 } else {
815                         dev_dbg(di->dev,
816                                 " EOC limit reached for the %d"
817                                 " time, out of %d before EOC\n",
818                                 di->eoc_cnt,
819                                 EOC_COND_CNT);
820                 }
821         } else {
822                 di->eoc_cnt = 0;
823         }
824 }
825
826 static void init_maxim_chg_curr(struct abx500_chargalg *di)
827 {
828         di->ccm.original_iset =
829                 di->bm->bat_type[di->bm->batt_id].normal_cur_lvl;
830         di->ccm.current_iset =
831                 di->bm->bat_type[di->bm->batt_id].normal_cur_lvl;
832         di->ccm.test_delta_i = di->bm->maxi->charger_curr_step;
833         di->ccm.max_current = di->bm->maxi->chg_curr;
834         di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
835         di->ccm.level = 0;
836 }
837
838 /**
839  * abx500_chargalg_chg_curr_maxim - increases the charger current to
840  *                      compensate for the system load
841  * @di          pointer to the abx500_chargalg structure
842  *
843  * This maximization function is used to raise the charger current to get the
844  * battery current as close to the optimal value as possible. The battery
845  * current during charging is affected by the system load
846  */
847 static enum maxim_ret abx500_chargalg_chg_curr_maxim(struct abx500_chargalg *di)
848 {
849         int delta_i;
850
851         if (!di->bm->maxi->ena_maxi)
852                 return MAXIM_RET_NOACTION;
853
854         delta_i = di->ccm.original_iset - di->batt_data.inst_curr;
855
856         if (di->events.vbus_collapsed) {
857                 dev_dbg(di->dev, "Charger voltage has collapsed %d\n",
858                                 di->ccm.wait_cnt);
859                 if (di->ccm.wait_cnt == 0) {
860                         dev_dbg(di->dev, "lowering current\n");
861                         di->ccm.wait_cnt++;
862                         di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
863                         di->ccm.max_current =
864                                 di->ccm.current_iset - di->ccm.test_delta_i;
865                         di->ccm.current_iset = di->ccm.max_current;
866                         di->ccm.level--;
867                         return MAXIM_RET_CHANGE;
868                 } else {
869                         dev_dbg(di->dev, "waiting\n");
870                         /* Let's go in here twice before lowering curr again */
871                         di->ccm.wait_cnt = (di->ccm.wait_cnt + 1) % 3;
872                         return MAXIM_RET_NOACTION;
873                 }
874         }
875
876         di->ccm.wait_cnt = 0;
877
878         if ((di->batt_data.inst_curr > di->ccm.original_iset)) {
879                 dev_dbg(di->dev, " Maximization Ibat (%dmA) too high"
880                         " (limit %dmA) (current iset: %dmA)!\n",
881                         di->batt_data.inst_curr, di->ccm.original_iset,
882                         di->ccm.current_iset);
883
884                 if (di->ccm.current_iset == di->ccm.original_iset)
885                         return MAXIM_RET_NOACTION;
886
887                 di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
888                 di->ccm.current_iset = di->ccm.original_iset;
889                 di->ccm.level = 0;
890
891                 return MAXIM_RET_IBAT_TOO_HIGH;
892         }
893
894         if (delta_i > di->ccm.test_delta_i &&
895                 (di->ccm.current_iset + di->ccm.test_delta_i) <
896                 di->ccm.max_current) {
897                 if (di->ccm.condition_cnt-- == 0) {
898                         /* Increse the iset with cco.test_delta_i */
899                         di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
900                         di->ccm.current_iset += di->ccm.test_delta_i;
901                         di->ccm.level++;
902                         dev_dbg(di->dev, " Maximization needed, increase"
903                                 " with %d mA to %dmA (Optimal ibat: %d)"
904                                 " Level %d\n",
905                                 di->ccm.test_delta_i,
906                                 di->ccm.current_iset,
907                                 di->ccm.original_iset,
908                                 di->ccm.level);
909                         return MAXIM_RET_CHANGE;
910                 } else {
911                         return MAXIM_RET_NOACTION;
912                 }
913         }  else {
914                 di->ccm.condition_cnt = di->bm->maxi->wait_cycles;
915                 return MAXIM_RET_NOACTION;
916         }
917 }
918
919 static void handle_maxim_chg_curr(struct abx500_chargalg *di)
920 {
921         enum maxim_ret ret;
922         int result;
923
924         ret = abx500_chargalg_chg_curr_maxim(di);
925         switch (ret) {
926         case MAXIM_RET_CHANGE:
927                 result = abx500_chargalg_update_chg_curr(di,
928                         di->ccm.current_iset);
929                 if (result)
930                         dev_err(di->dev, "failed to set chg curr\n");
931                 break;
932         case MAXIM_RET_IBAT_TOO_HIGH:
933                 result = abx500_chargalg_update_chg_curr(di,
934                         di->bm->bat_type[di->bm->batt_id].normal_cur_lvl);
935                 if (result)
936                         dev_err(di->dev, "failed to set chg curr\n");
937                 break;
938
939         case MAXIM_RET_NOACTION:
940         default:
941                 /* Do nothing..*/
942                 break;
943         }
944 }
945
946 static int abx500_chargalg_get_ext_psy_data(struct device *dev, void *data)
947 {
948         struct power_supply *psy;
949         struct power_supply *ext;
950         struct abx500_chargalg *di;
951         union power_supply_propval ret;
952         int i, j;
953         bool psy_found = false;
954         bool capacity_updated = false;
955
956         psy = (struct power_supply *)data;
957         ext = dev_get_drvdata(dev);
958         di = to_abx500_chargalg_device_info(psy);
959         /* For all psy where the driver name appears in any supplied_to */
960         for (i = 0; i < ext->num_supplicants; i++) {
961                 if (!strcmp(ext->supplied_to[i], psy->name))
962                         psy_found = true;
963         }
964         if (!psy_found)
965                 return 0;
966
967         /*
968          *  If external is not registering 'POWER_SUPPLY_PROP_CAPACITY' to its
969          * property because of handling that sysfs entry on its own, this is
970          * the place to get the battery capacity.
971          */
972         if (!ext->get_property(ext, POWER_SUPPLY_PROP_CAPACITY, &ret)) {
973                 di->batt_data.percent = ret.intval;
974                 capacity_updated = true;
975         }
976
977         /* Go through all properties for the psy */
978         for (j = 0; j < ext->num_properties; j++) {
979                 enum power_supply_property prop;
980                 prop = ext->properties[j];
981
982                 /* Initialize chargers if not already done */
983                 if (!di->ac_chg &&
984                         ext->type == POWER_SUPPLY_TYPE_MAINS)
985                         di->ac_chg = psy_to_ux500_charger(ext);
986                 else if (!di->usb_chg &&
987                         ext->type == POWER_SUPPLY_TYPE_USB)
988                         di->usb_chg = psy_to_ux500_charger(ext);
989
990                 if (ext->get_property(ext, prop, &ret))
991                         continue;
992                 switch (prop) {
993                 case POWER_SUPPLY_PROP_PRESENT:
994                         switch (ext->type) {
995                         case POWER_SUPPLY_TYPE_BATTERY:
996                                 /* Battery present */
997                                 if (ret.intval)
998                                         di->events.batt_rem = false;
999                                 /* Battery removed */
1000                                 else
1001                                         di->events.batt_rem = true;
1002                                 break;
1003                         case POWER_SUPPLY_TYPE_MAINS:
1004                                 /* AC disconnected */
1005                                 if (!ret.intval &&
1006                                         (di->chg_info.conn_chg & AC_CHG)) {
1007                                         di->chg_info.prev_conn_chg =
1008                                                 di->chg_info.conn_chg;
1009                                         di->chg_info.conn_chg &= ~AC_CHG;
1010                                 }
1011                                 /* AC connected */
1012                                 else if (ret.intval &&
1013                                         !(di->chg_info.conn_chg & AC_CHG)) {
1014                                         di->chg_info.prev_conn_chg =
1015                                                 di->chg_info.conn_chg;
1016                                         di->chg_info.conn_chg |= AC_CHG;
1017                                 }
1018                                 break;
1019                         case POWER_SUPPLY_TYPE_USB:
1020                                 /* USB disconnected */
1021                                 if (!ret.intval &&
1022                                         (di->chg_info.conn_chg & USB_CHG)) {
1023                                         di->chg_info.prev_conn_chg =
1024                                                 di->chg_info.conn_chg;
1025                                         di->chg_info.conn_chg &= ~USB_CHG;
1026                                 }
1027                                 /* USB connected */
1028                                 else if (ret.intval &&
1029                                         !(di->chg_info.conn_chg & USB_CHG)) {
1030                                         di->chg_info.prev_conn_chg =
1031                                                 di->chg_info.conn_chg;
1032                                         di->chg_info.conn_chg |= USB_CHG;
1033                                 }
1034                                 break;
1035                         default:
1036                                 break;
1037                         }
1038                         break;
1039
1040                 case POWER_SUPPLY_PROP_ONLINE:
1041                         switch (ext->type) {
1042                         case POWER_SUPPLY_TYPE_BATTERY:
1043                                 break;
1044                         case POWER_SUPPLY_TYPE_MAINS:
1045                                 /* AC offline */
1046                                 if (!ret.intval &&
1047                                         (di->chg_info.online_chg & AC_CHG)) {
1048                                         di->chg_info.prev_online_chg =
1049                                                 di->chg_info.online_chg;
1050                                         di->chg_info.online_chg &= ~AC_CHG;
1051                                 }
1052                                 /* AC online */
1053                                 else if (ret.intval &&
1054                                         !(di->chg_info.online_chg & AC_CHG)) {
1055                                         di->chg_info.prev_online_chg =
1056                                                 di->chg_info.online_chg;
1057                                         di->chg_info.online_chg |= AC_CHG;
1058                                         queue_delayed_work(di->chargalg_wq,
1059                                                 &di->chargalg_wd_work, 0);
1060                                 }
1061                                 break;
1062                         case POWER_SUPPLY_TYPE_USB:
1063                                 /* USB offline */
1064                                 if (!ret.intval &&
1065                                         (di->chg_info.online_chg & USB_CHG)) {
1066                                         di->chg_info.prev_online_chg =
1067                                                 di->chg_info.online_chg;
1068                                         di->chg_info.online_chg &= ~USB_CHG;
1069                                 }
1070                                 /* USB online */
1071                                 else if (ret.intval &&
1072                                         !(di->chg_info.online_chg & USB_CHG)) {
1073                                         di->chg_info.prev_online_chg =
1074                                                 di->chg_info.online_chg;
1075                                         di->chg_info.online_chg |= USB_CHG;
1076                                         queue_delayed_work(di->chargalg_wq,
1077                                                 &di->chargalg_wd_work, 0);
1078                                 }
1079                                 break;
1080                         default:
1081                                 break;
1082                         }
1083                         break;
1084
1085                 case POWER_SUPPLY_PROP_HEALTH:
1086                         switch (ext->type) {
1087                         case POWER_SUPPLY_TYPE_BATTERY:
1088                                 break;
1089                         case POWER_SUPPLY_TYPE_MAINS:
1090                                 switch (ret.intval) {
1091                                 case POWER_SUPPLY_HEALTH_UNSPEC_FAILURE:
1092                                         di->events.mainextchnotok = true;
1093                                         di->events.main_thermal_prot = false;
1094                                         di->events.main_ovv = false;
1095                                         di->events.ac_wd_expired = false;
1096                                         break;
1097                                 case POWER_SUPPLY_HEALTH_DEAD:
1098                                         di->events.ac_wd_expired = true;
1099                                         di->events.mainextchnotok = false;
1100                                         di->events.main_ovv = false;
1101                                         di->events.main_thermal_prot = false;
1102                                         break;
1103                                 case POWER_SUPPLY_HEALTH_COLD:
1104                                 case POWER_SUPPLY_HEALTH_OVERHEAT:
1105                                         di->events.main_thermal_prot = true;
1106                                         di->events.mainextchnotok = false;
1107                                         di->events.main_ovv = false;
1108                                         di->events.ac_wd_expired = false;
1109                                         break;
1110                                 case POWER_SUPPLY_HEALTH_OVERVOLTAGE:
1111                                         di->events.main_ovv = true;
1112                                         di->events.mainextchnotok = false;
1113                                         di->events.main_thermal_prot = false;
1114                                         di->events.ac_wd_expired = false;
1115                                         break;
1116                                 case POWER_SUPPLY_HEALTH_GOOD:
1117                                         di->events.main_thermal_prot = false;
1118                                         di->events.mainextchnotok = false;
1119                                         di->events.main_ovv = false;
1120                                         di->events.ac_wd_expired = false;
1121                                         break;
1122                                 default:
1123                                         break;
1124                                 }
1125                                 break;
1126
1127                         case POWER_SUPPLY_TYPE_USB:
1128                                 switch (ret.intval) {
1129                                 case POWER_SUPPLY_HEALTH_UNSPEC_FAILURE:
1130                                         di->events.usbchargernotok = true;
1131                                         di->events.usb_thermal_prot = false;
1132                                         di->events.vbus_ovv = false;
1133                                         di->events.usb_wd_expired = false;
1134                                         break;
1135                                 case POWER_SUPPLY_HEALTH_DEAD:
1136                                         di->events.usb_wd_expired = true;
1137                                         di->events.usbchargernotok = false;
1138                                         di->events.usb_thermal_prot = false;
1139                                         di->events.vbus_ovv = false;
1140                                         break;
1141                                 case POWER_SUPPLY_HEALTH_COLD:
1142                                 case POWER_SUPPLY_HEALTH_OVERHEAT:
1143                                         di->events.usb_thermal_prot = true;
1144                                         di->events.usbchargernotok = false;
1145                                         di->events.vbus_ovv = false;
1146                                         di->events.usb_wd_expired = false;
1147                                         break;
1148                                 case POWER_SUPPLY_HEALTH_OVERVOLTAGE:
1149                                         di->events.vbus_ovv = true;
1150                                         di->events.usbchargernotok = false;
1151                                         di->events.usb_thermal_prot = false;
1152                                         di->events.usb_wd_expired = false;
1153                                         break;
1154                                 case POWER_SUPPLY_HEALTH_GOOD:
1155                                         di->events.usbchargernotok = false;
1156                                         di->events.usb_thermal_prot = false;
1157                                         di->events.vbus_ovv = false;
1158                                         di->events.usb_wd_expired = false;
1159                                         break;
1160                                 default:
1161                                         break;
1162                                 }
1163                         default:
1164                                 break;
1165                         }
1166                         break;
1167
1168                 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
1169                         switch (ext->type) {
1170                         case POWER_SUPPLY_TYPE_BATTERY:
1171                                 di->batt_data.volt = ret.intval / 1000;
1172                                 break;
1173                         case POWER_SUPPLY_TYPE_MAINS:
1174                                 di->chg_info.ac_volt = ret.intval / 1000;
1175                                 break;
1176                         case POWER_SUPPLY_TYPE_USB:
1177                                 di->chg_info.usb_volt = ret.intval / 1000;
1178                                 break;
1179                         default:
1180                                 break;
1181                         }
1182                         break;
1183
1184                 case POWER_SUPPLY_PROP_VOLTAGE_AVG:
1185                         switch (ext->type) {
1186                         case POWER_SUPPLY_TYPE_MAINS:
1187                                 /* AVG is used to indicate when we are
1188                                  * in CV mode */
1189                                 if (ret.intval)
1190                                         di->events.ac_cv_active = true;
1191                                 else
1192                                         di->events.ac_cv_active = false;
1193
1194                                 break;
1195                         case POWER_SUPPLY_TYPE_USB:
1196                                 /* AVG is used to indicate when we are
1197                                  * in CV mode */
1198                                 if (ret.intval)
1199                                         di->events.usb_cv_active = true;
1200                                 else
1201                                         di->events.usb_cv_active = false;
1202
1203                                 break;
1204                         default:
1205                                 break;
1206                         }
1207                         break;
1208
1209                 case POWER_SUPPLY_PROP_TECHNOLOGY:
1210                         switch (ext->type) {
1211                         case POWER_SUPPLY_TYPE_BATTERY:
1212                                 if (ret.intval)
1213                                         di->events.batt_unknown = false;
1214                                 else
1215                                         di->events.batt_unknown = true;
1216
1217                                 break;
1218                         default:
1219                                 break;
1220                         }
1221                         break;
1222
1223                 case POWER_SUPPLY_PROP_TEMP:
1224                         di->batt_data.temp = ret.intval / 10;
1225                         break;
1226
1227                 case POWER_SUPPLY_PROP_CURRENT_NOW:
1228                         switch (ext->type) {
1229                         case POWER_SUPPLY_TYPE_MAINS:
1230                                         di->chg_info.ac_curr =
1231                                                 ret.intval / 1000;
1232                                         break;
1233                         case POWER_SUPPLY_TYPE_USB:
1234                                         di->chg_info.usb_curr =
1235                                                 ret.intval / 1000;
1236                                 break;
1237                         case POWER_SUPPLY_TYPE_BATTERY:
1238                                 di->batt_data.inst_curr = ret.intval / 1000;
1239                                 break;
1240                         default:
1241                                 break;
1242                         }
1243                         break;
1244
1245                 case POWER_SUPPLY_PROP_CURRENT_AVG:
1246                         switch (ext->type) {
1247                         case POWER_SUPPLY_TYPE_BATTERY:
1248                                 di->batt_data.avg_curr = ret.intval / 1000;
1249                                 break;
1250                         case POWER_SUPPLY_TYPE_USB:
1251                                 if (ret.intval)
1252                                         di->events.vbus_collapsed = true;
1253                                 else
1254                                         di->events.vbus_collapsed = false;
1255                                 break;
1256                         default:
1257                                 break;
1258                         }
1259                         break;
1260                 case POWER_SUPPLY_PROP_CAPACITY:
1261                         if (!capacity_updated)
1262                                 di->batt_data.percent = ret.intval;
1263                         break;
1264                 default:
1265                         break;
1266                 }
1267         }
1268         return 0;
1269 }
1270
1271 /**
1272  * abx500_chargalg_external_power_changed() - callback for power supply changes
1273  * @psy:       pointer to the structure power_supply
1274  *
1275  * This function is the entry point of the pointer external_power_changed
1276  * of the structure power_supply.
1277  * This function gets executed when there is a change in any external power
1278  * supply that this driver needs to be notified of.
1279  */
1280 static void abx500_chargalg_external_power_changed(struct power_supply *psy)
1281 {
1282         struct abx500_chargalg *di = to_abx500_chargalg_device_info(psy);
1283
1284         /*
1285          * Trigger execution of the algorithm instantly and read
1286          * all power_supply properties there instead
1287          */
1288         queue_work(di->chargalg_wq, &di->chargalg_work);
1289 }
1290
1291 /**
1292  * abx500_chargalg_algorithm() - Main function for the algorithm
1293  * @di:         pointer to the abx500_chargalg structure
1294  *
1295  * This is the main control function for the charging algorithm.
1296  * It is called periodically or when something happens that will
1297  * trigger a state change
1298  */
1299 static void abx500_chargalg_algorithm(struct abx500_chargalg *di)
1300 {
1301         int charger_status;
1302         int ret;
1303
1304         /* Collect data from all power_supply class devices */
1305         class_for_each_device(power_supply_class, NULL,
1306                 &di->chargalg_psy, abx500_chargalg_get_ext_psy_data);
1307
1308         abx500_chargalg_end_of_charge(di);
1309         abx500_chargalg_check_temp(di);
1310         abx500_chargalg_check_charger_voltage(di);
1311
1312         charger_status = abx500_chargalg_check_charger_connection(di);
1313
1314         if (is_ab8500(di->parent)) {
1315                 ret = abx500_chargalg_check_charger_enable(di);
1316                 if (ret < 0)
1317                         dev_err(di->dev, "Checking charger is enabled error"
1318                                         ": Returned Value %d\n", ret);
1319         }
1320
1321         /*
1322          * First check if we have a charger connected.
1323          * Also we don't allow charging of unknown batteries if configured
1324          * this way
1325          */
1326         if (!charger_status ||
1327                 (di->events.batt_unknown && !di->bm->chg_unknown_bat)) {
1328                 if (di->charge_state != STATE_HANDHELD) {
1329                         di->events.safety_timer_expired = false;
1330                         abx500_chargalg_state_to(di, STATE_HANDHELD_INIT);
1331                 }
1332         }
1333
1334         /* If suspended, we should not continue checking the flags */
1335         else if (di->charge_state == STATE_SUSPENDED_INIT ||
1336                 di->charge_state == STATE_SUSPENDED) {
1337                 /* We don't do anything here, just don,t continue */
1338         }
1339
1340         /* Safety timer expiration */
1341         else if (di->events.safety_timer_expired) {
1342                 if (di->charge_state != STATE_SAFETY_TIMER_EXPIRED)
1343                         abx500_chargalg_state_to(di,
1344                                 STATE_SAFETY_TIMER_EXPIRED_INIT);
1345         }
1346         /*
1347          * Check if any interrupts has occured
1348          * that will prevent us from charging
1349          */
1350
1351         /* Battery removed */
1352         else if (di->events.batt_rem) {
1353                 if (di->charge_state != STATE_BATT_REMOVED)
1354                         abx500_chargalg_state_to(di, STATE_BATT_REMOVED_INIT);
1355         }
1356         /* Main or USB charger not ok. */
1357         else if (di->events.mainextchnotok || di->events.usbchargernotok) {
1358                 /*
1359                  * If vbus_collapsed is set, we have to lower the charger
1360                  * current, which is done in the normal state below
1361                  */
1362                 if (di->charge_state != STATE_CHG_NOT_OK &&
1363                                 !di->events.vbus_collapsed)
1364                         abx500_chargalg_state_to(di, STATE_CHG_NOT_OK_INIT);
1365         }
1366         /* VBUS, Main or VBAT OVV. */
1367         else if (di->events.vbus_ovv ||
1368                         di->events.main_ovv ||
1369                         di->events.batt_ovv ||
1370                         !di->chg_info.usb_chg_ok ||
1371                         !di->chg_info.ac_chg_ok) {
1372                 if (di->charge_state != STATE_OVV_PROTECT)
1373                         abx500_chargalg_state_to(di, STATE_OVV_PROTECT_INIT);
1374         }
1375         /* USB Thermal, stop charging */
1376         else if (di->events.main_thermal_prot ||
1377                 di->events.usb_thermal_prot) {
1378                 if (di->charge_state != STATE_HW_TEMP_PROTECT)
1379                         abx500_chargalg_state_to(di,
1380                                 STATE_HW_TEMP_PROTECT_INIT);
1381         }
1382         /* Battery temp over/under */
1383         else if (di->events.btemp_underover) {
1384                 if (di->charge_state != STATE_TEMP_UNDEROVER)
1385                         abx500_chargalg_state_to(di,
1386                                 STATE_TEMP_UNDEROVER_INIT);
1387         }
1388         /* Watchdog expired */
1389         else if (di->events.ac_wd_expired ||
1390                 di->events.usb_wd_expired) {
1391                 if (di->charge_state != STATE_WD_EXPIRED)
1392                         abx500_chargalg_state_to(di, STATE_WD_EXPIRED_INIT);
1393         }
1394         /* Battery temp high/low */
1395         else if (di->events.btemp_lowhigh) {
1396                 if (di->charge_state != STATE_TEMP_LOWHIGH)
1397                         abx500_chargalg_state_to(di, STATE_TEMP_LOWHIGH_INIT);
1398         }
1399
1400         dev_dbg(di->dev,
1401                 "[CHARGALG] Vb %d Ib_avg %d Ib_inst %d Tb %d Cap %d Maint %d "
1402                 "State %s Active_chg %d Chg_status %d AC %d USB %d "
1403                 "AC_online %d USB_online %d AC_CV %d USB_CV %d AC_I %d "
1404                 "USB_I %d AC_Vset %d AC_Iset %d USB_Vset %d USB_Iset %d\n",
1405                 di->batt_data.volt,
1406                 di->batt_data.avg_curr,
1407                 di->batt_data.inst_curr,
1408                 di->batt_data.temp,
1409                 di->batt_data.percent,
1410                 di->maintenance_chg,
1411                 states[di->charge_state],
1412                 di->chg_info.charger_type,
1413                 di->charge_status,
1414                 di->chg_info.conn_chg & AC_CHG,
1415                 di->chg_info.conn_chg & USB_CHG,
1416                 di->chg_info.online_chg & AC_CHG,
1417                 di->chg_info.online_chg & USB_CHG,
1418                 di->events.ac_cv_active,
1419                 di->events.usb_cv_active,
1420                 di->chg_info.ac_curr,
1421                 di->chg_info.usb_curr,
1422                 di->chg_info.ac_vset,
1423                 di->chg_info.ac_iset,
1424                 di->chg_info.usb_vset,
1425                 di->chg_info.usb_iset);
1426
1427         switch (di->charge_state) {
1428         case STATE_HANDHELD_INIT:
1429                 abx500_chargalg_stop_charging(di);
1430                 di->charge_status = POWER_SUPPLY_STATUS_DISCHARGING;
1431                 abx500_chargalg_state_to(di, STATE_HANDHELD);
1432                 /* Intentional fallthrough */
1433
1434         case STATE_HANDHELD:
1435                 break;
1436
1437         case STATE_SUSPENDED_INIT:
1438                 if (di->susp_status.ac_suspended)
1439                         abx500_chargalg_ac_en(di, false, 0, 0);
1440                 if (di->susp_status.usb_suspended)
1441                         abx500_chargalg_usb_en(di, false, 0, 0);
1442                 abx500_chargalg_stop_safety_timer(di);
1443                 abx500_chargalg_stop_maintenance_timer(di);
1444                 di->charge_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
1445                 di->maintenance_chg = false;
1446                 abx500_chargalg_state_to(di, STATE_SUSPENDED);
1447                 power_supply_changed(&di->chargalg_psy);
1448                 /* Intentional fallthrough */
1449
1450         case STATE_SUSPENDED:
1451                 /* CHARGING is suspended */
1452                 break;
1453
1454         case STATE_BATT_REMOVED_INIT:
1455                 abx500_chargalg_stop_charging(di);
1456                 abx500_chargalg_state_to(di, STATE_BATT_REMOVED);
1457                 /* Intentional fallthrough */
1458
1459         case STATE_BATT_REMOVED:
1460                 if (!di->events.batt_rem)
1461                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1462                 break;
1463
1464         case STATE_HW_TEMP_PROTECT_INIT:
1465                 abx500_chargalg_stop_charging(di);
1466                 abx500_chargalg_state_to(di, STATE_HW_TEMP_PROTECT);
1467                 /* Intentional fallthrough */
1468
1469         case STATE_HW_TEMP_PROTECT:
1470                 if (!di->events.main_thermal_prot &&
1471                                 !di->events.usb_thermal_prot)
1472                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1473                 break;
1474
1475         case STATE_OVV_PROTECT_INIT:
1476                 abx500_chargalg_stop_charging(di);
1477                 abx500_chargalg_state_to(di, STATE_OVV_PROTECT);
1478                 /* Intentional fallthrough */
1479
1480         case STATE_OVV_PROTECT:
1481                 if (!di->events.vbus_ovv &&
1482                                 !di->events.main_ovv &&
1483                                 !di->events.batt_ovv &&
1484                                 di->chg_info.usb_chg_ok &&
1485                                 di->chg_info.ac_chg_ok)
1486                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1487                 break;
1488
1489         case STATE_CHG_NOT_OK_INIT:
1490                 abx500_chargalg_stop_charging(di);
1491                 abx500_chargalg_state_to(di, STATE_CHG_NOT_OK);
1492                 /* Intentional fallthrough */
1493
1494         case STATE_CHG_NOT_OK:
1495                 if (!di->events.mainextchnotok &&
1496                                 !di->events.usbchargernotok)
1497                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1498                 break;
1499
1500         case STATE_SAFETY_TIMER_EXPIRED_INIT:
1501                 abx500_chargalg_stop_charging(di);
1502                 abx500_chargalg_state_to(di, STATE_SAFETY_TIMER_EXPIRED);
1503                 /* Intentional fallthrough */
1504
1505         case STATE_SAFETY_TIMER_EXPIRED:
1506                 /* We exit this state when charger is removed */
1507                 break;
1508
1509         case STATE_NORMAL_INIT:
1510                 if ((di->chg_info.charger_type & USB_CHG) &&
1511                                 di->usb_chg->power_path) {
1512                         if (di->batt_data.volt >
1513                             (di->bm->fg_params->lowbat_threshold +
1514                              BAT_PLUS_MARGIN)) {
1515                                 ab8540_chargalg_usb_pre_chg_en(di, false);
1516                                 ab8540_chargalg_usb_pp_en(di, false);
1517                         } else {
1518                                 ab8540_chargalg_usb_pp_en(di, true);
1519                                 ab8540_chargalg_usb_pre_chg_en(di, true);
1520                                 abx500_chargalg_state_to(di,
1521                                         STATE_USB_PP_PRE_CHARGE);
1522                                 break;
1523                         }
1524                 }
1525
1526                 abx500_chargalg_start_charging(di,
1527                         di->bm->bat_type[di->bm->batt_id].normal_vol_lvl,
1528                         di->bm->bat_type[di->bm->batt_id].normal_cur_lvl);
1529                 abx500_chargalg_state_to(di, STATE_NORMAL);
1530                 abx500_chargalg_start_safety_timer(di);
1531                 abx500_chargalg_stop_maintenance_timer(di);
1532                 init_maxim_chg_curr(di);
1533                 di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
1534                 di->eoc_cnt = 0;
1535                 di->maintenance_chg = false;
1536                 power_supply_changed(&di->chargalg_psy);
1537
1538                 break;
1539
1540         case STATE_USB_PP_PRE_CHARGE:
1541                 if (di->batt_data.volt >
1542                         (di->bm->fg_params->lowbat_threshold +
1543                         BAT_PLUS_MARGIN))
1544                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1545                 break;
1546
1547         case STATE_NORMAL:
1548                 handle_maxim_chg_curr(di);
1549                 if (di->charge_status == POWER_SUPPLY_STATUS_FULL &&
1550                         di->maintenance_chg) {
1551                         if (di->bm->no_maintenance)
1552                                 abx500_chargalg_state_to(di,
1553                                         STATE_WAIT_FOR_RECHARGE_INIT);
1554                         else
1555                                 abx500_chargalg_state_to(di,
1556                                         STATE_MAINTENANCE_A_INIT);
1557                 }
1558                 break;
1559
1560         /* This state will be used when the maintenance state is disabled */
1561         case STATE_WAIT_FOR_RECHARGE_INIT:
1562                 abx500_chargalg_hold_charging(di);
1563                 abx500_chargalg_state_to(di, STATE_WAIT_FOR_RECHARGE);
1564                 /* Intentional fallthrough */
1565
1566         case STATE_WAIT_FOR_RECHARGE:
1567                 if (di->batt_data.percent <=
1568                     di->bm->bat_type[di->bm->batt_id].
1569                     recharge_cap)
1570                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1571                 break;
1572
1573         case STATE_MAINTENANCE_A_INIT:
1574                 abx500_chargalg_stop_safety_timer(di);
1575                 abx500_chargalg_start_maintenance_timer(di,
1576                         di->bm->bat_type[
1577                                 di->bm->batt_id].maint_a_chg_timer_h);
1578                 abx500_chargalg_start_charging(di,
1579                         di->bm->bat_type[
1580                                 di->bm->batt_id].maint_a_vol_lvl,
1581                         di->bm->bat_type[
1582                                 di->bm->batt_id].maint_a_cur_lvl);
1583                 abx500_chargalg_state_to(di, STATE_MAINTENANCE_A);
1584                 power_supply_changed(&di->chargalg_psy);
1585                 /* Intentional fallthrough*/
1586
1587         case STATE_MAINTENANCE_A:
1588                 if (di->events.maintenance_timer_expired) {
1589                         abx500_chargalg_stop_maintenance_timer(di);
1590                         abx500_chargalg_state_to(di, STATE_MAINTENANCE_B_INIT);
1591                 }
1592                 break;
1593
1594         case STATE_MAINTENANCE_B_INIT:
1595                 abx500_chargalg_start_maintenance_timer(di,
1596                         di->bm->bat_type[
1597                                 di->bm->batt_id].maint_b_chg_timer_h);
1598                 abx500_chargalg_start_charging(di,
1599                         di->bm->bat_type[
1600                                 di->bm->batt_id].maint_b_vol_lvl,
1601                         di->bm->bat_type[
1602                                 di->bm->batt_id].maint_b_cur_lvl);
1603                 abx500_chargalg_state_to(di, STATE_MAINTENANCE_B);
1604                 power_supply_changed(&di->chargalg_psy);
1605                 /* Intentional fallthrough*/
1606
1607         case STATE_MAINTENANCE_B:
1608                 if (di->events.maintenance_timer_expired) {
1609                         abx500_chargalg_stop_maintenance_timer(di);
1610                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1611                 }
1612                 break;
1613
1614         case STATE_TEMP_LOWHIGH_INIT:
1615                 abx500_chargalg_start_charging(di,
1616                         di->bm->bat_type[
1617                                 di->bm->batt_id].low_high_vol_lvl,
1618                         di->bm->bat_type[
1619                                 di->bm->batt_id].low_high_cur_lvl);
1620                 abx500_chargalg_stop_maintenance_timer(di);
1621                 di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
1622                 abx500_chargalg_state_to(di, STATE_TEMP_LOWHIGH);
1623                 power_supply_changed(&di->chargalg_psy);
1624                 /* Intentional fallthrough */
1625
1626         case STATE_TEMP_LOWHIGH:
1627                 if (!di->events.btemp_lowhigh)
1628                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1629                 break;
1630
1631         case STATE_WD_EXPIRED_INIT:
1632                 abx500_chargalg_stop_charging(di);
1633                 abx500_chargalg_state_to(di, STATE_WD_EXPIRED);
1634                 /* Intentional fallthrough */
1635
1636         case STATE_WD_EXPIRED:
1637                 if (!di->events.ac_wd_expired &&
1638                                 !di->events.usb_wd_expired)
1639                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1640                 break;
1641
1642         case STATE_TEMP_UNDEROVER_INIT:
1643                 abx500_chargalg_stop_charging(di);
1644                 abx500_chargalg_state_to(di, STATE_TEMP_UNDEROVER);
1645                 /* Intentional fallthrough */
1646
1647         case STATE_TEMP_UNDEROVER:
1648                 if (!di->events.btemp_underover)
1649                         abx500_chargalg_state_to(di, STATE_NORMAL_INIT);
1650                 break;
1651         }
1652
1653         /* Start charging directly if the new state is a charge state */
1654         if (di->charge_state == STATE_NORMAL_INIT ||
1655                         di->charge_state == STATE_MAINTENANCE_A_INIT ||
1656                         di->charge_state == STATE_MAINTENANCE_B_INIT)
1657                 queue_work(di->chargalg_wq, &di->chargalg_work);
1658 }
1659
1660 /**
1661  * abx500_chargalg_periodic_work() - Periodic work for the algorithm
1662  * @work:       pointer to the work_struct structure
1663  *
1664  * Work queue function for the charging algorithm
1665  */
1666 static void abx500_chargalg_periodic_work(struct work_struct *work)
1667 {
1668         struct abx500_chargalg *di = container_of(work,
1669                 struct abx500_chargalg, chargalg_periodic_work.work);
1670
1671         abx500_chargalg_algorithm(di);
1672
1673         /*
1674          * If a charger is connected then the battery has to be monitored
1675          * frequently, else the work can be delayed.
1676          */
1677         if (di->chg_info.conn_chg)
1678                 queue_delayed_work(di->chargalg_wq,
1679                         &di->chargalg_periodic_work,
1680                         di->bm->interval_charging * HZ);
1681         else
1682                 queue_delayed_work(di->chargalg_wq,
1683                         &di->chargalg_periodic_work,
1684                         di->bm->interval_not_charging * HZ);
1685 }
1686
1687 /**
1688  * abx500_chargalg_wd_work() - periodic work to kick the charger watchdog
1689  * @work:       pointer to the work_struct structure
1690  *
1691  * Work queue function for kicking the charger watchdog
1692  */
1693 static void abx500_chargalg_wd_work(struct work_struct *work)
1694 {
1695         int ret;
1696         struct abx500_chargalg *di = container_of(work,
1697                 struct abx500_chargalg, chargalg_wd_work.work);
1698
1699         dev_dbg(di->dev, "abx500_chargalg_wd_work\n");
1700
1701         ret = abx500_chargalg_kick_watchdog(di);
1702         if (ret < 0)
1703                 dev_err(di->dev, "failed to kick watchdog\n");
1704
1705         queue_delayed_work(di->chargalg_wq,
1706                 &di->chargalg_wd_work, CHG_WD_INTERVAL);
1707 }
1708
1709 /**
1710  * abx500_chargalg_work() - Work to run the charging algorithm instantly
1711  * @work:       pointer to the work_struct structure
1712  *
1713  * Work queue function for calling the charging algorithm
1714  */
1715 static void abx500_chargalg_work(struct work_struct *work)
1716 {
1717         struct abx500_chargalg *di = container_of(work,
1718                 struct abx500_chargalg, chargalg_work);
1719
1720         abx500_chargalg_algorithm(di);
1721 }
1722
1723 /**
1724  * abx500_chargalg_get_property() - get the chargalg properties
1725  * @psy:        pointer to the power_supply structure
1726  * @psp:        pointer to the power_supply_property structure
1727  * @val:        pointer to the power_supply_propval union
1728  *
1729  * This function gets called when an application tries to get the
1730  * chargalg properties by reading the sysfs files.
1731  * status:     charging/discharging/full/unknown
1732  * health:     health of the battery
1733  * Returns error code in case of failure else 0 on success
1734  */
1735 static int abx500_chargalg_get_property(struct power_supply *psy,
1736         enum power_supply_property psp,
1737         union power_supply_propval *val)
1738 {
1739         struct abx500_chargalg *di;
1740
1741         di = to_abx500_chargalg_device_info(psy);
1742
1743         switch (psp) {
1744         case POWER_SUPPLY_PROP_STATUS:
1745                 val->intval = di->charge_status;
1746                 break;
1747         case POWER_SUPPLY_PROP_HEALTH:
1748                 if (di->events.batt_ovv) {
1749                         val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
1750                 } else if (di->events.btemp_underover) {
1751                         if (di->batt_data.temp <= di->bm->temp_under)
1752                                 val->intval = POWER_SUPPLY_HEALTH_COLD;
1753                         else
1754                                 val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
1755                 } else if (di->charge_state == STATE_SAFETY_TIMER_EXPIRED ||
1756                            di->charge_state == STATE_SAFETY_TIMER_EXPIRED_INIT) {
1757                         val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
1758                 } else {
1759                         val->intval = POWER_SUPPLY_HEALTH_GOOD;
1760                 }
1761                 break;
1762         default:
1763                 return -EINVAL;
1764         }
1765         return 0;
1766 }
1767
1768 /* Exposure to the sysfs interface */
1769
1770 /**
1771  * abx500_chargalg_sysfs_show() - sysfs show operations
1772  * @kobj:      pointer to the struct kobject
1773  * @attr:      pointer to the struct attribute
1774  * @buf:       buffer that holds the parameter to send to userspace
1775  *
1776  * Returns a buffer to be displayed in user space
1777  */
1778 static ssize_t abx500_chargalg_sysfs_show(struct kobject *kobj,
1779                                           struct attribute *attr, char *buf)
1780 {
1781         struct abx500_chargalg *di = container_of(kobj,
1782                struct abx500_chargalg, chargalg_kobject);
1783
1784         return sprintf(buf, "%d\n",
1785                        di->susp_status.ac_suspended &&
1786                        di->susp_status.usb_suspended);
1787 }
1788
1789 /**
1790  * abx500_chargalg_sysfs_charger() - sysfs store operations
1791  * @kobj:      pointer to the struct kobject
1792  * @attr:      pointer to the struct attribute
1793  * @buf:       buffer that holds the parameter passed from userspace
1794  * @length:    length of the parameter passed
1795  *
1796  * Returns length of the buffer(input taken from user space) on success
1797  * else error code on failure
1798  * The operation to be performed on passing the parameters from the user space.
1799  */
1800 static ssize_t abx500_chargalg_sysfs_charger(struct kobject *kobj,
1801         struct attribute *attr, const char *buf, size_t length)
1802 {
1803         struct abx500_chargalg *di = container_of(kobj,
1804                 struct abx500_chargalg, chargalg_kobject);
1805         long int param;
1806         int ac_usb;
1807         int ret;
1808         char entry = *attr->name;
1809
1810         switch (entry) {
1811         case 'c':
1812                 ret = strict_strtol(buf, 10, &param);
1813                 if (ret < 0)
1814                         return ret;
1815
1816                 ac_usb = param;
1817                 switch (ac_usb) {
1818                 case 0:
1819                         /* Disable charging */
1820                         di->susp_status.ac_suspended = true;
1821                         di->susp_status.usb_suspended = true;
1822                         di->susp_status.suspended_change = true;
1823                         /* Trigger a state change */
1824                         queue_work(di->chargalg_wq,
1825                                 &di->chargalg_work);
1826                         break;
1827                 case 1:
1828                         /* Enable AC Charging */
1829                         di->susp_status.ac_suspended = false;
1830                         di->susp_status.suspended_change = true;
1831                         /* Trigger a state change */
1832                         queue_work(di->chargalg_wq,
1833                                 &di->chargalg_work);
1834                         break;
1835                 case 2:
1836                         /* Enable USB charging */
1837                         di->susp_status.usb_suspended = false;
1838                         di->susp_status.suspended_change = true;
1839                         /* Trigger a state change */
1840                         queue_work(di->chargalg_wq,
1841                                 &di->chargalg_work);
1842                         break;
1843                 default:
1844                         dev_info(di->dev, "Wrong input\n"
1845                                 "Enter 0. Disable AC/USB Charging\n"
1846                                 "1. Enable AC charging\n"
1847                                 "2. Enable USB Charging\n");
1848                 };
1849                 break;
1850         };
1851         return strlen(buf);
1852 }
1853
1854 static struct attribute abx500_chargalg_en_charger = \
1855 {
1856         .name = "chargalg",
1857         .mode = S_IRUGO | S_IWUSR,
1858 };
1859
1860 static struct attribute *abx500_chargalg_chg[] = {
1861         &abx500_chargalg_en_charger,
1862         NULL
1863 };
1864
1865 static const struct sysfs_ops abx500_chargalg_sysfs_ops = {
1866         .show = abx500_chargalg_sysfs_show,
1867         .store = abx500_chargalg_sysfs_charger,
1868 };
1869
1870 static struct kobj_type abx500_chargalg_ktype = {
1871         .sysfs_ops = &abx500_chargalg_sysfs_ops,
1872         .default_attrs = abx500_chargalg_chg,
1873 };
1874
1875 /**
1876  * abx500_chargalg_sysfs_exit() - de-init of sysfs entry
1877  * @di:                pointer to the struct abx500_chargalg
1878  *
1879  * This function removes the entry in sysfs.
1880  */
1881 static void abx500_chargalg_sysfs_exit(struct abx500_chargalg *di)
1882 {
1883         kobject_del(&di->chargalg_kobject);
1884 }
1885
1886 /**
1887  * abx500_chargalg_sysfs_init() - init of sysfs entry
1888  * @di:                pointer to the struct abx500_chargalg
1889  *
1890  * This function adds an entry in sysfs.
1891  * Returns error code in case of failure else 0(on success)
1892  */
1893 static int abx500_chargalg_sysfs_init(struct abx500_chargalg *di)
1894 {
1895         int ret = 0;
1896
1897         ret = kobject_init_and_add(&di->chargalg_kobject,
1898                 &abx500_chargalg_ktype,
1899                 NULL, "abx500_chargalg");
1900         if (ret < 0)
1901                 dev_err(di->dev, "failed to create sysfs entry\n");
1902
1903         return ret;
1904 }
1905 /* Exposure to the sysfs interface <<END>> */
1906
1907 #if defined(CONFIG_PM)
1908 static int abx500_chargalg_resume(struct platform_device *pdev)
1909 {
1910         struct abx500_chargalg *di = platform_get_drvdata(pdev);
1911
1912         /* Kick charger watchdog if charging (any charger online) */
1913         if (di->chg_info.online_chg)
1914                 queue_delayed_work(di->chargalg_wq, &di->chargalg_wd_work, 0);
1915
1916         /*
1917          * Run the charging algorithm directly to be sure we don't
1918          * do it too seldom
1919          */
1920         queue_delayed_work(di->chargalg_wq, &di->chargalg_periodic_work, 0);
1921
1922         return 0;
1923 }
1924
1925 static int abx500_chargalg_suspend(struct platform_device *pdev,
1926         pm_message_t state)
1927 {
1928         struct abx500_chargalg *di = platform_get_drvdata(pdev);
1929
1930         if (di->chg_info.online_chg)
1931                 cancel_delayed_work_sync(&di->chargalg_wd_work);
1932
1933         cancel_delayed_work_sync(&di->chargalg_periodic_work);
1934
1935         return 0;
1936 }
1937 #else
1938 #define abx500_chargalg_suspend      NULL
1939 #define abx500_chargalg_resume       NULL
1940 #endif
1941
1942 static int abx500_chargalg_remove(struct platform_device *pdev)
1943 {
1944         struct abx500_chargalg *di = platform_get_drvdata(pdev);
1945
1946         /* sysfs interface to enable/disbale charging from user space */
1947         abx500_chargalg_sysfs_exit(di);
1948
1949         hrtimer_cancel(&di->safety_timer);
1950         hrtimer_cancel(&di->maintenance_timer);
1951
1952         cancel_delayed_work_sync(&di->chargalg_periodic_work);
1953         cancel_delayed_work_sync(&di->chargalg_wd_work);
1954         cancel_work_sync(&di->chargalg_work);
1955
1956         /* Delete the work queue */
1957         destroy_workqueue(di->chargalg_wq);
1958
1959         power_supply_unregister(&di->chargalg_psy);
1960         platform_set_drvdata(pdev, NULL);
1961
1962         return 0;
1963 }
1964
1965 static char *supply_interface[] = {
1966         "ab8500_fg",
1967 };
1968
1969 static int abx500_chargalg_probe(struct platform_device *pdev)
1970 {
1971         struct device_node *np = pdev->dev.of_node;
1972         struct abx500_bm_data *plat = pdev->dev.platform_data;
1973         struct abx500_chargalg *di;
1974         int ret = 0;
1975
1976         di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);
1977         if (!di) {
1978                 dev_err(&pdev->dev, "%s no mem for ab8500_chargalg\n", __func__);
1979                 return -ENOMEM;
1980         }
1981
1982         if (!plat) {
1983                 dev_err(&pdev->dev, "no battery management data supplied\n");
1984                 return -EINVAL;
1985         }
1986         di->bm = plat;
1987
1988         if (np) {
1989                 ret = ab8500_bm_of_probe(&pdev->dev, np, di->bm);
1990                 if (ret) {
1991                         dev_err(&pdev->dev, "failed to get battery information\n");
1992                         return ret;
1993                 }
1994         }
1995
1996         /* get device struct and parent */
1997         di->dev = &pdev->dev;
1998         di->parent = dev_get_drvdata(pdev->dev.parent);
1999
2000         /* chargalg supply */
2001         di->chargalg_psy.name = "abx500_chargalg";
2002         di->chargalg_psy.type = POWER_SUPPLY_TYPE_BATTERY;
2003         di->chargalg_psy.properties = abx500_chargalg_props;
2004         di->chargalg_psy.num_properties = ARRAY_SIZE(abx500_chargalg_props);
2005         di->chargalg_psy.get_property = abx500_chargalg_get_property;
2006         di->chargalg_psy.supplied_to = supply_interface;
2007         di->chargalg_psy.num_supplicants = ARRAY_SIZE(supply_interface),
2008         di->chargalg_psy.external_power_changed =
2009                 abx500_chargalg_external_power_changed;
2010
2011         /* Initilialize safety timer */
2012         hrtimer_init(&di->safety_timer, CLOCK_REALTIME, HRTIMER_MODE_ABS);
2013         di->safety_timer.function = abx500_chargalg_safety_timer_expired;
2014
2015         /* Initilialize maintenance timer */
2016         hrtimer_init(&di->maintenance_timer, CLOCK_REALTIME, HRTIMER_MODE_ABS);
2017         di->maintenance_timer.function =
2018                 abx500_chargalg_maintenance_timer_expired;
2019
2020         /* Create a work queue for the chargalg */
2021         di->chargalg_wq =
2022                 create_singlethread_workqueue("abx500_chargalg_wq");
2023         if (di->chargalg_wq == NULL) {
2024                 dev_err(di->dev, "failed to create work queue\n");
2025                 return -ENOMEM;
2026         }
2027
2028         /* Init work for chargalg */
2029         INIT_DEFERRABLE_WORK(&di->chargalg_periodic_work,
2030                 abx500_chargalg_periodic_work);
2031         INIT_DEFERRABLE_WORK(&di->chargalg_wd_work,
2032                 abx500_chargalg_wd_work);
2033
2034         /* Init work for chargalg */
2035         INIT_WORK(&di->chargalg_work, abx500_chargalg_work);
2036
2037         /* To detect charger at startup */
2038         di->chg_info.prev_conn_chg = -1;
2039
2040         /* Register chargalg power supply class */
2041         ret = power_supply_register(di->dev, &di->chargalg_psy);
2042         if (ret) {
2043                 dev_err(di->dev, "failed to register chargalg psy\n");
2044                 goto free_chargalg_wq;
2045         }
2046
2047         platform_set_drvdata(pdev, di);
2048
2049         /* sysfs interface to enable/disable charging from user space */
2050         ret = abx500_chargalg_sysfs_init(di);
2051         if (ret) {
2052                 dev_err(di->dev, "failed to create sysfs entry\n");
2053                 goto free_psy;
2054         }
2055
2056         /* Run the charging algorithm */
2057         queue_delayed_work(di->chargalg_wq, &di->chargalg_periodic_work, 0);
2058
2059         dev_info(di->dev, "probe success\n");
2060         return ret;
2061
2062 free_psy:
2063         power_supply_unregister(&di->chargalg_psy);
2064 free_chargalg_wq:
2065         destroy_workqueue(di->chargalg_wq);
2066         return ret;
2067 }
2068
2069 static const struct of_device_id ab8500_chargalg_match[] = {
2070         { .compatible = "stericsson,ab8500-chargalg", },
2071         { },
2072 };
2073
2074 static struct platform_driver abx500_chargalg_driver = {
2075         .probe = abx500_chargalg_probe,
2076         .remove = abx500_chargalg_remove,
2077         .suspend = abx500_chargalg_suspend,
2078         .resume = abx500_chargalg_resume,
2079         .driver = {
2080                 .name = "ab8500-chargalg",
2081                 .owner = THIS_MODULE,
2082                 .of_match_table = ab8500_chargalg_match,
2083         },
2084 };
2085
2086 module_platform_driver(abx500_chargalg_driver);
2087
2088 MODULE_LICENSE("GPL v2");
2089 MODULE_AUTHOR("Johan Palsson, Karl Komierowski");
2090 MODULE_ALIAS("platform:abx500-chargalg");
2091 MODULE_DESCRIPTION("abx500 battery charging algorithm");