iwlwifi using mac80211_leds

Here's my naive attempt to implement the mac80211_leds, since the addition of the associated led to wireless2.6 it works rather well for me. The patch below Is only for the 3945 but it should work for 4965 too afaik by just copy pasting the changes in iwl3945-bace.c to iwl4965-base.c. But I can't test that and this way the email is clearer.

I am aware of two problems
- when unloading the module it prints a few warnings to dmesg because a send command failing
- when loading/unloading the module a few times. it will no longer connect. reloading mac80211 module fixes this

I expect there to be problems with the locking
- it's basically this way it doesn't crash for me spinlocking what can be spinlocked

But anyways, if for no other reason than your viewing pleasure ;-)

Signed-of-by Ian Schram <[email protected]>

---

drivers/net/wireless/iwlwifi/Kconfig +6 -0

index 25cfc6c..8e8f835 100644
@@ -126,3 +126,9 @@ config IWL3945
          inserted in and remvoed from the running kernel whenever you want),
          say M here and read <file:Documentation/modules.txt>.  The module
          will be called iwl3945.ko.
+config IWLWIFI_LEDS
+       bool    "IWLWIFI leds"
+       depends IWLWIFI && MAC80211_LEDS
+       default y
+       ---help---
+       This options enables the wireless led.

drivers/net/wireless/iwlwifi/iwl-leds.h new file +20 -0

new file mode 100644
index 0000000..07a55f0
@@ -0,0 +1,20 @@
+#ifndef __iwl_leds_h__
+#define __iwl_leds_h__
+
+
+#include <linux/leds.h>
+
+
+#define IWL_LED_ACTIVITY       (0<<1)
+#define IWL_LED_LINK           (1<<1)
+#define IWL_LED_INTERVAL       __constant_cpu_to_le32(1000)
+#define IWL_LED_ACTIVITY_PERIOD msecs_to_jiffies(500)
+#define IWL_LED_MAX_NAME_LEN   31
+
+struct iwl_led {
+       char name[IWL_LED_MAX_NAME_LEN + 1];
+       struct led_classdev cdev;
+};
+
+
+#endif

drivers/net/wireless/iwlwifi/iwl-priv.h +9 -5

index 6b490d0..bdaeb80 100644
@@ -127,11 +128,14 @@ struct iwl_priv {
        struct iwl_init_alive_resp card_alive_init;
        struct iwl_alive_resp card_alive;
 
-#ifdef LED
-       /* LED related variables */
-       struct iwl_activity_blink activity;
-       unsigned long led_packets;
-       int led_state;
+
+#ifdef CONFIG_IWLWIFI_LEDS
+       u8 led_state;
+       unsigned int rxtxpackets;
+       atomic_t ledtimer;
+       struct iwl_led tx_led;
+       struct iwl_led rx_led;
+       struct iwl_led assoc_led;
 #endif
 
        u16 active_rate;

@@ -274,6 +278,7 @@ struct iwl_priv {
        struct delayed_work gather_stats;
        struct delayed_work scan_check;
        struct delayed_work post_associate;
+       struct delayed_work update_led;
 
 #define IWL_DEFAULT_TX_POWER 0x0F
        s8 user_txpower_limit;

drivers/net/wireless/iwlwifi/iwl3945-base.c +180 -1

index b601455..72317a3 100644
@@ -6065,6 +6065,171 @@ static void iwl_init_alive_start(struct iwl_priv *priv)
        queue_work(priv->workqueue, &priv->restart);
 }
 
+#ifdef CONFIG_IWLWIFI_LEDS
+static int iwl_led_cmd_callback(struct iwl_priv *priv,
+                               struct iwl_cmd *cmd, struct sk_buff *skb)
+{
+       return 1;
+}
+
+static void iwl_bg_led_update(struct work_struct *data)
+{
+       struct iwl_priv *priv =
+           container_of(data, struct iwl_priv, update_led.work);
+       struct iwl_led_cmd led_cmd = {
+               .id = IWL_LED_ACTIVITY,
+               .interval = IWL_LED_INTERVAL,
+       };
+       struct iwl_host_cmd cmd = {
+               .id = REPLY_LEDS_CMD,
+               .len = sizeof(struct iwl_led_cmd),
+               .data = &led_cmd,
+               .meta.flags = CMD_ASYNC,
+               .meta.u.callback = iwl_led_cmd_callback,
+       };
+       u8 on;
+       unsigned long flags;
+
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+
+       if (priv->rxtxpackets){
+               on = 1 + 250 / priv->rxtxpackets;
+               priv->rxtxpackets = 0;
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+
+               if (on == priv->led_state)
+                       goto exit_unlock;
+
+               led_cmd.on = led_cmd.off = on;
+               priv->led_state = on;
+
+       }
+       else {
+
+               atomic_set(&priv->ledtimer, 0);
+               led_cmd.on = led_cmd.off = 0;
+       }
+
+       spin_unlock_irqrestore(&priv->lock, flags);
+       iwl_send_cmd(priv, &cmd);
+
+       return;
+
+exit_unlock:
+       spin_unlock_irqrestore(&priv->lock, flags);
+}
+
+static void iwl_led_set_rx(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            rx_led.cdev);
+       unsigned long flags;
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+       if (!atomic_xchg(&priv->ledtimer, 1))
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+       priv->rxtxpackets++;
+       spin_unlock_irqrestore(&priv->lock, flags);
+
+}
+
+static void iwl_led_set_tx(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            tx_led.cdev);
+       unsigned long flags;
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+       if (!atomic_xchg(&priv->ledtimer, 1))
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+
+       priv->rxtxpackets++;
+       spin_unlock_irqrestore(&priv->lock, flags);
+}
+
+static void iwl_led_set_assoc(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            assoc_led.cdev);
+       struct iwl_led_cmd led_cmd = {
+               .id = IWL_LED_LINK,
+               .interval = IWL_LED_INTERVAL,
+       };
+       struct iwl_host_cmd cmd = {
+               .id = REPLY_LEDS_CMD,
+               .len = sizeof(struct iwl_led_cmd),
+               .data = &led_cmd,
+               .meta.flags = CMD_ASYNC,
+               .meta.u.callback = iwl_led_cmd_callback
+       };
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       switch(value)
+       {
+               case LED_OFF:
+                       led_cmd.off = 0;
+                       led_cmd.on = 0;
+                       break;
+               case LED_HALF:
+               case LED_FULL:
+                       led_cmd.off = 0;
+                       led_cmd.on = 40;
+       }
+       iwl_send_cmd(priv, &cmd);
+}
+
+
+static int iwl_register_led(struct iwl_priv *priv, struct iwl_led *led, char *ledname,
+                            char *triggername, void (*callback)
+                            (struct led_classdev *, enum led_brightness))
+{
+       snprintf(led->name, sizeof(led->name), ledname,
+                wiphy_name(priv->hw->wiphy));
+       led->cdev.name = led->name;
+       led->cdev.brightness_set = callback;
+       led->cdev.default_trigger = triggername;
+
+       return led_classdev_register(&priv->pci_dev->dev, &led->cdev);
+}
+
+static void iwl_register_leds(struct iwl_priv *priv)
+{
+       iwl_register_led(priv, &priv->tx_led, "iwl-%s:tx",
+                        ieee80211_get_tx_led_name(priv->hw),
+                        iwl_led_set_tx);
+       iwl_register_led(priv, &priv->rx_led, "iwl-%s:rx",
+                        ieee80211_get_rx_led_name(priv->hw),
+                        iwl_led_set_rx);
+       iwl_register_led(priv, &priv->assoc_led, "iwl-%s:asoc",
+                        ieee80211_get_assoc_led_name(priv->hw),
+                        iwl_led_set_assoc);
+}
+
+static void iwl_unregister_leds(struct iwl_priv *priv)
+{
+       led_classdev_unregister(&priv->tx_led.cdev);
+       led_classdev_unregister(&priv->rx_led.cdev);
+       led_classdev_unregister(&priv->assoc_led.cdev);
+}
+#endif
 
 /**
  * iwl_alive_start - called after REPLY_ALIVE notification received

@@ -6140,6 +6140,9 @@ static void iwl_alive_start(struct iwl_priv *priv)
        if (iwl_is_rfkill(priv))
                return;
 
+#ifdef CONFIG_IWLWIFI_LEDS
+       atomic_set(&priv->ledtimer, 0);
+#endif
        if (!priv->mac80211_registered) {
                /* Unlock so any user space entry points can call back into
                 * the driver without a deadlock... */

@@ -6158,6 +6161,9 @@ static void iwl_alive_start(struct iwl_priv *priv)
                priv->mac80211_registered = 1;
 
                iwl_reset_channel_flag(priv);
+#ifdef CONFIG_IWLWIFI_LEDS
+               iwl_register_leds(priv);
+#endif
        } else
                ieee80211_start_queues(priv->hw);
 

@@ -6217,6 +6223,10 @@ static void __iwl_down(struct iwl_priv *priv)
        if (!exit_pending)
                set_bit(STATUS_EXIT_PENDING, &priv->status);
 
+#ifdef CONFIG_IWLWIFI_LEDS
+       /* Prevent the led callbacks from rescheduling the update_led timer */
+       atomic_set(&priv->ledtimer, 1);
+#endif
        iwl_clear_stations_table(priv);
 
        /* Unblock any waiting calls */

@@ -8198,7 +8208,7 @@ static void iwl_setup_deferred_work(struct iwl_priv *priv)
        INIT_DELAYED_WORK(&priv->init_alive_start, iwl_bg_init_alive_start);
        INIT_DELAYED_WORK(&priv->alive_start, iwl_bg_alive_start);
        INIT_DELAYED_WORK(&priv->scan_check, iwl_bg_scan_check);
-
+       INIT_DELAYED_WORK(&priv->update_led, iwl_bg_led_update);
        iwl_hw_setup_deferred_work(priv);
 
        tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))

@@ -8209,6 +8219,7 @@ static void iwl_cancel_deferred_work(struct iwl_priv *priv)
 {
        iwl_hw_cancel_deferred_work(priv);
 
+       cancel_delayed_work(&priv->update_led);
        cancel_delayed_work(&priv->scan_check);
        cancel_delayed_work(&priv->alive_start);
        cancel_delayed_work(&priv->post_associate);

@@ -8531,6 +8542,9 @@ static void iwl_pci_remove(struct pci_dev *pdev)
        iwl_clear_stations_table(priv);
 
        if (priv->mac80211_registered) {
+#ifdef CONFIG_IWLWIFI_LEDS
+               iwl_unregister_leds(priv);
+#endif
                ieee80211_unregister_hw(priv->hw);
                iwl_rate_control_unregister(priv->hw);
        }

drivers/net/wireless/iwlwifi/iwlwifi.h +3 -1

index e0b97c3..ce5d489 100644
@@ -55,6 +55,9 @@ extern struct pci_device_id iwl_hw_card_ids[];
 
 #include "iwl-prph.h"
 
+#ifdef CONFIG_IWLWIFI_LEDS
+#include "iwl-leds.h"
+#endif
 /*
  * Driver implementation data structures, constants, inline
  * functions
 
 
 
-------------------------------------------------------------------------

This SF.net email is sponsored by: Splunk Inc.
Still grepping through log files to find problems? Stop. Now Search log events and configuration files using AJAX and a browser. Download your FREE copy of Splunk now >> http://get.splunk.com/
_______________________________________________
Ipw3945-devel mailing list [email protected]
https://lists.sourceforge.net/lists/listinfo/ipw3945-devel

I'm not familiar with the led framework but as far as I see this is not how the LEDs work in iwl. You don't run it upon each packet just define blinking pattern with on off and period timers. It is too expensive to send the LED command for each packet.
Usually you would change the pattern pattern as the throughput changes.

Quoted 348 lines · Ian Schram

Here's my naive attempt to implement the mac80211_leds, since the addition of the associated led to wireless2.6 it works rather well for me. The patch below Is only for the 3945 but it should work for 4965 too afaik by just copy pasting the changes in iwl3945-bace.c to iwl4965-base.c. But I can't test that and this way the email is clearer.

I am aware of two problems
- when unloading the module it prints a few warnings to dmesg because a send command failing
- when loading/unloading the module a few times. it will no longer connect. reloading mac80211 module fixes this

I expect there to be problems with the locking
- it's basically this way it doesn't crash for me spinlocking what can be spinlocked

But anyways, if for no other reason than your viewing pleasure ;-)

Signed-of-by Ian Schram <[email protected]>

---

drivers/net/wireless/iwlwifi/Kconfig +6 -0

index 25cfc6c..8e8f835 100644
@@ -126,3 +126,9 @@ config IWL3945
          inserted in and remvoed from the running kernel whenever you want),
          say M here and read <file:Documentation/modules.txt>.  The module
          will be called iwl3945.ko.
+config IWLWIFI_LEDS
+       bool    "IWLWIFI leds"
+       depends IWLWIFI && MAC80211_LEDS
+       default y
+       ---help---
+       This options enables the wireless led.

drivers/net/wireless/iwlwifi/iwl-leds.h new file +20 -0

new file mode 100644
index 0000000..07a55f0
@@ -0,0 +1,20 @@
+#ifndef __iwl_leds_h__
+#define __iwl_leds_h__
+
+
+#include <linux/leds.h>
+
+
+#define IWL_LED_ACTIVITY       (0<<1)
+#define IWL_LED_LINK           (1<<1)
+#define IWL_LED_INTERVAL       __constant_cpu_to_le32(1000)
+#define IWL_LED_ACTIVITY_PERIOD msecs_to_jiffies(500)
+#define IWL_LED_MAX_NAME_LEN   31
+
+struct iwl_led {
+       char name[IWL_LED_MAX_NAME_LEN + 1];
+       struct led_classdev cdev;
+};
+
+
+#endif

drivers/net/wireless/iwlwifi/iwl-priv.h +9 -5

index 6b490d0..bdaeb80 100644
@@ -127,11 +128,14 @@ struct iwl_priv {
        struct iwl_init_alive_resp card_alive_init;
        struct iwl_alive_resp card_alive;
 
-#ifdef LED
-       /* LED related variables */
-       struct iwl_activity_blink activity;
-       unsigned long led_packets;
-       int led_state;
+
+#ifdef CONFIG_IWLWIFI_LEDS
+       u8 led_state;
+       unsigned int rxtxpackets;
+       atomic_t ledtimer;
+       struct iwl_led tx_led;
+       struct iwl_led rx_led;
+       struct iwl_led assoc_led;
 #endif
 
        u16 active_rate;

@@ -274,6 +278,7 @@ struct iwl_priv {
        struct delayed_work gather_stats;
        struct delayed_work scan_check;
        struct delayed_work post_associate;
+       struct delayed_work update_led;
 
 #define IWL_DEFAULT_TX_POWER 0x0F
        s8 user_txpower_limit;

drivers/net/wireless/iwlwifi/iwl3945-base.c +180 -1

index b601455..72317a3 100644
@@ -6065,6 +6065,171 @@ static void iwl_init_alive_start(struct iwl_priv *priv)
        queue_work(priv->workqueue, &priv->restart);
 }
 
+#ifdef CONFIG_IWLWIFI_LEDS
+static int iwl_led_cmd_callback(struct iwl_priv *priv,
+                               struct iwl_cmd *cmd, struct sk_buff *skb)
+{
+       return 1;
+}
+
+static void iwl_bg_led_update(struct work_struct *data)
+{
+       struct iwl_priv *priv =
+           container_of(data, struct iwl_priv, update_led.work);
+       struct iwl_led_cmd led_cmd = {
+               .id = IWL_LED_ACTIVITY,
+               .interval = IWL_LED_INTERVAL,
+       };
+       struct iwl_host_cmd cmd = {
+               .id = REPLY_LEDS_CMD,
+               .len = sizeof(struct iwl_led_cmd),
+               .data = &led_cmd,
+               .meta.flags = CMD_ASYNC,
+               .meta.u.callback = iwl_led_cmd_callback,
+       };
+       u8 on;
+       unsigned long flags;
+
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+
+       if (priv->rxtxpackets){
+               on = 1 + 250 / priv->rxtxpackets;
+               priv->rxtxpackets = 0;
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+
+               if (on == priv->led_state)
+                       goto exit_unlock;
+
+               led_cmd.on = led_cmd.off = on;
+               priv->led_state = on;
+
+       }
+       else {
+
+               atomic_set(&priv->ledtimer, 0);
+               led_cmd.on = led_cmd.off = 0;
+       }
+
+       spin_unlock_irqrestore(&priv->lock, flags);
+       iwl_send_cmd(priv, &cmd);
+
+       return;
+
+exit_unlock:
+       spin_unlock_irqrestore(&priv->lock, flags);
+}
+
+static void iwl_led_set_rx(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            rx_led.cdev);
+       unsigned long flags;
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+       if (!atomic_xchg(&priv->ledtimer, 1))
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+       priv->rxtxpackets++;
+       spin_unlock_irqrestore(&priv->lock, flags);
+
+}
+
+static void iwl_led_set_tx(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            tx_led.cdev);
+       unsigned long flags;
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+       if (!atomic_xchg(&priv->ledtimer, 1))
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+
+       priv->rxtxpackets++;
+       spin_unlock_irqrestore(&priv->lock, flags);
+}
+
+static void iwl_led_set_assoc(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            assoc_led.cdev);
+       struct iwl_led_cmd led_cmd = {
+               .id = IWL_LED_LINK,
+               .interval = IWL_LED_INTERVAL,
+       };
+       struct iwl_host_cmd cmd = {
+               .id = REPLY_LEDS_CMD,
+               .len = sizeof(struct iwl_led_cmd),
+               .data = &led_cmd,
+               .meta.flags = CMD_ASYNC,
+               .meta.u.callback = iwl_led_cmd_callback
+       };
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       switch(value)
+       {
+               case LED_OFF:
+                       led_cmd.off = 0;
+                       led_cmd.on = 0;
+                       break;
+               case LED_HALF:
+               case LED_FULL:
+                       led_cmd.off = 0;
+                       led_cmd.on = 40;
+       }
+       iwl_send_cmd(priv, &cmd);
+}
+
+
+static int iwl_register_led(struct iwl_priv *priv, struct iwl_led *led, char *ledname,
+                            char *triggername, void (*callback)
+                            (struct led_classdev *, enum led_brightness))
+{
+       snprintf(led->name, sizeof(led->name), ledname,
+                wiphy_name(priv->hw->wiphy));
+       led->cdev.name = led->name;
+       led->cdev.brightness_set = callback;
+       led->cdev.default_trigger = triggername;
+
+       return led_classdev_register(&priv->pci_dev->dev, &led->cdev);
+}
+
+static void iwl_register_leds(struct iwl_priv *priv)
+{
+       iwl_register_led(priv, &priv->tx_led, "iwl-%s:tx",
+                        ieee80211_get_tx_led_name(priv->hw),
+                        iwl_led_set_tx);
+       iwl_register_led(priv, &priv->rx_led, "iwl-%s:rx",
+                        ieee80211_get_rx_led_name(priv->hw),
+                        iwl_led_set_rx);
+       iwl_register_led(priv, &priv->assoc_led, "iwl-%s:asoc",
+                        ieee80211_get_assoc_led_name(priv->hw),
+                        iwl_led_set_assoc);
+}
+
+static void iwl_unregister_leds(struct iwl_priv *priv)
+{
+       led_classdev_unregister(&priv->tx_led.cdev);
+       led_classdev_unregister(&priv->rx_led.cdev);
+       led_classdev_unregister(&priv->assoc_led.cdev);
+}
+#endif
 
 /**
  * iwl_alive_start - called after REPLY_ALIVE notification received

@@ -6140,6 +6140,9 @@ static void iwl_alive_start(struct iwl_priv *priv)
        if (iwl_is_rfkill(priv))
                return;
 
+#ifdef CONFIG_IWLWIFI_LEDS
+       atomic_set(&priv->ledtimer, 0);
+#endif
        if (!priv->mac80211_registered) {
                /* Unlock so any user space entry points can call back into
                 * the driver without a deadlock... */

@@ -6158,6 +6161,9 @@ static void iwl_alive_start(struct iwl_priv *priv)
                priv->mac80211_registered = 1;
 
                iwl_reset_channel_flag(priv);
+#ifdef CONFIG_IWLWIFI_LEDS
+               iwl_register_leds(priv);
+#endif
        } else
                ieee80211_start_queues(priv->hw);
 

@@ -6217,6 +6223,10 @@ static void __iwl_down(struct iwl_priv *priv)
        if (!exit_pending)
                set_bit(STATUS_EXIT_PENDING, &priv->status);
 
+#ifdef CONFIG_IWLWIFI_LEDS
+       /* Prevent the led callbacks from rescheduling the update_led timer */
+       atomic_set(&priv->ledtimer, 1);
+#endif
        iwl_clear_stations_table(priv);
 
        /* Unblock any waiting calls */

@@ -8198,7 +8208,7 @@ static void iwl_setup_deferred_work(struct iwl_priv *priv)
        INIT_DELAYED_WORK(&priv->init_alive_start, iwl_bg_init_alive_start);
        INIT_DELAYED_WORK(&priv->alive_start, iwl_bg_alive_start);
        INIT_DELAYED_WORK(&priv->scan_check, iwl_bg_scan_check);
-
+       INIT_DELAYED_WORK(&priv->update_led, iwl_bg_led_update);
        iwl_hw_setup_deferred_work(priv);
 
        tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))

@@ -8209,6 +8219,7 @@ static void iwl_cancel_deferred_work(struct iwl_priv *priv)
 {
        iwl_hw_cancel_deferred_work(priv);
 
+       cancel_delayed_work(&priv->update_led);
        cancel_delayed_work(&priv->scan_check);
        cancel_delayed_work(&priv->alive_start);
        cancel_delayed_work(&priv->post_associate);

@@ -8531,6 +8542,9 @@ static void iwl_pci_remove(struct pci_dev *pdev)
        iwl_clear_stations_table(priv);
 
        if (priv->mac80211_registered) {
+#ifdef CONFIG_IWLWIFI_LEDS
+               iwl_unregister_leds(priv);
+#endif
                ieee80211_unregister_hw(priv->hw);
                iwl_rate_control_unregister(priv->hw);
        }

drivers/net/wireless/iwlwifi/iwlwifi.h +3 -1

index e0b97c3..ce5d489 100644
@@ -55,6 +55,9 @@ extern struct pci_device_id iwl_hw_card_ids[];
 
 #include "iwl-prph.h"
 
+#ifdef CONFIG_IWLWIFI_LEDS
+#include "iwl-leds.h"
+#endif
 /*
  * Driver implementation data structures, constants, inline
  * functions
 
 
 
-------------------------------------------------------------------------

This SF.net email is sponsored by: Splunk Inc.
Still grepping through log files to find problems? Stop. Now Search log events and configuration files using AJAX and a browser. Download your FREE copy of Splunk now >> http://get.splunk.com/
_______________________________________________
Ipw3945-devel mailing list [email protected]
https://lists.sourceforge.net/lists/listinfo/ipw3945-devel

Here's my naive attempt to implement the mac80211_leds, since the addition of the associated led to wireless2.6 it works rather well for me. The patch below Is only for the 3945 but it should work for 4965 too afaik by just copy pasting the changes in iwl3945-bace.c to iwl4965-base.c. But I can't test that and this way the email is clearer.

I am aware of two problems
- when unloading the module it prints a few warnings to dmesg because a send command failing
- when loading/unloading the module a few times. it will no longer connect. reloading mac80211 module fixes this

I expect there to be problems with the locking
- it's basically this way it doesn't crash for me spinlocking what can be spinlocked

But anyways, if for no other reason than your viewing pleasure ;-)

Signed-of-by Ian Schram <[email protected]>

---

drivers/net/wireless/iwlwifi/Kconfig +6 -0

index 25cfc6c..8e8f835 100644
@@ -126,3 +126,9 @@ config IWL3945
          inserted in and remvoed from the running kernel whenever you want),
          say M here and read <file:Documentation/modules.txt>.  The module
          will be called iwl3945.ko.
+config IWLWIFI_LEDS
+       bool    "IWLWIFI leds"
+       depends IWLWIFI && MAC80211_LEDS
+       default y
+       ---help---
+       This options enables the wireless led.

drivers/net/wireless/iwlwifi/iwl-leds.h new file +20 -0

new file mode 100644
index 0000000..07a55f0
@@ -0,0 +1,20 @@
+#ifndef __iwl_leds_h__
+#define __iwl_leds_h__
+
+
+#include <linux/leds.h>
+
+
+#define IWL_LED_ACTIVITY       (0<<1)
+#define IWL_LED_LINK           (1<<1)
+#define IWL_LED_INTERVAL       __constant_cpu_to_le32(1000)
+#define IWL_LED_ACTIVITY_PERIOD msecs_to_jiffies(500)
+#define IWL_LED_MAX_NAME_LEN   31
+
+struct iwl_led {
+       char name[IWL_LED_MAX_NAME_LEN + 1];
+       struct led_classdev cdev;
+};
+
+
+#endif

drivers/net/wireless/iwlwifi/iwl-priv.h +9 -5

index 6b490d0..bdaeb80 100644
@@ -127,11 +128,14 @@ struct iwl_priv {
        struct iwl_init_alive_resp card_alive_init;
        struct iwl_alive_resp card_alive;
 
-#ifdef LED
-       /* LED related variables */
-       struct iwl_activity_blink activity;
-       unsigned long led_packets;
-       int led_state;
+
+#ifdef CONFIG_IWLWIFI_LEDS
+       u8 led_state;
+       unsigned int rxtxpackets;
+       atomic_t ledtimer;
+       struct iwl_led tx_led;
+       struct iwl_led rx_led;
+       struct iwl_led assoc_led;
 #endif
 
        u16 active_rate;

@@ -274,6 +278,7 @@ struct iwl_priv {
        struct delayed_work gather_stats;
        struct delayed_work scan_check;
        struct delayed_work post_associate;
+       struct delayed_work update_led;
 
 #define IWL_DEFAULT_TX_POWER 0x0F
        s8 user_txpower_limit;

drivers/net/wireless/iwlwifi/iwl3945-base.c +180 -1

index b601455..72317a3 100644
@@ -6065,6 +6065,171 @@ static void iwl_init_alive_start(struct iwl_priv *priv)
        queue_work(priv->workqueue, &priv->restart);
 }
 
+#ifdef CONFIG_IWLWIFI_LEDS
+static int iwl_led_cmd_callback(struct iwl_priv *priv,
+                               struct iwl_cmd *cmd, struct sk_buff *skb)
+{
+       return 1;
+}
+
+static void iwl_bg_led_update(struct work_struct *data)
+{
+       struct iwl_priv *priv =
+           container_of(data, struct iwl_priv, update_led.work);
+       struct iwl_led_cmd led_cmd = {
+               .id = IWL_LED_ACTIVITY,
+               .interval = IWL_LED_INTERVAL,
+       };
+       struct iwl_host_cmd cmd = {
+               .id = REPLY_LEDS_CMD,
+               .len = sizeof(struct iwl_led_cmd),
+               .data = &led_cmd,
+               .meta.flags = CMD_ASYNC,
+               .meta.u.callback = iwl_led_cmd_callback,
+       };
+       u8 on;
+       unsigned long flags;
+
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+
+       if (priv->rxtxpackets){
+               on = 1 + 250 / priv->rxtxpackets;
+               priv->rxtxpackets = 0;
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+
+               if (on == priv->led_state)
+                       goto exit_unlock;
+
+               led_cmd.on = led_cmd.off = on;
+               priv->led_state = on;
+
+       }
+       else {
+
+               atomic_set(&priv->ledtimer, 0);
+               led_cmd.on = led_cmd.off = 0;
+       }
+
+       spin_unlock_irqrestore(&priv->lock, flags);
+       iwl_send_cmd(priv, &cmd);
+
+       return;
+
+exit_unlock:
+       spin_unlock_irqrestore(&priv->lock, flags);
+}
+
+static void iwl_led_set_rx(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            rx_led.cdev);
+       unsigned long flags;
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+       if (!atomic_xchg(&priv->ledtimer, 1))
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+       priv->rxtxpackets++;
+       spin_unlock_irqrestore(&priv->lock, flags);
+
+}
+
+static void iwl_led_set_tx(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            tx_led.cdev);
+       unsigned long flags;
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       spin_lock_irqsave(&priv->lock, flags);
+       if (!atomic_xchg(&priv->ledtimer, 1))
+               queue_delayed_work(priv->workqueue, &priv->update_led,
+                                  IWL_LED_ACTIVITY_PERIOD);
+
+       priv->rxtxpackets++;
+       spin_unlock_irqrestore(&priv->lock, flags);
+}
+
+static void iwl_led_set_assoc(struct led_classdev *led_cdev,
+                          enum led_brightness value)
+{
+       struct iwl_priv *priv = container_of(led_cdev, struct iwl_priv,
+                                            assoc_led.cdev);
+       struct iwl_led_cmd led_cmd = {
+               .id = IWL_LED_LINK,
+               .interval = IWL_LED_INTERVAL,
+       };
+       struct iwl_host_cmd cmd = {
+               .id = REPLY_LEDS_CMD,
+               .len = sizeof(struct iwl_led_cmd),
+               .data = &led_cmd,
+               .meta.flags = CMD_ASYNC,
+               .meta.u.callback = iwl_led_cmd_callback
+       };
+
+       if (test_bit(STATUS_EXIT_PENDING, &priv->status))
+               return;
+
+       switch(value)
+       {
+               case LED_OFF:
+                       led_cmd.off = 0;
+                       led_cmd.on = 0;
+                       break;
+               case LED_HALF:
+               case LED_FULL:
+                       led_cmd.off = 0;
+                       led_cmd.on = 40;
+       }
+       iwl_send_cmd(priv, &cmd);
+}
+
+
+static int iwl_register_led(struct iwl_priv *priv, struct iwl_led *led, char *ledname,
+                            char *triggername, void (*callback)
+                            (struct led_classdev *, enum led_brightness))
+{
+       snprintf(led->name, sizeof(led->name), ledname,
+                wiphy_name(priv->hw->wiphy));
+       led->cdev.name = led->name;
+       led->cdev.brightness_set = callback;
+       led->cdev.default_trigger = triggername;
+
+       return led_classdev_register(&priv->pci_dev->dev, &led->cdev);
+}
+
+static void iwl_register_leds(struct iwl_priv *priv)
+{
+       iwl_register_led(priv, &priv->tx_led, "iwl-%s:tx",
+                        ieee80211_get_tx_led_name(priv->hw),
+                        iwl_led_set_tx);
+       iwl_register_led(priv, &priv->rx_led, "iwl-%s:rx",
+                        ieee80211_get_rx_led_name(priv->hw),
+                        iwl_led_set_rx);
+       iwl_register_led(priv, &priv->assoc_led, "iwl-%s:asoc",
+                        ieee80211_get_assoc_led_name(priv->hw),
+                        iwl_led_set_assoc);
+}
+
+static void iwl_unregister_leds(struct iwl_priv *priv)
+{
+       led_classdev_unregister(&priv->tx_led.cdev);
+       led_classdev_unregister(&priv->rx_led.cdev);
+       led_classdev_unregister(&priv->assoc_led.cdev);
+}
+#endif
 
 /**
  * iwl_alive_start - called after REPLY_ALIVE notification received

@@ -6140,6 +6140,9 @@ static void iwl_alive_start(struct iwl_priv *priv)
        if (iwl_is_rfkill(priv))
                return;
 
+#ifdef CONFIG_IWLWIFI_LEDS
+       atomic_set(&priv->ledtimer, 0);
+#endif
        if (!priv->mac80211_registered) {
                /* Unlock so any user space entry points can call back into
                 * the driver without a deadlock... */

@@ -6158,6 +6161,9 @@ static void iwl_alive_start(struct iwl_priv *priv)
                priv->mac80211_registered = 1;
 
                iwl_reset_channel_flag(priv);
+#ifdef CONFIG_IWLWIFI_LEDS
+               iwl_register_leds(priv);
+#endif
        } else
                ieee80211_start_queues(priv->hw);
 

@@ -6217,6 +6223,10 @@ static void __iwl_down(struct iwl_priv *priv)
        if (!exit_pending)
                set_bit(STATUS_EXIT_PENDING, &priv->status);
 
+#ifdef CONFIG_IWLWIFI_LEDS
+       /* Prevent the led callbacks from rescheduling the update_led timer */
+       atomic_set(&priv->ledtimer, 1);
+#endif
        iwl_clear_stations_table(priv);
 
        /* Unblock any waiting calls */

@@ -8198,7 +8208,7 @@ static void iwl_setup_deferred_work(struct iwl_priv *priv)
        INIT_DELAYED_WORK(&priv->init_alive_start, iwl_bg_init_alive_start);
        INIT_DELAYED_WORK(&priv->alive_start, iwl_bg_alive_start);
        INIT_DELAYED_WORK(&priv->scan_check, iwl_bg_scan_check);
-
+       INIT_DELAYED_WORK(&priv->update_led, iwl_bg_led_update);
        iwl_hw_setup_deferred_work(priv);
 
        tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))

@@ -8209,6 +8219,7 @@ static void iwl_cancel_deferred_work(struct iwl_priv *priv)
 {
        iwl_hw_cancel_deferred_work(priv);
 
+       cancel_delayed_work(&priv->update_led);
        cancel_delayed_work(&priv->scan_check);
        cancel_delayed_work(&priv->alive_start);
        cancel_delayed_work(&priv->post_associate);

@@ -8531,6 +8542,9 @@ static void iwl_pci_remove(struct pci_dev *pdev)
        iwl_clear_stations_table(priv);
 
        if (priv->mac80211_registered) {
+#ifdef CONFIG_IWLWIFI_LEDS
+               iwl_unregister_leds(priv);
+#endif
                ieee80211_unregister_hw(priv->hw);
                iwl_rate_control_unregister(priv->hw);
        }

drivers/net/wireless/iwlwifi/iwlwifi.h +3 -1

index e0b97c3..ce5d489 100644
@@ -55,6 +55,9 @@ extern struct pci_device_id iwl_hw_card_ids[];
 
 #include "iwl-prph.h"
 
+#ifdef CONFIG_IWLWIFI_LEDS
+#include "iwl-leds.h"
+#endif
 /*
  * Driver implementation data structures, constants, inline
  * functions
 
 
 
-------------------------------------------------------------------------

This SF.net email is sponsored by: Splunk Inc.
Still grepping through log files to find problems? Stop. Now Search log events and configuration files using AJAX and a browser. Download your FREE copy of Splunk now >> http://get.splunk.com/
_______________________________________________
Ipw3945-devel mailing list [email protected]
https://lists.sourceforge.net/lists/listinfo/ipw3945-devel

Is this patch acceptable for everyone?
It would be nice to finally have the wireless led indicator working. If this patch is ok .. I'll put out a patch for the iwl4965 and test it. I think since a lot of the major functionality is now in the driver (great job guys!) it's about time to kill these small user

try to do it next week. But any test are always welcome!

Zhu Yi <yi.zhu@...> writes:
aven't have enough time to review this patch these days. Will

Quoted 1 line

try to do it next week. But any test are always welcome!

I would like to, is there a way to patch this into the git sources?

I am running 2.6.23 with latest iwlwifi git sources.

I patched the git sources and started compiling with -DCONFIG_IWLWIFI_LEDS=y but the compile boiled out with:
/src/wlan/iwlwifi/foo/compatible/iwl3945-base.c:6218: error: implicit declaration of function 'ieee80211_get_assoc_led_name'
(and some more warnings).

Is there anything I can do to test it?

Best wishes

Norbert

Quoted 1 line

I would like to, is there a way to patch this into the git sources?

the intellinuxwireless.org gits? to make it work it would require an update

of the mac80211 package, and compatibility with older kernels is probably pretty nasty.

the association led is only in the very latest git sources, i'm guessing only wireless-2.6 for now.

I'll try to send a patch a bit later today to fix a few of the outstanding issues.

Ok, so 2.6.23-mm1 should do the trick, am I right?

This is the second version of this patch with a few several bugfixes, please test this one instead. I also included a 4965 part to the patch

This is the second version of this patch with a few several bugfixes, please test this one instead. I also included a 4965 part to the patch