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#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
43
44#include <linux/pci.h>
45#include "ath5k.h"
46
47#define ATH_SDEVICE(subv, subd) \
48 .vendor = PCI_ANY_ID, .device = PCI_ANY_ID, \
49 .subvendor = (subv), .subdevice = (subd)
50
51#define ATH_LED(pin, polarity) .driver_data = (((pin) << 8) | (polarity))
52#define ATH_PIN(data) ((data) >> 8)
53#define ATH_POLARITY(data) ((data) & 0xff)
54
55
56static const struct pci_device_id ath5k_led_devices[] = {
57
58 { PCI_VDEVICE(ATHEROS, PCI_DEVICE_ID_ATHEROS_AR5211), ATH_LED(0, 0) },
59
60 { ATH_SDEVICE(PCI_VENDOR_ID_COMPAQ, PCI_ANY_ID), ATH_LED(1, 1) },
61
62 { ATH_SDEVICE(PCI_VENDOR_ID_FOXCONN, 0xe008), ATH_LED(3, 0) },
63
64 { ATH_SDEVICE(PCI_VENDOR_ID_FOXCONN, 0xe00d), ATH_LED(3, 0) },
65
66 { ATH_SDEVICE(PCI_VENDOR_ID_AMBIT, 0x0422), ATH_LED(1, 1) },
67
68 { ATH_SDEVICE(PCI_VENDOR_ID_AMBIT, 0x0428), ATH_LED(3, 0) },
69
70 { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0100), ATH_LED(1, 0) },
71
72 { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0105), ATH_LED(3, 0) },
73
74 { ATH_SDEVICE(PCI_VENDOR_ID_AZWAVE, 0x1026), ATH_LED(3, 0) },
75
76 { ATH_SDEVICE(PCI_VENDOR_ID_IBM, 0x058a), ATH_LED(1, 0) },
77
78 { ATH_SDEVICE(PCI_VENDOR_ID_HP, 0x0137a), ATH_LED(3, 1) },
79
80 { ATH_SDEVICE(PCI_VENDOR_ID_HP, 0x0137b), ATH_LED(3, 0) },
81
82 { ATH_SDEVICE(PCI_VENDOR_ID_ATHEROS, 0x3067), ATH_LED(3, 0) },
83
84 { PCI_VDEVICE(ATHEROS, PCI_DEVICE_ID_ATHEROS_AR5212_IBM), ATH_LED(0, 0) },
85
86 { ATH_SDEVICE(PCI_VENDOR_ID_QMI, 0x0112), ATH_LED(3, 0) },
87 { }
88};
89
90void ath5k_led_enable(struct ath5k_hw *ah)
91{
92 if (IS_ENABLED(CONFIG_MAC80211_LEDS) &&
93 test_bit(ATH_STAT_LEDSOFT, ah->status)) {
94 ath5k_hw_set_gpio_output(ah, ah->led_pin);
95 ath5k_led_off(ah);
96 }
97}
98
99static void ath5k_led_on(struct ath5k_hw *ah)
100{
101 if (!test_bit(ATH_STAT_LEDSOFT, ah->status))
102 return;
103 ath5k_hw_set_gpio(ah, ah->led_pin, ah->led_on);
104}
105
106void ath5k_led_off(struct ath5k_hw *ah)
107{
108 if (!IS_ENABLED(CONFIG_MAC80211_LEDS) ||
109 !test_bit(ATH_STAT_LEDSOFT, ah->status))
110 return;
111 ath5k_hw_set_gpio(ah, ah->led_pin, !ah->led_on);
112}
113
114static void
115ath5k_led_brightness_set(struct led_classdev *led_dev,
116 enum led_brightness brightness)
117{
118 struct ath5k_led *led = container_of(led_dev, struct ath5k_led,
119 led_dev);
120
121 if (brightness == LED_OFF)
122 ath5k_led_off(led->ah);
123 else
124 ath5k_led_on(led->ah);
125}
126
127static int
128ath5k_register_led(struct ath5k_hw *ah, struct ath5k_led *led,
129 const char *name, const char *trigger)
130{
131 int err;
132
133 led->ah = ah;
134 strncpy(led->name, name, sizeof(led->name));
135 led->name[sizeof(led->name)-1] = 0;
136 led->led_dev.name = led->name;
137 led->led_dev.default_trigger = trigger;
138 led->led_dev.brightness_set = ath5k_led_brightness_set;
139
140 err = led_classdev_register(ah->dev, &led->led_dev);
141 if (err) {
142 ATH5K_WARN(ah, "could not register LED %s\n", name);
143 led->ah = NULL;
144 }
145 return err;
146}
147
148static void
149ath5k_unregister_led(struct ath5k_led *led)
150{
151 if (!IS_ENABLED(CONFIG_MAC80211_LEDS) || !led->ah)
152 return;
153 led_classdev_unregister(&led->led_dev);
154 ath5k_led_off(led->ah);
155 led->ah = NULL;
156}
157
158void ath5k_unregister_leds(struct ath5k_hw *ah)
159{
160 ath5k_unregister_led(&ah->rx_led);
161 ath5k_unregister_led(&ah->tx_led);
162}
163
164int ath5k_init_leds(struct ath5k_hw *ah)
165{
166 int ret = 0;
167 struct ieee80211_hw *hw = ah->hw;
168#ifndef CONFIG_ATH5K_AHB
169 struct pci_dev *pdev = ah->pdev;
170#endif
171 char name[ATH5K_LED_MAX_NAME_LEN + 1];
172 const struct pci_device_id *match;
173
174 if (!IS_ENABLED(CONFIG_MAC80211_LEDS) || !ah->pdev)
175 return 0;
176
177#ifdef CONFIG_ATH5K_AHB
178 match = NULL;
179#else
180 match = pci_match_id(&ath5k_led_devices[0], pdev);
181#endif
182 if (match) {
183 __set_bit(ATH_STAT_LEDSOFT, ah->status);
184 ah->led_pin = ATH_PIN(match->driver_data);
185 ah->led_on = ATH_POLARITY(match->driver_data);
186 }
187
188 if (!test_bit(ATH_STAT_LEDSOFT, ah->status))
189 goto out;
190
191 ath5k_led_enable(ah);
192
193 snprintf(name, sizeof(name), "ath5k-%s::rx", wiphy_name(hw->wiphy));
194 ret = ath5k_register_led(ah, &ah->rx_led, name,
195 ieee80211_get_rx_led_name(hw));
196 if (ret)
197 goto out;
198
199 snprintf(name, sizeof(name), "ath5k-%s::tx", wiphy_name(hw->wiphy));
200 ret = ath5k_register_led(ah, &ah->tx_led, name,
201 ieee80211_get_tx_led_name(hw));
202out:
203 return ret;
204}
205
206