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