Commit | Line | Data |
---|---|---|
75388acd LF |
1 | /* |
2 | ||
ba48f7bb LF |
3 | Broadcom B43 wireless driver |
4 | LED control | |
75388acd LF |
5 | |
6 | Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>, | |
1f21ad2a | 7 | Copyright (c) 2005 Stefano Brivio <stefano.brivio@polimi.it> |
eb032b98 | 8 | Copyright (c) 2005-2007 Michael Buesch <m@bues.ch> |
ba48f7bb LF |
9 | Copyright (c) 2005 Danny van Dyk <kugelfang@gentoo.org> |
10 | Copyright (c) 2005 Andreas Jaggi <andreas.jaggi@waterwave.ch> | |
75388acd LF |
11 | |
12 | This program is free software; you can redistribute it and/or modify | |
13 | it under the terms of the GNU General Public License as published by | |
14 | the Free Software Foundation; either version 2 of the License, or | |
15 | (at your option) any later version. | |
16 | ||
17 | This program is distributed in the hope that it will be useful, | |
18 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
19 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
20 | GNU General Public License for more details. | |
21 | ||
22 | You should have received a copy of the GNU General Public License | |
23 | along with this program; see the file COPYING. If not, write to | |
24 | the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor, | |
25 | Boston, MA 02110-1301, USA. | |
26 | ||
27 | */ | |
28 | ||
75388acd | 29 | #include "b43legacy.h" |
ba48f7bb | 30 | #include "leds.h" |
f41f3f37 | 31 | #include "rfkill.h" |
75388acd | 32 | |
75388acd | 33 | |
ba48f7bb LF |
34 | static void b43legacy_led_turn_on(struct b43legacy_wldev *dev, u8 led_index, |
35 | bool activelow) | |
75388acd | 36 | { |
ba48f7bb | 37 | struct b43legacy_wl *wl = dev->wl; |
75388acd | 38 | unsigned long flags; |
ba48f7bb | 39 | u16 ctl; |
75388acd | 40 | |
ba48f7bb LF |
41 | spin_lock_irqsave(&wl->leds_lock, flags); |
42 | ctl = b43legacy_read16(dev, B43legacy_MMIO_GPIO_CONTROL); | |
43 | if (activelow) | |
44 | ctl &= ~(1 << led_index); | |
45 | else | |
46 | ctl |= (1 << led_index); | |
47 | b43legacy_write16(dev, B43legacy_MMIO_GPIO_CONTROL, ctl); | |
48 | spin_unlock_irqrestore(&wl->leds_lock, flags); | |
75388acd LF |
49 | } |
50 | ||
ba48f7bb LF |
51 | static void b43legacy_led_turn_off(struct b43legacy_wldev *dev, u8 led_index, |
52 | bool activelow) | |
75388acd | 53 | { |
ba48f7bb LF |
54 | struct b43legacy_wl *wl = dev->wl; |
55 | unsigned long flags; | |
56 | u16 ctl; | |
57 | ||
58 | spin_lock_irqsave(&wl->leds_lock, flags); | |
59 | ctl = b43legacy_read16(dev, B43legacy_MMIO_GPIO_CONTROL); | |
60 | if (activelow) | |
61 | ctl |= (1 << led_index); | |
62 | else | |
63 | ctl &= ~(1 << led_index); | |
64 | b43legacy_write16(dev, B43legacy_MMIO_GPIO_CONTROL, ctl); | |
65 | spin_unlock_irqrestore(&wl->leds_lock, flags); | |
75388acd LF |
66 | } |
67 | ||
ba48f7bb LF |
68 | /* Callback from the LED subsystem. */ |
69 | static void b43legacy_led_brightness_set(struct led_classdev *led_dev, | |
70 | enum led_brightness brightness) | |
75388acd | 71 | { |
ba48f7bb LF |
72 | struct b43legacy_led *led = container_of(led_dev, struct b43legacy_led, |
73 | led_dev); | |
75388acd | 74 | struct b43legacy_wldev *dev = led->dev; |
ba48f7bb | 75 | bool radio_enabled; |
75388acd | 76 | |
ba48f7bb LF |
77 | /* Checking the radio-enabled status here is slightly racy, |
78 | * but we want to avoid the locking overhead and we don't care | |
79 | * whether the LED has the wrong state for a second. */ | |
80 | radio_enabled = (dev->phy.radio_on && dev->radio_hw_enable); | |
75388acd | 81 | |
ba48f7bb LF |
82 | if (brightness == LED_OFF || !radio_enabled) |
83 | b43legacy_led_turn_off(dev, led->index, led->activelow); | |
75388acd | 84 | else |
ba48f7bb | 85 | b43legacy_led_turn_on(dev, led->index, led->activelow); |
75388acd LF |
86 | } |
87 | ||
ba48f7bb LF |
88 | static int b43legacy_register_led(struct b43legacy_wldev *dev, |
89 | struct b43legacy_led *led, | |
19d337df JB |
90 | const char *name, |
91 | const char *default_trigger, | |
ba48f7bb | 92 | u8 led_index, bool activelow) |
75388acd | 93 | { |
ba48f7bb LF |
94 | int err; |
95 | ||
96 | b43legacy_led_turn_off(dev, led_index, activelow); | |
97 | if (led->dev) | |
98 | return -EEXIST; | |
99 | if (!default_trigger) | |
100 | return -EINVAL; | |
101 | led->dev = dev; | |
102 | led->index = led_index; | |
103 | led->activelow = activelow; | |
104 | strncpy(led->name, name, sizeof(led->name)); | |
105 | ||
106 | led->led_dev.name = led->name; | |
107 | led->led_dev.default_trigger = default_trigger; | |
108 | led->led_dev.brightness_set = b43legacy_led_brightness_set; | |
109 | ||
110 | err = led_classdev_register(dev->dev->dev, &led->led_dev); | |
111 | if (err) { | |
112 | b43legacywarn(dev->wl, "LEDs: Failed to register %s\n", name); | |
113 | led->dev = NULL; | |
114 | return err; | |
115 | } | |
116 | return 0; | |
117 | } | |
75388acd | 118 | |
ba48f7bb LF |
119 | static void b43legacy_unregister_led(struct b43legacy_led *led) |
120 | { | |
121 | if (!led->dev) | |
122 | return; | |
123 | led_classdev_unregister(&led->led_dev); | |
124 | b43legacy_led_turn_off(led->dev, led->index, led->activelow); | |
125 | led->dev = NULL; | |
126 | } | |
127 | ||
128 | static void b43legacy_map_led(struct b43legacy_wldev *dev, | |
129 | u8 led_index, | |
130 | enum b43legacy_led_behaviour behaviour, | |
131 | bool activelow) | |
132 | { | |
133 | struct ieee80211_hw *hw = dev->wl->hw; | |
134 | char name[B43legacy_LED_MAX_NAME_LEN + 1]; | |
75388acd | 135 | |
ba48f7bb LF |
136 | /* Map the b43 specific LED behaviour value to the |
137 | * generic LED triggers. */ | |
138 | switch (behaviour) { | |
139 | case B43legacy_LED_INACTIVE: | |
75388acd | 140 | break; |
ba48f7bb LF |
141 | case B43legacy_LED_OFF: |
142 | b43legacy_led_turn_off(dev, led_index, activelow); | |
75388acd | 143 | break; |
ba48f7bb LF |
144 | case B43legacy_LED_ON: |
145 | b43legacy_led_turn_on(dev, led_index, activelow); | |
75388acd | 146 | break; |
ba48f7bb LF |
147 | case B43legacy_LED_ACTIVITY: |
148 | case B43legacy_LED_TRANSFER: | |
149 | case B43legacy_LED_APTRANSFER: | |
150 | snprintf(name, sizeof(name), | |
b157b5e6 | 151 | "b43legacy-%s::tx", wiphy_name(hw->wiphy)); |
ba48f7bb LF |
152 | b43legacy_register_led(dev, &dev->led_tx, name, |
153 | ieee80211_get_tx_led_name(hw), | |
154 | led_index, activelow); | |
155 | snprintf(name, sizeof(name), | |
b157b5e6 | 156 | "b43legacy-%s::rx", wiphy_name(hw->wiphy)); |
ba48f7bb LF |
157 | b43legacy_register_led(dev, &dev->led_rx, name, |
158 | ieee80211_get_rx_led_name(hw), | |
159 | led_index, activelow); | |
160 | break; | |
ba48f7bb LF |
161 | case B43legacy_LED_RADIO_ALL: |
162 | case B43legacy_LED_RADIO_A: | |
163 | case B43legacy_LED_RADIO_B: | |
164 | case B43legacy_LED_MODE_BG: | |
93bb7f3a | 165 | snprintf(name, sizeof(name), |
b157b5e6 | 166 | "b43legacy-%s::radio", wiphy_name(hw->wiphy)); |
93bb7f3a | 167 | b43legacy_register_led(dev, &dev->led_radio, name, |
f41f3f37 | 168 | ieee80211_get_radio_led_name(hw), |
93bb7f3a | 169 | led_index, activelow); |
f41f3f37 JB |
170 | /* Sync the RF-kill LED state with radio and switch states. */ |
171 | if (dev->phy.radio_on && b43legacy_is_hw_radio_enabled(dev)) | |
4ad36d78 | 172 | b43legacy_led_turn_on(dev, led_index, activelow); |
93bb7f3a | 173 | break; |
ba48f7bb LF |
174 | case B43legacy_LED_WEIRD: |
175 | case B43legacy_LED_ASSOC: | |
176 | snprintf(name, sizeof(name), | |
b157b5e6 | 177 | "b43legacy-%s::assoc", wiphy_name(hw->wiphy)); |
ba48f7bb LF |
178 | b43legacy_register_led(dev, &dev->led_assoc, name, |
179 | ieee80211_get_assoc_led_name(hw), | |
180 | led_index, activelow); | |
75388acd LF |
181 | break; |
182 | default: | |
ba48f7bb LF |
183 | b43legacywarn(dev->wl, "LEDs: Unknown behaviour 0x%02X\n", |
184 | behaviour); | |
185 | break; | |
75388acd LF |
186 | } |
187 | } | |
188 | ||
ba48f7bb | 189 | void b43legacy_leds_init(struct b43legacy_wldev *dev) |
75388acd | 190 | { |
ba48f7bb | 191 | struct ssb_bus *bus = dev->dev->bus; |
75388acd LF |
192 | u8 sprom[4]; |
193 | int i; | |
ba48f7bb LF |
194 | enum b43legacy_led_behaviour behaviour; |
195 | bool activelow; | |
196 | ||
7797aa38 LF |
197 | sprom[0] = bus->sprom.gpio0; |
198 | sprom[1] = bus->sprom.gpio1; | |
199 | sprom[2] = bus->sprom.gpio2; | |
200 | sprom[3] = bus->sprom.gpio3; | |
ba48f7bb LF |
201 | |
202 | for (i = 0; i < 4; i++) { | |
203 | if (sprom[i] == 0xFF) { | |
204 | /* There is no LED information in the SPROM | |
205 | * for this LED. Hardcode it here. */ | |
206 | activelow = 0; | |
207 | switch (i) { | |
208 | case 0: | |
209 | behaviour = B43legacy_LED_ACTIVITY; | |
210 | activelow = 1; | |
211 | if (bus->boardinfo.vendor == PCI_VENDOR_ID_COMPAQ) | |
212 | behaviour = B43legacy_LED_RADIO_ALL; | |
213 | break; | |
214 | case 1: | |
215 | behaviour = B43legacy_LED_RADIO_B; | |
216 | if (bus->boardinfo.vendor == PCI_VENDOR_ID_ASUSTEK) | |
217 | behaviour = B43legacy_LED_ASSOC; | |
218 | break; | |
219 | case 2: | |
220 | behaviour = B43legacy_LED_RADIO_A; | |
221 | break; | |
222 | case 3: | |
223 | behaviour = B43legacy_LED_OFF; | |
224 | break; | |
225 | default: | |
226 | B43legacy_WARN_ON(1); | |
227 | return; | |
228 | } | |
229 | } else { | |
230 | behaviour = sprom[i] & B43legacy_LED_BEHAVIOUR; | |
231 | activelow = !!(sprom[i] & B43legacy_LED_ACTIVELOW); | |
75388acd | 232 | } |
ba48f7bb | 233 | b43legacy_map_led(dev, i, behaviour, activelow); |
75388acd | 234 | } |
75388acd LF |
235 | } |
236 | ||
237 | void b43legacy_leds_exit(struct b43legacy_wldev *dev) | |
238 | { | |
ba48f7bb LF |
239 | b43legacy_unregister_led(&dev->led_tx); |
240 | b43legacy_unregister_led(&dev->led_rx); | |
241 | b43legacy_unregister_led(&dev->led_assoc); | |
4ad36d78 | 242 | b43legacy_unregister_led(&dev->led_radio); |
75388acd | 243 | } |