led.c

Go to the documentation of this file.

/*
 * 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).
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/init.h>
#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, 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);
}