|
@@ -12,96 +12,175 @@
|
|
#include <linux/export.h>
|
|
#include <linux/export.h>
|
|
#include "led.h"
|
|
#include "led.h"
|
|
|
|
|
|
-#define MAC80211_BLINK_DELAY 50 /* ms */
|
|
|
|
-
|
|
|
|
-void ieee80211_led_rx(struct ieee80211_local *local)
|
|
|
|
-{
|
|
|
|
- unsigned long led_delay = MAC80211_BLINK_DELAY;
|
|
|
|
- if (unlikely(!local->rx_led))
|
|
|
|
- return;
|
|
|
|
- led_trigger_blink_oneshot(local->rx_led, &led_delay, &led_delay, 0);
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-void ieee80211_led_tx(struct ieee80211_local *local)
|
|
|
|
-{
|
|
|
|
- unsigned long led_delay = MAC80211_BLINK_DELAY;
|
|
|
|
- if (unlikely(!local->tx_led))
|
|
|
|
- return;
|
|
|
|
- led_trigger_blink_oneshot(local->tx_led, &led_delay, &led_delay, 0);
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
|
|
void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
|
|
{
|
|
{
|
|
- if (unlikely(!local->assoc_led))
|
|
|
|
|
|
+ if (!atomic_read(&local->assoc_led_active))
|
|
return;
|
|
return;
|
|
if (associated)
|
|
if (associated)
|
|
- led_trigger_event(local->assoc_led, LED_FULL);
|
|
|
|
|
|
+ led_trigger_event(&local->assoc_led, LED_FULL);
|
|
else
|
|
else
|
|
- led_trigger_event(local->assoc_led, LED_OFF);
|
|
|
|
|
|
+ led_trigger_event(&local->assoc_led, LED_OFF);
|
|
}
|
|
}
|
|
|
|
|
|
void ieee80211_led_radio(struct ieee80211_local *local, bool enabled)
|
|
void ieee80211_led_radio(struct ieee80211_local *local, bool enabled)
|
|
{
|
|
{
|
|
- if (unlikely(!local->radio_led))
|
|
|
|
|
|
+ if (!atomic_read(&local->radio_led_active))
|
|
return;
|
|
return;
|
|
if (enabled)
|
|
if (enabled)
|
|
- led_trigger_event(local->radio_led, LED_FULL);
|
|
|
|
|
|
+ led_trigger_event(&local->radio_led, LED_FULL);
|
|
else
|
|
else
|
|
- led_trigger_event(local->radio_led, LED_OFF);
|
|
|
|
|
|
+ led_trigger_event(&local->radio_led, LED_OFF);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+void ieee80211_alloc_led_names(struct ieee80211_local *local)
|
|
|
|
+{
|
|
|
|
+ local->rx_led.name = kasprintf(GFP_KERNEL, "%srx",
|
|
|
|
+ wiphy_name(local->hw.wiphy));
|
|
|
|
+ local->tx_led.name = kasprintf(GFP_KERNEL, "%stx",
|
|
|
|
+ wiphy_name(local->hw.wiphy));
|
|
|
|
+ local->assoc_led.name = kasprintf(GFP_KERNEL, "%sassoc",
|
|
|
|
+ wiphy_name(local->hw.wiphy));
|
|
|
|
+ local->radio_led.name = kasprintf(GFP_KERNEL, "%sradio",
|
|
|
|
+ wiphy_name(local->hw.wiphy));
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+void ieee80211_free_led_names(struct ieee80211_local *local)
|
|
|
|
+{
|
|
|
|
+ kfree(local->rx_led.name);
|
|
|
|
+ kfree(local->tx_led.name);
|
|
|
|
+ kfree(local->assoc_led.name);
|
|
|
|
+ kfree(local->radio_led.name);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_tx_led_activate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ tx_led);
|
|
|
|
+
|
|
|
|
+ atomic_inc(&local->tx_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_tx_led_deactivate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ tx_led);
|
|
|
|
+
|
|
|
|
+ atomic_dec(&local->tx_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_rx_led_activate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ rx_led);
|
|
|
|
+
|
|
|
|
+ atomic_inc(&local->rx_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_rx_led_deactivate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ rx_led);
|
|
|
|
+
|
|
|
|
+ atomic_dec(&local->rx_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_assoc_led_activate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ assoc_led);
|
|
|
|
+
|
|
|
|
+ atomic_inc(&local->assoc_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_assoc_led_deactivate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ assoc_led);
|
|
|
|
+
|
|
|
|
+ atomic_dec(&local->assoc_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_radio_led_activate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ radio_led);
|
|
|
|
+
|
|
|
|
+ atomic_inc(&local->radio_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_radio_led_deactivate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ radio_led);
|
|
|
|
+
|
|
|
|
+ atomic_dec(&local->radio_led_active);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void ieee80211_tpt_led_activate(struct led_classdev *led_cdev)
|
|
|
|
+{
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ tpt_led);
|
|
|
|
+
|
|
|
|
+ atomic_inc(&local->tpt_led_active);
|
|
}
|
|
}
|
|
|
|
|
|
-void ieee80211_led_names(struct ieee80211_local *local)
|
|
|
|
|
|
+static void ieee80211_tpt_led_deactivate(struct led_classdev *led_cdev)
|
|
{
|
|
{
|
|
- snprintf(local->rx_led_name, sizeof(local->rx_led_name),
|
|
|
|
- "%srx", wiphy_name(local->hw.wiphy));
|
|
|
|
- snprintf(local->tx_led_name, sizeof(local->tx_led_name),
|
|
|
|
- "%stx", wiphy_name(local->hw.wiphy));
|
|
|
|
- snprintf(local->assoc_led_name, sizeof(local->assoc_led_name),
|
|
|
|
- "%sassoc", wiphy_name(local->hw.wiphy));
|
|
|
|
- snprintf(local->radio_led_name, sizeof(local->radio_led_name),
|
|
|
|
- "%sradio", wiphy_name(local->hw.wiphy));
|
|
|
|
|
|
+ struct ieee80211_local *local = container_of(led_cdev->trigger,
|
|
|
|
+ struct ieee80211_local,
|
|
|
|
+ tpt_led);
|
|
|
|
+
|
|
|
|
+ atomic_dec(&local->tpt_led_active);
|
|
}
|
|
}
|
|
|
|
|
|
void ieee80211_led_init(struct ieee80211_local *local)
|
|
void ieee80211_led_init(struct ieee80211_local *local)
|
|
{
|
|
{
|
|
- local->rx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
|
|
|
|
- if (local->rx_led) {
|
|
|
|
- local->rx_led->name = local->rx_led_name;
|
|
|
|
- if (led_trigger_register(local->rx_led)) {
|
|
|
|
- kfree(local->rx_led);
|
|
|
|
- local->rx_led = NULL;
|
|
|
|
- }
|
|
|
|
|
|
+ atomic_set(&local->rx_led_active, 0);
|
|
|
|
+ local->rx_led.activate = ieee80211_rx_led_activate;
|
|
|
|
+ local->rx_led.deactivate = ieee80211_rx_led_deactivate;
|
|
|
|
+ if (local->rx_led.name && led_trigger_register(&local->rx_led)) {
|
|
|
|
+ kfree(local->rx_led.name);
|
|
|
|
+ local->rx_led.name = NULL;
|
|
}
|
|
}
|
|
|
|
|
|
- local->tx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
|
|
|
|
- if (local->tx_led) {
|
|
|
|
- local->tx_led->name = local->tx_led_name;
|
|
|
|
- if (led_trigger_register(local->tx_led)) {
|
|
|
|
- kfree(local->tx_led);
|
|
|
|
- local->tx_led = NULL;
|
|
|
|
- }
|
|
|
|
|
|
+ atomic_set(&local->tx_led_active, 0);
|
|
|
|
+ local->tx_led.activate = ieee80211_tx_led_activate;
|
|
|
|
+ local->tx_led.deactivate = ieee80211_tx_led_deactivate;
|
|
|
|
+ if (local->tx_led.name && led_trigger_register(&local->tx_led)) {
|
|
|
|
+ kfree(local->tx_led.name);
|
|
|
|
+ local->tx_led.name = NULL;
|
|
}
|
|
}
|
|
|
|
|
|
- local->assoc_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
|
|
|
|
- if (local->assoc_led) {
|
|
|
|
- local->assoc_led->name = local->assoc_led_name;
|
|
|
|
- if (led_trigger_register(local->assoc_led)) {
|
|
|
|
- kfree(local->assoc_led);
|
|
|
|
- local->assoc_led = NULL;
|
|
|
|
- }
|
|
|
|
|
|
+ atomic_set(&local->assoc_led_active, 0);
|
|
|
|
+ local->assoc_led.activate = ieee80211_assoc_led_activate;
|
|
|
|
+ local->assoc_led.deactivate = ieee80211_assoc_led_deactivate;
|
|
|
|
+ if (local->assoc_led.name && led_trigger_register(&local->assoc_led)) {
|
|
|
|
+ kfree(local->assoc_led.name);
|
|
|
|
+ local->assoc_led.name = NULL;
|
|
}
|
|
}
|
|
|
|
|
|
- local->radio_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
|
|
|
|
- if (local->radio_led) {
|
|
|
|
- local->radio_led->name = local->radio_led_name;
|
|
|
|
- if (led_trigger_register(local->radio_led)) {
|
|
|
|
- kfree(local->radio_led);
|
|
|
|
- local->radio_led = NULL;
|
|
|
|
- }
|
|
|
|
|
|
+ atomic_set(&local->radio_led_active, 0);
|
|
|
|
+ local->radio_led.activate = ieee80211_radio_led_activate;
|
|
|
|
+ local->radio_led.deactivate = ieee80211_radio_led_deactivate;
|
|
|
|
+ if (local->radio_led.name && led_trigger_register(&local->radio_led)) {
|
|
|
|
+ kfree(local->radio_led.name);
|
|
|
|
+ local->radio_led.name = NULL;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+ atomic_set(&local->tpt_led_active, 0);
|
|
if (local->tpt_led_trigger) {
|
|
if (local->tpt_led_trigger) {
|
|
- if (led_trigger_register(&local->tpt_led_trigger->trig)) {
|
|
|
|
|
|
+ local->tpt_led.activate = ieee80211_tpt_led_activate;
|
|
|
|
+ local->tpt_led.deactivate = ieee80211_tpt_led_deactivate;
|
|
|
|
+ if (led_trigger_register(&local->tpt_led)) {
|
|
kfree(local->tpt_led_trigger);
|
|
kfree(local->tpt_led_trigger);
|
|
local->tpt_led_trigger = NULL;
|
|
local->tpt_led_trigger = NULL;
|
|
}
|
|
}
|
|
@@ -110,25 +189,17 @@ void ieee80211_led_init(struct ieee80211_local *local)
|
|
|
|
|
|
void ieee80211_led_exit(struct ieee80211_local *local)
|
|
void ieee80211_led_exit(struct ieee80211_local *local)
|
|
{
|
|
{
|
|
- if (local->radio_led) {
|
|
|
|
- led_trigger_unregister(local->radio_led);
|
|
|
|
- kfree(local->radio_led);
|
|
|
|
- }
|
|
|
|
- if (local->assoc_led) {
|
|
|
|
- led_trigger_unregister(local->assoc_led);
|
|
|
|
- kfree(local->assoc_led);
|
|
|
|
- }
|
|
|
|
- if (local->tx_led) {
|
|
|
|
- led_trigger_unregister(local->tx_led);
|
|
|
|
- kfree(local->tx_led);
|
|
|
|
- }
|
|
|
|
- if (local->rx_led) {
|
|
|
|
- led_trigger_unregister(local->rx_led);
|
|
|
|
- kfree(local->rx_led);
|
|
|
|
- }
|
|
|
|
|
|
+ if (local->radio_led.name)
|
|
|
|
+ led_trigger_unregister(&local->radio_led);
|
|
|
|
+ if (local->assoc_led.name)
|
|
|
|
+ led_trigger_unregister(&local->assoc_led);
|
|
|
|
+ if (local->tx_led.name)
|
|
|
|
+ led_trigger_unregister(&local->tx_led);
|
|
|
|
+ if (local->rx_led.name)
|
|
|
|
+ led_trigger_unregister(&local->rx_led);
|
|
|
|
|
|
if (local->tpt_led_trigger) {
|
|
if (local->tpt_led_trigger) {
|
|
- led_trigger_unregister(&local->tpt_led_trigger->trig);
|
|
|
|
|
|
+ led_trigger_unregister(&local->tpt_led);
|
|
kfree(local->tpt_led_trigger);
|
|
kfree(local->tpt_led_trigger);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -137,7 +208,7 @@ const char *__ieee80211_get_radio_led_name(struct ieee80211_hw *hw)
|
|
{
|
|
{
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
|
|
|
|
- return local->radio_led_name;
|
|
|
|
|
|
+ return local->radio_led.name;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(__ieee80211_get_radio_led_name);
|
|
EXPORT_SYMBOL(__ieee80211_get_radio_led_name);
|
|
|
|
|
|
@@ -145,7 +216,7 @@ const char *__ieee80211_get_assoc_led_name(struct ieee80211_hw *hw)
|
|
{
|
|
{
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
|
|
|
|
- return local->assoc_led_name;
|
|
|
|
|
|
+ return local->assoc_led.name;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);
|
|
EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);
|
|
|
|
|
|
@@ -153,7 +224,7 @@ const char *__ieee80211_get_tx_led_name(struct ieee80211_hw *hw)
|
|
{
|
|
{
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
|
|
|
|
- return local->tx_led_name;
|
|
|
|
|
|
+ return local->tx_led.name;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(__ieee80211_get_tx_led_name);
|
|
EXPORT_SYMBOL(__ieee80211_get_tx_led_name);
|
|
|
|
|
|
@@ -161,7 +232,7 @@ const char *__ieee80211_get_rx_led_name(struct ieee80211_hw *hw)
|
|
{
|
|
{
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
struct ieee80211_local *local = hw_to_local(hw);
|
|
|
|
|
|
- return local->rx_led_name;
|
|
|
|
|
|
+ return local->rx_led.name;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(__ieee80211_get_rx_led_name);
|
|
EXPORT_SYMBOL(__ieee80211_get_rx_led_name);
|
|
|
|
|
|
@@ -230,7 +301,7 @@ __ieee80211_create_tpt_led_trigger(struct ieee80211_hw *hw,
|
|
snprintf(tpt_trig->name, sizeof(tpt_trig->name),
|
|
snprintf(tpt_trig->name, sizeof(tpt_trig->name),
|
|
"%stpt", wiphy_name(local->hw.wiphy));
|
|
"%stpt", wiphy_name(local->hw.wiphy));
|
|
|
|
|
|
- tpt_trig->trig.name = tpt_trig->name;
|
|
|
|
|
|
+ local->tpt_led.name = tpt_trig->name;
|
|
|
|
|
|
tpt_trig->blink_table = blink_table;
|
|
tpt_trig->blink_table = blink_table;
|
|
tpt_trig->blink_table_len = blink_table_len;
|
|
tpt_trig->blink_table_len = blink_table_len;
|