Merge branch 'upstream-linus' of master.kernel.org:/pub/scm/linux/kernel/git/jgarzik...
[linux-2.6] / drivers / net / wireless / bcm43xx / bcm43xx_leds.c
1 /*
2
3   Broadcom BCM43xx wireless driver
4
5   Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>,
6                      Stefano Brivio <st3@riseup.net>
7                      Michael Buesch <mbuesch@freenet.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 "bcm43xx_leds.h"
29 #include "bcm43xx.h"
30
31 #include <asm/bitops.h>
32
33
34 static void bcm43xx_led_changestate(struct bcm43xx_led *led)
35 {
36         struct bcm43xx_private *bcm = led->bcm;
37         const int index = bcm43xx_led_index(led);
38         const u16 mask = (1 << index);
39         u16 ledctl;
40
41         assert(index >= 0 && index < BCM43xx_NR_LEDS);
42         assert(led->blink_interval);
43         ledctl = bcm43xx_read16(bcm, BCM43xx_MMIO_GPIO_CONTROL);
44         ledctl = (ledctl & mask) ? (ledctl & ~mask) : (ledctl | mask);
45         bcm43xx_write16(bcm, BCM43xx_MMIO_GPIO_CONTROL, ledctl);
46 }
47
48 static void bcm43xx_led_blink(unsigned long d)
49 {
50         struct bcm43xx_led *led = (struct bcm43xx_led *)d;
51         struct bcm43xx_private *bcm = led->bcm;
52         unsigned long flags;
53
54         spin_lock_irqsave(&bcm->leds_lock, flags);
55         if (led->blink_interval) {
56                 bcm43xx_led_changestate(led);
57                 mod_timer(&led->blink_timer, jiffies + led->blink_interval);
58         }
59         spin_unlock_irqrestore(&bcm->leds_lock, flags);
60 }
61
62 static void bcm43xx_led_blink_start(struct bcm43xx_led *led,
63                                     unsigned long interval)
64 {
65         if (led->blink_interval)
66                 return;
67         led->blink_interval = interval;
68         bcm43xx_led_changestate(led);
69         led->blink_timer.expires = jiffies + interval;
70         add_timer(&led->blink_timer);
71 }
72
73 static void bcm43xx_led_blink_stop(struct bcm43xx_led *led, int sync)
74 {
75         struct bcm43xx_private *bcm = led->bcm;
76         const int index = bcm43xx_led_index(led);
77         u16 ledctl;
78
79         if (!led->blink_interval)
80                 return;
81         if (unlikely(sync))
82                 del_timer_sync(&led->blink_timer);
83         else
84                 del_timer(&led->blink_timer);
85         led->blink_interval = 0;
86
87         /* Make sure the LED is turned off. */
88         assert(index >= 0 && index < BCM43xx_NR_LEDS);
89         ledctl = bcm43xx_read16(bcm, BCM43xx_MMIO_GPIO_CONTROL);
90         if (led->activelow)
91                 ledctl |= (1 << index);
92         else
93                 ledctl &= ~(1 << index);
94         bcm43xx_write16(bcm, BCM43xx_MMIO_GPIO_CONTROL, ledctl);
95 }
96
97 static void bcm43xx_led_init_hardcoded(struct bcm43xx_private *bcm,
98                                        struct bcm43xx_led *led,
99                                        int led_index)
100 {
101         /* This function is called, if the behaviour (and activelow)
102          * information for a LED is missing in the SPROM.
103          * We hardcode the behaviour values for various devices here.
104          * Note that the BCM43xx_LED_TEST_XXX behaviour values can
105          * be used to figure out which led is mapped to which index.
106          */
107
108         switch (led_index) {
109         case 0:
110                 led->behaviour = BCM43xx_LED_ACTIVITY;
111                 if (bcm->board_vendor == PCI_VENDOR_ID_COMPAQ)
112                         led->behaviour = BCM43xx_LED_RADIO_ALL;
113                 break;
114         case 1:
115                 led->behaviour = BCM43xx_LED_RADIO_B;
116                 if (bcm->board_vendor == PCI_VENDOR_ID_ASUSTEK)
117                         led->behaviour = BCM43xx_LED_ASSOC;
118                 break;
119         case 2:
120                 led->behaviour = BCM43xx_LED_RADIO_A;
121                 break;
122         case 3:
123                 led->behaviour = BCM43xx_LED_OFF;
124                 break;
125         default:
126                 assert(0);
127         }
128 }
129
130 int bcm43xx_leds_init(struct bcm43xx_private *bcm)
131 {
132         struct bcm43xx_led *led;
133         u8 sprom[4];
134         int i;
135
136         sprom[0] = bcm->sprom.wl0gpio0;
137         sprom[1] = bcm->sprom.wl0gpio1;
138         sprom[2] = bcm->sprom.wl0gpio2;
139         sprom[3] = bcm->sprom.wl0gpio3;
140
141         for (i = 0; i < BCM43xx_NR_LEDS; i++) {
142                 led = &(bcm->leds[i]);
143                 led->bcm = bcm;
144                 setup_timer(&led->blink_timer,
145                             bcm43xx_led_blink,
146                             (unsigned long)led);
147
148                 if (sprom[i] == 0xFF) {
149                         bcm43xx_led_init_hardcoded(bcm, led, i);
150                 } else {
151                         led->behaviour = sprom[i] & BCM43xx_LED_BEHAVIOUR;
152                         led->activelow = !!(sprom[i] & BCM43xx_LED_ACTIVELOW);
153                 }
154         }
155
156         return 0;
157 }
158
159 void bcm43xx_leds_exit(struct bcm43xx_private *bcm)
160 {
161         struct bcm43xx_led *led;
162         int i;
163
164         for (i = 0; i < BCM43xx_NR_LEDS; i++) {
165                 led = &(bcm->leds[i]);
166                 bcm43xx_led_blink_stop(led, 1);
167         }
168         bcm43xx_leds_switch_all(bcm, 0);
169 }
170
171 void bcm43xx_leds_update(struct bcm43xx_private *bcm, int activity)
172 {
173         struct bcm43xx_led *led;
174         struct bcm43xx_radioinfo *radio = bcm43xx_current_radio(bcm);
175         struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
176         const int transferring = (jiffies - bcm->stats.last_tx) < BCM43xx_LED_XFER_THRES;
177         int i, turn_on;
178         unsigned long interval = 0;
179         u16 ledctl;
180         unsigned long flags;
181
182         spin_lock_irqsave(&bcm->leds_lock, flags);
183         ledctl = bcm43xx_read16(bcm, BCM43xx_MMIO_GPIO_CONTROL);
184         for (i = 0; i < BCM43xx_NR_LEDS; i++) {
185                 led = &(bcm->leds[i]);
186
187                 turn_on = 0;
188                 switch (led->behaviour) {
189                 case BCM43xx_LED_INACTIVE:
190                         continue;
191                 case BCM43xx_LED_OFF:
192                 case BCM43xx_LED_BCM4303_3:
193                         break;
194                 case BCM43xx_LED_ON:
195                         turn_on = 1;
196                         break;
197                 case BCM43xx_LED_ACTIVITY:
198                 case BCM43xx_LED_BCM4303_0:
199                         turn_on = activity;
200                         break;
201                 case BCM43xx_LED_RADIO_ALL:
202                         turn_on = radio->enabled;
203                         break;
204                 case BCM43xx_LED_RADIO_A:
205                 case BCM43xx_LED_BCM4303_2:
206                         turn_on = (radio->enabled && phy->type == BCM43xx_PHYTYPE_A);
207                         break;
208                 case BCM43xx_LED_RADIO_B:
209                 case BCM43xx_LED_BCM4303_1:
210                         turn_on = (radio->enabled &&
211                                    (phy->type == BCM43xx_PHYTYPE_B ||
212                                     phy->type == BCM43xx_PHYTYPE_G));
213                         break;
214                 case BCM43xx_LED_MODE_BG:
215                         if (phy->type == BCM43xx_PHYTYPE_G &&
216                             1/*FIXME: using G rates.*/)
217                                 turn_on = 1;
218                         break;
219                 case BCM43xx_LED_TRANSFER:
220                         if (transferring)
221                                 bcm43xx_led_blink_start(led, BCM43xx_LEDBLINK_MEDIUM);
222                         else
223                                 bcm43xx_led_blink_stop(led, 0);
224                         continue;
225                 case BCM43xx_LED_APTRANSFER:
226                         if (bcm->ieee->iw_mode == IW_MODE_MASTER) {
227                                 if (transferring) {
228                                         interval = BCM43xx_LEDBLINK_FAST;
229                                         turn_on = 1;
230                                 }
231                         } else {
232                                 turn_on = 1;
233                                 if (0/*TODO: not assoc*/)
234                                         interval = BCM43xx_LEDBLINK_SLOW;
235                                 else if (transferring)
236                                         interval = BCM43xx_LEDBLINK_FAST;
237                                 else
238                                         turn_on = 0;
239                         }
240                         if (turn_on)
241                                 bcm43xx_led_blink_start(led, interval);
242                         else
243                                 bcm43xx_led_blink_stop(led, 0);
244                         continue;
245                 case BCM43xx_LED_WEIRD:
246                         //TODO
247                         break;
248                 case BCM43xx_LED_ASSOC:
249                         if (bcm->softmac->associnfo.associated)
250                                 turn_on = 1;
251                         break;
252 #ifdef CONFIG_BCM43XX_DEBUG
253                 case BCM43xx_LED_TEST_BLINKSLOW:
254                         bcm43xx_led_blink_start(led, BCM43xx_LEDBLINK_SLOW);
255                         continue;
256                 case BCM43xx_LED_TEST_BLINKMEDIUM:
257                         bcm43xx_led_blink_start(led, BCM43xx_LEDBLINK_MEDIUM);
258                         continue;
259                 case BCM43xx_LED_TEST_BLINKFAST:
260                         bcm43xx_led_blink_start(led, BCM43xx_LEDBLINK_FAST);
261                         continue;
262 #endif /* CONFIG_BCM43XX_DEBUG */
263                 default:
264                         dprintkl(KERN_INFO PFX "Bad value in leds_update,"
265                                 " led->behaviour: 0x%x\n", led->behaviour);
266                 };
267
268                 if (led->activelow)
269                         turn_on = !turn_on;
270                 if (turn_on)
271                         ledctl |= (1 << i);
272                 else
273                         ledctl &= ~(1 << i);
274         }
275         bcm43xx_write16(bcm, BCM43xx_MMIO_GPIO_CONTROL, ledctl);
276         spin_unlock_irqrestore(&bcm->leds_lock, flags);
277 }
278
279 void bcm43xx_leds_switch_all(struct bcm43xx_private *bcm, int on)
280 {
281         struct bcm43xx_led *led;
282         u16 ledctl;
283         int i;
284         int bit_on;
285         unsigned long flags;
286
287         spin_lock_irqsave(&bcm->leds_lock, flags);
288         ledctl = bcm43xx_read16(bcm, BCM43xx_MMIO_GPIO_CONTROL);
289         for (i = 0; i < BCM43xx_NR_LEDS; i++) {
290                 led = &(bcm->leds[i]);
291                 if (led->behaviour == BCM43xx_LED_INACTIVE)
292                         continue;
293                 if (on)
294                         bit_on = led->activelow ? 0 : 1;
295                 else
296                         bit_on = led->activelow ? 1 : 0;
297                 if (bit_on)
298                         ledctl |= (1 << i);
299                 else
300                         ledctl &= ~(1 << i);
301         }
302         bcm43xx_write16(bcm, BCM43xx_MMIO_GPIO_CONTROL, ledctl);
303         spin_unlock_irqrestore(&bcm->leds_lock, flags);
304 }