159 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Common code for mac80211 Prism54 drivers4 *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 driver13 * 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_LEDS21#include <linux/leds.h>22#endif /* CONFIG_P54_LEDS */23 24#include "p54.h"25#include "lmac.h"26 27static 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 } else52 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 64static 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 81static 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 else104 led->registered = 1;105 106 return err;107}108 109int 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 number116 * 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 145void 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}159