aboutsummaryrefslogtreecommitdiffstats
path: root/package/mac80211/patches/531-ath9k_extra_platform_leds.patch
blob: c64c89a369953dc02b346dd170fc9db2eb7c42ef (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
--- a/include/linux/ath9k_platform.h
+++ b/include/linux/ath9k_platform.h
@@ -33,6 +33,9 @@ struct ath9k_platform_data {
 	bool is_clk_25mhz;
 	int (*get_mac_revision)(void);
 	int (*external_reset)(void);
+
+	int num_leds;
+	const struct gpio_led *leds;
 };
 
 #endif /* _LINUX_ATH9K_PLATFORM_H */
--- a/drivers/net/wireless/ath/ath9k/gpio.c
+++ b/drivers/net/wireless/ath/ath9k/gpio.c
@@ -14,6 +14,7 @@
  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  */
 
+#include <linux/ath9k_platform.h>
 #include "ath9k.h"
 
 /********************************/
@@ -88,6 +89,24 @@ int ath_create_gpio_led(struct ath_softc
 	return ret;
 }
 
+static int ath_create_platform_led(struct ath_softc *sc,
+				   const struct gpio_led *gpio)
+{
+	struct ath_led *led;
+	int ret;
+
+	led = kzalloc(sizeof(*led), GFP_KERNEL);
+	if (!led)
+		return -ENOMEM;
+
+	led->gpio = gpio;
+	ret = ath_add_led(sc, led);
+	if (ret < 0)
+		kfree(led);
+
+	return ret;
+}
+
 void ath_deinit_leds(struct ath_softc *sc)
 {
 	struct ath_led *led;
@@ -103,8 +122,10 @@ void ath_deinit_leds(struct ath_softc *s
 
 void ath_init_leds(struct ath_softc *sc)
 {
+	struct ath9k_platform_data *pdata = sc->dev->platform_data;
 	char led_name[32];
 	const char *trigger;
+	int i;
 
 	INIT_LIST_HEAD(&sc->leds);
 
@@ -120,6 +141,12 @@ void ath_init_leds(struct ath_softc *sc)
 		trigger = ieee80211_get_radio_led_name(sc->hw);
 
 	ath_create_gpio_led(sc, sc->sc_ah->led_pin, led_name, trigger, 1);
+
+	if (!pdata)
+		return;
+
+	for (i = 0; i < pdata->num_leds; i++)
+		ath_create_platform_led(sc, &pdata->leds[i]);
 }
 
 void ath_fill_led_pin(struct ath_softc *sc)