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#include <linux/slab.h>
16
17#include "power_supply.h"
18
19/* Battery specific LEDs triggers. */
20
21static void power_supply_update_bat_leds(struct power_supply *psy)
22{
23 union power_supply_propval status;
24 unsigned long delay_on = 0;
25 unsigned long delay_off = 0;
26
27 if (psy->get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
28 return;
29
30 dev_dbg(psy->dev, "%s %d\n", __func__, status.intval);
31
32 switch (status.intval) {
33 case POWER_SUPPLY_STATUS_FULL:
34 led_trigger_event(psy->charging_full_trig, LED_FULL);
35 led_trigger_event(psy->charging_trig, LED_OFF);
36 led_trigger_event(psy->full_trig, LED_FULL);
37 led_trigger_event(psy->charging_blink_full_solid_trig,
38 LED_FULL);
39 break;
40 case POWER_SUPPLY_STATUS_CHARGING:
41 led_trigger_event(psy->charging_full_trig, LED_FULL);
42 led_trigger_event(psy->charging_trig, LED_FULL);
43 led_trigger_event(psy->full_trig, LED_OFF);
44 led_trigger_blink(psy->charging_blink_full_solid_trig,
45 &delay_on, &delay_off);
46 break;
47 default:
48 led_trigger_event(psy->charging_full_trig, LED_OFF);
49 led_trigger_event(psy->charging_trig, LED_OFF);
50 led_trigger_event(psy->full_trig, LED_OFF);
51 led_trigger_event(psy->charging_blink_full_solid_trig,
52 LED_OFF);
53 break;
54 }
55}
56
57static int power_supply_create_bat_triggers(struct power_supply *psy)
58{
59 int rc = 0;
60
61 psy->charging_full_trig_name = kasprintf(GFP_KERNEL,
62 "%s-charging-or-full", psy->name);
63 if (!psy->charging_full_trig_name)
64 goto charging_full_failed;
65
66 psy->charging_trig_name = kasprintf(GFP_KERNEL,
67 "%s-charging", psy->name);
68 if (!psy->charging_trig_name)
69 goto charging_failed;
70
71 psy->full_trig_name = kasprintf(GFP_KERNEL, "%s-full", psy->name);
72 if (!psy->full_trig_name)
73 goto full_failed;
74
75 psy->charging_blink_full_solid_trig_name = kasprintf(GFP_KERNEL,
76 "%s-charging-blink-full-solid", psy->name);
77 if (!psy->charging_blink_full_solid_trig_name)
78 goto charging_blink_full_solid_failed;
79
80 led_trigger_register_simple(psy->charging_full_trig_name,
81 &psy->charging_full_trig);
82 led_trigger_register_simple(psy->charging_trig_name,
83 &psy->charging_trig);
84 led_trigger_register_simple(psy->full_trig_name,
85 &psy->full_trig);
86 led_trigger_register_simple(psy->charging_blink_full_solid_trig_name,
87 &psy->charging_blink_full_solid_trig);
88
89 goto success;
90
91charging_blink_full_solid_failed:
92 kfree(psy->full_trig_name);
93full_failed:
94 kfree(psy->charging_trig_name);
95charging_failed:
96 kfree(psy->charging_full_trig_name);
97charging_full_failed:
98 rc = -ENOMEM;
99success:
100 return rc;
101}
102
103static void power_supply_remove_bat_triggers(struct power_supply *psy)
104{
105 led_trigger_unregister_simple(psy->charging_full_trig);
106 led_trigger_unregister_simple(psy->charging_trig);
107 led_trigger_unregister_simple(psy->full_trig);
108 led_trigger_unregister_simple(psy->charging_blink_full_solid_trig);
109 kfree(psy->charging_blink_full_solid_trig_name);
110 kfree(psy->full_trig_name);
111 kfree(psy->charging_trig_name);
112 kfree(psy->charging_full_trig_name);
113}
114
115/* Generated power specific LEDs triggers. */
116
117static void power_supply_update_gen_leds(struct power_supply *psy)
118{
119 union power_supply_propval online;
120
121 if (psy->get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
122 return;
123
124 dev_dbg(psy->dev, "%s %d\n", __func__, online.intval);
125
126 if (online.intval)
127 led_trigger_event(psy->online_trig, LED_FULL);
128 else
129 led_trigger_event(psy->online_trig, LED_OFF);
130}
131
132static int power_supply_create_gen_triggers(struct power_supply *psy)
133{
134 int rc = 0;
135
136 psy->online_trig_name = kasprintf(GFP_KERNEL, "%s-online", psy->name);
137 if (!psy->online_trig_name)
138 goto online_failed;
139
140 led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);
141
142 goto success;
143
144online_failed:
145 rc = -ENOMEM;
146success:
147 return rc;
148}
149
150static void power_supply_remove_gen_triggers(struct power_supply *psy)
151{
152 led_trigger_unregister_simple(psy->online_trig);
153 kfree(psy->online_trig_name);
154}
155
156/* Choice what triggers to create&update. */
157
158void power_supply_update_leds(struct power_supply *psy)
159{
160 if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
161 power_supply_update_bat_leds(psy);
162 else
163 power_supply_update_gen_leds(psy);
164}
165
166int power_supply_create_triggers(struct power_supply *psy)
167{
168 if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
169 return power_supply_create_bat_triggers(psy);
170 return power_supply_create_gen_triggers(psy);
171}
172
173void power_supply_remove_triggers(struct power_supply *psy)
174{
175 if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
176 power_supply_remove_bat_triggers(psy);
177 else
178 power_supply_remove_gen_triggers(psy);
179}