tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1/*
2 * LEDs triggers for power supply class
3 *
4 * Copyright © 2007 Anton Vorontsov <cbou@mail.ru>
5 * Copyright © 2004 Szabolcs Gyurko
6 * Copyright © 2003 Ian Molton <spyro@f2s.com>
7 *
8 * Modified: 2004, Oct Szabolcs Gyurko
9 *
10 * You may use this code as per GPL version 2
11 */
12
13#include <linux/kernel.h>
14#include <linux/power_supply.h>
15
16#include "power_supply.h"
17
18/* Battery specific LEDs triggers. */
19
20static void power_supply_update_bat_leds(struct power_supply *psy)
21{
22 union power_supply_propval status;
23
24 if (psy->get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
25 return;
26
27 dev_dbg(psy->dev, "%s %d\n", __func__, status.intval);
28
29 switch (status.intval) {
30 case POWER_SUPPLY_STATUS_FULL:
31 led_trigger_event(psy->charging_full_trig, LED_FULL);
32 led_trigger_event(psy->charging_trig, LED_OFF);
33 led_trigger_event(psy->full_trig, LED_FULL);
34 break;
35 case POWER_SUPPLY_STATUS_CHARGING:
36 led_trigger_event(psy->charging_full_trig, LED_FULL);
37 led_trigger_event(psy->charging_trig, LED_FULL);
38 led_trigger_event(psy->full_trig, LED_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 break;
45 }
46}
47
48static int power_supply_create_bat_triggers(struct power_supply *psy)
49{
50 int rc = 0;
51
52 psy->charging_full_trig_name = kasprintf(GFP_KERNEL,
53 "%s-charging-or-full", psy->name);
54 if (!psy->charging_full_trig_name)
55 goto charging_full_failed;
56
57 psy->charging_trig_name = kasprintf(GFP_KERNEL,
58 "%s-charging", psy->name);
59 if (!psy->charging_trig_name)
60 goto charging_failed;
61
62 psy->full_trig_name = kasprintf(GFP_KERNEL, "%s-full", psy->name);
63 if (!psy->full_trig_name)
64 goto full_failed;
65
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
73 goto success;
74
75full_failed:
76 kfree(psy->charging_trig_name);
77charging_failed:
78 kfree(psy->charging_full_trig_name);
79charging_full_failed:
80 rc = -ENOMEM;
81success:
82 return rc;
83}
84
85static void power_supply_remove_bat_triggers(struct power_supply *psy)
86{
87 led_trigger_unregister_simple(psy->charging_full_trig);
88 led_trigger_unregister_simple(psy->charging_trig);
89 led_trigger_unregister_simple(psy->full_trig);
90 kfree(psy->full_trig_name);
91 kfree(psy->charging_trig_name);
92 kfree(psy->charging_full_trig_name);
93}
94
95/* Generated power specific LEDs triggers. */
96
97static void power_supply_update_gen_leds(struct power_supply *psy)
98{
99 union power_supply_propval online;
100
101 if (psy->get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
102 return;
103
104 dev_dbg(psy->dev, "%s %d\n", __func__, online.intval);
105
106 if (online.intval)
107 led_trigger_event(psy->online_trig, LED_FULL);
108 else
109 led_trigger_event(psy->online_trig, LED_OFF);
110}
111
112static int power_supply_create_gen_triggers(struct power_supply *psy)
113{
114 int rc = 0;
115
116 psy->online_trig_name = kasprintf(GFP_KERNEL, "%s-online", psy->name);
117 if (!psy->online_trig_name)
118 goto online_failed;
119
120 led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);
121
122 goto success;
123
124online_failed:
125 rc = -ENOMEM;
126success:
127 return rc;
128}
129
130static void power_supply_remove_gen_triggers(struct power_supply *psy)
131{
132 led_trigger_unregister_simple(psy->online_trig);
133 kfree(psy->online_trig_name);
134}
135
136/* Choice what triggers to create&update. */
137
138void power_supply_update_leds(struct power_supply *psy)
139{
140 if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
141 power_supply_update_bat_leds(psy);
142 else
143 power_supply_update_gen_leds(psy);
144}
145
146int power_supply_create_triggers(struct power_supply *psy)
147{
148 if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
149 return power_supply_create_bat_triggers(psy);
150 return power_supply_create_gen_triggers(psy);
151}
152
153void power_supply_remove_triggers(struct power_supply *psy)
154{
155 if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
156 power_supply_remove_bat_triggers(psy);
157 else
158 power_supply_remove_gen_triggers(psy);
159}