Commit | Line | Data |
---|---|---|
e4d6b795 MB |
1 | /* |
2 | ||
3 | Broadcom B43 wireless driver | |
4 | ||
5 | Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>, | |
6 | Stefano Brivio <st3@riseup.net> | |
7 | Michael Buesch <mb@bu3sch.de> | |
8 | Danny van Dyk <kugelfang@gentoo.org> | |
9 | Andreas Jaggi <andreas.jaggi@waterwave.ch> | |
10 | ||
11 | This program is free software; you can redistribute it and/or modify | |
12 | it under the terms of the GNU General Public License as published by | |
13 | the Free Software Foundation; either version 2 of the License, or | |
14 | (at your option) any later version. | |
15 | ||
16 | This program is distributed in the hope that it will be useful, | |
17 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
18 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
19 | GNU General Public License for more details. | |
20 | ||
21 | You should have received a copy of the GNU General Public License | |
22 | along with this program; see the file COPYING. If not, write to | |
23 | the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor, | |
24 | Boston, MA 02110-1301, USA. | |
25 | ||
26 | */ | |
27 | ||
28 | #include "b43.h" | |
29 | #include "leds.h" | |
30 | #include "main.h" | |
31 | ||
32 | static void b43_led_changestate(struct b43_led *led) | |
33 | { | |
34 | struct b43_wldev *dev = led->dev; | |
1a09404a | 35 | const int index = led->index; |
e4d6b795 MB |
36 | u16 ledctl; |
37 | ||
38 | B43_WARN_ON(!(index >= 0 && index < B43_NR_LEDS)); | |
39 | B43_WARN_ON(!led->blink_interval); | |
40 | ledctl = b43_read16(dev, B43_MMIO_GPIO_CONTROL); | |
1a09404a | 41 | ledctl ^= (1 << index); |
e4d6b795 MB |
42 | b43_write16(dev, B43_MMIO_GPIO_CONTROL, ledctl); |
43 | } | |
44 | ||
45 | static void b43_led_blink(unsigned long d) | |
46 | { | |
47 | struct b43_led *led = (struct b43_led *)d; | |
48 | struct b43_wldev *dev = led->dev; | |
49 | unsigned long flags; | |
50 | ||
51 | spin_lock_irqsave(&dev->wl->leds_lock, flags); | |
52 | if (led->blink_interval) { | |
53 | b43_led_changestate(led); | |
54 | mod_timer(&led->blink_timer, jiffies + led->blink_interval); | |
55 | } | |
56 | spin_unlock_irqrestore(&dev->wl->leds_lock, flags); | |
57 | } | |
58 | ||
59 | static void b43_led_blink_start(struct b43_led *led, unsigned long interval) | |
60 | { | |
61 | if (led->blink_interval) | |
62 | return; | |
63 | led->blink_interval = interval; | |
64 | b43_led_changestate(led); | |
65 | led->blink_timer.expires = jiffies + interval; | |
66 | add_timer(&led->blink_timer); | |
67 | } | |
68 | ||
69 | static void b43_led_blink_stop(struct b43_led *led, int sync) | |
70 | { | |
71 | struct b43_wldev *dev = led->dev; | |
1a09404a | 72 | const int index = led->index; |
e4d6b795 MB |
73 | u16 ledctl; |
74 | ||
75 | if (!led->blink_interval) | |
76 | return; | |
77 | if (unlikely(sync)) | |
78 | del_timer_sync(&led->blink_timer); | |
79 | else | |
80 | del_timer(&led->blink_timer); | |
81 | led->blink_interval = 0; | |
82 | ||
83 | /* Make sure the LED is turned off. */ | |
84 | B43_WARN_ON(!(index >= 0 && index < B43_NR_LEDS)); | |
85 | ledctl = b43_read16(dev, B43_MMIO_GPIO_CONTROL); | |
86 | if (led->activelow) | |
87 | ledctl |= (1 << index); | |
88 | else | |
89 | ledctl &= ~(1 << index); | |
90 | b43_write16(dev, B43_MMIO_GPIO_CONTROL, ledctl); | |
91 | } | |
92 | ||
93 | static void b43_led_init_hardcoded(struct b43_wldev *dev, | |
94 | struct b43_led *led, int led_index) | |
95 | { | |
96 | struct ssb_bus *bus = dev->dev->bus; | |
97 | ||
98 | /* This function is called, if the behaviour (and activelow) | |
99 | * information for a LED is missing in the SPROM. | |
100 | * We hardcode the behaviour values for various devices here. | |
101 | * Note that the B43_LED_TEST_XXX behaviour values can | |
102 | * be used to figure out which led is mapped to which index. | |
103 | */ | |
104 | ||
105 | switch (led_index) { | |
106 | case 0: | |
107 | led->behaviour = B43_LED_ACTIVITY; | |
108 | led->activelow = 1; | |
109 | if (bus->boardinfo.vendor == PCI_VENDOR_ID_COMPAQ) | |
110 | led->behaviour = B43_LED_RADIO_ALL; | |
111 | break; | |
112 | case 1: | |
113 | led->behaviour = B43_LED_RADIO_B; | |
114 | if (bus->boardinfo.vendor == PCI_VENDOR_ID_ASUSTEK) | |
115 | led->behaviour = B43_LED_ASSOC; | |
116 | break; | |
117 | case 2: | |
118 | led->behaviour = B43_LED_RADIO_A; | |
119 | break; | |
120 | case 3: | |
121 | led->behaviour = B43_LED_OFF; | |
122 | break; | |
123 | default: | |
124 | B43_WARN_ON(1); | |
125 | } | |
126 | } | |
127 | ||
128 | int b43_leds_init(struct b43_wldev *dev) | |
129 | { | |
130 | struct b43_led *led; | |
131 | u8 sprom[4]; | |
132 | int i; | |
133 | ||
134 | sprom[0] = dev->dev->bus->sprom.r1.gpio0; | |
135 | sprom[1] = dev->dev->bus->sprom.r1.gpio1; | |
136 | sprom[2] = dev->dev->bus->sprom.r1.gpio2; | |
137 | sprom[3] = dev->dev->bus->sprom.r1.gpio3; | |
138 | ||
139 | for (i = 0; i < B43_NR_LEDS; i++) { | |
140 | led = &(dev->leds[i]); | |
1a09404a | 141 | led->index = i; |
e4d6b795 MB |
142 | led->dev = dev; |
143 | setup_timer(&led->blink_timer, | |
144 | b43_led_blink, (unsigned long)led); | |
145 | ||
146 | if (sprom[i] == 0xFF) { | |
147 | b43_led_init_hardcoded(dev, led, i); | |
148 | } else { | |
149 | led->behaviour = sprom[i] & B43_LED_BEHAVIOUR; | |
150 | led->activelow = !!(sprom[i] & B43_LED_ACTIVELOW); | |
151 | } | |
152 | } | |
153 | ||
154 | return 0; | |
155 | } | |
156 | ||
157 | void b43_leds_exit(struct b43_wldev *dev) | |
158 | { | |
159 | struct b43_led *led; | |
160 | int i; | |
161 | ||
162 | for (i = 0; i < B43_NR_LEDS; i++) { | |
163 | led = &(dev->leds[i]); | |
164 | b43_led_blink_stop(led, 1); | |
165 | } | |
166 | b43_leds_switch_all(dev, 0); | |
167 | } | |
168 | ||
169 | void b43_leds_update(struct b43_wldev *dev, int activity) | |
170 | { | |
171 | struct b43_led *led; | |
172 | struct b43_phy *phy = &dev->phy; | |
173 | const int transferring = | |
174 | (jiffies - dev->stats.last_tx) < B43_LED_XFER_THRES; | |
175 | int i, turn_on; | |
176 | unsigned long interval = 0; | |
177 | u16 ledctl; | |
178 | unsigned long flags; | |
05155c83 | 179 | bool radio_enabled = (phy->radio_on && dev->radio_hw_enable); |
e4d6b795 MB |
180 | |
181 | spin_lock_irqsave(&dev->wl->leds_lock, flags); | |
182 | ledctl = b43_read16(dev, B43_MMIO_GPIO_CONTROL); | |
183 | for (i = 0; i < B43_NR_LEDS; i++) { | |
184 | led = &(dev->leds[i]); | |
185 | ||
186 | turn_on = 0; | |
187 | switch (led->behaviour) { | |
188 | case B43_LED_INACTIVE: | |
189 | continue; | |
190 | case B43_LED_OFF: | |
191 | break; | |
192 | case B43_LED_ON: | |
193 | turn_on = 1; | |
194 | break; | |
195 | case B43_LED_ACTIVITY: | |
196 | turn_on = activity; | |
197 | break; | |
198 | case B43_LED_RADIO_ALL: | |
05155c83 | 199 | turn_on = radio_enabled; |
e4d6b795 MB |
200 | break; |
201 | case B43_LED_RADIO_A: | |
05155c83 | 202 | turn_on = (radio_enabled && phy->type == B43_PHYTYPE_A); |
e4d6b795 MB |
203 | break; |
204 | case B43_LED_RADIO_B: | |
05155c83 MB |
205 | turn_on = (radio_enabled && |
206 | (phy->type == B43_PHYTYPE_B | |
207 | || phy->type == B43_PHYTYPE_G)); | |
e4d6b795 MB |
208 | break; |
209 | case B43_LED_MODE_BG: | |
210 | if (phy->type == B43_PHYTYPE_G | |
05155c83 | 211 | && radio_enabled) |
e4d6b795 MB |
212 | turn_on = 1; |
213 | break; | |
214 | case B43_LED_TRANSFER: | |
215 | if (transferring) | |
216 | b43_led_blink_start(led, B43_LEDBLINK_MEDIUM); | |
217 | else | |
218 | b43_led_blink_stop(led, 0); | |
219 | continue; | |
220 | case B43_LED_APTRANSFER: | |
221 | if (b43_is_mode(dev->wl, IEEE80211_IF_TYPE_AP)) { | |
222 | if (transferring) { | |
223 | interval = B43_LEDBLINK_FAST; | |
224 | turn_on = 1; | |
225 | } | |
226 | } else { | |
227 | turn_on = 1; | |
228 | if (0 /*TODO: not assoc */ ) | |
229 | interval = B43_LEDBLINK_SLOW; | |
230 | else if (transferring) | |
231 | interval = B43_LEDBLINK_FAST; | |
232 | else | |
233 | turn_on = 0; | |
234 | } | |
235 | if (turn_on) | |
236 | b43_led_blink_start(led, interval); | |
237 | else | |
238 | b43_led_blink_stop(led, 0); | |
239 | continue; | |
240 | case B43_LED_WEIRD: | |
241 | //TODO | |
242 | break; | |
243 | case B43_LED_ASSOC: | |
244 | if (1 /*dev->softmac->associated */ ) | |
245 | turn_on = 1; | |
246 | break; | |
247 | #ifdef CONFIG_B43_DEBUG | |
248 | case B43_LED_TEST_BLINKSLOW: | |
249 | b43_led_blink_start(led, B43_LEDBLINK_SLOW); | |
250 | continue; | |
251 | case B43_LED_TEST_BLINKMEDIUM: | |
252 | b43_led_blink_start(led, B43_LEDBLINK_MEDIUM); | |
253 | continue; | |
254 | case B43_LED_TEST_BLINKFAST: | |
255 | b43_led_blink_start(led, B43_LEDBLINK_FAST); | |
256 | continue; | |
257 | #endif /* CONFIG_B43_DEBUG */ | |
258 | default: | |
259 | B43_WARN_ON(1); | |
260 | }; | |
261 | ||
262 | if (led->activelow) | |
263 | turn_on = !turn_on; | |
264 | if (turn_on) | |
265 | ledctl |= (1 << i); | |
266 | else | |
267 | ledctl &= ~(1 << i); | |
268 | } | |
269 | b43_write16(dev, B43_MMIO_GPIO_CONTROL, ledctl); | |
270 | spin_unlock_irqrestore(&dev->wl->leds_lock, flags); | |
271 | } | |
272 | ||
273 | void b43_leds_switch_all(struct b43_wldev *dev, int on) | |
274 | { | |
275 | struct b43_led *led; | |
276 | u16 ledctl; | |
277 | int i; | |
278 | int bit_on; | |
279 | unsigned long flags; | |
280 | ||
281 | spin_lock_irqsave(&dev->wl->leds_lock, flags); | |
282 | ledctl = b43_read16(dev, B43_MMIO_GPIO_CONTROL); | |
283 | for (i = 0; i < B43_NR_LEDS; i++) { | |
284 | led = &(dev->leds[i]); | |
285 | if (led->behaviour == B43_LED_INACTIVE) | |
286 | continue; | |
287 | if (on) | |
288 | bit_on = led->activelow ? 0 : 1; | |
289 | else | |
290 | bit_on = led->activelow ? 1 : 0; | |
291 | if (bit_on) | |
292 | ledctl |= (1 << i); | |
293 | else | |
294 | ledctl &= ~(1 << i); | |
295 | } | |
296 | b43_write16(dev, B43_MMIO_GPIO_CONTROL, ledctl); | |
297 | spin_unlock_irqrestore(&dev->wl->leds_lock, flags); | |
298 | } |