[PATCH] mac80211: kill rate control ioctls
[linux-2.6] / net / mac80211 / ieee80211_ioctl.c
1 /*
2  * Copyright 2002-2005, Instant802 Networks, Inc.
3  * Copyright 2005-2006, Devicescape Software, Inc.
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License version 2 as
7  * published by the Free Software Foundation.
8  */
9
10 #include <linux/module.h>
11 #include <linux/init.h>
12 #include <linux/netdevice.h>
13 #include <linux/types.h>
14 #include <linux/slab.h>
15 #include <linux/skbuff.h>
16 #include <linux/etherdevice.h>
17 #include <linux/if_arp.h>
18 #include <linux/wireless.h>
19 #include <net/iw_handler.h>
20 #include <asm/uaccess.h>
21
22 #include <net/mac80211.h>
23 #include "ieee80211_i.h"
24 #include "hostapd_ioctl.h"
25 #include "ieee80211_rate.h"
26 #include "wpa.h"
27 #include "aes_ccm.h"
28 #include "debugfs_key.h"
29
30 static int ieee80211_regdom = 0x10; /* FCC */
31 module_param(ieee80211_regdom, int, 0444);
32 MODULE_PARM_DESC(ieee80211_regdom, "IEEE 802.11 regulatory domain; 64=MKK");
33
34 /*
35  * If firmware is upgraded by the vendor, additional channels can be used based
36  * on the new Japanese regulatory rules. This is indicated by setting
37  * ieee80211_japan_5ghz module parameter to one when loading the 80211 kernel
38  * module.
39  */
40 static int ieee80211_japan_5ghz /* = 0 */;
41 module_param(ieee80211_japan_5ghz, int, 0444);
42 MODULE_PARM_DESC(ieee80211_japan_5ghz, "Vendor-updated firmware for 5 GHz");
43
44 static void ieee80211_set_hw_encryption(struct net_device *dev,
45                                         struct sta_info *sta, u8 addr[ETH_ALEN],
46                                         struct ieee80211_key *key)
47 {
48         struct ieee80211_key_conf *keyconf = NULL;
49         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
50
51         /* default to sw encryption; this will be cleared by low-level
52          * driver if the hw supports requested encryption */
53         if (key)
54                 key->force_sw_encrypt = 1;
55
56         if (key && local->ops->set_key &&
57             (keyconf = ieee80211_key_data2conf(local, key))) {
58                 if (local->ops->set_key(local_to_hw(local), SET_KEY, addr,
59                                        keyconf, sta ? sta->aid : 0)) {
60                         key->force_sw_encrypt = 1;
61                         key->hw_key_idx = HW_KEY_IDX_INVALID;
62                 } else {
63                         key->force_sw_encrypt =
64                                 !!(keyconf->flags & IEEE80211_KEY_FORCE_SW_ENCRYPT);
65                         key->hw_key_idx =
66                                 keyconf->hw_key_idx;
67
68                 }
69         }
70         kfree(keyconf);
71 }
72
73
74 static int ieee80211_set_encryption(struct net_device *dev, u8 *sta_addr,
75                                     int idx, int alg, int set_tx_key,
76                                     const u8 *_key, size_t key_len)
77 {
78         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
79         int ret = 0;
80         struct sta_info *sta;
81         struct ieee80211_key *key, *old_key;
82         int try_hwaccel = 1;
83         struct ieee80211_key_conf *keyconf;
84         struct ieee80211_sub_if_data *sdata;
85
86         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
87
88         if (is_broadcast_ether_addr(sta_addr)) {
89                 sta = NULL;
90                 if (idx >= NUM_DEFAULT_KEYS) {
91                         printk(KERN_DEBUG "%s: set_encrypt - invalid idx=%d\n",
92                                dev->name, idx);
93                         return -EINVAL;
94                 }
95                 key = sdata->keys[idx];
96
97                 /* TODO: consider adding hwaccel support for these; at least
98                  * Atheros key cache should be able to handle this since AP is
99                  * only transmitting frames with default keys. */
100                 /* FIX: hw key cache can be used when only one virtual
101                  * STA is associated with each AP. If more than one STA
102                  * is associated to the same AP, software encryption
103                  * must be used. This should be done automatically
104                  * based on configured station devices. For the time
105                  * being, this can be only set at compile time. */
106         } else {
107                 set_tx_key = 0;
108                 if (idx != 0) {
109                         printk(KERN_DEBUG "%s: set_encrypt - non-zero idx for "
110                                "individual key\n", dev->name);
111                         return -EINVAL;
112                 }
113
114                 sta = sta_info_get(local, sta_addr);
115                 if (!sta) {
116 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
117                         printk(KERN_DEBUG "%s: set_encrypt - unknown addr "
118                                MAC_FMT "\n",
119                                dev->name, MAC_ARG(sta_addr));
120 #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
121
122                         return -ENOENT;
123                 }
124
125                 key = sta->key;
126         }
127
128         /* FIX:
129          * Cannot configure default hwaccel keys with WEP algorithm, if
130          * any of the virtual interfaces is using static WEP
131          * configuration because hwaccel would otherwise try to decrypt
132          * these frames.
133          *
134          * For now, just disable WEP hwaccel for broadcast when there is
135          * possibility of conflict with default keys. This can maybe later be
136          * optimized by using non-default keys (at least with Atheros ar521x).
137          */
138         if (!sta && alg == ALG_WEP && !local->default_wep_only &&
139             sdata->type != IEEE80211_IF_TYPE_IBSS &&
140             sdata->type != IEEE80211_IF_TYPE_AP) {
141                 try_hwaccel = 0;
142         }
143
144         if (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP) {
145                 /* Software encryption cannot be used with devices that hide
146                  * encryption from the host system, so always try to use
147                  * hardware acceleration with such devices. */
148                 try_hwaccel = 1;
149         }
150
151         if ((local->hw.flags & IEEE80211_HW_NO_TKIP_WMM_HWACCEL) &&
152             alg == ALG_TKIP) {
153                 if (sta && (sta->flags & WLAN_STA_WME)) {
154                 /* Hardware does not support hwaccel with TKIP when using WMM.
155                  */
156                         try_hwaccel = 0;
157                 }
158                 else if (sdata->type == IEEE80211_IF_TYPE_STA) {
159                         sta = sta_info_get(local, sdata->u.sta.bssid);
160                         if (sta) {
161                                 if (sta->flags & WLAN_STA_WME) {
162                                         try_hwaccel = 0;
163                                 }
164                                 sta_info_put(sta);
165                                 sta = NULL;
166                         }
167                 }
168         }
169
170         if (alg == ALG_NONE) {
171                 keyconf = NULL;
172                 if (try_hwaccel && key &&
173                     key->hw_key_idx != HW_KEY_IDX_INVALID &&
174                     local->ops->set_key &&
175                     (keyconf = ieee80211_key_data2conf(local, key)) != NULL &&
176                     local->ops->set_key(local_to_hw(local), DISABLE_KEY,
177                                        sta_addr, keyconf, sta ? sta->aid : 0)) {
178                         printk(KERN_DEBUG "%s: set_encrypt - low-level disable"
179                                " failed\n", dev->name);
180                         ret = -EINVAL;
181                 }
182                 kfree(keyconf);
183
184                 if (set_tx_key || sdata->default_key == key) {
185                         ieee80211_debugfs_key_remove_default(sdata);
186                         sdata->default_key = NULL;
187                 }
188                 ieee80211_debugfs_key_remove(key);
189                 if (sta)
190                         sta->key = NULL;
191                 else
192                         sdata->keys[idx] = NULL;
193                 ieee80211_key_free(key);
194                 key = NULL;
195         } else {
196                 old_key = key;
197                 key = ieee80211_key_alloc(sta ? NULL : sdata, idx, key_len,
198                                           GFP_KERNEL);
199                 if (!key) {
200                         ret = -ENOMEM;
201                         goto err_out;
202                 }
203
204                 /* default to sw encryption; low-level driver sets these if the
205                  * requested encryption is supported */
206                 key->hw_key_idx = HW_KEY_IDX_INVALID;
207                 key->force_sw_encrypt = 1;
208
209                 key->alg = alg;
210                 key->keyidx = idx;
211                 key->keylen = key_len;
212                 memcpy(key->key, _key, key_len);
213                 if (set_tx_key)
214                         key->default_tx_key = 1;
215
216                 if (alg == ALG_CCMP) {
217                         /* Initialize AES key state here as an optimization
218                          * so that it does not need to be initialized for every
219                          * packet. */
220                         key->u.ccmp.tfm = ieee80211_aes_key_setup_encrypt(
221                                 key->key);
222                         if (!key->u.ccmp.tfm) {
223                                 ret = -ENOMEM;
224                                 goto err_free;
225                         }
226                 }
227
228                 if (set_tx_key || sdata->default_key == old_key) {
229                         ieee80211_debugfs_key_remove_default(sdata);
230                         sdata->default_key = NULL;
231                 }
232                 ieee80211_debugfs_key_remove(old_key);
233                 if (sta)
234                         sta->key = key;
235                 else
236                         sdata->keys[idx] = key;
237                 ieee80211_key_free(old_key);
238                 ieee80211_debugfs_key_add(local, key);
239                 if (sta)
240                         ieee80211_debugfs_key_sta_link(key, sta);
241
242                 if (try_hwaccel &&
243                     (alg == ALG_WEP || alg == ALG_TKIP || alg == ALG_CCMP))
244                         ieee80211_set_hw_encryption(dev, sta, sta_addr, key);
245         }
246
247         if (set_tx_key || (!sta && !sdata->default_key && key)) {
248                 sdata->default_key = key;
249                 if (key)
250                         ieee80211_debugfs_key_add_default(sdata);
251
252                 if (local->ops->set_key_idx &&
253                     local->ops->set_key_idx(local_to_hw(local), idx))
254                         printk(KERN_DEBUG "%s: failed to set TX key idx for "
255                                "low-level driver\n", dev->name);
256         }
257
258         if (sta)
259                 sta_info_put(sta);
260
261         return 0;
262
263 err_free:
264         ieee80211_key_free(key);
265 err_out:
266         if (sta)
267                 sta_info_put(sta);
268         return ret;
269 }
270
271 static int ieee80211_ioctl_siwgenie(struct net_device *dev,
272                                     struct iw_request_info *info,
273                                     struct iw_point *data, char *extra)
274 {
275         struct ieee80211_sub_if_data *sdata;
276         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
277
278         if (local->user_space_mlme)
279                 return -EOPNOTSUPP;
280
281         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
282         if (sdata->type == IEEE80211_IF_TYPE_STA ||
283             sdata->type == IEEE80211_IF_TYPE_IBSS) {
284                 int ret = ieee80211_sta_set_extra_ie(dev, extra, data->length);
285                 if (ret)
286                         return ret;
287                 sdata->u.sta.auto_bssid_sel = 0;
288                 ieee80211_sta_req_auth(dev, &sdata->u.sta);
289                 return 0;
290         }
291
292         if (sdata->type == IEEE80211_IF_TYPE_AP) {
293                 kfree(sdata->u.ap.generic_elem);
294                 sdata->u.ap.generic_elem = kmalloc(data->length, GFP_KERNEL);
295                 if (!sdata->u.ap.generic_elem)
296                         return -ENOMEM;
297                 memcpy(sdata->u.ap.generic_elem, extra, data->length);
298                 sdata->u.ap.generic_elem_len = data->length;
299                 return ieee80211_if_config(dev);
300         }
301         return -EOPNOTSUPP;
302 }
303
304 static int ieee80211_ioctl_set_radio_enabled(struct net_device *dev,
305                                              int val)
306 {
307         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
308         struct ieee80211_conf *conf = &local->hw.conf;
309
310         conf->radio_enabled = val;
311         return ieee80211_hw_config(wdev_priv(dev->ieee80211_ptr));
312 }
313
314 static int ieee80211_ioctl_giwname(struct net_device *dev,
315                                    struct iw_request_info *info,
316                                    char *name, char *extra)
317 {
318         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
319
320         switch (local->hw.conf.phymode) {
321         case MODE_IEEE80211A:
322                 strcpy(name, "IEEE 802.11a");
323                 break;
324         case MODE_IEEE80211B:
325                 strcpy(name, "IEEE 802.11b");
326                 break;
327         case MODE_IEEE80211G:
328                 strcpy(name, "IEEE 802.11g");
329                 break;
330         case MODE_ATHEROS_TURBO:
331                 strcpy(name, "5GHz Turbo");
332                 break;
333         default:
334                 strcpy(name, "IEEE 802.11");
335                 break;
336         }
337
338         return 0;
339 }
340
341
342 static int ieee80211_ioctl_giwrange(struct net_device *dev,
343                                  struct iw_request_info *info,
344                                  struct iw_point *data, char *extra)
345 {
346         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
347         struct iw_range *range = (struct iw_range *) extra;
348         struct ieee80211_hw_mode *mode = NULL;
349         int c = 0;
350
351         data->length = sizeof(struct iw_range);
352         memset(range, 0, sizeof(struct iw_range));
353
354         range->we_version_compiled = WIRELESS_EXT;
355         range->we_version_source = 21;
356         range->retry_capa = IW_RETRY_LIMIT;
357         range->retry_flags = IW_RETRY_LIMIT;
358         range->min_retry = 0;
359         range->max_retry = 255;
360         range->min_rts = 0;
361         range->max_rts = 2347;
362         range->min_frag = 256;
363         range->max_frag = 2346;
364
365         range->encoding_size[0] = 5;
366         range->encoding_size[1] = 13;
367         range->num_encoding_sizes = 2;
368         range->max_encoding_tokens = NUM_DEFAULT_KEYS;
369
370         range->max_qual.qual = local->hw.max_signal;
371         range->max_qual.level = local->hw.max_rssi;
372         range->max_qual.noise = local->hw.max_noise;
373         range->max_qual.updated = local->wstats_flags;
374
375         range->avg_qual.qual = local->hw.max_signal/2;
376         range->avg_qual.level = 0;
377         range->avg_qual.noise = 0;
378         range->avg_qual.updated = local->wstats_flags;
379
380         range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
381                           IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
382
383         list_for_each_entry(mode, &local->modes_list, list) {
384                 int i = 0;
385
386                 if (!(local->enabled_modes & (1 << mode->mode)) ||
387                     (local->hw_modes & local->enabled_modes &
388                      (1 << MODE_IEEE80211G) && mode->mode == MODE_IEEE80211B))
389                         continue;
390
391                 while (i < mode->num_channels && c < IW_MAX_FREQUENCIES) {
392                         struct ieee80211_channel *chan = &mode->channels[i];
393
394                         if (chan->flag & IEEE80211_CHAN_W_SCAN) {
395                                 range->freq[c].i = chan->chan;
396                                 range->freq[c].m = chan->freq * 100000;
397                                 range->freq[c].e = 1;
398                                 c++;
399                         }
400                         i++;
401                 }
402         }
403         range->num_channels = c;
404         range->num_frequency = c;
405
406         IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
407         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWTHRSPY);
408         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
409         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
410
411         return 0;
412 }
413
414
415 struct ieee80211_channel_range {
416         short start_freq;
417         short end_freq;
418         unsigned char power_level;
419         unsigned char antenna_max;
420 };
421
422 static const struct ieee80211_channel_range ieee80211_fcc_channels[] = {
423         { 2412, 2462, 27, 6 } /* IEEE 802.11b/g, channels 1..11 */,
424         { 5180, 5240, 17, 6 } /* IEEE 802.11a, channels 36..48 */,
425         { 5260, 5320, 23, 6 } /* IEEE 802.11a, channels 52..64 */,
426         { 5745, 5825, 30, 6 } /* IEEE 802.11a, channels 149..165, outdoor */,
427         { 0 }
428 };
429
430 static const struct ieee80211_channel_range ieee80211_mkk_channels[] = {
431         { 2412, 2472, 20, 6 } /* IEEE 802.11b/g, channels 1..13 */,
432         { 5170, 5240, 20, 6 } /* IEEE 802.11a, channels 34..48 */,
433         { 5260, 5320, 20, 6 } /* IEEE 802.11a, channels 52..64 */,
434         { 0 }
435 };
436
437
438 static const struct ieee80211_channel_range *channel_range =
439         ieee80211_fcc_channels;
440
441
442 static void ieee80211_unmask_channel(struct net_device *dev, int mode,
443                                      struct ieee80211_channel *chan)
444 {
445         int i;
446
447         chan->flag = 0;
448
449         if (ieee80211_regdom == 64 &&
450             (mode == MODE_ATHEROS_TURBO || mode == MODE_ATHEROS_TURBOG)) {
451                 /* Do not allow Turbo modes in Japan. */
452                 return;
453         }
454
455         for (i = 0; channel_range[i].start_freq; i++) {
456                 const struct ieee80211_channel_range *r = &channel_range[i];
457                 if (r->start_freq <= chan->freq && r->end_freq >= chan->freq) {
458                         if (ieee80211_regdom == 64 && !ieee80211_japan_5ghz &&
459                             chan->freq >= 5260 && chan->freq <= 5320) {
460                                 /*
461                                  * Skip new channels in Japan since the
462                                  * firmware was not marked having been upgraded
463                                  * by the vendor.
464                                  */
465                                 continue;
466                         }
467
468                         if (ieee80211_regdom == 0x10 &&
469                             (chan->freq == 5190 || chan->freq == 5210 ||
470                              chan->freq == 5230)) {
471                                     /* Skip MKK channels when in FCC domain. */
472                                     continue;
473                         }
474
475                         chan->flag |= IEEE80211_CHAN_W_SCAN |
476                                 IEEE80211_CHAN_W_ACTIVE_SCAN |
477                                 IEEE80211_CHAN_W_IBSS;
478                         chan->power_level = r->power_level;
479                         chan->antenna_max = r->antenna_max;
480
481                         if (ieee80211_regdom == 64 &&
482                             (chan->freq == 5170 || chan->freq == 5190 ||
483                              chan->freq == 5210 || chan->freq == 5230)) {
484                                 /*
485                                  * New regulatory rules in Japan have backwards
486                                  * compatibility with old channels in 5.15-5.25
487                                  * GHz band, but the station is not allowed to
488                                  * use active scan on these old channels.
489                                  */
490                                 chan->flag &= ~IEEE80211_CHAN_W_ACTIVE_SCAN;
491                         }
492
493                         if (ieee80211_regdom == 64 &&
494                             (chan->freq == 5260 || chan->freq == 5280 ||
495                              chan->freq == 5300 || chan->freq == 5320)) {
496                                 /*
497                                  * IBSS is not allowed on 5.25-5.35 GHz band
498                                  * due to radar detection requirements.
499                                  */
500                                 chan->flag &= ~IEEE80211_CHAN_W_IBSS;
501                         }
502
503                         break;
504                 }
505         }
506 }
507
508
509 static int ieee80211_unmask_channels(struct net_device *dev)
510 {
511         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
512         struct ieee80211_hw_mode *mode;
513         int c;
514
515         list_for_each_entry(mode, &local->modes_list, list) {
516                 for (c = 0; c < mode->num_channels; c++) {
517                         ieee80211_unmask_channel(dev, mode->mode,
518                                                  &mode->channels[c]);
519                 }
520         }
521         return 0;
522 }
523
524
525 int ieee80211_init_client(struct net_device *dev)
526 {
527         if (ieee80211_regdom == 0x40)
528                 channel_range = ieee80211_mkk_channels;
529         ieee80211_unmask_channels(dev);
530         return 0;
531 }
532
533
534 static int ieee80211_ioctl_siwmode(struct net_device *dev,
535                                    struct iw_request_info *info,
536                                    __u32 *mode, char *extra)
537 {
538         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
539         int type;
540
541         if (sdata->type == IEEE80211_IF_TYPE_VLAN)
542                 return -EOPNOTSUPP;
543
544         switch (*mode) {
545         case IW_MODE_INFRA:
546                 type = IEEE80211_IF_TYPE_STA;
547                 break;
548         case IW_MODE_ADHOC:
549                 type = IEEE80211_IF_TYPE_IBSS;
550                 break;
551         case IW_MODE_MONITOR:
552                 type = IEEE80211_IF_TYPE_MNTR;
553                 break;
554         default:
555                 return -EINVAL;
556         }
557
558         if (type == sdata->type)
559                 return 0;
560         if (netif_running(dev))
561                 return -EBUSY;
562
563         ieee80211_if_reinit(dev);
564         ieee80211_if_set_type(dev, type);
565
566         return 0;
567 }
568
569
570 static int ieee80211_ioctl_giwmode(struct net_device *dev,
571                                    struct iw_request_info *info,
572                                    __u32 *mode, char *extra)
573 {
574         struct ieee80211_sub_if_data *sdata;
575
576         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
577         switch (sdata->type) {
578         case IEEE80211_IF_TYPE_AP:
579                 *mode = IW_MODE_MASTER;
580                 break;
581         case IEEE80211_IF_TYPE_STA:
582                 *mode = IW_MODE_INFRA;
583                 break;
584         case IEEE80211_IF_TYPE_IBSS:
585                 *mode = IW_MODE_ADHOC;
586                 break;
587         case IEEE80211_IF_TYPE_MNTR:
588                 *mode = IW_MODE_MONITOR;
589                 break;
590         case IEEE80211_IF_TYPE_WDS:
591                 *mode = IW_MODE_REPEAT;
592                 break;
593         case IEEE80211_IF_TYPE_VLAN:
594                 *mode = IW_MODE_SECOND;         /* FIXME */
595                 break;
596         default:
597                 *mode = IW_MODE_AUTO;
598                 break;
599         }
600         return 0;
601 }
602
603 int ieee80211_set_channel(struct ieee80211_local *local, int channel, int freq)
604 {
605         struct ieee80211_hw_mode *mode;
606         int c, set = 0;
607         int ret = -EINVAL;
608
609         list_for_each_entry(mode, &local->modes_list, list) {
610                 if (!(local->enabled_modes & (1 << mode->mode)))
611                         continue;
612                 for (c = 0; c < mode->num_channels; c++) {
613                         struct ieee80211_channel *chan = &mode->channels[c];
614                         if (chan->flag & IEEE80211_CHAN_W_SCAN &&
615                             ((chan->chan == channel) || (chan->freq == freq))) {
616                                 /* Use next_mode as the mode preference to
617                                  * resolve non-unique channel numbers. */
618                                 if (set && mode->mode != local->next_mode)
619                                         continue;
620
621                                 local->oper_channel = chan;
622                                 local->oper_hw_mode = mode;
623                                 set++;
624                         }
625                 }
626         }
627
628         if (set) {
629                 if (local->sta_scanning)
630                         ret = 0;
631                 else
632                         ret = ieee80211_hw_config(local);
633
634                 rate_control_clear(local);
635         }
636
637         return ret;
638 }
639
640 static int ieee80211_ioctl_siwfreq(struct net_device *dev,
641                                    struct iw_request_info *info,
642                                    struct iw_freq *freq, char *extra)
643 {
644         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
645         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
646
647         if (sdata->type == IEEE80211_IF_TYPE_STA)
648                 sdata->u.sta.auto_channel_sel = 0;
649
650         /* freq->e == 0: freq->m = channel; otherwise freq = m * 10^e */
651         if (freq->e == 0) {
652                 if (freq->m < 0) {
653                         if (sdata->type == IEEE80211_IF_TYPE_STA)
654                                 sdata->u.sta.auto_channel_sel = 1;
655                         return 0;
656                 } else
657                         return ieee80211_set_channel(local, freq->m, -1);
658         } else {
659                 int i, div = 1000000;
660                 for (i = 0; i < freq->e; i++)
661                         div /= 10;
662                 if (div > 0)
663                         return ieee80211_set_channel(local, -1, freq->m / div);
664                 else
665                         return -EINVAL;
666         }
667 }
668
669
670 static int ieee80211_ioctl_giwfreq(struct net_device *dev,
671                                    struct iw_request_info *info,
672                                    struct iw_freq *freq, char *extra)
673 {
674         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
675
676         /* TODO: in station mode (Managed/Ad-hoc) might need to poll low-level
677          * driver for the current channel with firmware-based management */
678
679         freq->m = local->hw.conf.freq;
680         freq->e = 6;
681
682         return 0;
683 }
684
685
686 static int ieee80211_ioctl_siwessid(struct net_device *dev,
687                                     struct iw_request_info *info,
688                                     struct iw_point *data, char *ssid)
689 {
690         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
691         struct ieee80211_sub_if_data *sdata;
692         size_t len = data->length;
693
694         /* iwconfig uses nul termination in SSID.. */
695         if (len > 0 && ssid[len - 1] == '\0')
696                 len--;
697
698         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
699         if (sdata->type == IEEE80211_IF_TYPE_STA ||
700             sdata->type == IEEE80211_IF_TYPE_IBSS) {
701                 int ret;
702                 if (local->user_space_mlme) {
703                         if (len > IEEE80211_MAX_SSID_LEN)
704                                 return -EINVAL;
705                         memcpy(sdata->u.sta.ssid, ssid, len);
706                         sdata->u.sta.ssid_len = len;
707                         return 0;
708                 }
709                 sdata->u.sta.auto_ssid_sel = !data->flags;
710                 ret = ieee80211_sta_set_ssid(dev, ssid, len);
711                 if (ret)
712                         return ret;
713                 ieee80211_sta_req_auth(dev, &sdata->u.sta);
714                 return 0;
715         }
716
717         if (sdata->type == IEEE80211_IF_TYPE_AP) {
718                 memcpy(sdata->u.ap.ssid, ssid, len);
719                 memset(sdata->u.ap.ssid + len, 0,
720                        IEEE80211_MAX_SSID_LEN - len);
721                 sdata->u.ap.ssid_len = len;
722                 return ieee80211_if_config(dev);
723         }
724         return -EOPNOTSUPP;
725 }
726
727
728 static int ieee80211_ioctl_giwessid(struct net_device *dev,
729                                     struct iw_request_info *info,
730                                     struct iw_point *data, char *ssid)
731 {
732         size_t len;
733
734         struct ieee80211_sub_if_data *sdata;
735         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
736         if (sdata->type == IEEE80211_IF_TYPE_STA ||
737             sdata->type == IEEE80211_IF_TYPE_IBSS) {
738                 int res = ieee80211_sta_get_ssid(dev, ssid, &len);
739                 if (res == 0) {
740                         data->length = len;
741                         data->flags = 1;
742                 } else
743                         data->flags = 0;
744                 return res;
745         }
746
747         if (sdata->type == IEEE80211_IF_TYPE_AP) {
748                 len = sdata->u.ap.ssid_len;
749                 if (len > IW_ESSID_MAX_SIZE)
750                         len = IW_ESSID_MAX_SIZE;
751                 memcpy(ssid, sdata->u.ap.ssid, len);
752                 data->length = len;
753                 data->flags = 1;
754                 return 0;
755         }
756         return -EOPNOTSUPP;
757 }
758
759
760 static int ieee80211_ioctl_siwap(struct net_device *dev,
761                                  struct iw_request_info *info,
762                                  struct sockaddr *ap_addr, char *extra)
763 {
764         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
765         struct ieee80211_sub_if_data *sdata;
766
767         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
768         if (sdata->type == IEEE80211_IF_TYPE_STA ||
769             sdata->type == IEEE80211_IF_TYPE_IBSS) {
770                 int ret;
771                 if (local->user_space_mlme) {
772                         memcpy(sdata->u.sta.bssid, (u8 *) &ap_addr->sa_data,
773                                ETH_ALEN);
774                         return 0;
775                 }
776                 if (is_zero_ether_addr((u8 *) &ap_addr->sa_data)) {
777                         sdata->u.sta.auto_bssid_sel = 1;
778                         sdata->u.sta.auto_channel_sel = 1;
779                 } else if (is_broadcast_ether_addr((u8 *) &ap_addr->sa_data))
780                         sdata->u.sta.auto_bssid_sel = 1;
781                 else
782                         sdata->u.sta.auto_bssid_sel = 0;
783                 ret = ieee80211_sta_set_bssid(dev, (u8 *) &ap_addr->sa_data);
784                 if (ret)
785                         return ret;
786                 ieee80211_sta_req_auth(dev, &sdata->u.sta);
787                 return 0;
788         } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
789                 if (memcmp(sdata->u.wds.remote_addr, (u8 *) &ap_addr->sa_data,
790                            ETH_ALEN) == 0)
791                         return 0;
792                 return ieee80211_if_update_wds(dev, (u8 *) &ap_addr->sa_data);
793         }
794
795         return -EOPNOTSUPP;
796 }
797
798
799 static int ieee80211_ioctl_giwap(struct net_device *dev,
800                                  struct iw_request_info *info,
801                                  struct sockaddr *ap_addr, char *extra)
802 {
803         struct ieee80211_sub_if_data *sdata;
804
805         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
806         if (sdata->type == IEEE80211_IF_TYPE_STA ||
807             sdata->type == IEEE80211_IF_TYPE_IBSS) {
808                 ap_addr->sa_family = ARPHRD_ETHER;
809                 memcpy(&ap_addr->sa_data, sdata->u.sta.bssid, ETH_ALEN);
810                 return 0;
811         } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
812                 ap_addr->sa_family = ARPHRD_ETHER;
813                 memcpy(&ap_addr->sa_data, sdata->u.wds.remote_addr, ETH_ALEN);
814                 return 0;
815         }
816
817         return -EOPNOTSUPP;
818 }
819
820
821 static int ieee80211_ioctl_siwscan(struct net_device *dev,
822                                    struct iw_request_info *info,
823                                    struct iw_point *data, char *extra)
824 {
825         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
826         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
827         u8 *ssid = NULL;
828         size_t ssid_len = 0;
829
830         if (!netif_running(dev))
831                 return -ENETDOWN;
832
833         if (local->scan_flags & IEEE80211_SCAN_MATCH_SSID) {
834                 if (sdata->type == IEEE80211_IF_TYPE_STA ||
835                     sdata->type == IEEE80211_IF_TYPE_IBSS) {
836                         ssid = sdata->u.sta.ssid;
837                         ssid_len = sdata->u.sta.ssid_len;
838                 } else if (sdata->type == IEEE80211_IF_TYPE_AP) {
839                         ssid = sdata->u.ap.ssid;
840                         ssid_len = sdata->u.ap.ssid_len;
841                 } else
842                         return -EINVAL;
843         }
844         return ieee80211_sta_req_scan(dev, ssid, ssid_len);
845 }
846
847
848 static int ieee80211_ioctl_giwscan(struct net_device *dev,
849                                    struct iw_request_info *info,
850                                    struct iw_point *data, char *extra)
851 {
852         int res;
853         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
854         if (local->sta_scanning)
855                 return -EAGAIN;
856         res = ieee80211_sta_scan_results(dev, extra, data->length);
857         if (res >= 0) {
858                 data->length = res;
859                 return 0;
860         }
861         data->length = 0;
862         return res;
863 }
864
865
866 static int ieee80211_ioctl_giwrate(struct net_device *dev,
867                                   struct iw_request_info *info,
868                                   struct iw_param *rate, char *extra)
869 {
870         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
871         struct sta_info *sta;
872         struct ieee80211_sub_if_data *sdata;
873
874         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
875         if (sdata->type == IEEE80211_IF_TYPE_STA)
876                 sta = sta_info_get(local, sdata->u.sta.bssid);
877         else
878                 return -EOPNOTSUPP;
879         if (!sta)
880                 return -ENODEV;
881         if (sta->txrate < local->oper_hw_mode->num_rates)
882                 rate->value = local->oper_hw_mode->rates[sta->txrate].rate * 100000;
883         else
884                 rate->value = 0;
885         sta_info_put(sta);
886         return 0;
887 }
888
889 static int ieee80211_ioctl_siwrts(struct net_device *dev,
890                                   struct iw_request_info *info,
891                                   struct iw_param *rts, char *extra)
892 {
893         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
894
895         if (rts->disabled)
896                 local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
897         else if (rts->value < 0 || rts->value > IEEE80211_MAX_RTS_THRESHOLD)
898                 return -EINVAL;
899         else
900                 local->rts_threshold = rts->value;
901
902         /* If the wlan card performs RTS/CTS in hardware/firmware,
903          * configure it here */
904
905         if (local->ops->set_rts_threshold)
906                 local->ops->set_rts_threshold(local_to_hw(local),
907                                              local->rts_threshold);
908
909         return 0;
910 }
911
912 static int ieee80211_ioctl_giwrts(struct net_device *dev,
913                                   struct iw_request_info *info,
914                                   struct iw_param *rts, char *extra)
915 {
916         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
917
918         rts->value = local->rts_threshold;
919         rts->disabled = (rts->value >= IEEE80211_MAX_RTS_THRESHOLD);
920         rts->fixed = 1;
921
922         return 0;
923 }
924
925
926 static int ieee80211_ioctl_siwfrag(struct net_device *dev,
927                                    struct iw_request_info *info,
928                                    struct iw_param *frag, char *extra)
929 {
930         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
931
932         if (frag->disabled)
933                 local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD;
934         else if (frag->value < 256 ||
935                  frag->value > IEEE80211_MAX_FRAG_THRESHOLD)
936                 return -EINVAL;
937         else {
938                 /* Fragment length must be even, so strip LSB. */
939                 local->fragmentation_threshold = frag->value & ~0x1;
940         }
941
942         /* If the wlan card performs fragmentation in hardware/firmware,
943          * configure it here */
944
945         if (local->ops->set_frag_threshold)
946                 local->ops->set_frag_threshold(
947                         local_to_hw(local),
948                         local->fragmentation_threshold);
949
950         return 0;
951 }
952
953 static int ieee80211_ioctl_giwfrag(struct net_device *dev,
954                                    struct iw_request_info *info,
955                                    struct iw_param *frag, char *extra)
956 {
957         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
958
959         frag->value = local->fragmentation_threshold;
960         frag->disabled = (frag->value >= IEEE80211_MAX_RTS_THRESHOLD);
961         frag->fixed = 1;
962
963         return 0;
964 }
965
966
967 static int ieee80211_ioctl_siwretry(struct net_device *dev,
968                                     struct iw_request_info *info,
969                                     struct iw_param *retry, char *extra)
970 {
971         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
972
973         if (retry->disabled ||
974             (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
975                 return -EINVAL;
976
977         if (retry->flags & IW_RETRY_MAX)
978                 local->long_retry_limit = retry->value;
979         else if (retry->flags & IW_RETRY_MIN)
980                 local->short_retry_limit = retry->value;
981         else {
982                 local->long_retry_limit = retry->value;
983                 local->short_retry_limit = retry->value;
984         }
985
986         if (local->ops->set_retry_limit) {
987                 return local->ops->set_retry_limit(
988                         local_to_hw(local),
989                         local->short_retry_limit,
990                         local->long_retry_limit);
991         }
992
993         return 0;
994 }
995
996
997 static int ieee80211_ioctl_giwretry(struct net_device *dev,
998                                     struct iw_request_info *info,
999                                     struct iw_param *retry, char *extra)
1000 {
1001         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1002
1003         retry->disabled = 0;
1004         if (retry->flags == 0 || retry->flags & IW_RETRY_MIN) {
1005                 /* first return min value, iwconfig will ask max value
1006                  * later if needed */
1007                 retry->flags |= IW_RETRY_LIMIT;
1008                 retry->value = local->short_retry_limit;
1009                 if (local->long_retry_limit != local->short_retry_limit)
1010                         retry->flags |= IW_RETRY_MIN;
1011                 return 0;
1012         }
1013         if (retry->flags & IW_RETRY_MAX) {
1014                 retry->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
1015                 retry->value = local->long_retry_limit;
1016         }
1017
1018         return 0;
1019 }
1020
1021 static int ieee80211_ioctl_clear_keys(struct net_device *dev)
1022 {
1023         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1024         struct ieee80211_key_conf key;
1025         int i;
1026         u8 addr[ETH_ALEN];
1027         struct ieee80211_key_conf *keyconf;
1028         struct ieee80211_sub_if_data *sdata;
1029         struct sta_info *sta;
1030
1031         memset(addr, 0xff, ETH_ALEN);
1032         read_lock(&local->sub_if_lock);
1033         list_for_each_entry(sdata, &local->sub_if_list, list) {
1034                 for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1035                         keyconf = NULL;
1036                         if (sdata->keys[i] &&
1037                             !sdata->keys[i]->force_sw_encrypt &&
1038                             local->ops->set_key &&
1039                             (keyconf = ieee80211_key_data2conf(local,
1040                                                                sdata->keys[i])))
1041                                 local->ops->set_key(local_to_hw(local),
1042                                                    DISABLE_KEY, addr,
1043                                                    keyconf, 0);
1044                         kfree(keyconf);
1045                         ieee80211_key_free(sdata->keys[i]);
1046                         sdata->keys[i] = NULL;
1047                 }
1048                 sdata->default_key = NULL;
1049         }
1050         read_unlock(&local->sub_if_lock);
1051
1052         spin_lock_bh(&local->sta_lock);
1053         list_for_each_entry(sta, &local->sta_list, list) {
1054                 keyconf = NULL;
1055                 if (sta->key && !sta->key->force_sw_encrypt &&
1056                     local->ops->set_key &&
1057                     (keyconf = ieee80211_key_data2conf(local, sta->key)))
1058                         local->ops->set_key(local_to_hw(local), DISABLE_KEY,
1059                                            sta->addr, keyconf, sta->aid);
1060                 kfree(keyconf);
1061                 ieee80211_key_free(sta->key);
1062                 sta->key = NULL;
1063         }
1064         spin_unlock_bh(&local->sta_lock);
1065
1066         memset(&key, 0, sizeof(key));
1067         if (local->ops->set_key &&
1068                     local->ops->set_key(local_to_hw(local), REMOVE_ALL_KEYS,
1069                                        NULL, &key, 0))
1070                 printk(KERN_DEBUG "%s: failed to remove hwaccel keys\n",
1071                        dev->name);
1072
1073         return 0;
1074 }
1075
1076
1077 static void ieee80211_key_enable_hwaccel(struct ieee80211_local *local,
1078                                          struct ieee80211_key *key)
1079 {
1080         struct ieee80211_key_conf *keyconf;
1081         u8 addr[ETH_ALEN];
1082
1083         if (!key || key->alg != ALG_WEP || !key->force_sw_encrypt ||
1084             (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP))
1085                 return;
1086
1087         memset(addr, 0xff, ETH_ALEN);
1088         keyconf = ieee80211_key_data2conf(local, key);
1089         if (keyconf && local->ops->set_key &&
1090             local->ops->set_key(local_to_hw(local),
1091                                SET_KEY, addr, keyconf, 0) == 0) {
1092                 key->force_sw_encrypt =
1093                         !!(keyconf->flags & IEEE80211_KEY_FORCE_SW_ENCRYPT);
1094                 key->hw_key_idx = keyconf->hw_key_idx;
1095         }
1096         kfree(keyconf);
1097 }
1098
1099
1100 static void ieee80211_key_disable_hwaccel(struct ieee80211_local *local,
1101                                           struct ieee80211_key *key)
1102 {
1103         struct ieee80211_key_conf *keyconf;
1104         u8 addr[ETH_ALEN];
1105
1106         if (!key || key->alg != ALG_WEP || key->force_sw_encrypt ||
1107             (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP))
1108                 return;
1109
1110         memset(addr, 0xff, ETH_ALEN);
1111         keyconf = ieee80211_key_data2conf(local, key);
1112         if (keyconf && local->ops->set_key)
1113                 local->ops->set_key(local_to_hw(local), DISABLE_KEY,
1114                                    addr, keyconf, 0);
1115         kfree(keyconf);
1116         key->force_sw_encrypt = 1;
1117 }
1118
1119
1120 static int ieee80211_ioctl_default_wep_only(struct ieee80211_local *local,
1121                                             int value)
1122 {
1123         int i;
1124         struct ieee80211_sub_if_data *sdata;
1125
1126         local->default_wep_only = value;
1127         read_lock(&local->sub_if_lock);
1128         list_for_each_entry(sdata, &local->sub_if_list, list)
1129                 for (i = 0; i < NUM_DEFAULT_KEYS; i++)
1130                         if (value)
1131                                 ieee80211_key_enable_hwaccel(local,
1132                                                              sdata->keys[i]);
1133                         else
1134                                 ieee80211_key_disable_hwaccel(local,
1135                                                               sdata->keys[i]);
1136         read_unlock(&local->sub_if_lock);
1137
1138         return 0;
1139 }
1140
1141
1142 void ieee80211_update_default_wep_only(struct ieee80211_local *local)
1143 {
1144         int i = 0;
1145         struct ieee80211_sub_if_data *sdata;
1146
1147         read_lock(&local->sub_if_lock);
1148         list_for_each_entry(sdata, &local->sub_if_list, list) {
1149
1150                 if (sdata->dev == local->mdev)
1151                         continue;
1152
1153                 /* If there is an AP interface then depend on userspace to
1154                    set default_wep_only correctly. */
1155                 if (sdata->type == IEEE80211_IF_TYPE_AP) {
1156                         read_unlock(&local->sub_if_lock);
1157                         return;
1158                 }
1159
1160                 i++;
1161         }
1162
1163         read_unlock(&local->sub_if_lock);
1164
1165         if (i <= 1)
1166                 ieee80211_ioctl_default_wep_only(local, 1);
1167         else
1168                 ieee80211_ioctl_default_wep_only(local, 0);
1169 }
1170
1171
1172 static int ieee80211_ioctl_prism2_param(struct net_device *dev,
1173                                         struct iw_request_info *info,
1174                                         void *wrqu, char *extra)
1175 {
1176         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1177         struct ieee80211_sub_if_data *sdata;
1178         int *i = (int *) extra;
1179         int param = *i;
1180         int value = *(i + 1);
1181         int ret = 0;
1182
1183         if (!capable(CAP_NET_ADMIN))
1184                 return -EPERM;
1185
1186         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1187
1188         switch (param) {
1189         case PRISM2_PARAM_IEEE_802_1X:
1190                 if (local->ops->set_ieee8021x)
1191                         ret = local->ops->set_ieee8021x(local_to_hw(local),
1192                                                         value);
1193                 if (ret)
1194                         printk(KERN_DEBUG "%s: failed to set IEEE 802.1X (%d) "
1195                                "for low-level driver\n", dev->name, value);
1196                 else
1197                         sdata->ieee802_1x = value;
1198                 break;
1199
1200         case PRISM2_PARAM_ANTSEL_TX:
1201                 local->hw.conf.antenna_sel_tx = value;
1202                 if (ieee80211_hw_config(local))
1203                         ret = -EINVAL;
1204                 break;
1205
1206         case PRISM2_PARAM_ANTSEL_RX:
1207                 local->hw.conf.antenna_sel_rx = value;
1208                 if (ieee80211_hw_config(local))
1209                         ret = -EINVAL;
1210                 break;
1211
1212         case PRISM2_PARAM_CTS_PROTECT_ERP_FRAMES:
1213                 local->cts_protect_erp_frames = value;
1214                 break;
1215
1216         case PRISM2_PARAM_DROP_UNENCRYPTED:
1217                 sdata->drop_unencrypted = value;
1218                 break;
1219
1220         case PRISM2_PARAM_PREAMBLE:
1221                 local->short_preamble = value;
1222                 break;
1223
1224         case PRISM2_PARAM_STAT_TIME:
1225                 if (!local->stat_time && value) {
1226                         local->stat_timer.expires = jiffies + HZ * value / 100;
1227                         add_timer(&local->stat_timer);
1228                 } else if (local->stat_time && !value) {
1229                         del_timer_sync(&local->stat_timer);
1230                 }
1231                 local->stat_time = value;
1232                 break;
1233         case PRISM2_PARAM_SHORT_SLOT_TIME:
1234                 if (value)
1235                         local->hw.conf.flags |= IEEE80211_CONF_SHORT_SLOT_TIME;
1236                 else
1237                         local->hw.conf.flags &= ~IEEE80211_CONF_SHORT_SLOT_TIME;
1238                 if (ieee80211_hw_config(local))
1239                         ret = -EINVAL;
1240                 break;
1241
1242         case PRISM2_PARAM_NEXT_MODE:
1243                 local->next_mode = value;
1244                 break;
1245
1246         case PRISM2_PARAM_CLEAR_KEYS:
1247                 ret = ieee80211_ioctl_clear_keys(dev);
1248                 break;
1249
1250         case PRISM2_PARAM_RADIO_ENABLED:
1251                 ret = ieee80211_ioctl_set_radio_enabled(dev, value);
1252                 break;
1253
1254         case PRISM2_PARAM_ANTENNA_MODE:
1255                 local->hw.conf.antenna_mode = value;
1256                 if (ieee80211_hw_config(local))
1257                         ret = -EINVAL;
1258                 break;
1259
1260         case PRISM2_PARAM_STA_ANTENNA_SEL:
1261                 local->sta_antenna_sel = value;
1262                 break;
1263
1264         case PRISM2_PARAM_TX_POWER_REDUCTION:
1265                 if (value < 0)
1266                         ret = -EINVAL;
1267                 else
1268                         local->hw.conf.tx_power_reduction = value;
1269                 break;
1270
1271         case PRISM2_PARAM_KEY_TX_RX_THRESHOLD:
1272                 local->key_tx_rx_threshold = value;
1273                 break;
1274
1275         case PRISM2_PARAM_DEFAULT_WEP_ONLY:
1276                 ret = ieee80211_ioctl_default_wep_only(local, value);
1277                 break;
1278
1279         case PRISM2_PARAM_WIFI_WME_NOACK_TEST:
1280                 local->wifi_wme_noack_test = value;
1281                 break;
1282
1283         case PRISM2_PARAM_SCAN_FLAGS:
1284                 local->scan_flags = value;
1285                 break;
1286
1287         case PRISM2_PARAM_MIXED_CELL:
1288                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1289                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1290                         ret = -EINVAL;
1291                 else
1292                         sdata->u.sta.mixed_cell = !!value;
1293                 break;
1294
1295         case PRISM2_PARAM_HW_MODES:
1296                 local->enabled_modes = value;
1297                 break;
1298
1299         case PRISM2_PARAM_CREATE_IBSS:
1300                 if (sdata->type != IEEE80211_IF_TYPE_IBSS)
1301                         ret = -EINVAL;
1302                 else
1303                         sdata->u.sta.create_ibss = !!value;
1304                 break;
1305         case PRISM2_PARAM_WMM_ENABLED:
1306                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1307                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1308                         ret = -EINVAL;
1309                 else
1310                         sdata->u.sta.wmm_enabled = !!value;
1311                 break;
1312         case PRISM2_PARAM_RADAR_DETECT:
1313                 local->hw.conf.radar_detect = value;
1314                 break;
1315         case PRISM2_PARAM_SPECTRUM_MGMT:
1316                 local->hw.conf.spect_mgmt = value;
1317                 break;
1318         default:
1319                 ret = -EOPNOTSUPP;
1320                 break;
1321         }
1322
1323         return ret;
1324 }
1325
1326
1327 static int ieee80211_ioctl_get_prism2_param(struct net_device *dev,
1328                                             struct iw_request_info *info,
1329                                             void *wrqu, char *extra)
1330 {
1331         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1332         struct ieee80211_sub_if_data *sdata;
1333         int *param = (int *) extra;
1334         int ret = 0;
1335
1336         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1337
1338         switch (*param) {
1339         case PRISM2_PARAM_IEEE_802_1X:
1340                 *param = sdata->ieee802_1x;
1341                 break;
1342
1343         case PRISM2_PARAM_ANTSEL_TX:
1344                 *param = local->hw.conf.antenna_sel_tx;
1345                 break;
1346
1347         case PRISM2_PARAM_ANTSEL_RX:
1348                 *param = local->hw.conf.antenna_sel_rx;
1349                 break;
1350
1351         case PRISM2_PARAM_CTS_PROTECT_ERP_FRAMES:
1352                 *param = local->cts_protect_erp_frames;
1353                 break;
1354
1355         case PRISM2_PARAM_DROP_UNENCRYPTED:
1356                 *param = sdata->drop_unencrypted;
1357                 break;
1358
1359         case PRISM2_PARAM_PREAMBLE:
1360                 *param = local->short_preamble;
1361                 break;
1362
1363         case PRISM2_PARAM_STAT_TIME:
1364                 *param = local->stat_time;
1365                 break;
1366         case PRISM2_PARAM_SHORT_SLOT_TIME:
1367                 *param = !!(local->hw.conf.flags & IEEE80211_CONF_SHORT_SLOT_TIME);
1368                 break;
1369
1370         case PRISM2_PARAM_NEXT_MODE:
1371                 *param = local->next_mode;
1372                 break;
1373
1374         case PRISM2_PARAM_ANTENNA_MODE:
1375                 *param = local->hw.conf.antenna_mode;
1376                 break;
1377
1378         case PRISM2_PARAM_STA_ANTENNA_SEL:
1379                 *param = local->sta_antenna_sel;
1380                 break;
1381
1382         case PRISM2_PARAM_TX_POWER_REDUCTION:
1383                 *param = local->hw.conf.tx_power_reduction;
1384                 break;
1385
1386         case PRISM2_PARAM_KEY_TX_RX_THRESHOLD:
1387                 *param = local->key_tx_rx_threshold;
1388                 break;
1389
1390         case PRISM2_PARAM_DEFAULT_WEP_ONLY:
1391                 *param = local->default_wep_only;
1392                 break;
1393
1394         case PRISM2_PARAM_WIFI_WME_NOACK_TEST:
1395                 *param = local->wifi_wme_noack_test;
1396                 break;
1397
1398         case PRISM2_PARAM_SCAN_FLAGS:
1399                 *param = local->scan_flags;
1400                 break;
1401
1402         case PRISM2_PARAM_HW_MODES:
1403                 *param = local->enabled_modes;
1404                 break;
1405
1406         case PRISM2_PARAM_CREATE_IBSS:
1407                 if (sdata->type != IEEE80211_IF_TYPE_IBSS)
1408                         ret = -EINVAL;
1409                 else
1410                         *param = !!sdata->u.sta.create_ibss;
1411                 break;
1412
1413         case PRISM2_PARAM_MIXED_CELL:
1414                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1415                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1416                         ret = -EINVAL;
1417                 else
1418                         *param = !!sdata->u.sta.mixed_cell;
1419                 break;
1420         case PRISM2_PARAM_WMM_ENABLED:
1421                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1422                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1423                         ret = -EINVAL;
1424                 else
1425                         *param = !!sdata->u.sta.wmm_enabled;
1426                 break;
1427         default:
1428                 ret = -EOPNOTSUPP;
1429                 break;
1430         }
1431
1432         return ret;
1433 }
1434
1435 static int ieee80211_ioctl_siwmlme(struct net_device *dev,
1436                                    struct iw_request_info *info,
1437                                    struct iw_point *data, char *extra)
1438 {
1439         struct ieee80211_sub_if_data *sdata;
1440         struct iw_mlme *mlme = (struct iw_mlme *) extra;
1441
1442         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1443         if (sdata->type != IEEE80211_IF_TYPE_STA &&
1444             sdata->type != IEEE80211_IF_TYPE_IBSS)
1445                 return -EINVAL;
1446
1447         switch (mlme->cmd) {
1448         case IW_MLME_DEAUTH:
1449                 /* TODO: mlme->addr.sa_data */
1450                 return ieee80211_sta_deauthenticate(dev, mlme->reason_code);
1451         case IW_MLME_DISASSOC:
1452                 /* TODO: mlme->addr.sa_data */
1453                 return ieee80211_sta_disassociate(dev, mlme->reason_code);
1454         default:
1455                 return -EOPNOTSUPP;
1456         }
1457 }
1458
1459
1460 static int ieee80211_ioctl_siwencode(struct net_device *dev,
1461                                      struct iw_request_info *info,
1462                                      struct iw_point *erq, char *keybuf)
1463 {
1464         struct ieee80211_sub_if_data *sdata;
1465         int idx, i, alg = ALG_WEP;
1466         u8 bcaddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
1467
1468         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1469
1470         idx = erq->flags & IW_ENCODE_INDEX;
1471         if (idx == 0) {
1472                 if (sdata->default_key)
1473                         for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1474                                 if (sdata->default_key == sdata->keys[i]) {
1475                                         idx = i;
1476                                         break;
1477                                 }
1478                         }
1479         } else if (idx < 1 || idx > 4)
1480                 return -EINVAL;
1481         else
1482                 idx--;
1483
1484         if (erq->flags & IW_ENCODE_DISABLED)
1485                 alg = ALG_NONE;
1486         else if (erq->length == 0) {
1487                 /* No key data - just set the default TX key index */
1488                 if (sdata->default_key != sdata->keys[idx]) {
1489                         ieee80211_debugfs_key_remove_default(sdata);
1490                         sdata->default_key = sdata->keys[idx];
1491                         if (sdata->default_key)
1492                                 ieee80211_debugfs_key_add_default(sdata);
1493                 }
1494                 return 0;
1495         }
1496
1497         return ieee80211_set_encryption(
1498                 dev, bcaddr,
1499                 idx, alg,
1500                 !sdata->default_key,
1501                 keybuf, erq->length);
1502 }
1503
1504
1505 static int ieee80211_ioctl_giwencode(struct net_device *dev,
1506                                      struct iw_request_info *info,
1507                                      struct iw_point *erq, char *key)
1508 {
1509         struct ieee80211_sub_if_data *sdata;
1510         int idx, i;
1511
1512         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1513
1514         idx = erq->flags & IW_ENCODE_INDEX;
1515         if (idx < 1 || idx > 4) {
1516                 idx = -1;
1517                 if (!sdata->default_key)
1518                         idx = 0;
1519                 else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1520                         if (sdata->default_key == sdata->keys[i]) {
1521                                 idx = i;
1522                                 break;
1523                         }
1524                 }
1525                 if (idx < 0)
1526                         return -EINVAL;
1527         } else
1528                 idx--;
1529
1530         erq->flags = idx + 1;
1531
1532         if (!sdata->keys[idx]) {
1533                 erq->length = 0;
1534                 erq->flags |= IW_ENCODE_DISABLED;
1535                 return 0;
1536         }
1537
1538         memcpy(key, sdata->keys[idx]->key,
1539                min((int)erq->length, sdata->keys[idx]->keylen));
1540         erq->length = sdata->keys[idx]->keylen;
1541         erq->flags |= IW_ENCODE_ENABLED;
1542
1543         return 0;
1544 }
1545
1546 static int ieee80211_ioctl_siwauth(struct net_device *dev,
1547                                    struct iw_request_info *info,
1548                                    struct iw_param *data, char *extra)
1549 {
1550         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1551         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1552         int ret = 0;
1553
1554         switch (data->flags & IW_AUTH_INDEX) {
1555         case IW_AUTH_WPA_VERSION:
1556         case IW_AUTH_CIPHER_PAIRWISE:
1557         case IW_AUTH_CIPHER_GROUP:
1558         case IW_AUTH_WPA_ENABLED:
1559         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1560                 break;
1561         case IW_AUTH_KEY_MGMT:
1562                 if (sdata->type != IEEE80211_IF_TYPE_STA)
1563                         ret = -EINVAL;
1564                 else {
1565                         /*
1566                          * TODO: sdata->u.sta.key_mgmt does not match with WE18
1567                          * value completely; could consider modifying this to
1568                          * be closer to WE18. For now, this value is not really
1569                          * used for anything else than Privacy matching, so the
1570                          * current code here should be more or less OK.
1571                          */
1572                         if (data->value & IW_AUTH_KEY_MGMT_802_1X) {
1573                                 sdata->u.sta.key_mgmt =
1574                                         IEEE80211_KEY_MGMT_WPA_EAP;
1575                         } else if (data->value & IW_AUTH_KEY_MGMT_PSK) {
1576                                 sdata->u.sta.key_mgmt =
1577                                         IEEE80211_KEY_MGMT_WPA_PSK;
1578                         } else {
1579                                 sdata->u.sta.key_mgmt =
1580                                         IEEE80211_KEY_MGMT_NONE;
1581                         }
1582                 }
1583                 break;
1584         case IW_AUTH_80211_AUTH_ALG:
1585                 if (sdata->type == IEEE80211_IF_TYPE_STA ||
1586                     sdata->type == IEEE80211_IF_TYPE_IBSS)
1587                         sdata->u.sta.auth_algs = data->value;
1588                 else
1589                         ret = -EOPNOTSUPP;
1590                 break;
1591         case IW_AUTH_PRIVACY_INVOKED:
1592                 if (local->ops->set_privacy_invoked)
1593                         ret = local->ops->set_privacy_invoked(
1594                                         local_to_hw(local), data->value);
1595                 break;
1596         default:
1597                 ret = -EOPNOTSUPP;
1598                 break;
1599         }
1600         return ret;
1601 }
1602
1603 /* Get wireless statistics.  Called by /proc/net/wireless and by SIOCGIWSTATS */
1604 static struct iw_statistics *ieee80211_get_wireless_stats(struct net_device *dev)
1605 {
1606         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1607         struct iw_statistics *wstats = &local->wstats;
1608         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1609         struct sta_info *sta = NULL;
1610
1611         if (sdata->type == IEEE80211_IF_TYPE_STA ||
1612             sdata->type == IEEE80211_IF_TYPE_IBSS)
1613                 sta = sta_info_get(local, sdata->u.sta.bssid);
1614         if (!sta) {
1615                 wstats->discard.fragment = 0;
1616                 wstats->discard.misc = 0;
1617                 wstats->qual.qual = 0;
1618                 wstats->qual.level = 0;
1619                 wstats->qual.noise = 0;
1620                 wstats->qual.updated = IW_QUAL_ALL_INVALID;
1621         } else {
1622                 wstats->qual.level = sta->last_rssi;
1623                 wstats->qual.qual = sta->last_signal;
1624                 wstats->qual.noise = sta->last_noise;
1625                 wstats->qual.updated = local->wstats_flags;
1626                 sta_info_put(sta);
1627         }
1628         return wstats;
1629 }
1630
1631 static int ieee80211_ioctl_giwauth(struct net_device *dev,
1632                                    struct iw_request_info *info,
1633                                    struct iw_param *data, char *extra)
1634 {
1635         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1636         int ret = 0;
1637
1638         switch (data->flags & IW_AUTH_INDEX) {
1639         case IW_AUTH_80211_AUTH_ALG:
1640                 if (sdata->type == IEEE80211_IF_TYPE_STA ||
1641                     sdata->type == IEEE80211_IF_TYPE_IBSS)
1642                         data->value = sdata->u.sta.auth_algs;
1643                 else
1644                         ret = -EOPNOTSUPP;
1645                 break;
1646         default:
1647                 ret = -EOPNOTSUPP;
1648                 break;
1649         }
1650         return ret;
1651 }
1652
1653
1654 static int ieee80211_ioctl_siwencodeext(struct net_device *dev,
1655                                         struct iw_request_info *info,
1656                                         struct iw_point *erq, char *extra)
1657 {
1658         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1659         struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
1660         int alg, idx, i;
1661
1662         switch (ext->alg) {
1663         case IW_ENCODE_ALG_NONE:
1664                 alg = ALG_NONE;
1665                 break;
1666         case IW_ENCODE_ALG_WEP:
1667                 alg = ALG_WEP;
1668                 break;
1669         case IW_ENCODE_ALG_TKIP:
1670                 alg = ALG_TKIP;
1671                 break;
1672         case IW_ENCODE_ALG_CCMP:
1673                 alg = ALG_CCMP;
1674                 break;
1675         default:
1676                 return -EOPNOTSUPP;
1677         }
1678
1679         if (erq->flags & IW_ENCODE_DISABLED)
1680                 alg = ALG_NONE;
1681
1682         idx = erq->flags & IW_ENCODE_INDEX;
1683         if (idx < 1 || idx > 4) {
1684                 idx = -1;
1685                 if (!sdata->default_key)
1686                         idx = 0;
1687                 else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1688                         if (sdata->default_key == sdata->keys[i]) {
1689                                 idx = i;
1690                                 break;
1691                         }
1692                 }
1693                 if (idx < 0)
1694                         return -EINVAL;
1695         } else
1696                 idx--;
1697
1698         return ieee80211_set_encryption(dev, ext->addr.sa_data, idx, alg,
1699                                         ext->ext_flags &
1700                                         IW_ENCODE_EXT_SET_TX_KEY,
1701                                         ext->key, ext->key_len);
1702 }
1703
1704
1705 static const struct iw_priv_args ieee80211_ioctl_priv[] = {
1706         { PRISM2_IOCTL_PRISM2_PARAM,
1707           IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "param" },
1708         { PRISM2_IOCTL_GET_PRISM2_PARAM,
1709           IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1710           IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "get_param" },
1711 };
1712
1713 /* Structures to export the Wireless Handlers */
1714
1715 static const iw_handler ieee80211_handler[] =
1716 {
1717         (iw_handler) NULL,                              /* SIOCSIWCOMMIT */
1718         (iw_handler) ieee80211_ioctl_giwname,           /* SIOCGIWNAME */
1719         (iw_handler) NULL,                              /* SIOCSIWNWID */
1720         (iw_handler) NULL,                              /* SIOCGIWNWID */
1721         (iw_handler) ieee80211_ioctl_siwfreq,           /* SIOCSIWFREQ */
1722         (iw_handler) ieee80211_ioctl_giwfreq,           /* SIOCGIWFREQ */
1723         (iw_handler) ieee80211_ioctl_siwmode,           /* SIOCSIWMODE */
1724         (iw_handler) ieee80211_ioctl_giwmode,           /* SIOCGIWMODE */
1725         (iw_handler) NULL,                              /* SIOCSIWSENS */
1726         (iw_handler) NULL,                              /* SIOCGIWSENS */
1727         (iw_handler) NULL /* not used */,               /* SIOCSIWRANGE */
1728         (iw_handler) ieee80211_ioctl_giwrange,          /* SIOCGIWRANGE */
1729         (iw_handler) NULL /* not used */,               /* SIOCSIWPRIV */
1730         (iw_handler) NULL /* kernel code */,            /* SIOCGIWPRIV */
1731         (iw_handler) NULL /* not used */,               /* SIOCSIWSTATS */
1732         (iw_handler) NULL /* kernel code */,            /* SIOCGIWSTATS */
1733         iw_handler_set_spy,                             /* SIOCSIWSPY */
1734         iw_handler_get_spy,                             /* SIOCGIWSPY */
1735         iw_handler_set_thrspy,                          /* SIOCSIWTHRSPY */
1736         iw_handler_get_thrspy,                          /* SIOCGIWTHRSPY */
1737         (iw_handler) ieee80211_ioctl_siwap,             /* SIOCSIWAP */
1738         (iw_handler) ieee80211_ioctl_giwap,             /* SIOCGIWAP */
1739         (iw_handler) ieee80211_ioctl_siwmlme,           /* SIOCSIWMLME */
1740         (iw_handler) NULL,                              /* SIOCGIWAPLIST */
1741         (iw_handler) ieee80211_ioctl_siwscan,           /* SIOCSIWSCAN */
1742         (iw_handler) ieee80211_ioctl_giwscan,           /* SIOCGIWSCAN */
1743         (iw_handler) ieee80211_ioctl_siwessid,          /* SIOCSIWESSID */
1744         (iw_handler) ieee80211_ioctl_giwessid,          /* SIOCGIWESSID */
1745         (iw_handler) NULL,                              /* SIOCSIWNICKN */
1746         (iw_handler) NULL,                              /* SIOCGIWNICKN */
1747         (iw_handler) NULL,                              /* -- hole -- */
1748         (iw_handler) NULL,                              /* -- hole -- */
1749         (iw_handler) NULL,                              /* SIOCSIWRATE */
1750         (iw_handler) ieee80211_ioctl_giwrate,           /* SIOCGIWRATE */
1751         (iw_handler) ieee80211_ioctl_siwrts,            /* SIOCSIWRTS */
1752         (iw_handler) ieee80211_ioctl_giwrts,            /* SIOCGIWRTS */
1753         (iw_handler) ieee80211_ioctl_siwfrag,           /* SIOCSIWFRAG */
1754         (iw_handler) ieee80211_ioctl_giwfrag,           /* SIOCGIWFRAG */
1755         (iw_handler) NULL,                              /* SIOCSIWTXPOW */
1756         (iw_handler) NULL,                              /* SIOCGIWTXPOW */
1757         (iw_handler) ieee80211_ioctl_siwretry,          /* SIOCSIWRETRY */
1758         (iw_handler) ieee80211_ioctl_giwretry,          /* SIOCGIWRETRY */
1759         (iw_handler) ieee80211_ioctl_siwencode,         /* SIOCSIWENCODE */
1760         (iw_handler) ieee80211_ioctl_giwencode,         /* SIOCGIWENCODE */
1761         (iw_handler) NULL,                              /* SIOCSIWPOWER */
1762         (iw_handler) NULL,                              /* SIOCGIWPOWER */
1763         (iw_handler) NULL,                              /* -- hole -- */
1764         (iw_handler) NULL,                              /* -- hole -- */
1765         (iw_handler) ieee80211_ioctl_siwgenie,          /* SIOCSIWGENIE */
1766         (iw_handler) NULL,                              /* SIOCGIWGENIE */
1767         (iw_handler) ieee80211_ioctl_siwauth,           /* SIOCSIWAUTH */
1768         (iw_handler) ieee80211_ioctl_giwauth,           /* SIOCGIWAUTH */
1769         (iw_handler) ieee80211_ioctl_siwencodeext,      /* SIOCSIWENCODEEXT */
1770         (iw_handler) NULL,                              /* SIOCGIWENCODEEXT */
1771         (iw_handler) NULL,                              /* SIOCSIWPMKSA */
1772         (iw_handler) NULL,                              /* -- hole -- */
1773 };
1774
1775 static const iw_handler ieee80211_private_handler[] =
1776 {                                                       /* SIOCIWFIRSTPRIV + */
1777         (iw_handler) ieee80211_ioctl_prism2_param,      /* 0 */
1778         (iw_handler) ieee80211_ioctl_get_prism2_param,  /* 1 */
1779 };
1780
1781 const struct iw_handler_def ieee80211_iw_handler_def =
1782 {
1783         .num_standard   = ARRAY_SIZE(ieee80211_handler),
1784         .num_private    = ARRAY_SIZE(ieee80211_private_handler),
1785         .num_private_args = ARRAY_SIZE(ieee80211_ioctl_priv),
1786         .standard       = (iw_handler *) ieee80211_handler,
1787         .private        = (iw_handler *) ieee80211_private_handler,
1788         .private_args   = (struct iw_priv_args *) ieee80211_ioctl_priv,
1789         .get_wireless_stats = ieee80211_get_wireless_stats,
1790 };