2 Copyright (C) 2004 - 2008 rt2x00 SourceForge Project
3 <http://rt2x00.serialmonkey.com>
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
15 You should have received a copy of the GNU General Public License
16 along with this program; if not, write to the
17 Free Software Foundation, Inc.,
18 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23 Abstract: rt2x00 led specific routines.
26 #include <linux/kernel.h>
27 #include <linux/module.h>
30 #include "rt2x00lib.h"
32 void rt2x00leds_led_quality(struct rt2x00_dev
*rt2x00dev
, int rssi
)
34 struct rt2x00_led
*led
= &rt2x00dev
->led_qual
;
35 unsigned int brightness
;
37 if ((led
->type
!= LED_TYPE_QUALITY
) || !(led
->flags
& LED_REGISTERED
))
41 * Led handling requires a positive value for the rssi,
42 * to do that correctly we need to add the correction.
44 rssi
+= rt2x00dev
->rssi_offset
;
47 * Get the rssi level, this is used to convert the rssi
48 * to a LED value inside the range LED_OFF - LED_FULL.
64 * Note that we must _not_ send LED_OFF since the driver
65 * is going to calculate the value and might use it in a
68 brightness
= ((LED_FULL
/ 6) * rssi
) + 1;
69 if (brightness
!= led
->led_dev
.brightness
) {
70 led
->led_dev
.brightness_set(&led
->led_dev
, brightness
);
71 led
->led_dev
.brightness
= brightness
;
75 static void rt2x00led_led_simple(struct rt2x00_led
*led
, bool enabled
)
77 unsigned int brightness
= enabled
? LED_FULL
: LED_OFF
;
79 if (!(led
->flags
& LED_REGISTERED
))
82 led
->led_dev
.brightness_set(&led
->led_dev
, brightness
);
83 led
->led_dev
.brightness
= brightness
;
86 void rt2x00led_led_activity(struct rt2x00_dev
*rt2x00dev
, bool enabled
)
88 if (rt2x00dev
->led_qual
.type
== LED_TYPE_ACTIVITY
)
89 rt2x00led_led_simple(&rt2x00dev
->led_qual
, enabled
);
92 void rt2x00leds_led_assoc(struct rt2x00_dev
*rt2x00dev
, bool enabled
)
94 if (rt2x00dev
->led_assoc
.type
== LED_TYPE_ASSOC
)
95 rt2x00led_led_simple(&rt2x00dev
->led_assoc
, enabled
);
98 void rt2x00leds_led_radio(struct rt2x00_dev
*rt2x00dev
, bool enabled
)
100 if (rt2x00dev
->led_radio
.type
== LED_TYPE_ASSOC
)
101 rt2x00led_led_simple(&rt2x00dev
->led_radio
, enabled
);
104 static int rt2x00leds_register_led(struct rt2x00_dev
*rt2x00dev
,
105 struct rt2x00_led
*led
,
108 struct device
*device
= wiphy_dev(rt2x00dev
->hw
->wiphy
);
111 led
->led_dev
.name
= name
;
112 led
->led_dev
.brightness
= LED_OFF
;
115 * Ensure the LED is off, it might have been enabled
116 * by the hardware when the device was powered on.
118 led
->led_dev
.brightness_set(&led
->led_dev
, LED_OFF
);
120 retval
= led_classdev_register(device
, &led
->led_dev
);
122 ERROR(rt2x00dev
, "Failed to register led handler.\n");
126 led
->flags
|= LED_REGISTERED
;
131 void rt2x00leds_register(struct rt2x00_dev
*rt2x00dev
)
136 unsigned long on_period
;
137 unsigned long off_period
;
139 snprintf(dev_name
, sizeof(dev_name
), "%s-%s",
140 rt2x00dev
->ops
->name
, wiphy_name(rt2x00dev
->hw
->wiphy
));
142 if (rt2x00dev
->led_radio
.flags
& LED_INITIALIZED
) {
143 snprintf(name
, sizeof(name
), "%s:radio", dev_name
);
145 retval
= rt2x00leds_register_led(rt2x00dev
,
146 &rt2x00dev
->led_radio
,
152 if (rt2x00dev
->led_assoc
.flags
& LED_INITIALIZED
) {
153 snprintf(name
, sizeof(name
), "%s:assoc", dev_name
);
155 retval
= rt2x00leds_register_led(rt2x00dev
,
156 &rt2x00dev
->led_assoc
,
162 if (rt2x00dev
->led_qual
.flags
& LED_INITIALIZED
) {
163 snprintf(name
, sizeof(name
), "%s:quality", dev_name
);
165 retval
= rt2x00leds_register_led(rt2x00dev
,
166 &rt2x00dev
->led_qual
,
173 * Initialize blink time to default value:
177 if (rt2x00dev
->led_radio
.led_dev
.blink_set
) {
180 rt2x00dev
->led_radio
.led_dev
.blink_set(
181 &rt2x00dev
->led_radio
.led_dev
, &on_period
, &off_period
);
187 rt2x00leds_unregister(rt2x00dev
);
190 static void rt2x00leds_unregister_led(struct rt2x00_led
*led
)
192 led_classdev_unregister(&led
->led_dev
);
195 * This might look weird, but when we are unregistering while
196 * suspended the led is already off, and since we haven't
197 * fully resumed yet, access to the device might not be
200 if (!(led
->led_dev
.flags
& LED_SUSPENDED
))
201 led
->led_dev
.brightness_set(&led
->led_dev
, LED_OFF
);
203 led
->flags
&= ~LED_REGISTERED
;
206 void rt2x00leds_unregister(struct rt2x00_dev
*rt2x00dev
)
208 if (rt2x00dev
->led_qual
.flags
& LED_REGISTERED
)
209 rt2x00leds_unregister_led(&rt2x00dev
->led_qual
);
210 if (rt2x00dev
->led_assoc
.flags
& LED_REGISTERED
)
211 rt2x00leds_unregister_led(&rt2x00dev
->led_assoc
);
212 if (rt2x00dev
->led_radio
.flags
& LED_REGISTERED
)
213 rt2x00leds_unregister_led(&rt2x00dev
->led_radio
);
216 static inline void rt2x00leds_suspend_led(struct rt2x00_led
*led
)
218 led_classdev_suspend(&led
->led_dev
);
220 /* This shouldn't be needed, but just to be safe */
221 led
->led_dev
.brightness_set(&led
->led_dev
, LED_OFF
);
222 led
->led_dev
.brightness
= LED_OFF
;
225 void rt2x00leds_suspend(struct rt2x00_dev
*rt2x00dev
)
227 if (rt2x00dev
->led_qual
.flags
& LED_REGISTERED
)
228 rt2x00leds_suspend_led(&rt2x00dev
->led_qual
);
229 if (rt2x00dev
->led_assoc
.flags
& LED_REGISTERED
)
230 rt2x00leds_suspend_led(&rt2x00dev
->led_assoc
);
231 if (rt2x00dev
->led_radio
.flags
& LED_REGISTERED
)
232 rt2x00leds_suspend_led(&rt2x00dev
->led_radio
);
235 static inline void rt2x00leds_resume_led(struct rt2x00_led
*led
)
237 led_classdev_resume(&led
->led_dev
);
239 /* Device might have enabled the LEDS during resume */
240 led
->led_dev
.brightness_set(&led
->led_dev
, LED_OFF
);
241 led
->led_dev
.brightness
= LED_OFF
;
244 void rt2x00leds_resume(struct rt2x00_dev
*rt2x00dev
)
246 if (rt2x00dev
->led_radio
.flags
& LED_REGISTERED
)
247 rt2x00leds_resume_led(&rt2x00dev
->led_radio
);
248 if (rt2x00dev
->led_assoc
.flags
& LED_REGISTERED
)
249 rt2x00leds_resume_led(&rt2x00dev
->led_assoc
);
250 if (rt2x00dev
->led_qual
.flags
& LED_REGISTERED
)
251 rt2x00leds_resume_led(&rt2x00dev
->led_qual
);