← Back to branch summary

~ubuntu-branches/ubuntu/natty/linux-backports-modules-2.6.38/natty-updates

« back to all changes in this revision

Viewing changes to updates/cw-2.6.39/drivers/net/wireless/rt2x00/rt2x00leds.c

  • Committer: Bazaar Package Importer
  • Author(s): Tim Gardner, Tim Gardner
  • Date: 2011-06-08 10:44:09 UTC
  • Revision ID: james.westby@ubuntu.com-20110608104409-fnl8carkdo15bwsz
Tags: 2.6.38-10.6
[ Tim Gardner ]

Shorten compat-wireless package name to cw to accomodate
CDROM file name length restrictions.

Show diffs side-by-side

added added

removed removed

Lines of Context:
updates/cw-2.6.39/drivers/net/wireless/rt2x00/rt2x00leds.c
 
1
/*
 
2
        Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
 
3
        <http://rt2x00.serialmonkey.com>
 
4
 
 
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.
 
9
 
 
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.
 
14
 
 
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.
 
19
 */
 
20
 
 
21
/*
 
22
        Module: rt2x00lib
 
23
        Abstract: rt2x00 led specific routines.
 
24
 */
 
25
 
 
26
#include <linux/kernel.h>
 
27
#include <linux/module.h>
 
28
 
 
29
#include "rt2x00.h"
 
30
#include "rt2x00lib.h"
 
31
 
 
32
void rt2x00leds_led_quality(struct rt2x00_dev *rt2x00dev, int rssi)
 
33
{
 
34
        struct rt2x00_led *led = &rt2x00dev->led_qual;
 
35
        unsigned int brightness;
 
36
 
 
37
        if ((led->type != LED_TYPE_QUALITY) || !(led->flags & LED_REGISTERED))
 
38
                return;
 
39
 
 
40
        /*
 
41
         * Led handling requires a positive value for the rssi,
 
42
         * to do that correctly we need to add the correction.
 
43
         */
 
44
        rssi += rt2x00dev->rssi_offset;
 
45
 
 
46
        /*
 
47
         * Get the rssi level, this is used to convert the rssi
 
48
         * to a LED value inside the range LED_OFF - LED_FULL.
 
49
         */
 
50
        if (rssi <= 30)
 
51
                rssi = 0;
 
52
        else if (rssi <= 39)
 
53
                rssi = 1;
 
54
        else if (rssi <= 49)
 
55
                rssi = 2;
 
56
        else if (rssi <= 53)
 
57
                rssi = 3;
 
58
        else if (rssi <= 63)
 
59
                rssi = 4;
 
60
        else
 
61
                rssi = 5;
 
62
 
 
63
        /*
 
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
 
66
         * division.
 
67
         */
 
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;
 
72
        }
 
73
}
 
74
 
 
75
static void rt2x00led_led_simple(struct rt2x00_led *led, bool enabled)
 
76
{
 
77
        unsigned int brightness = enabled ? LED_FULL : LED_OFF;
 
78
 
 
79
        if (!(led->flags & LED_REGISTERED))
 
80
                return;
 
81
 
 
82
        led->led_dev.brightness_set(&led->led_dev, brightness);
 
83
        led->led_dev.brightness = brightness;
 
84
}
 
85
 
 
86
void rt2x00led_led_activity(struct rt2x00_dev *rt2x00dev, bool enabled)
 
87
{
 
88
        if (rt2x00dev->led_qual.type == LED_TYPE_ACTIVITY)
 
89
                rt2x00led_led_simple(&rt2x00dev->led_qual, enabled);
 
90
}
 
91
 
 
92
void rt2x00leds_led_assoc(struct rt2x00_dev *rt2x00dev, bool enabled)
 
93
{
 
94
        if (rt2x00dev->led_assoc.type == LED_TYPE_ASSOC)
 
95
                rt2x00led_led_simple(&rt2x00dev->led_assoc, enabled);
 
96
}
 
97
 
 
98
void rt2x00leds_led_radio(struct rt2x00_dev *rt2x00dev, bool enabled)
 
99
{
 
100
        if (rt2x00dev->led_radio.type == LED_TYPE_RADIO)
 
101
                rt2x00led_led_simple(&rt2x00dev->led_radio, enabled);
 
102
}
 
103
 
 
104
static int rt2x00leds_register_led(struct rt2x00_dev *rt2x00dev,
 
105
                                   struct rt2x00_led *led,
 
106
                                   const char *name)
 
107
{
 
108
        struct device *device = wiphy_dev(rt2x00dev->hw->wiphy);
 
109
        int retval;
 
110
 
 
111
        led->led_dev.name = name;
 
112
        led->led_dev.brightness = LED_OFF;
 
113
 
 
114
        retval = led_classdev_register(device, &led->led_dev);
 
115
        if (retval) {
 
116
                ERROR(rt2x00dev, "Failed to register led handler.\n");
 
117
                return retval;
 
118
        }
 
119
 
 
120
        led->flags |= LED_REGISTERED;
 
121
 
 
122
        return 0;
 
123
}
 
124
 
 
125
void rt2x00leds_register(struct rt2x00_dev *rt2x00dev)
 
126
{
 
127
        char dev_name[16];
 
128
        char name[32];
 
129
        int retval;
 
130
        unsigned long on_period;
 
131
        unsigned long off_period;
 
132
 
 
133
        snprintf(dev_name, sizeof(dev_name), "%s-%s",
 
134
                 rt2x00dev->ops->name, wiphy_name(rt2x00dev->hw->wiphy));
 
135
 
 
136
        if (rt2x00dev->led_radio.flags & LED_INITIALIZED) {
 
137
                snprintf(name, sizeof(name), "%s::radio", dev_name);
 
138
 
 
139
                retval = rt2x00leds_register_led(rt2x00dev,
 
140
                                                 &rt2x00dev->led_radio,
 
141
                                                 name);
 
142
                if (retval)
 
143
                        goto exit_fail;
 
144
        }
 
145
 
 
146
        if (rt2x00dev->led_assoc.flags & LED_INITIALIZED) {
 
147
                snprintf(name, sizeof(name), "%s::assoc", dev_name);
 
148
 
 
149
                retval = rt2x00leds_register_led(rt2x00dev,
 
150
                                                 &rt2x00dev->led_assoc,
 
151
                                                 name);
 
152
                if (retval)
 
153
                        goto exit_fail;
 
154
        }
 
155
 
 
156
        if (rt2x00dev->led_qual.flags & LED_INITIALIZED) {
 
157
                snprintf(name, sizeof(name), "%s::quality", dev_name);
 
158
 
 
159
                retval = rt2x00leds_register_led(rt2x00dev,
 
160
                                                 &rt2x00dev->led_qual,
 
161
                                                 name);
 
162
                if (retval)
 
163
                        goto exit_fail;
 
164
        }
 
165
 
 
166
        /*
 
167
         * Initialize blink time to default value:
 
168
         * On period: 70ms
 
169
         * Off period: 30ms
 
170
         */
 
171
        if (rt2x00dev->led_radio.led_dev.blink_set) {
 
172
                on_period = 70;
 
173
                off_period = 30;
 
174
                rt2x00dev->led_radio.led_dev.blink_set(
 
175
                    &rt2x00dev->led_radio.led_dev, &on_period, &off_period);
 
176
        }
 
177
 
 
178
        return;
 
179
 
 
180
exit_fail:
 
181
        rt2x00leds_unregister(rt2x00dev);
 
182
}
 
183
 
 
184
static void rt2x00leds_unregister_led(struct rt2x00_led *led)
 
185
{
 
186
        led_classdev_unregister(&led->led_dev);
 
187
 
 
188
        /*
 
189
         * This might look weird, but when we are unregistering while
 
190
         * suspended the led is already off, and since we haven't
 
191
         * fully resumed yet, access to the device might not be
 
192
         * possible yet.
 
193
         */
 
194
        if (!(led->led_dev.flags & LED_SUSPENDED))
 
195
                led->led_dev.brightness_set(&led->led_dev, LED_OFF);
 
196
 
 
197
        led->flags &= ~LED_REGISTERED;
 
198
}
 
199
 
 
200
void rt2x00leds_unregister(struct rt2x00_dev *rt2x00dev)
 
201
{
 
202
        if (rt2x00dev->led_qual.flags & LED_REGISTERED)
 
203
                rt2x00leds_unregister_led(&rt2x00dev->led_qual);
 
204
        if (rt2x00dev->led_assoc.flags & LED_REGISTERED)
 
205
                rt2x00leds_unregister_led(&rt2x00dev->led_assoc);
 
206
        if (rt2x00dev->led_radio.flags & LED_REGISTERED)
 
207
                rt2x00leds_unregister_led(&rt2x00dev->led_radio);
 
208
}
 
209
 
 
210
static inline void rt2x00leds_suspend_led(struct rt2x00_led *led)
 
211
{
 
212
        led_classdev_suspend(&led->led_dev);
 
213
 
 
214
        /* This shouldn't be needed, but just to be safe */
 
215
        led->led_dev.brightness_set(&led->led_dev, LED_OFF);
 
216
        led->led_dev.brightness = LED_OFF;
 
217
}
 
218
 
 
219
void rt2x00leds_suspend(struct rt2x00_dev *rt2x00dev)
 
220
{
 
221
        if (rt2x00dev->led_qual.flags & LED_REGISTERED)
 
222
                rt2x00leds_suspend_led(&rt2x00dev->led_qual);
 
223
        if (rt2x00dev->led_assoc.flags & LED_REGISTERED)
 
224
                rt2x00leds_suspend_led(&rt2x00dev->led_assoc);
 
225
        if (rt2x00dev->led_radio.flags & LED_REGISTERED)
 
226
                rt2x00leds_suspend_led(&rt2x00dev->led_radio);
 
227
}
 
228
 
 
229
static inline void rt2x00leds_resume_led(struct rt2x00_led *led)
 
230
{
 
231
        led_classdev_resume(&led->led_dev);
 
232
 
 
233
        /* Device might have enabled the LEDS during resume */
 
234
        led->led_dev.brightness_set(&led->led_dev, LED_OFF);
 
235
        led->led_dev.brightness = LED_OFF;
 
236
}
 
237
 
 
238
void rt2x00leds_resume(struct rt2x00_dev *rt2x00dev)
 
239
{
 
240
        if (rt2x00dev->led_radio.flags & LED_REGISTERED)
 
241
                rt2x00leds_resume_led(&rt2x00dev->led_radio);
 
242
        if (rt2x00dev->led_assoc.flags & LED_REGISTERED)
 
243
                rt2x00leds_resume_led(&rt2x00dev->led_assoc);
 
244
        if (rt2x00dev->led_qual.flags & LED_REGISTERED)
 
245
                rt2x00leds_resume_led(&rt2x00dev->led_qual);
 
246
}