intersil/p54/led.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * Common code for mac80211 Prism54 drivers
0004  *
0005  * Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net>
0006  * Copyright (c) 2007-2009, Christian Lamparter <chunkeey@web.de>
0007  * Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
0008  *
0009  * Based on:
0010  * - the islsm (softmac prism54) driver, which is:
0011  *   Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al.
0012  * - stlc45xx driver
0013  *   Copyright (C) 2008 Nokia Corporation and/or its subsidiary(-ies).
0014  */
0015
0016 #include <linux/firmware.h>
0017 #include <linux/etherdevice.h>
0018
0019 #include <net/mac80211.h>
0020 #ifdef CONFIG_P54_LEDS
0021 #include <linux/leds.h>
0022 #endif /* CONFIG_P54_LEDS */
0023
0024 #include "p54.h"
0025 #include "lmac.h"
0026
0027 static void p54_update_leds(struct work_struct *work)
0028 {
0029     struct p54_common *priv = container_of(work, struct p54_common,
0030                            led_work.work);
0031     int err, i, tmp, blink_delay = 400;
0032     bool rerun = false;
0033
0034     /* Don't toggle the LED, when the device is down. */
0035     if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
0036         return ;
0037
0038     for (i = 0; i < ARRAY_SIZE(priv->leds); i++)
0039         if (priv->leds[i].toggled) {
0040             priv->softled_state |= BIT(i);
0041
0042             tmp = 70 + 200 / (priv->leds[i].toggled);
0043             if (tmp < blink_delay)
0044                 blink_delay = tmp;
0045
0046             if (priv->leds[i].led_dev.brightness == LED_OFF)
0047                 rerun = true;
0048
0049             priv->leds[i].toggled =
0050                 !!priv->leds[i].led_dev.brightness;
0051         } else
0052             priv->softled_state &= ~BIT(i);
0053
0054     err = p54_set_leds(priv);
0055     if (err && net_ratelimit())
0056         wiphy_err(priv->hw->wiphy,
0057               "failed to update LEDs (%d).\n", err);
0058
0059     if (rerun)
0060         ieee80211_queue_delayed_work(priv->hw, &priv->led_work,
0061             msecs_to_jiffies(blink_delay));
0062 }
0063
0064 static void p54_led_brightness_set(struct led_classdev *led_dev,
0065                    enum led_brightness brightness)
0066 {
0067     struct p54_led_dev *led = container_of(led_dev, struct p54_led_dev,
0068                            led_dev);
0069     struct ieee80211_hw *dev = led->hw_dev;
0070     struct p54_common *priv = dev->priv;
0071
0072     if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)
0073         return ;
0074
0075     if ((brightness) && (led->registered)) {
0076         led->toggled++;
0077         ieee80211_queue_delayed_work(priv->hw, &priv->led_work, HZ/10);
0078     }
0079 }
0080
0081 static int p54_register_led(struct p54_common *priv,
0082                 unsigned int led_index,
0083                 char *name, const char *trigger)
0084 {
0085     struct p54_led_dev *led = &priv->leds[led_index];
0086     int err;
0087
0088     if (led->registered)
0089         return -EEXIST;
0090
0091     snprintf(led->name, sizeof(led->name), "p54-%s::%s",
0092          wiphy_name(priv->hw->wiphy), name);
0093     led->hw_dev = priv->hw;
0094     led->index = led_index;
0095     led->led_dev.name = led->name;
0096     led->led_dev.default_trigger = trigger;
0097     led->led_dev.brightness_set = p54_led_brightness_set;
0098
0099     err = led_classdev_register(wiphy_dev(priv->hw->wiphy), &led->led_dev);
0100     if (err)
0101         wiphy_err(priv->hw->wiphy,
0102               "Failed to register %s LED.\n", name);
0103     else
0104         led->registered = 1;
0105
0106     return err;
0107 }
0108
0109 int p54_init_leds(struct p54_common *priv)
0110 {
0111     int err;
0112
0113     /*
0114      * TODO:
0115      * Figure out if the EEPROM contains some hints about the number
0116      * of available/programmable LEDs of the device.
0117      */
0118
0119     INIT_DELAYED_WORK(&priv->led_work, p54_update_leds);
0120
0121     err = p54_register_led(priv, 0, "assoc",
0122                    ieee80211_get_assoc_led_name(priv->hw));
0123     if (err)
0124         return err;
0125
0126     err = p54_register_led(priv, 1, "tx",
0127                    ieee80211_get_tx_led_name(priv->hw));
0128     if (err)
0129         return err;
0130
0131     err = p54_register_led(priv, 2, "rx",
0132                    ieee80211_get_rx_led_name(priv->hw));
0133     if (err)
0134         return err;
0135
0136     err = p54_register_led(priv, 3, "radio",
0137                    ieee80211_get_radio_led_name(priv->hw));
0138     if (err)
0139         return err;
0140
0141     err = p54_set_leds(priv);
0142     return err;
0143 }
0144
0145 void p54_unregister_leds(struct p54_common *priv)
0146 {
0147     int i;
0148
0149     for (i = 0; i < ARRAY_SIZE(priv->leds); i++) {
0150         if (priv->leds[i].registered) {
0151             priv->leds[i].registered = false;
0152             priv->leds[i].toggled = 0;
0153             led_classdev_unregister(&priv->leds[i].led_dev);
0154         }
0155     }
0156
0157     cancel_delayed_work_sync(&priv->led_work);
0158 }