mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
158 lines
3.8 KiB
158 lines
3.8 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* Common code for mac80211 Prism54 drivers |
|
* |
|
* Copyright (c) 2006, Michael Wu <[email protected]> |
|
* Copyright (c) 2007-2009, Christian Lamparter <[email protected]> |
|
* Copyright 2008, Johannes Berg <[email protected]> |
|
* |
|
* Based on: |
|
* - the islsm (softmac prism54) driver, which is: |
|
* Copyright 2004-2006 Jean-Baptiste Note <[email protected]>, et al. |
|
* - stlc45xx driver |
|
* Copyright (C) 2008 Nokia Corporation and/or its subsidiary(-ies). |
|
*/ |
|
|
|
#include <linux/firmware.h> |
|
#include <linux/etherdevice.h> |
|
|
|
#include <net/mac80211.h> |
|
#ifdef CONFIG_P54_LEDS |
|
#include <linux/leds.h> |
|
#endif /* CONFIG_P54_LEDS */ |
|
|
|
#include "p54.h" |
|
#include "lmac.h" |
|
|
|
static void p54_update_leds(struct work_struct *work) |
|
{ |
|
struct p54_common *priv = container_of(work, struct p54_common, |
|
led_work.work); |
|
int err, i, tmp, blink_delay = 400; |
|
bool rerun = false; |
|
|
|
/* Don't toggle the LED, when the device is down. */ |
|
if (priv->mode == NL80211_IFTYPE_UNSPECIFIED) |
|
return ; |
|
|
|
for (i = 0; i < ARRAY_SIZE(priv->leds); i++) |
|
if (priv->leds[i].toggled) { |
|
priv->softled_state |= BIT(i); |
|
|
|
tmp = 70 + 200 / (priv->leds[i].toggled); |
|
if (tmp < blink_delay) |
|
blink_delay = tmp; |
|
|
|
if (priv->leds[i].led_dev.brightness == LED_OFF) |
|
rerun = true; |
|
|
|
priv->leds[i].toggled = |
|
!!priv->leds[i].led_dev.brightness; |
|
} else |
|
priv->softled_state &= ~BIT(i); |
|
|
|
err = p54_set_leds(priv); |
|
if (err && net_ratelimit()) |
|
wiphy_err(priv->hw->wiphy, |
|
"failed to update LEDs (%d).\n", err); |
|
|
|
if (rerun) |
|
ieee80211_queue_delayed_work(priv->hw, &priv->led_work, |
|
msecs_to_jiffies(blink_delay)); |
|
} |
|
|
|
static void p54_led_brightness_set(struct led_classdev *led_dev, |
|
enum led_brightness brightness) |
|
{ |
|
struct p54_led_dev *led = container_of(led_dev, struct p54_led_dev, |
|
led_dev); |
|
struct ieee80211_hw *dev = led->hw_dev; |
|
struct p54_common *priv = dev->priv; |
|
|
|
if (priv->mode == NL80211_IFTYPE_UNSPECIFIED) |
|
return ; |
|
|
|
if ((brightness) && (led->registered)) { |
|
led->toggled++; |
|
ieee80211_queue_delayed_work(priv->hw, &priv->led_work, HZ/10); |
|
} |
|
} |
|
|
|
static int p54_register_led(struct p54_common *priv, |
|
unsigned int led_index, |
|
char *name, const char *trigger) |
|
{ |
|
struct p54_led_dev *led = &priv->leds[led_index]; |
|
int err; |
|
|
|
if (led->registered) |
|
return -EEXIST; |
|
|
|
snprintf(led->name, sizeof(led->name), "p54-%s::%s", |
|
wiphy_name(priv->hw->wiphy), name); |
|
led->hw_dev = priv->hw; |
|
led->index = led_index; |
|
led->led_dev.name = led->name; |
|
led->led_dev.default_trigger = trigger; |
|
led->led_dev.brightness_set = p54_led_brightness_set; |
|
|
|
err = led_classdev_register(wiphy_dev(priv->hw->wiphy), &led->led_dev); |
|
if (err) |
|
wiphy_err(priv->hw->wiphy, |
|
"Failed to register %s LED.\n", name); |
|
else |
|
led->registered = 1; |
|
|
|
return err; |
|
} |
|
|
|
int p54_init_leds(struct p54_common *priv) |
|
{ |
|
int err; |
|
|
|
/* |
|
* TODO: |
|
* Figure out if the EEPROM contains some hints about the number |
|
* of available/programmable LEDs of the device. |
|
*/ |
|
|
|
INIT_DELAYED_WORK(&priv->led_work, p54_update_leds); |
|
|
|
err = p54_register_led(priv, 0, "assoc", |
|
ieee80211_get_assoc_led_name(priv->hw)); |
|
if (err) |
|
return err; |
|
|
|
err = p54_register_led(priv, 1, "tx", |
|
ieee80211_get_tx_led_name(priv->hw)); |
|
if (err) |
|
return err; |
|
|
|
err = p54_register_led(priv, 2, "rx", |
|
ieee80211_get_rx_led_name(priv->hw)); |
|
if (err) |
|
return err; |
|
|
|
err = p54_register_led(priv, 3, "radio", |
|
ieee80211_get_radio_led_name(priv->hw)); |
|
if (err) |
|
return err; |
|
|
|
err = p54_set_leds(priv); |
|
return err; |
|
} |
|
|
|
void p54_unregister_leds(struct p54_common *priv) |
|
{ |
|
int i; |
|
|
|
for (i = 0; i < ARRAY_SIZE(priv->leds); i++) { |
|
if (priv->leds[i].registered) { |
|
priv->leds[i].registered = false; |
|
priv->leds[i].toggled = 0; |
|
led_classdev_unregister(&priv->leds[i].led_dev); |
|
} |
|
} |
|
|
|
cancel_delayed_work_sync(&priv->led_work); |
|
}
|
|
|