Merge branch 'mfd/wm8994' of git://git.kernel.org/pub/scm/linux/kernel/git/broonie...
[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/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
21 static 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
57 static 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
91 charging_blink_full_solid_failed:
92         kfree(psy->full_trig_name);
93 full_failed:
94         kfree(psy->charging_trig_name);
95 charging_failed:
96         kfree(psy->charging_full_trig_name);
97 charging_full_failed:
98         rc = -ENOMEM;
99 success:
100         return rc;
101 }
102
103 static 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
117 static 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
132 static 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
144 online_failed:
145         rc = -ENOMEM;
146 success:
147         return rc;
148 }
149
150 static 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
158 void 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
166 int 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
173 void 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 }