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