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