Merge branch 'upstream-fixes' into upstream
[linux-2.6] / drivers / net / wireless / bcm43xx / bcm43xx_sysfs.c
1 /*
2
3   Broadcom BCM43xx wireless driver
4
5   SYSFS support routines
6
7   Copyright (c) 2006 Michael Buesch <mbuesch@freenet.de>
8
9   This program is free software; you can redistribute it and/or modify
10   it under the terms of the GNU General Public License as published by
11   the Free Software Foundation; either version 2 of the License, or
12   (at your option) any later version.
13
14   This program is distributed in the hope that it will be useful,
15   but WITHOUT ANY WARRANTY; without even the implied warranty of
16   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17   GNU General Public License for more details.
18
19   You should have received a copy of the GNU General Public License
20   along with this program; see the file COPYING.  If not, write to
21   the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
22   Boston, MA 02110-1301, USA.
23
24 */
25
26 #include "bcm43xx_sysfs.h"
27 #include "bcm43xx.h"
28 #include "bcm43xx_main.h"
29 #include "bcm43xx_radio.h"
30
31 #include <linux/capability.h>
32
33
34 #define GENERIC_FILESIZE        64
35
36
37 static int get_integer(const char *buf, size_t count)
38 {
39         char tmp[10 + 1] = { 0 };
40         int ret = -EINVAL;
41
42         if (count == 0)
43                 goto out;
44         count = min(count, (size_t)10);
45         memcpy(tmp, buf, count);
46         ret = simple_strtol(tmp, NULL, 10);
47 out:
48         return ret;
49 }
50
51 static int get_boolean(const char *buf, size_t count)
52 {
53         if (count != 0) {
54                 if (buf[0] == '1')
55                         return 1;
56                 if (buf[0] == '0')
57                         return 0;
58                 if (count >= 4 && memcmp(buf, "true", 4) == 0)
59                         return 1;
60                 if (count >= 5 && memcmp(buf, "false", 5) == 0)
61                         return 0;
62                 if (count >= 3 && memcmp(buf, "yes", 3) == 0)
63                         return 1;
64                 if (count >= 2 && memcmp(buf, "no", 2) == 0)
65                         return 0;
66                 if (count >= 2 && memcmp(buf, "on", 2) == 0)
67                         return 1;
68                 if (count >= 3 && memcmp(buf, "off", 3) == 0)
69                         return 0;
70         }
71         return -EINVAL;
72 }
73
74 static int sprom2hex(const u16 *sprom, char *buf, size_t buf_len)
75 {
76         int i, pos = 0;
77
78         for (i = 0; i < BCM43xx_SPROM_SIZE; i++) {
79                 pos += snprintf(buf + pos, buf_len - pos - 1,
80                                 "%04X", swab16(sprom[i]) & 0xFFFF);
81         }
82         pos += snprintf(buf + pos, buf_len - pos - 1, "\n");
83
84         return pos + 1;
85 }
86
87 static int hex2sprom(u16 *sprom, const char *dump, size_t len)
88 {
89         char tmp[5] = { 0 };
90         int cnt = 0;
91         unsigned long parsed;
92
93         if (len < BCM43xx_SPROM_SIZE * sizeof(u16) * 2)
94                 return -EINVAL;
95
96         while (cnt < BCM43xx_SPROM_SIZE) {
97                 memcpy(tmp, dump, 4);
98                 dump += 4;
99                 parsed = simple_strtoul(tmp, NULL, 16);
100                 sprom[cnt++] = swab16((u16)parsed);
101         }
102
103         return 0;
104 }
105
106 static ssize_t bcm43xx_attr_sprom_show(struct device *dev,
107                                        struct device_attribute *attr,
108                                        char *buf)
109 {
110         struct bcm43xx_private *bcm = dev_to_bcm(dev);
111         u16 *sprom;
112         unsigned long flags;
113         int err;
114
115         if (!capable(CAP_NET_ADMIN))
116                 return -EPERM;
117
118         assert(BCM43xx_SPROM_SIZE * sizeof(u16) <= PAGE_SIZE);
119         sprom = kmalloc(BCM43xx_SPROM_SIZE * sizeof(*sprom),
120                         GFP_KERNEL);
121         if (!sprom)
122                 return -ENOMEM;
123         mutex_lock(&bcm->mutex);
124         spin_lock_irqsave(&bcm->irq_lock, flags);
125         err = bcm43xx_sprom_read(bcm, sprom);
126         if (!err)
127                 err = sprom2hex(sprom, buf, PAGE_SIZE);
128         mmiowb();
129         spin_unlock_irqrestore(&bcm->irq_lock, flags);
130         mutex_unlock(&bcm->mutex);
131         kfree(sprom);
132
133         return err;
134 }
135
136 static ssize_t bcm43xx_attr_sprom_store(struct device *dev,
137                                         struct device_attribute *attr,
138                                         const char *buf, size_t count)
139 {
140         struct bcm43xx_private *bcm = dev_to_bcm(dev);
141         u16 *sprom;
142         unsigned long flags;
143         int err;
144
145         if (!capable(CAP_NET_ADMIN))
146                 return -EPERM;
147
148         sprom = kmalloc(BCM43xx_SPROM_SIZE * sizeof(*sprom),
149                         GFP_KERNEL);
150         if (!sprom)
151                 return -ENOMEM;
152         err = hex2sprom(sprom, buf, count);
153         if (err)
154                 goto out_kfree;
155         mutex_lock(&bcm->mutex);
156         spin_lock_irqsave(&bcm->irq_lock, flags);
157         spin_lock(&bcm->leds_lock);
158         err = bcm43xx_sprom_write(bcm, sprom);
159         mmiowb();
160         spin_unlock(&bcm->leds_lock);
161         spin_unlock_irqrestore(&bcm->irq_lock, flags);
162         mutex_unlock(&bcm->mutex);
163 out_kfree:
164         kfree(sprom);
165
166         return err ? err : count;
167
168 }
169
170 static DEVICE_ATTR(sprom, 0600,
171                    bcm43xx_attr_sprom_show,
172                    bcm43xx_attr_sprom_store);
173
174 static ssize_t bcm43xx_attr_interfmode_show(struct device *dev,
175                                             struct device_attribute *attr,
176                                             char *buf)
177 {
178         struct bcm43xx_private *bcm = dev_to_bcm(dev);
179         int err;
180         ssize_t count = 0;
181
182         if (!capable(CAP_NET_ADMIN))
183                 return -EPERM;
184
185         mutex_lock(&bcm->mutex);
186
187         switch (bcm43xx_current_radio(bcm)->interfmode) {
188         case BCM43xx_RADIO_INTERFMODE_NONE:
189                 count = snprintf(buf, PAGE_SIZE, "0 (No Interference Mitigation)\n");
190                 break;
191         case BCM43xx_RADIO_INTERFMODE_NONWLAN:
192                 count = snprintf(buf, PAGE_SIZE, "1 (Non-WLAN Interference Mitigation)\n");
193                 break;
194         case BCM43xx_RADIO_INTERFMODE_MANUALWLAN:
195                 count = snprintf(buf, PAGE_SIZE, "2 (WLAN Interference Mitigation)\n");
196                 break;
197         default:
198                 assert(0);
199         }
200         err = 0;
201
202         mutex_unlock(&bcm->mutex);
203
204         return err ? err : count;
205
206 }
207
208 static ssize_t bcm43xx_attr_interfmode_store(struct device *dev,
209                                              struct device_attribute *attr,
210                                              const char *buf, size_t count)
211 {
212         struct bcm43xx_private *bcm = dev_to_bcm(dev);
213         unsigned long flags;
214         int err;
215         int mode;
216
217         if (!capable(CAP_NET_ADMIN))
218                 return -EPERM;
219
220         mode = get_integer(buf, count);
221         switch (mode) {
222         case 0:
223                 mode = BCM43xx_RADIO_INTERFMODE_NONE;
224                 break;
225         case 1:
226                 mode = BCM43xx_RADIO_INTERFMODE_NONWLAN;
227                 break;
228         case 2:
229                 mode = BCM43xx_RADIO_INTERFMODE_MANUALWLAN;
230                 break;
231         case 3:
232                 mode = BCM43xx_RADIO_INTERFMODE_AUTOWLAN;
233                 break;
234         default:
235                 return -EINVAL;
236         }
237
238         mutex_lock(&bcm->mutex);
239         spin_lock_irqsave(&bcm->irq_lock, flags);
240
241         err = bcm43xx_radio_set_interference_mitigation(bcm, mode);
242         if (err) {
243                 printk(KERN_ERR PFX "Interference Mitigation not "
244                                     "supported by device\n");
245         }
246         mmiowb();
247         spin_unlock_irqrestore(&bcm->irq_lock, flags);
248         mutex_unlock(&bcm->mutex);
249
250         return err ? err : count;
251 }
252
253 static DEVICE_ATTR(interference, 0644,
254                    bcm43xx_attr_interfmode_show,
255                    bcm43xx_attr_interfmode_store);
256
257 static ssize_t bcm43xx_attr_preamble_show(struct device *dev,
258                                           struct device_attribute *attr,
259                                           char *buf)
260 {
261         struct bcm43xx_private *bcm = dev_to_bcm(dev);
262         int err;
263         ssize_t count;
264
265         if (!capable(CAP_NET_ADMIN))
266                 return -EPERM;
267
268         mutex_lock(&bcm->mutex);
269
270         if (bcm->short_preamble)
271                 count = snprintf(buf, PAGE_SIZE, "1 (Short Preamble enabled)\n");
272         else
273                 count = snprintf(buf, PAGE_SIZE, "0 (Short Preamble disabled)\n");
274
275         err = 0;
276         mutex_unlock(&bcm->mutex);
277
278         return err ? err : count;
279 }
280
281 static ssize_t bcm43xx_attr_preamble_store(struct device *dev,
282                                            struct device_attribute *attr,
283                                            const char *buf, size_t count)
284 {
285         struct bcm43xx_private *bcm = dev_to_bcm(dev);
286         unsigned long flags;
287         int err;
288         int value;
289
290         if (!capable(CAP_NET_ADMIN))
291                 return -EPERM;
292
293         value = get_boolean(buf, count);
294         if (value < 0)
295                 return value;
296         mutex_lock(&bcm->mutex);
297         spin_lock_irqsave(&bcm->irq_lock, flags);
298
299         bcm->short_preamble = !!value;
300
301         err = 0;
302         spin_unlock_irqrestore(&bcm->irq_lock, flags);
303         mutex_unlock(&bcm->mutex);
304
305         return err ? err : count;
306 }
307
308 static DEVICE_ATTR(shortpreamble, 0644,
309                    bcm43xx_attr_preamble_show,
310                    bcm43xx_attr_preamble_store);
311
312 static ssize_t bcm43xx_attr_phymode_store(struct device *dev,
313                                           struct device_attribute *attr,
314                                           const char *buf, size_t count)
315 {
316         struct bcm43xx_private *bcm = dev_to_bcm(dev);
317         int phytype;
318         int err = -EINVAL;
319
320         if (count < 1)
321                 goto out;
322         switch (buf[0]) {
323         case 'a':  case 'A':
324                 phytype = BCM43xx_PHYTYPE_A;
325                 break;
326         case 'b':  case 'B':
327                 phytype = BCM43xx_PHYTYPE_B;
328                 break;
329         case 'g':  case 'G':
330                 phytype = BCM43xx_PHYTYPE_G;
331                 break;
332         default:
333                 goto out;
334         }
335
336         mutex_lock(&(bcm)->mutex);
337         err = bcm43xx_select_wireless_core(bcm, phytype);
338         mutex_unlock(&(bcm)->mutex);
339         if (err == -ESRCH)
340                 err = -ENODEV;
341
342 out:
343         return err ? err : count;
344 }
345
346 static ssize_t bcm43xx_attr_phymode_show(struct device *dev,
347                                          struct device_attribute *attr,
348                                          char *buf)
349 {
350         struct bcm43xx_private *bcm = dev_to_bcm(dev);
351         ssize_t count = 0;
352
353         mutex_lock(&(bcm)->mutex);
354         switch (bcm43xx_current_phy(bcm)->type) {
355         case BCM43xx_PHYTYPE_A:
356                 snprintf(buf, PAGE_SIZE, "A");
357                 break;
358         case BCM43xx_PHYTYPE_B:
359                 snprintf(buf, PAGE_SIZE, "B");
360                 break;
361         case BCM43xx_PHYTYPE_G:
362                 snprintf(buf, PAGE_SIZE, "G");
363                 break;
364         default:
365                 assert(0);
366         }
367         mutex_unlock(&(bcm)->mutex);
368
369         return count;
370 }
371
372 static DEVICE_ATTR(phymode, 0644,
373                    bcm43xx_attr_phymode_show,
374                    bcm43xx_attr_phymode_store);
375
376 int bcm43xx_sysfs_register(struct bcm43xx_private *bcm)
377 {
378         struct device *dev = &bcm->pci_dev->dev;
379         int err;
380
381         assert(bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED);
382
383         err = device_create_file(dev, &dev_attr_sprom);
384         if (err)
385                 goto out;
386         err = device_create_file(dev, &dev_attr_interference);
387         if (err)
388                 goto err_remove_sprom;
389         err = device_create_file(dev, &dev_attr_shortpreamble);
390         if (err)
391                 goto err_remove_interfmode;
392         err = device_create_file(dev, &dev_attr_phymode);
393         if (err)
394                 goto err_remove_shortpreamble;
395
396 out:
397         return err;
398 err_remove_shortpreamble:
399         device_remove_file(dev, &dev_attr_shortpreamble);
400 err_remove_interfmode:
401         device_remove_file(dev, &dev_attr_interference);
402 err_remove_sprom:
403         device_remove_file(dev, &dev_attr_sprom);
404         goto out;
405 }
406
407 void bcm43xx_sysfs_unregister(struct bcm43xx_private *bcm)
408 {
409         struct device *dev = &bcm->pci_dev->dev;
410
411         device_remove_file(dev, &dev_attr_phymode);
412         device_remove_file(dev, &dev_attr_shortpreamble);
413         device_remove_file(dev, &dev_attr_interference);
414         device_remove_file(dev, &dev_attr_sprom);
415 }