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