1
2
3
4
5
6
7
8
9
10
11
12
13#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
14
15#include <linux/io.h>
16#include <linux/module.h>
17#include <linux/irq.h>
18#include <linux/interrupt.h>
19#include <linux/rtc.h>
20#include <linux/slab.h>
21#include <linux/workqueue.h>
22#include <linux/platform_device.h>
23#include <linux/power/charger-manager.h>
24#include <linux/regulator/consumer.h>
25#include <linux/sysfs.h>
26#include <linux/of.h>
27#include <linux/thermal.h>
28
29static struct {
30 const char *name;
31 u64 extcon_type;
32} extcon_mapping[] = {
33
34 { "USB", EXTCON_USB },
35 { "USB-HOST", EXTCON_USB_HOST },
36 { "SDP", EXTCON_CHG_USB_SDP },
37 { "DCP", EXTCON_CHG_USB_DCP },
38 { "CDP", EXTCON_CHG_USB_CDP },
39 { "ACA", EXTCON_CHG_USB_ACA },
40 { "FAST-CHARGER", EXTCON_CHG_USB_FAST },
41 { "SLOW-CHARGER", EXTCON_CHG_USB_SLOW },
42 { "WPT", EXTCON_CHG_WPT },
43 { "PD", EXTCON_CHG_USB_PD },
44 { "DOCK", EXTCON_DOCK },
45 { "JIG", EXTCON_JIG },
46 { "MECHANICAL", EXTCON_MECHANICAL },
47
48 { "TA", EXTCON_CHG_USB_SDP },
49 { "CHARGE-DOWNSTREAM", EXTCON_CHG_USB_CDP },
50};
51
52
53
54
55
56#define CM_DEFAULT_RECHARGE_TEMP_DIFF 50
57#define CM_DEFAULT_CHARGE_TEMP_MAX 500
58
59
60
61
62
63
64#define CM_JIFFIES_SMALL (2)
65
66
67#define CM_MIN_VALID(x, y) x = (((y > 0) && ((x) > (y))) ? (y) : (x))
68
69
70
71
72
73#define CM_RTC_SMALL (2)
74
75static LIST_HEAD(cm_list);
76static DEFINE_MUTEX(cm_list_mtx);
77
78
79static struct alarm *cm_timer;
80
81static bool cm_suspended;
82static bool cm_timer_set;
83static unsigned long cm_suspend_duration_ms;
84
85
86static unsigned long polling_jiffy = ULONG_MAX;
87static unsigned long next_polling;
88static struct workqueue_struct *cm_wq;
89static struct delayed_work cm_monitor_work;
90
91
92
93
94
95static bool is_batt_present(struct charger_manager *cm)
96{
97 union power_supply_propval val;
98 struct power_supply *psy;
99 bool present = false;
100 int i, ret;
101
102 switch (cm->desc->battery_present) {
103 case CM_BATTERY_PRESENT:
104 present = true;
105 break;
106 case CM_NO_BATTERY:
107 break;
108 case CM_FUEL_GAUGE:
109 psy = power_supply_get_by_name(cm->desc->psy_fuel_gauge);
110 if (!psy)
111 break;
112
113 ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_PRESENT,
114 &val);
115 if (ret == 0 && val.intval)
116 present = true;
117 power_supply_put(psy);
118 break;
119 case CM_CHARGER_STAT:
120 for (i = 0; cm->desc->psy_charger_stat[i]; i++) {
121 psy = power_supply_get_by_name(
122 cm->desc->psy_charger_stat[i]);
123 if (!psy) {
124 dev_err(cm->dev, "Cannot find power supply \"%s\"\n",
125 cm->desc->psy_charger_stat[i]);
126 continue;
127 }
128
129 ret = power_supply_get_property(psy,
130 POWER_SUPPLY_PROP_PRESENT, &val);
131 power_supply_put(psy);
132 if (ret == 0 && val.intval) {
133 present = true;
134 break;
135 }
136 }
137 break;
138 }
139
140 return present;
141}
142
143
144
145
146
147
148
149
150
151static bool is_ext_pwr_online(struct charger_manager *cm)
152{
153 union power_supply_propval val;
154 struct power_supply *psy;
155 bool online = false;
156 int i, ret;
157
158
159 for (i = 0; cm->desc->psy_charger_stat[i]; i++) {
160 psy = power_supply_get_by_name(cm->desc->psy_charger_stat[i]);
161 if (!psy) {
162 dev_err(cm->dev, "Cannot find power supply \"%s\"\n",
163 cm->desc->psy_charger_stat[i]);
164 continue;
165 }
166
167 ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_ONLINE,
168 &val);
169 power_supply_put(psy);
170 if (ret == 0 && val.intval) {
171 online = true;
172 break;
173 }
174 }
175
176 return online;
177}
178
179
180
181
182
183
184
185
186
187static int get_batt_uV(struct charger_manager *cm, int *uV)
188{
189 union power_supply_propval val;
190 struct power_supply *fuel_gauge;
191 int ret;
192
193 fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge);
194 if (!fuel_gauge)
195 return -ENODEV;
196
197 ret = power_supply_get_property(fuel_gauge,
198 POWER_SUPPLY_PROP_VOLTAGE_NOW, &val);
199 power_supply_put(fuel_gauge);
200 if (ret)
201 return ret;
202
203 *uV = val.intval;
204 return 0;
205}
206
207
208
209
210
211static bool is_charging(struct charger_manager *cm)
212{
213 int i, ret;
214 bool charging = false;
215 struct power_supply *psy;
216 union power_supply_propval val;
217
218
219 if (!is_batt_present(cm))
220 return false;
221
222
223 for (i = 0; cm->desc->psy_charger_stat[i]; i++) {
224
225 if (cm->emergency_stop)
226 continue;
227 if (!cm->charger_enabled)
228 continue;
229
230 psy = power_supply_get_by_name(cm->desc->psy_charger_stat[i]);
231 if (!psy) {
232 dev_err(cm->dev, "Cannot find power supply \"%s\"\n",
233 cm->desc->psy_charger_stat[i]);
234 continue;
235 }
236
237
238 ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_ONLINE,
239 &val);
240 if (ret) {
241 dev_warn(cm->dev, "Cannot read ONLINE value from %s\n",
242 cm->desc->psy_charger_stat[i]);
243 power_supply_put(psy);
244 continue;
245 }
246 if (val.intval == 0) {
247 power_supply_put(psy);
248 continue;
249 }
250
251
252
253
254
255 ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_STATUS,
256 &val);
257 power_supply_put(psy);
258 if (ret) {
259 dev_warn(cm->dev, "Cannot read STATUS value from %s\n",
260 cm->desc->psy_charger_stat[i]);
261 continue;
262 }
263 if (val.intval == POWER_SUPPLY_STATUS_FULL ||
264 val.intval == POWER_SUPPLY_STATUS_DISCHARGING ||
265 val.intval == POWER_SUPPLY_STATUS_NOT_CHARGING)
266 continue;
267
268
269 charging = true;
270 break;
271 }
272
273 return charging;
274}
275
276
277
278
279
280static bool is_full_charged(struct charger_manager *cm)
281{
282 struct charger_desc *desc = cm->desc;
283 union power_supply_propval val;
284 struct power_supply *fuel_gauge;
285 bool is_full = false;
286 int ret = 0;
287 int uV;
288
289
290 if (!is_batt_present(cm))
291 return false;
292
293 fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge);
294 if (!fuel_gauge)
295 return false;
296
297
298 if (desc->fullbatt_uV > 0) {
299 ret = get_batt_uV(cm, &uV);
300 if (!ret) {
301
302 if (cm->battery_status == POWER_SUPPLY_STATUS_FULL
303 && desc->fullbatt_vchkdrop_uV)
304 uV += desc->fullbatt_vchkdrop_uV;
305 if (uV >= desc->fullbatt_uV)
306 return true;
307 }
308 }
309
310 if (desc->fullbatt_full_capacity > 0) {
311 val.intval = 0;
312
313
314 ret = power_supply_get_property(fuel_gauge,
315 POWER_SUPPLY_PROP_CHARGE_FULL, &val);
316 if (!ret && val.intval > desc->fullbatt_full_capacity) {
317 is_full = true;
318 goto out;
319 }
320 }
321
322
323 if (desc->fullbatt_soc > 0) {
324 val.intval = 0;
325
326 ret = power_supply_get_property(fuel_gauge,
327 POWER_SUPPLY_PROP_CAPACITY, &val);
328 if (!ret && val.intval >= desc->fullbatt_soc) {
329 is_full = true;
330 goto out;
331 }
332 }
333
334out:
335 power_supply_put(fuel_gauge);
336 return is_full;
337}
338
339
340
341
342
343static bool is_polling_required(struct charger_manager *cm)
344{
345 switch (cm->desc->polling_mode) {
346 case CM_POLL_DISABLE:
347 return false;
348 case CM_POLL_ALWAYS:
349 return true;
350 case CM_POLL_EXTERNAL_POWER_ONLY:
351 return is_ext_pwr_online(cm);
352 case CM_POLL_CHARGING_ONLY:
353 return is_charging(cm);
354 default:
355 dev_warn(cm->dev, "Incorrect polling_mode (%d)\n",
356 cm->desc->polling_mode);
357 }
358
359 return false;
360}
361
362
363
364
365
366
367
368
369
370
371
372static int try_charger_enable(struct charger_manager *cm, bool enable)
373{
374 int err = 0, i;
375 struct charger_desc *desc = cm->desc;
376
377
378 if (enable == cm->charger_enabled)
379 return 0;
380
381 if (enable) {
382 if (cm->emergency_stop)
383 return -EAGAIN;
384
385
386
387
388
389 cm->charging_start_time = ktime_to_ms(ktime_get());
390 cm->charging_end_time = 0;
391
392 for (i = 0 ; i < desc->num_charger_regulators ; i++) {
393 if (desc->charger_regulators[i].externally_control)
394 continue;
395
396 err = regulator_enable(desc->charger_regulators[i].consumer);
397 if (err < 0) {
398 dev_warn(cm->dev, "Cannot enable %s regulator\n",
399 desc->charger_regulators[i].regulator_name);
400 }
401 }
402 } else {
403
404
405
406
407 cm->charging_start_time = 0;
408 cm->charging_end_time = ktime_to_ms(ktime_get());
409
410 for (i = 0 ; i < desc->num_charger_regulators ; i++) {
411 if (desc->charger_regulators[i].externally_control)
412 continue;
413
414 err = regulator_disable(desc->charger_regulators[i].consumer);
415 if (err < 0) {
416 dev_warn(cm->dev, "Cannot disable %s regulator\n",
417 desc->charger_regulators[i].regulator_name);
418 }
419 }
420
421
422
423
424
425 for (i = 0; i < desc->num_charger_regulators; i++) {
426 if (regulator_is_enabled(
427 desc->charger_regulators[i].consumer)) {
428 regulator_force_disable(
429 desc->charger_regulators[i].consumer);
430 dev_warn(cm->dev, "Disable regulator(%s) forcibly\n",
431 desc->charger_regulators[i].regulator_name);
432 }
433 }
434 }
435
436 if (!err)
437 cm->charger_enabled = enable;
438
439 return err;
440}
441
442
443
444
445
446
447
448
449
450
451
452static int check_charging_duration(struct charger_manager *cm)
453{
454 struct charger_desc *desc = cm->desc;
455 u64 curr = ktime_to_ms(ktime_get());
456 u64 duration;
457 int ret = false;
458
459 if (!desc->charging_max_duration_ms &&
460 !desc->discharging_max_duration_ms)
461 return ret;
462
463 if (cm->charger_enabled) {
464 duration = curr - cm->charging_start_time;
465
466 if (duration > desc->charging_max_duration_ms) {
467 dev_info(cm->dev, "Charging duration exceed %ums\n",
468 desc->charging_max_duration_ms);
469 ret = true;
470 }
471 } else if (cm->battery_status == POWER_SUPPLY_STATUS_NOT_CHARGING) {
472 duration = curr - cm->charging_end_time;
473
474 if (duration > desc->discharging_max_duration_ms) {
475 dev_info(cm->dev, "Discharging duration exceed %ums\n",
476 desc->discharging_max_duration_ms);
477 ret = true;
478 }
479 }
480
481 return ret;
482}
483
484static int cm_get_battery_temperature_by_psy(struct charger_manager *cm,
485 int *temp)
486{
487 struct power_supply *fuel_gauge;
488 int ret;
489
490 fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge);
491 if (!fuel_gauge)
492 return -ENODEV;
493
494 ret = power_supply_get_property(fuel_gauge,
495 POWER_SUPPLY_PROP_TEMP,
496 (union power_supply_propval *)temp);
497 power_supply_put(fuel_gauge);
498
499 return ret;
500}
501
502static int cm_get_battery_temperature(struct charger_manager *cm,
503 int *temp)
504{
505 int ret;
506
507 if (!cm->desc->measure_battery_temp)
508 return -ENODEV;
509
510#ifdef CONFIG_THERMAL
511 if (cm->tzd_batt) {
512 ret = thermal_zone_get_temp(cm->tzd_batt, temp);
513 if (!ret)
514
515 *temp /= 100;
516 } else
517#endif
518 {
519
520 ret = cm_get_battery_temperature_by_psy(cm, temp);
521 }
522
523 return ret;
524}
525
526static int cm_check_thermal_status(struct charger_manager *cm)
527{
528 struct charger_desc *desc = cm->desc;
529 int temp, upper_limit, lower_limit;
530 int ret = 0;
531
532 ret = cm_get_battery_temperature(cm, &temp);
533 if (ret) {
534
535
536
537
538
539 dev_err(cm->dev, "Failed to get battery temperature\n");
540 return 0;
541 }
542
543 upper_limit = desc->temp_max;
544 lower_limit = desc->temp_min;
545
546 if (cm->emergency_stop) {
547 upper_limit -= desc->temp_diff;
548 lower_limit += desc->temp_diff;
549 }
550
551 if (temp > upper_limit)
552 ret = CM_BATT_OVERHEAT;
553 else if (temp < lower_limit)
554 ret = CM_BATT_COLD;
555 else
556 ret = CM_BATT_OK;
557
558 cm->emergency_stop = ret;
559
560 return ret;
561}
562
563
564
565
566
567static int cm_get_target_status(struct charger_manager *cm)
568{
569 if (!is_ext_pwr_online(cm))
570 return POWER_SUPPLY_STATUS_DISCHARGING;
571
572 if (cm_check_thermal_status(cm)) {
573
574 if (check_charging_duration(cm))
575 goto charging_ok;
576 return POWER_SUPPLY_STATUS_NOT_CHARGING;
577 }
578
579 switch (cm->battery_status) {
580 case POWER_SUPPLY_STATUS_CHARGING:
581
582 if (check_charging_duration(cm))
583 return POWER_SUPPLY_STATUS_FULL;
584 fallthrough;
585 case POWER_SUPPLY_STATUS_FULL:
586 if (is_full_charged(cm))
587 return POWER_SUPPLY_STATUS_FULL;
588 fallthrough;
589 default:
590 break;
591 }
592
593charging_ok:
594
595 return POWER_SUPPLY_STATUS_CHARGING;
596}
597
598
599
600
601
602
603
604
605static bool _cm_monitor(struct charger_manager *cm)
606{
607 int target;
608
609 target = cm_get_target_status(cm);
610
611 try_charger_enable(cm, (target == POWER_SUPPLY_STATUS_CHARGING));
612
613 if (cm->battery_status != target) {
614 cm->battery_status = target;
615 power_supply_changed(cm->charger_psy);
616 }
617
618 return (cm->battery_status == POWER_SUPPLY_STATUS_NOT_CHARGING);
619}
620
621
622
623
624
625
626
627static bool cm_monitor(void)
628{
629 bool stop = false;
630 struct charger_manager *cm;
631
632 mutex_lock(&cm_list_mtx);
633
634 list_for_each_entry(cm, &cm_list, entry) {
635 if (_cm_monitor(cm))
636 stop = true;
637 }
638
639 mutex_unlock(&cm_list_mtx);
640
641 return stop;
642}
643
644
645
646
647
648static void _setup_polling(struct work_struct *work)
649{
650 unsigned long min = ULONG_MAX;
651 struct charger_manager *cm;
652 bool keep_polling = false;
653 unsigned long _next_polling;
654
655 mutex_lock(&cm_list_mtx);
656
657 list_for_each_entry(cm, &cm_list, entry) {
658 if (is_polling_required(cm) && cm->desc->polling_interval_ms) {
659 keep_polling = true;
660
661 if (min > cm->desc->polling_interval_ms)
662 min = cm->desc->polling_interval_ms;
663 }
664 }
665
666 polling_jiffy = msecs_to_jiffies(min);
667 if (polling_jiffy <= CM_JIFFIES_SMALL)
668 polling_jiffy = CM_JIFFIES_SMALL + 1;
669
670 if (!keep_polling)
671 polling_jiffy = ULONG_MAX;
672 if (polling_jiffy == ULONG_MAX)
673 goto out;
674
675 WARN(cm_wq == NULL, "charger-manager: workqueue not initialized"
676 ". try it later. %s\n", __func__);
677
678
679
680
681
682
683
684 _next_polling = jiffies + polling_jiffy;
685
686 if (time_before(_next_polling, next_polling)) {
687 mod_delayed_work(cm_wq, &cm_monitor_work, polling_jiffy);
688 next_polling = _next_polling;
689 } else {
690 if (queue_delayed_work(cm_wq, &cm_monitor_work, polling_jiffy))
691 next_polling = _next_polling;
692 }
693out:
694 mutex_unlock(&cm_list_mtx);
695}
696static DECLARE_WORK(setup_polling, _setup_polling);
697
698
699
700
701
702
703
704
705static void cm_monitor_poller(struct work_struct *work)
706{
707 cm_monitor();
708 schedule_work(&setup_polling);
709}
710
711static int charger_get_property(struct power_supply *psy,
712 enum power_supply_property psp,
713 union power_supply_propval *val)
714{
715 struct charger_manager *cm = power_supply_get_drvdata(psy);
716 struct charger_desc *desc = cm->desc;
717 struct power_supply *fuel_gauge = NULL;
718 int ret = 0;
719 int uV;
720
721 switch (psp) {
722 case POWER_SUPPLY_PROP_STATUS:
723 val->intval = cm->battery_status;
724 break;
725 case POWER_SUPPLY_PROP_HEALTH:
726 if (cm->emergency_stop > 0)
727 val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
728 else if (cm->emergency_stop < 0)
729 val->intval = POWER_SUPPLY_HEALTH_COLD;
730 else
731 val->intval = POWER_SUPPLY_HEALTH_GOOD;
732 break;
733 case POWER_SUPPLY_PROP_PRESENT:
734 if (is_batt_present(cm))
735 val->intval = 1;
736 else
737 val->intval = 0;
738 break;
739 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
740 ret = get_batt_uV(cm, &val->intval);
741 break;
742 case POWER_SUPPLY_PROP_CURRENT_NOW:
743 fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge);
744 if (!fuel_gauge) {
745 ret = -ENODEV;
746 break;
747 }
748 ret = power_supply_get_property(fuel_gauge,
749 POWER_SUPPLY_PROP_CURRENT_NOW, val);
750 break;
751 case POWER_SUPPLY_PROP_TEMP:
752 return cm_get_battery_temperature(cm, &val->intval);
753 case POWER_SUPPLY_PROP_CAPACITY:
754 if (!is_batt_present(cm)) {
755
756 val->intval = 100;
757 break;
758 }
759
760 fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge);
761 if (!fuel_gauge) {
762 ret = -ENODEV;
763 break;
764 }
765
766 ret = power_supply_get_property(fuel_gauge,
767 POWER_SUPPLY_PROP_CAPACITY, val);
768 if (ret)
769 break;
770
771 if (val->intval > 100) {
772 val->intval = 100;
773 break;
774 }
775 if (val->intval < 0)
776 val->intval = 0;
777
778
779 if (is_charging(cm))
780 break;
781
782
783
784
785
786 ret = get_batt_uV(cm, &uV);
787 if (ret) {
788
789 ret = 0;
790 break;
791 }
792
793 if (desc->fullbatt_uV > 0 && uV >= desc->fullbatt_uV &&
794 !is_charging(cm)) {
795 val->intval = 100;
796 break;
797 }
798
799 break;
800 case POWER_SUPPLY_PROP_ONLINE:
801 if (is_ext_pwr_online(cm))
802 val->intval = 1;
803 else
804 val->intval = 0;
805 break;
806 case POWER_SUPPLY_PROP_CHARGE_FULL:
807 case POWER_SUPPLY_PROP_CHARGE_NOW:
808 fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge);
809 if (!fuel_gauge) {
810 ret = -ENODEV;
811 break;
812 }
813 ret = power_supply_get_property(fuel_gauge, psp, val);
814 break;
815 default:
816 return -EINVAL;
817 }
818 if (fuel_gauge)
819 power_supply_put(fuel_gauge);
820 return ret;
821}
822
823#define NUM_CHARGER_PSY_OPTIONAL (4)
824static enum power_supply_property default_charger_props[] = {
825
826 POWER_SUPPLY_PROP_STATUS,
827 POWER_SUPPLY_PROP_HEALTH,
828 POWER_SUPPLY_PROP_PRESENT,
829 POWER_SUPPLY_PROP_VOLTAGE_NOW,
830 POWER_SUPPLY_PROP_CAPACITY,
831 POWER_SUPPLY_PROP_ONLINE,
832
833
834
835
836
837
838
839};
840
841static const struct power_supply_desc psy_default = {
842 .name = "battery",
843 .type = POWER_SUPPLY_TYPE_BATTERY,
844 .properties = default_charger_props,
845 .num_properties = ARRAY_SIZE(default_charger_props),
846 .get_property = charger_get_property,
847 .no_thermal = true,
848};
849
850
851
852
853
854
855
856
857
858
859
860static bool cm_setup_timer(void)
861{
862 struct charger_manager *cm;
863 unsigned int wakeup_ms = UINT_MAX;
864 int timer_req = 0;
865
866 if (time_after(next_polling, jiffies))
867 CM_MIN_VALID(wakeup_ms,
868 jiffies_to_msecs(next_polling - jiffies));
869
870 mutex_lock(&cm_list_mtx);
871 list_for_each_entry(cm, &cm_list, entry) {
872
873 if (!is_polling_required(cm) && !cm->emergency_stop)
874 continue;
875 timer_req++;
876 if (cm->desc->polling_interval_ms == 0)
877 continue;
878 CM_MIN_VALID(wakeup_ms, cm->desc->polling_interval_ms);
879 }
880 mutex_unlock(&cm_list_mtx);
881
882 if (timer_req && cm_timer) {
883 ktime_t now, add;
884
885
886
887
888
889 if (wakeup_ms == UINT_MAX ||
890 wakeup_ms < CM_RTC_SMALL * MSEC_PER_SEC)
891 wakeup_ms = 2 * CM_RTC_SMALL * MSEC_PER_SEC;
892
893 pr_info("Charger Manager wakeup timer: %u ms\n", wakeup_ms);
894
895 now = ktime_get_boottime();
896 add = ktime_set(wakeup_ms / MSEC_PER_SEC,
897 (wakeup_ms % MSEC_PER_SEC) * NSEC_PER_MSEC);
898 alarm_start(cm_timer, ktime_add(now, add));
899
900 cm_suspend_duration_ms = wakeup_ms;
901
902 return true;
903 }
904 return false;
905}
906
907
908
909
910
911
912
913static void charger_extcon_work(struct work_struct *work)
914{
915 struct charger_cable *cable =
916 container_of(work, struct charger_cable, wq);
917 int ret;
918
919 if (cable->attached && cable->min_uA != 0 && cable->max_uA != 0) {
920 ret = regulator_set_current_limit(cable->charger->consumer,
921 cable->min_uA, cable->max_uA);
922 if (ret < 0) {
923 pr_err("Cannot set current limit of %s (%s)\n",
924 cable->charger->regulator_name, cable->name);
925 return;
926 }
927
928 pr_info("Set current limit of %s : %duA ~ %duA\n",
929 cable->charger->regulator_name,
930 cable->min_uA, cable->max_uA);
931 }
932
933 cancel_delayed_work(&cm_monitor_work);
934 queue_delayed_work(cm_wq, &cm_monitor_work, 0);
935}
936
937
938
939
940
941
942
943
944
945static int charger_extcon_notifier(struct notifier_block *self,
946 unsigned long event, void *ptr)
947{
948 struct charger_cable *cable =
949 container_of(self, struct charger_cable, nb);
950
951
952
953
954
955 cable->attached = event;
956
957
958
959
960
961 schedule_work(&cable->wq);
962
963 return NOTIFY_DONE;
964}
965
966
967
968
969
970
971
972
973static int charger_extcon_init(struct charger_manager *cm,
974 struct charger_cable *cable)
975{
976 int ret, i;
977 u64 extcon_type = EXTCON_NONE;
978
979
980
981
982
983
984 INIT_WORK(&cable->wq, charger_extcon_work);
985 cable->nb.notifier_call = charger_extcon_notifier;
986
987 cable->extcon_dev = extcon_get_extcon_dev(cable->extcon_name);
988 if (IS_ERR_OR_NULL(cable->extcon_dev)) {
989 pr_err("Cannot find extcon_dev for %s (cable: %s)\n",
990 cable->extcon_name, cable->name);
991 if (cable->extcon_dev == NULL)
992 return -EPROBE_DEFER;
993 else
994 return PTR_ERR(cable->extcon_dev);
995 }
996
997 for (i = 0; i < ARRAY_SIZE(extcon_mapping); i++) {
998 if (!strcmp(cable->name, extcon_mapping[i].name)) {
999 extcon_type = extcon_mapping[i].extcon_type;
1000 break;
1001 }
1002 }
1003 if (extcon_type == EXTCON_NONE) {
1004 pr_err("Cannot find cable for type %s", cable->name);
1005 return -EINVAL;
1006 }
1007
1008 cable->extcon_type = extcon_type;
1009
1010 ret = devm_extcon_register_notifier(cm->dev, cable->extcon_dev,
1011 cable->extcon_type, &cable->nb);
1012 if (ret < 0) {
1013 pr_err("Cannot register extcon_dev for %s (cable: %s)\n",
1014 cable->extcon_name, cable->name);
1015 return ret;
1016 }
1017
1018 return 0;
1019}
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031static int charger_manager_register_extcon(struct charger_manager *cm)
1032{
1033 struct charger_desc *desc = cm->desc;
1034 struct charger_regulator *charger;
1035 unsigned long event;
1036 int ret;
1037 int i;
1038 int j;
1039
1040 for (i = 0; i < desc->num_charger_regulators; i++) {
1041 charger = &desc->charger_regulators[i];
1042
1043 charger->consumer = regulator_get(cm->dev,
1044 charger->regulator_name);
1045 if (IS_ERR(charger->consumer)) {
1046 dev_err(cm->dev, "Cannot find charger(%s)\n",
1047 charger->regulator_name);
1048 return PTR_ERR(charger->consumer);
1049 }
1050 charger->cm = cm;
1051
1052 for (j = 0; j < charger->num_cables; j++) {
1053 struct charger_cable *cable = &charger->cables[j];
1054
1055 ret = charger_extcon_init(cm, cable);
1056 if (ret < 0) {
1057 dev_err(cm->dev, "Cannot initialize charger(%s)\n",
1058 charger->regulator_name);
1059 return ret;
1060 }
1061 cable->charger = charger;
1062 cable->cm = cm;
1063
1064 event = extcon_get_state(cable->extcon_dev,
1065 cable->extcon_type);
1066 charger_extcon_notifier(&cable->nb,
1067 event, NULL);
1068 }
1069 }
1070
1071 return 0;
1072}
1073
1074
1075static ssize_t charger_name_show(struct device *dev,
1076 struct device_attribute *attr, char *buf)
1077{
1078 struct charger_regulator *charger
1079 = container_of(attr, struct charger_regulator, attr_name);
1080
1081 return sprintf(buf, "%s\n", charger->regulator_name);
1082}
1083
1084static ssize_t charger_state_show(struct device *dev,
1085 struct device_attribute *attr, char *buf)
1086{
1087 struct charger_regulator *charger
1088 = container_of(attr, struct charger_regulator, attr_state);
1089 int state = 0;
1090
1091 if (!charger->externally_control)
1092 state = regulator_is_enabled(charger->consumer);
1093
1094 return sprintf(buf, "%s\n", state ? "enabled" : "disabled");
1095}
1096
1097static ssize_t charger_externally_control_show(struct device *dev,
1098 struct device_attribute *attr, char *buf)
1099{
1100 struct charger_regulator *charger = container_of(attr,
1101 struct charger_regulator, attr_externally_control);
1102
1103 return sprintf(buf, "%d\n", charger->externally_control);
1104}
1105
1106static ssize_t charger_externally_control_store(struct device *dev,
1107 struct device_attribute *attr, const char *buf,
1108 size_t count)
1109{
1110 struct charger_regulator *charger
1111 = container_of(attr, struct charger_regulator,
1112 attr_externally_control);
1113 struct charger_manager *cm = charger->cm;
1114 struct charger_desc *desc = cm->desc;
1115 int i;
1116 int ret;
1117 int externally_control;
1118 int chargers_externally_control = 1;
1119
1120 ret = sscanf(buf, "%d", &externally_control);
1121 if (ret == 0) {
1122 ret = -EINVAL;
1123 return ret;
1124 }
1125
1126 if (!externally_control) {
1127 charger->externally_control = 0;
1128 return count;
1129 }
1130
1131 for (i = 0; i < desc->num_charger_regulators; i++) {
1132 if (&desc->charger_regulators[i] != charger &&
1133 !desc->charger_regulators[i].externally_control) {
1134
1135
1136
1137
1138 chargers_externally_control = 0;
1139 break;
1140 }
1141 }
1142
1143 if (!chargers_externally_control) {
1144 if (cm->charger_enabled) {
1145 try_charger_enable(charger->cm, false);
1146 charger->externally_control = externally_control;
1147 try_charger_enable(charger->cm, true);
1148 } else {
1149 charger->externally_control = externally_control;
1150 }
1151 } else {
1152 dev_warn(cm->dev,
1153 "'%s' regulator should be controlled in charger-manager because charger-manager must need at least one charger for charging\n",
1154 charger->regulator_name);
1155 }
1156
1157 return count;
1158}
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173static int charger_manager_prepare_sysfs(struct charger_manager *cm)
1174{
1175 struct charger_desc *desc = cm->desc;
1176 struct charger_regulator *charger;
1177 int chargers_externally_control = 1;
1178 char *name;
1179 int i;
1180
1181
1182 for (i = 0; i < desc->num_charger_regulators; i++) {
1183 charger = &desc->charger_regulators[i];
1184
1185 name = devm_kasprintf(cm->dev, GFP_KERNEL, "charger.%d", i);
1186 if (!name)
1187 return -ENOMEM;
1188
1189 charger->attrs[0] = &charger->attr_name.attr;
1190 charger->attrs[1] = &charger->attr_state.attr;
1191 charger->attrs[2] = &charger->attr_externally_control.attr;
1192 charger->attrs[3] = NULL;
1193
1194 charger->attr_grp.name = name;
1195 charger->attr_grp.attrs = charger->attrs;
1196 desc->sysfs_groups[i] = &charger->attr_grp;
1197
1198 sysfs_attr_init(&charger->attr_name.attr);
1199 charger->attr_name.attr.name = "name";
1200 charger->attr_name.attr.mode = 0444;
1201 charger->attr_name.show = charger_name_show;
1202
1203 sysfs_attr_init(&charger->attr_state.attr);
1204 charger->attr_state.attr.name = "state";
1205 charger->attr_state.attr.mode = 0444;
1206 charger->attr_state.show = charger_state_show;
1207
1208 sysfs_attr_init(&charger->attr_externally_control.attr);
1209 charger->attr_externally_control.attr.name
1210 = "externally_control";
1211 charger->attr_externally_control.attr.mode = 0644;
1212 charger->attr_externally_control.show
1213 = charger_externally_control_show;
1214 charger->attr_externally_control.store
1215 = charger_externally_control_store;
1216
1217 if (!desc->charger_regulators[i].externally_control ||
1218 !chargers_externally_control)
1219 chargers_externally_control = 0;
1220
1221 dev_info(cm->dev, "'%s' regulator's externally_control is %d\n",
1222 charger->regulator_name, charger->externally_control);
1223 }
1224
1225 if (chargers_externally_control) {
1226 dev_err(cm->dev, "Cannot register regulator because charger-manager must need at least one charger for charging battery\n");
1227 return -EINVAL;
1228 }
1229
1230 return 0;
1231}
1232
1233static int cm_init_thermal_data(struct charger_manager *cm,
1234 struct power_supply *fuel_gauge,
1235 enum power_supply_property *properties,
1236 size_t *num_properties)
1237{
1238 struct charger_desc *desc = cm->desc;
1239 union power_supply_propval val;
1240 int ret;
1241
1242
1243 ret = power_supply_get_property(fuel_gauge,
1244 POWER_SUPPLY_PROP_TEMP, &val);
1245
1246 if (!ret) {
1247 properties[*num_properties] = POWER_SUPPLY_PROP_TEMP;
1248 (*num_properties)++;
1249 cm->desc->measure_battery_temp = true;
1250 }
1251#ifdef CONFIG_THERMAL
1252 if (ret && desc->thermal_zone) {
1253 cm->tzd_batt =
1254 thermal_zone_get_zone_by_name(desc->thermal_zone);
1255 if (IS_ERR(cm->tzd_batt))
1256 return PTR_ERR(cm->tzd_batt);
1257
1258
1259 properties[*num_properties] = POWER_SUPPLY_PROP_TEMP;
1260 (*num_properties)++;
1261 cm->desc->measure_battery_temp = true;
1262 ret = 0;
1263 }
1264#endif
1265 if (cm->desc->measure_battery_temp) {
1266
1267 if (!desc->temp_max)
1268 desc->temp_max = CM_DEFAULT_CHARGE_TEMP_MAX;
1269 if (!desc->temp_diff)
1270 desc->temp_diff = CM_DEFAULT_RECHARGE_TEMP_DIFF;
1271 }
1272
1273 return ret;
1274}
1275
1276static const struct of_device_id charger_manager_match[] = {
1277 {
1278 .compatible = "charger-manager",
1279 },
1280 {},
1281};
1282
1283static struct charger_desc *of_cm_parse_desc(struct device *dev)
1284{
1285 struct charger_desc *desc;
1286 struct device_node *np = dev->of_node;
1287 u32 poll_mode = CM_POLL_DISABLE;
1288 u32 battery_stat = CM_NO_BATTERY;
1289 int num_chgs = 0;
1290
1291 desc = devm_kzalloc(dev, sizeof(*desc), GFP_KERNEL);
1292 if (!desc)
1293 return ERR_PTR(-ENOMEM);
1294
1295 of_property_read_string(np, "cm-name", &desc->psy_name);
1296
1297 of_property_read_u32(np, "cm-poll-mode", &poll_mode);
1298 desc->polling_mode = poll_mode;
1299
1300 of_property_read_u32(np, "cm-poll-interval",
1301 &desc->polling_interval_ms);
1302
1303 of_property_read_u32(np, "cm-fullbatt-vchkdrop-volt",
1304 &desc->fullbatt_vchkdrop_uV);
1305 of_property_read_u32(np, "cm-fullbatt-voltage", &desc->fullbatt_uV);
1306 of_property_read_u32(np, "cm-fullbatt-soc", &desc->fullbatt_soc);
1307 of_property_read_u32(np, "cm-fullbatt-capacity",
1308 &desc->fullbatt_full_capacity);
1309
1310 of_property_read_u32(np, "cm-battery-stat", &battery_stat);
1311 desc->battery_present = battery_stat;
1312
1313
1314 num_chgs = of_property_count_strings(np, "cm-chargers");
1315 if (num_chgs > 0) {
1316 int i;
1317
1318
1319 desc->psy_charger_stat = devm_kcalloc(dev,
1320 num_chgs + 1,
1321 sizeof(char *),
1322 GFP_KERNEL);
1323 if (!desc->psy_charger_stat)
1324 return ERR_PTR(-ENOMEM);
1325
1326 for (i = 0; i < num_chgs; i++)
1327 of_property_read_string_index(np, "cm-chargers",
1328 i, &desc->psy_charger_stat[i]);
1329 }
1330
1331 of_property_read_string(np, "cm-fuel-gauge", &desc->psy_fuel_gauge);
1332
1333 of_property_read_string(np, "cm-thermal-zone", &desc->thermal_zone);
1334
1335 of_property_read_u32(np, "cm-battery-cold", &desc->temp_min);
1336 if (of_get_property(np, "cm-battery-cold-in-minus", NULL))
1337 desc->temp_min *= -1;
1338 of_property_read_u32(np, "cm-battery-hot", &desc->temp_max);
1339 of_property_read_u32(np, "cm-battery-temp-diff", &desc->temp_diff);
1340
1341 of_property_read_u32(np, "cm-charging-max",
1342 &desc->charging_max_duration_ms);
1343 of_property_read_u32(np, "cm-discharging-max",
1344 &desc->discharging_max_duration_ms);
1345
1346
1347 desc->num_charger_regulators = of_get_child_count(np);
1348 if (desc->num_charger_regulators) {
1349 struct charger_regulator *chg_regs;
1350 struct device_node *child;
1351
1352 chg_regs = devm_kcalloc(dev,
1353 desc->num_charger_regulators,
1354 sizeof(*chg_regs),
1355 GFP_KERNEL);
1356 if (!chg_regs)
1357 return ERR_PTR(-ENOMEM);
1358
1359 desc->charger_regulators = chg_regs;
1360
1361 desc->sysfs_groups = devm_kcalloc(dev,
1362 desc->num_charger_regulators + 1,
1363 sizeof(*desc->sysfs_groups),
1364 GFP_KERNEL);
1365 if (!desc->sysfs_groups)
1366 return ERR_PTR(-ENOMEM);
1367
1368 for_each_child_of_node(np, child) {
1369 struct charger_cable *cables;
1370 struct device_node *_child;
1371
1372 of_property_read_string(child, "cm-regulator-name",
1373 &chg_regs->regulator_name);
1374
1375
1376 chg_regs->num_cables = of_get_child_count(child);
1377 if (chg_regs->num_cables) {
1378 cables = devm_kcalloc(dev,
1379 chg_regs->num_cables,
1380 sizeof(*cables),
1381 GFP_KERNEL);
1382 if (!cables) {
1383 of_node_put(child);
1384 return ERR_PTR(-ENOMEM);
1385 }
1386
1387 chg_regs->cables = cables;
1388
1389 for_each_child_of_node(child, _child) {
1390 of_property_read_string(_child,
1391 "cm-cable-name", &cables->name);
1392 of_property_read_string(_child,
1393 "cm-cable-extcon",
1394 &cables->extcon_name);
1395 of_property_read_u32(_child,
1396 "cm-cable-min",
1397 &cables->min_uA);
1398 of_property_read_u32(_child,
1399 "cm-cable-max",
1400 &cables->max_uA);
1401 cables++;
1402 }
1403 }
1404 chg_regs++;
1405 }
1406 }
1407 return desc;
1408}
1409
1410static inline struct charger_desc *cm_get_drv_data(struct platform_device *pdev)
1411{
1412 if (pdev->dev.of_node)
1413 return of_cm_parse_desc(&pdev->dev);
1414 return dev_get_platdata(&pdev->dev);
1415}
1416
1417static enum alarmtimer_restart cm_timer_func(struct alarm *alarm, ktime_t now)
1418{
1419 cm_timer_set = false;
1420 return ALARMTIMER_NORESTART;
1421}
1422
1423static int charger_manager_probe(struct platform_device *pdev)
1424{
1425 struct charger_desc *desc = cm_get_drv_data(pdev);
1426 struct charger_manager *cm;
1427 int ret, i = 0;
1428 union power_supply_propval val;
1429 struct power_supply *fuel_gauge;
1430 enum power_supply_property *properties;
1431 size_t num_properties;
1432 struct power_supply_config psy_cfg = {};
1433
1434 if (IS_ERR(desc)) {
1435 dev_err(&pdev->dev, "No platform data (desc) found\n");
1436 return PTR_ERR(desc);
1437 }
1438
1439 cm = devm_kzalloc(&pdev->dev, sizeof(*cm), GFP_KERNEL);
1440 if (!cm)
1441 return -ENOMEM;
1442
1443
1444 cm->dev = &pdev->dev;
1445 cm->desc = desc;
1446 psy_cfg.drv_data = cm;
1447
1448
1449 if (alarmtimer_get_rtcdev()) {
1450 cm_timer = devm_kzalloc(cm->dev, sizeof(*cm_timer), GFP_KERNEL);
1451 if (!cm_timer)
1452 return -ENOMEM;
1453 alarm_init(cm_timer, ALARM_BOOTTIME, cm_timer_func);
1454 }
1455
1456
1457
1458
1459
1460 if (desc->fullbatt_uV == 0) {
1461 dev_info(&pdev->dev, "Ignoring full-battery voltage threshold as it is not supplied\n");
1462 }
1463 if (!desc->fullbatt_vchkdrop_uV) {
1464 dev_info(&pdev->dev, "Disabling full-battery voltage drop checking mechanism as it is not supplied\n");
1465 desc->fullbatt_vchkdrop_uV = 0;
1466 }
1467 if (desc->fullbatt_soc == 0) {
1468 dev_info(&pdev->dev, "Ignoring full-battery soc(state of charge) threshold as it is not supplied\n");
1469 }
1470 if (desc->fullbatt_full_capacity == 0) {
1471 dev_info(&pdev->dev, "Ignoring full-battery full capacity threshold as it is not supplied\n");
1472 }
1473
1474 if (!desc->charger_regulators || desc->num_charger_regulators < 1) {
1475 dev_err(&pdev->dev, "charger_regulators undefined\n");
1476 return -EINVAL;
1477 }
1478
1479 if (!desc->psy_charger_stat || !desc->psy_charger_stat[0]) {
1480 dev_err(&pdev->dev, "No power supply defined\n");
1481 return -EINVAL;
1482 }
1483
1484 if (!desc->psy_fuel_gauge) {
1485 dev_err(&pdev->dev, "No fuel gauge power supply defined\n");
1486 return -EINVAL;
1487 }
1488
1489
1490 for (i = 0; desc->psy_charger_stat[i]; i++) {
1491 struct power_supply *psy;
1492
1493 psy = power_supply_get_by_name(desc->psy_charger_stat[i]);
1494 if (!psy) {
1495 dev_err(&pdev->dev, "Cannot find power supply \"%s\"\n",
1496 desc->psy_charger_stat[i]);
1497 return -ENODEV;
1498 }
1499 power_supply_put(psy);
1500 }
1501
1502 if (cm->desc->polling_mode != CM_POLL_DISABLE &&
1503 (desc->polling_interval_ms == 0 ||
1504 msecs_to_jiffies(desc->polling_interval_ms) <= CM_JIFFIES_SMALL)) {
1505 dev_err(&pdev->dev, "polling_interval_ms is too small\n");
1506 return -EINVAL;
1507 }
1508
1509 if (!desc->charging_max_duration_ms ||
1510 !desc->discharging_max_duration_ms) {
1511 dev_info(&pdev->dev, "Cannot limit charging duration checking mechanism to prevent overcharge/overheat and control discharging duration\n");
1512 desc->charging_max_duration_ms = 0;
1513 desc->discharging_max_duration_ms = 0;
1514 }
1515
1516 platform_set_drvdata(pdev, cm);
1517
1518 memcpy(&cm->charger_psy_desc, &psy_default, sizeof(psy_default));
1519
1520 if (!desc->psy_name)
1521 strncpy(cm->psy_name_buf, psy_default.name, PSY_NAME_MAX);
1522 else
1523 strncpy(cm->psy_name_buf, desc->psy_name, PSY_NAME_MAX);
1524 cm->charger_psy_desc.name = cm->psy_name_buf;
1525
1526
1527 properties = devm_kcalloc(&pdev->dev,
1528 ARRAY_SIZE(default_charger_props) +
1529 NUM_CHARGER_PSY_OPTIONAL,
1530 sizeof(*properties), GFP_KERNEL);
1531 if (!properties)
1532 return -ENOMEM;
1533
1534 memcpy(properties, default_charger_props,
1535 sizeof(enum power_supply_property) *
1536 ARRAY_SIZE(default_charger_props));
1537 num_properties = ARRAY_SIZE(default_charger_props);
1538
1539
1540 fuel_gauge = power_supply_get_by_name(desc->psy_fuel_gauge);
1541 if (!fuel_gauge) {
1542 dev_err(&pdev->dev, "Cannot find power supply \"%s\"\n",
1543 desc->psy_fuel_gauge);
1544 return -ENODEV;
1545 }
1546 if (!power_supply_get_property(fuel_gauge,
1547 POWER_SUPPLY_PROP_CHARGE_FULL, &val)) {
1548 properties[num_properties] =
1549 POWER_SUPPLY_PROP_CHARGE_FULL;
1550 num_properties++;
1551 }
1552 if (!power_supply_get_property(fuel_gauge,
1553 POWER_SUPPLY_PROP_CHARGE_NOW, &val)) {
1554 properties[num_properties] =
1555 POWER_SUPPLY_PROP_CHARGE_NOW;
1556 num_properties++;
1557 }
1558 if (!power_supply_get_property(fuel_gauge,
1559 POWER_SUPPLY_PROP_CURRENT_NOW,
1560 &val)) {
1561 properties[num_properties] =
1562 POWER_SUPPLY_PROP_CURRENT_NOW;
1563 num_properties++;
1564 }
1565
1566 ret = cm_init_thermal_data(cm, fuel_gauge, properties, &num_properties);
1567 if (ret) {
1568 dev_err(&pdev->dev, "Failed to initialize thermal data\n");
1569 cm->desc->measure_battery_temp = false;
1570 }
1571 power_supply_put(fuel_gauge);
1572
1573 cm->charger_psy_desc.properties = properties;
1574 cm->charger_psy_desc.num_properties = num_properties;
1575
1576
1577 ret = charger_manager_prepare_sysfs(cm);
1578 if (ret < 0) {
1579 dev_err(&pdev->dev,
1580 "Cannot prepare sysfs entry of regulators\n");
1581 return ret;
1582 }
1583 psy_cfg.attr_grp = desc->sysfs_groups;
1584
1585 cm->charger_psy = power_supply_register(&pdev->dev,
1586 &cm->charger_psy_desc,
1587 &psy_cfg);
1588 if (IS_ERR(cm->charger_psy)) {
1589 dev_err(&pdev->dev, "Cannot register charger-manager with name \"%s\"\n",
1590 cm->charger_psy_desc.name);
1591 return PTR_ERR(cm->charger_psy);
1592 }
1593
1594
1595 ret = charger_manager_register_extcon(cm);
1596 if (ret < 0) {
1597 dev_err(&pdev->dev, "Cannot initialize extcon device\n");
1598 goto err_reg_extcon;
1599 }
1600
1601
1602 mutex_lock(&cm_list_mtx);
1603 list_add(&cm->entry, &cm_list);
1604 mutex_unlock(&cm_list_mtx);
1605
1606
1607
1608
1609
1610 device_init_wakeup(&pdev->dev, true);
1611 device_set_wakeup_capable(&pdev->dev, false);
1612
1613
1614
1615
1616
1617
1618 cm_monitor();
1619
1620 schedule_work(&setup_polling);
1621
1622 return 0;
1623
1624err_reg_extcon:
1625 for (i = 0; i < desc->num_charger_regulators; i++)
1626 regulator_put(desc->charger_regulators[i].consumer);
1627
1628 power_supply_unregister(cm->charger_psy);
1629
1630 return ret;
1631}
1632
1633static int charger_manager_remove(struct platform_device *pdev)
1634{
1635 struct charger_manager *cm = platform_get_drvdata(pdev);
1636 struct charger_desc *desc = cm->desc;
1637 int i = 0;
1638
1639
1640 mutex_lock(&cm_list_mtx);
1641 list_del(&cm->entry);
1642 mutex_unlock(&cm_list_mtx);
1643
1644 cancel_work_sync(&setup_polling);
1645 cancel_delayed_work_sync(&cm_monitor_work);
1646
1647 for (i = 0 ; i < desc->num_charger_regulators ; i++)
1648 regulator_put(desc->charger_regulators[i].consumer);
1649
1650 power_supply_unregister(cm->charger_psy);
1651
1652 try_charger_enable(cm, false);
1653
1654 return 0;
1655}
1656
1657static const struct platform_device_id charger_manager_id[] = {
1658 { "charger-manager", 0 },
1659 { },
1660};
1661MODULE_DEVICE_TABLE(platform, charger_manager_id);
1662
1663static int cm_suspend_noirq(struct device *dev)
1664{
1665 if (device_may_wakeup(dev)) {
1666 device_set_wakeup_capable(dev, false);
1667 return -EAGAIN;
1668 }
1669
1670 return 0;
1671}
1672
1673static bool cm_need_to_awake(void)
1674{
1675 struct charger_manager *cm;
1676
1677 if (cm_timer)
1678 return false;
1679
1680 mutex_lock(&cm_list_mtx);
1681 list_for_each_entry(cm, &cm_list, entry) {
1682 if (is_charging(cm)) {
1683 mutex_unlock(&cm_list_mtx);
1684 return true;
1685 }
1686 }
1687 mutex_unlock(&cm_list_mtx);
1688
1689 return false;
1690}
1691
1692static int cm_suspend_prepare(struct device *dev)
1693{
1694 if (cm_need_to_awake())
1695 return -EBUSY;
1696
1697 if (!cm_suspended)
1698 cm_suspended = true;
1699
1700 cm_timer_set = cm_setup_timer();
1701
1702 if (cm_timer_set) {
1703 cancel_work_sync(&setup_polling);
1704 cancel_delayed_work_sync(&cm_monitor_work);
1705 }
1706
1707 return 0;
1708}
1709
1710static void cm_suspend_complete(struct device *dev)
1711{
1712 struct charger_manager *cm = dev_get_drvdata(dev);
1713
1714 if (cm_suspended)
1715 cm_suspended = false;
1716
1717 if (cm_timer_set) {
1718 ktime_t remain;
1719
1720 alarm_cancel(cm_timer);
1721 cm_timer_set = false;
1722 remain = alarm_expires_remaining(cm_timer);
1723 cm_suspend_duration_ms -= ktime_to_ms(remain);
1724 schedule_work(&setup_polling);
1725 }
1726
1727 _cm_monitor(cm);
1728
1729 device_set_wakeup_capable(cm->dev, false);
1730}
1731
1732static const struct dev_pm_ops charger_manager_pm = {
1733 .prepare = cm_suspend_prepare,
1734 .suspend_noirq = cm_suspend_noirq,
1735 .complete = cm_suspend_complete,
1736};
1737
1738static struct platform_driver charger_manager_driver = {
1739 .driver = {
1740 .name = "charger-manager",
1741 .pm = &charger_manager_pm,
1742 .of_match_table = charger_manager_match,
1743 },
1744 .probe = charger_manager_probe,
1745 .remove = charger_manager_remove,
1746 .id_table = charger_manager_id,
1747};
1748
1749static int __init charger_manager_init(void)
1750{
1751 cm_wq = create_freezable_workqueue("charger_manager");
1752 if (unlikely(!cm_wq))
1753 return -ENOMEM;
1754
1755 INIT_DELAYED_WORK(&cm_monitor_work, cm_monitor_poller);
1756
1757 return platform_driver_register(&charger_manager_driver);
1758}
1759late_initcall(charger_manager_init);
1760
1761static void __exit charger_manager_cleanup(void)
1762{
1763 destroy_workqueue(cm_wq);
1764 cm_wq = NULL;
1765
1766 platform_driver_unregister(&charger_manager_driver);
1767}
1768module_exit(charger_manager_cleanup);
1769
1770MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
1771MODULE_DESCRIPTION("Charger Manager");
1772MODULE_LICENSE("GPL");
1773