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 
p54_update_leds(struct work_struct * work)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 
p54_led_brightness_set(struct led_classdev * led_dev,enum led_brightness brightness)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 
p54_register_led(struct p54_common * priv,unsigned int led_index,char * name,const char * trigger)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 
p54_init_leds(struct p54_common * priv)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 
p54_unregister_leds(struct p54_common * priv)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 }
159