drivers/net/wireless/intersil/p54/led.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Common code for mac80211 Prism54 drivers
   4  *
   5  * Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net>
   6  * Copyright (c) 2007-2009, Christian Lamparter <chunkeey@web.de>
   7  * Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
   8  *
   9  * Based on:
  10  * - the islsm (softmac prism54) driver, which is:
  11  *   Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al.
  12  * - stlc45xx driver
  13  *   Copyright (C) 2008 Nokia Corporation and/or its subsidiary(-ies).
  14  */
  15
  16 #include <linux/firmware.h>
  17 #include <linux/etherdevice.h>
  18
  19 #include <net/mac80211.h>
  20 #ifdef CONFIG_P54_LEDS
  21 #include <linux/leds.h>
  22 #endif /* CONFIG_P54_LEDS */
  23
  24 #include "p54.h"
  25 #include "lmac.h"
  26
  27 static void p54_update_leds(struct work_struct *work)
  28 {
  29         struct p54_common *priv = container_of(work, struct p54_common,
  30                                                led_work.work);
  31         int err, i, tmp, blink_delay = 400;
  32         bool rerun = false;
  33
  34         /* Don't toggle the LED, when the device is down. */
  35         if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
  36                 return ;
  37
  38         for (i = 0; i < ARRAY_SIZE(priv->leds); i++)
  39                 if (priv->leds[i].toggled) {
  40                         priv->softled_state |= BIT(i);
  41
  42                         tmp = 70 + 200 / (priv->leds[i].toggled);
  43                         if (tmp < blink_delay)
  44                                 blink_delay = tmp;
  45
  46                         if (priv->leds[i].led_dev.brightness == LED_OFF)
  47                                 rerun = true;
  48
  49                         priv->leds[i].toggled =
  50                                 !!priv->leds[i].led_dev.brightness;
  51                 } else
  52                         priv->softled_state &= ~BIT(i);
  53
  54         err = p54_set_leds(priv);
  55         if (err && net_ratelimit())
  56                 wiphy_err(priv->hw->wiphy,
  57                           "failed to update LEDs (%d).\n", err);
  58
  59         if (rerun)
  60                 ieee80211_queue_delayed_work(priv->hw, &priv->led_work,
  61                         msecs_to_jiffies(blink_delay));
  62 }
  63
  64 static void p54_led_brightness_set(struct led_classdev *led_dev,
  65                                    enum led_brightness brightness)
  66 {
  67         struct p54_led_dev *led = container_of(led_dev, struct p54_led_dev,
  68                                                led_dev);
  69         struct ieee80211_hw *dev = led->hw_dev;
  70         struct p54_common *priv = dev->priv;
  71
  72         if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
  73                 return ;
  74
  75         if ((brightness) && (led->registered)) {
  76                 led->toggled++;
  77                 ieee80211_queue_delayed_work(priv->hw, &priv->led_work, HZ/10);
  78         }
  79 }
  80
  81 static int p54_register_led(struct p54_common *priv,
  82                             unsigned int led_index,
  83                             char *name, const char *trigger)
  84 {
  85         struct p54_led_dev *led = &priv->leds[led_index];
  86         int err;
  87
  88         if (led->registered)
  89                 return -EEXIST;
  90
  91         snprintf(led->name, sizeof(led->name), "p54-%s::%s",
  92                  wiphy_name(priv->hw->wiphy), name);
  93         led->hw_dev = priv->hw;
  94         led->index = led_index;
  95         led->led_dev.name = led->name;
  96         led->led_dev.default_trigger = trigger;
  97         led->led_dev.brightness_set = p54_led_brightness_set;
  98
  99         err = led_classdev_register(wiphy_dev(priv->hw->wiphy), &led->led_dev);
 100         if (err)
 101                 wiphy_err(priv->hw->wiphy,
 102                           "Failed to register %s LED.\n", name);
 103         else
 104                 led->registered = 1;
 105
 106         return err;
 107 }
 108
 109 int p54_init_leds(struct p54_common *priv)
 110 {
 111         int err;
 112
 113         /*
 114          * TODO:
 115          * Figure out if the EEPROM contains some hints about the number
 116          * of available/programmable LEDs of the device.
 117          */
 118
 119         INIT_DELAYED_WORK(&priv->led_work, p54_update_leds);
 120
 121         err = p54_register_led(priv, 0, "assoc",
 122                                ieee80211_get_assoc_led_name(priv->hw));
 123         if (err)
 124                 return err;
 125
 126         err = p54_register_led(priv, 1, "tx",
 127                                ieee80211_get_tx_led_name(priv->hw));
 128         if (err)
 129                 return err;
 130
 131         err = p54_register_led(priv, 2, "rx",
 132                                ieee80211_get_rx_led_name(priv->hw));
 133         if (err)
 134                 return err;
 135
 136         err = p54_register_led(priv, 3, "radio",
 137                                ieee80211_get_radio_led_name(priv->hw));
 138         if (err)
 139                 return err;
 140
 141         err = p54_set_leds(priv);
 142         return err;
 143 }
 144
 145 void p54_unregister_leds(struct p54_common *priv)
 146 {
 147         int i;
 148
 149         for (i = 0; i < ARRAY_SIZE(priv->leds); i++) {
 150                 if (priv->leds[i].registered) {
 151                         priv->leds[i].registered = false;
 152                         priv->leds[i].toggled = 0;
 153                         led_classdev_unregister(&priv->leds[i].led_dev);
 154                 }
 155         }
 156
 157         cancel_delayed_work_sync(&priv->led_work);
 158 }