power_supply_leds.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * LEDs triggers for power supply class
  4. *
  5. * Copyright © 2007 Anton Vorontsov <cbou@mail.ru>
  6. * Copyright © 2004 Szabolcs Gyurko
  7. * Copyright © 2003 Ian Molton <spyro@f2s.com>
  8. *
  9. * Modified: 2004, Oct Szabolcs Gyurko
  10. */
  11. #include <linux/kernel.h>
  12. #include <linux/device.h>
  13. #include <linux/power_supply.h>
  14. #include <linux/slab.h>
  15. #include "power_supply.h"
  16. /* Battery specific LEDs triggers. */
  17. static void power_supply_update_bat_leds(struct power_supply *psy)
  18. {
  19. union power_supply_propval status;
  20. unsigned long delay_on = 0;
  21. unsigned long delay_off = 0;
  22. if (power_supply_get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
  23. return;
  24. dev_dbg(&psy->dev, "%s %d\n", __func__, status.intval);
  25. switch (status.intval) {
  26. case POWER_SUPPLY_STATUS_FULL:
  27. led_trigger_event(psy->charging_full_trig, LED_FULL);
  28. led_trigger_event(psy->charging_trig, LED_OFF);
  29. led_trigger_event(psy->full_trig, LED_FULL);
  30. led_trigger_event(psy->charging_blink_full_solid_trig,
  31. LED_FULL);
  32. break;
  33. case POWER_SUPPLY_STATUS_CHARGING:
  34. led_trigger_event(psy->charging_full_trig, LED_FULL);
  35. led_trigger_event(psy->charging_trig, LED_FULL);
  36. led_trigger_event(psy->full_trig, LED_OFF);
  37. led_trigger_blink(psy->charging_blink_full_solid_trig,
  38. &delay_on, &delay_off);
  39. break;
  40. default:
  41. led_trigger_event(psy->charging_full_trig, LED_OFF);
  42. led_trigger_event(psy->charging_trig, LED_OFF);
  43. led_trigger_event(psy->full_trig, LED_OFF);
  44. led_trigger_event(psy->charging_blink_full_solid_trig,
  45. LED_OFF);
  46. break;
  47. }
  48. }
  49. static int power_supply_create_bat_triggers(struct power_supply *psy)
  50. {
  51. psy->charging_full_trig_name = kasprintf(GFP_KERNEL,
  52. "%s-charging-or-full", psy->desc->name);
  53. if (!psy->charging_full_trig_name)
  54. goto charging_full_failed;
  55. psy->charging_trig_name = kasprintf(GFP_KERNEL,
  56. "%s-charging", psy->desc->name);
  57. if (!psy->charging_trig_name)
  58. goto charging_failed;
  59. psy->full_trig_name = kasprintf(GFP_KERNEL, "%s-full", psy->desc->name);
  60. if (!psy->full_trig_name)
  61. goto full_failed;
  62. psy->charging_blink_full_solid_trig_name = kasprintf(GFP_KERNEL,
  63. "%s-charging-blink-full-solid", psy->desc->name);
  64. if (!psy->charging_blink_full_solid_trig_name)
  65. goto charging_blink_full_solid_failed;
  66. led_trigger_register_simple(psy->charging_full_trig_name,
  67. &psy->charging_full_trig);
  68. led_trigger_register_simple(psy->charging_trig_name,
  69. &psy->charging_trig);
  70. led_trigger_register_simple(psy->full_trig_name,
  71. &psy->full_trig);
  72. led_trigger_register_simple(psy->charging_blink_full_solid_trig_name,
  73. &psy->charging_blink_full_solid_trig);
  74. return 0;
  75. charging_blink_full_solid_failed:
  76. kfree(psy->full_trig_name);
  77. full_failed:
  78. kfree(psy->charging_trig_name);
  79. charging_failed:
  80. kfree(psy->charging_full_trig_name);
  81. charging_full_failed:
  82. return -ENOMEM;
  83. }
  84. static void power_supply_remove_bat_triggers(struct power_supply *psy)
  85. {
  86. led_trigger_unregister_simple(psy->charging_full_trig);
  87. led_trigger_unregister_simple(psy->charging_trig);
  88. led_trigger_unregister_simple(psy->full_trig);
  89. led_trigger_unregister_simple(psy->charging_blink_full_solid_trig);
  90. kfree(psy->charging_blink_full_solid_trig_name);
  91. kfree(psy->full_trig_name);
  92. kfree(psy->charging_trig_name);
  93. kfree(psy->charging_full_trig_name);
  94. }
  95. /* Generated power specific LEDs triggers. */
  96. static void power_supply_update_gen_leds(struct power_supply *psy)
  97. {
  98. union power_supply_propval online;
  99. if (power_supply_get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
  100. return;
  101. dev_dbg(&psy->dev, "%s %d\n", __func__, online.intval);
  102. if (online.intval)
  103. led_trigger_event(psy->online_trig, LED_FULL);
  104. else
  105. led_trigger_event(psy->online_trig, LED_OFF);
  106. }
  107. static int power_supply_create_gen_triggers(struct power_supply *psy)
  108. {
  109. psy->online_trig_name = kasprintf(GFP_KERNEL, "%s-online",
  110. psy->desc->name);
  111. if (!psy->online_trig_name)
  112. return -ENOMEM;
  113. led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);
  114. return 0;
  115. }
  116. static void power_supply_remove_gen_triggers(struct power_supply *psy)
  117. {
  118. led_trigger_unregister_simple(psy->online_trig);
  119. kfree(psy->online_trig_name);
  120. }
  121. /* Choice what triggers to create&update. */
  122. void power_supply_update_leds(struct power_supply *psy)
  123. {
  124. if (psy->desc->type == POWER_SUPPLY_TYPE_BATTERY)
  125. power_supply_update_bat_leds(psy);
  126. else
  127. power_supply_update_gen_leds(psy);
  128. }
  129. int power_supply_create_triggers(struct power_supply *psy)
  130. {
  131. if (psy->desc->type == POWER_SUPPLY_TYPE_BATTERY)
  132. return power_supply_create_bat_triggers(psy);
  133. return power_supply_create_gen_triggers(psy);
  134. }
  135. void power_supply_remove_triggers(struct power_supply *psy)
  136. {
  137. if (psy->desc->type == POWER_SUPPLY_TYPE_BATTERY)
  138. power_supply_remove_bat_triggers(psy);
  139. else
  140. power_supply_remove_gen_triggers(psy);
  141. }