b337d7d5edb3b21dfebb365ac3ae825f77a6ad90
[safe/jmp/linux-2.6] / net / mac80211 / wext.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 "led.h"
25 #include "rate.h"
26 #include "wpa.h"
27 #include "aes_ccm.h"
28
29
30 static int ieee80211_set_encryption(struct ieee80211_sub_if_data *sdata, u8 *sta_addr,
31                                     int idx, int alg, int remove,
32                                     int set_tx_key, const u8 *_key,
33                                     size_t key_len)
34 {
35         struct ieee80211_local *local = sdata->local;
36         struct sta_info *sta;
37         struct ieee80211_key *key;
38         int err;
39
40         if (alg == ALG_AES_CMAC) {
41                 if (idx < NUM_DEFAULT_KEYS ||
42                     idx >= NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS) {
43                         printk(KERN_DEBUG "%s: set_encrypt - invalid idx=%d "
44                                "(BIP)\n", sdata->dev->name, idx);
45                         return -EINVAL;
46                 }
47         } else if (idx < 0 || idx >= NUM_DEFAULT_KEYS) {
48                 printk(KERN_DEBUG "%s: set_encrypt - invalid idx=%d\n",
49                        sdata->dev->name, idx);
50                 return -EINVAL;
51         }
52
53         if (remove) {
54                 rcu_read_lock();
55
56                 err = 0;
57
58                 if (is_broadcast_ether_addr(sta_addr)) {
59                         key = sdata->keys[idx];
60                 } else {
61                         sta = sta_info_get(local, sta_addr);
62                         if (!sta) {
63                                 err = -ENOENT;
64                                 goto out_unlock;
65                         }
66                         key = sta->key;
67                 }
68
69                 ieee80211_key_free(key);
70         } else {
71                 key = ieee80211_key_alloc(alg, idx, key_len, _key);
72                 if (!key)
73                         return -ENOMEM;
74
75                 sta = NULL;
76                 err = 0;
77
78                 rcu_read_lock();
79
80                 if (!is_broadcast_ether_addr(sta_addr)) {
81                         set_tx_key = 0;
82                         /*
83                          * According to the standard, the key index of a
84                          * pairwise key must be zero. However, some AP are
85                          * broken when it comes to WEP key indices, so we
86                          * work around this.
87                          */
88                         if (idx != 0 && alg != ALG_WEP) {
89                                 ieee80211_key_free(key);
90                                 err = -EINVAL;
91                                 goto out_unlock;
92                         }
93
94                         sta = sta_info_get(local, sta_addr);
95                         if (!sta) {
96                                 ieee80211_key_free(key);
97                                 err = -ENOENT;
98                                 goto out_unlock;
99                         }
100                 }
101
102                 if (alg == ALG_WEP &&
103                         key_len != LEN_WEP40 && key_len != LEN_WEP104) {
104                         ieee80211_key_free(key);
105                         err = -EINVAL;
106                         goto out_unlock;
107                 }
108
109                 ieee80211_key_link(key, sdata, sta);
110
111                 if (set_tx_key || (!sta && !sdata->default_key && key))
112                         ieee80211_set_default_key(sdata, idx);
113                 if (alg == ALG_AES_CMAC &&
114                     (set_tx_key || (!sta && !sdata->default_mgmt_key && key)))
115                         ieee80211_set_default_mgmt_key(sdata, idx);
116         }
117
118  out_unlock:
119         rcu_read_unlock();
120
121         return err;
122 }
123
124 static int ieee80211_ioctl_siwgenie(struct net_device *dev,
125                                     struct iw_request_info *info,
126                                     struct iw_point *data, char *extra)
127 {
128         struct ieee80211_sub_if_data *sdata;
129
130         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
131
132         if (sdata->flags & IEEE80211_SDATA_USERSPACE_MLME)
133                 return -EOPNOTSUPP;
134
135         if (sdata->vif.type == NL80211_IFTYPE_STATION ||
136             sdata->vif.type == NL80211_IFTYPE_ADHOC) {
137                 int ret = ieee80211_sta_set_extra_ie(sdata, extra, data->length);
138                 if (ret)
139                         return ret;
140                 sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_BSSID_SEL;
141                 ieee80211_sta_req_auth(sdata, &sdata->u.sta);
142                 return 0;
143         }
144
145         return -EOPNOTSUPP;
146 }
147
148 static int ieee80211_ioctl_giwrange(struct net_device *dev,
149                                  struct iw_request_info *info,
150                                  struct iw_point *data, char *extra)
151 {
152         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
153         struct iw_range *range = (struct iw_range *) extra;
154         enum ieee80211_band band;
155         int c = 0;
156
157         data->length = sizeof(struct iw_range);
158         memset(range, 0, sizeof(struct iw_range));
159
160         range->we_version_compiled = WIRELESS_EXT;
161         range->we_version_source = 21;
162         range->retry_capa = IW_RETRY_LIMIT;
163         range->retry_flags = IW_RETRY_LIMIT;
164         range->min_retry = 0;
165         range->max_retry = 255;
166         range->min_rts = 0;
167         range->max_rts = 2347;
168         range->min_frag = 256;
169         range->max_frag = 2346;
170
171         range->encoding_size[0] = 5;
172         range->encoding_size[1] = 13;
173         range->num_encoding_sizes = 2;
174         range->max_encoding_tokens = NUM_DEFAULT_KEYS;
175
176         /* cfg80211 requires this, and enforces 0..100 */
177         if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
178                 range->max_qual.level = 100;
179         else if  (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
180                 range->max_qual.level = -110;
181         else
182                 range->max_qual.level = 0;
183
184         if (local->hw.flags & IEEE80211_HW_NOISE_DBM)
185                 range->max_qual.noise = -110;
186         else
187                 range->max_qual.noise = 0;
188
189         range->max_qual.qual = 100;
190         range->max_qual.updated = local->wstats_flags;
191
192         range->avg_qual.qual = 50;
193         /* not always true but better than nothing */
194         range->avg_qual.level = range->max_qual.level / 2;
195         range->avg_qual.noise = range->max_qual.noise / 2;
196         range->avg_qual.updated = local->wstats_flags;
197
198         range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
199                           IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
200
201
202         for (band = 0; band < IEEE80211_NUM_BANDS; band ++) {
203                 int i;
204                 struct ieee80211_supported_band *sband;
205
206                 sband = local->hw.wiphy->bands[band];
207
208                 if (!sband)
209                         continue;
210
211                 for (i = 0; i < sband->n_channels && c < IW_MAX_FREQUENCIES; i++) {
212                         struct ieee80211_channel *chan = &sband->channels[i];
213
214                         if (!(chan->flags & IEEE80211_CHAN_DISABLED)) {
215                                 range->freq[c].i =
216                                         ieee80211_frequency_to_channel(
217                                                 chan->center_freq);
218                                 range->freq[c].m = chan->center_freq;
219                                 range->freq[c].e = 6;
220                                 c++;
221                         }
222                 }
223         }
224         range->num_channels = c;
225         range->num_frequency = c;
226
227         IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
228         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
229         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
230
231         range->scan_capa |= IW_SCAN_CAPA_ESSID;
232
233         return 0;
234 }
235
236
237 static int ieee80211_ioctl_siwfreq(struct net_device *dev,
238                                    struct iw_request_info *info,
239                                    struct iw_freq *freq, char *extra)
240 {
241         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
242
243         if (sdata->vif.type == NL80211_IFTYPE_ADHOC ||
244             sdata->vif.type == NL80211_IFTYPE_STATION)
245                 sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_CHANNEL_SEL;
246
247         /* freq->e == 0: freq->m = channel; otherwise freq = m * 10^e */
248         if (freq->e == 0) {
249                 if (freq->m < 0) {
250                         if (sdata->vif.type == NL80211_IFTYPE_ADHOC ||
251                             sdata->vif.type == NL80211_IFTYPE_STATION)
252                                 sdata->u.sta.flags |=
253                                         IEEE80211_STA_AUTO_CHANNEL_SEL;
254                         return 0;
255                 } else
256                         return ieee80211_set_freq(sdata,
257                                 ieee80211_channel_to_frequency(freq->m));
258         } else {
259                 int i, div = 1000000;
260                 for (i = 0; i < freq->e; i++)
261                         div /= 10;
262                 if (div > 0)
263                         return ieee80211_set_freq(sdata, freq->m / div);
264                 else
265                         return -EINVAL;
266         }
267 }
268
269
270 static int ieee80211_ioctl_giwfreq(struct net_device *dev,
271                                    struct iw_request_info *info,
272                                    struct iw_freq *freq, char *extra)
273 {
274         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
275
276         freq->m = local->hw.conf.channel->center_freq;
277         freq->e = 6;
278
279         return 0;
280 }
281
282
283 static int ieee80211_ioctl_siwessid(struct net_device *dev,
284                                     struct iw_request_info *info,
285                                     struct iw_point *data, char *ssid)
286 {
287         struct ieee80211_sub_if_data *sdata;
288         size_t len = data->length;
289
290         /* iwconfig uses nul termination in SSID.. */
291         if (len > 0 && ssid[len - 1] == '\0')
292                 len--;
293
294         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
295         if (sdata->vif.type == NL80211_IFTYPE_STATION ||
296             sdata->vif.type == NL80211_IFTYPE_ADHOC) {
297                 int ret;
298                 if (sdata->flags & IEEE80211_SDATA_USERSPACE_MLME) {
299                         if (len > IEEE80211_MAX_SSID_LEN)
300                                 return -EINVAL;
301                         memcpy(sdata->u.sta.ssid, ssid, len);
302                         sdata->u.sta.ssid_len = len;
303                         return 0;
304                 }
305                 if (data->flags)
306                         sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_SSID_SEL;
307                 else
308                         sdata->u.sta.flags |= IEEE80211_STA_AUTO_SSID_SEL;
309                 ret = ieee80211_sta_set_ssid(sdata, ssid, len);
310                 if (ret)
311                         return ret;
312                 ieee80211_sta_req_auth(sdata, &sdata->u.sta);
313                 return 0;
314         }
315
316         return -EOPNOTSUPP;
317 }
318
319
320 static int ieee80211_ioctl_giwessid(struct net_device *dev,
321                                     struct iw_request_info *info,
322                                     struct iw_point *data, char *ssid)
323 {
324         size_t len;
325
326         struct ieee80211_sub_if_data *sdata;
327         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
328         if (sdata->vif.type == NL80211_IFTYPE_STATION ||
329             sdata->vif.type == NL80211_IFTYPE_ADHOC) {
330                 int res = ieee80211_sta_get_ssid(sdata, ssid, &len);
331                 if (res == 0) {
332                         data->length = len;
333                         data->flags = 1;
334                 } else
335                         data->flags = 0;
336                 return res;
337         }
338
339         return -EOPNOTSUPP;
340 }
341
342
343 static int ieee80211_ioctl_siwap(struct net_device *dev,
344                                  struct iw_request_info *info,
345                                  struct sockaddr *ap_addr, char *extra)
346 {
347         struct ieee80211_sub_if_data *sdata;
348
349         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
350         if (sdata->vif.type == NL80211_IFTYPE_STATION ||
351             sdata->vif.type == NL80211_IFTYPE_ADHOC) {
352                 int ret;
353                 if (sdata->flags & IEEE80211_SDATA_USERSPACE_MLME) {
354                         memcpy(sdata->u.sta.bssid, (u8 *) &ap_addr->sa_data,
355                                ETH_ALEN);
356                         return 0;
357                 }
358                 if (is_zero_ether_addr((u8 *) &ap_addr->sa_data))
359                         sdata->u.sta.flags |= IEEE80211_STA_AUTO_BSSID_SEL |
360                                 IEEE80211_STA_AUTO_CHANNEL_SEL;
361                 else if (is_broadcast_ether_addr((u8 *) &ap_addr->sa_data))
362                         sdata->u.sta.flags |= IEEE80211_STA_AUTO_BSSID_SEL;
363                 else
364                         sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_BSSID_SEL;
365                 ret = ieee80211_sta_set_bssid(sdata, (u8 *) &ap_addr->sa_data);
366                 if (ret)
367                         return ret;
368                 ieee80211_sta_req_auth(sdata, &sdata->u.sta);
369                 return 0;
370         } else if (sdata->vif.type == NL80211_IFTYPE_WDS) {
371                 /*
372                  * If it is necessary to update the WDS peer address
373                  * while the interface is running, then we need to do
374                  * more work here, namely if it is running we need to
375                  * add a new and remove the old STA entry, this is
376                  * normally handled by _open() and _stop().
377                  */
378                 if (netif_running(dev))
379                         return -EBUSY;
380
381                 memcpy(&sdata->u.wds.remote_addr, (u8 *) &ap_addr->sa_data,
382                        ETH_ALEN);
383
384                 return 0;
385         }
386
387         return -EOPNOTSUPP;
388 }
389
390
391 static int ieee80211_ioctl_giwap(struct net_device *dev,
392                                  struct iw_request_info *info,
393                                  struct sockaddr *ap_addr, char *extra)
394 {
395         struct ieee80211_sub_if_data *sdata;
396
397         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
398         if (sdata->vif.type == NL80211_IFTYPE_STATION ||
399             sdata->vif.type == NL80211_IFTYPE_ADHOC) {
400                 if (sdata->u.sta.state == IEEE80211_STA_MLME_ASSOCIATED ||
401                     sdata->u.sta.state == IEEE80211_STA_MLME_IBSS_JOINED) {
402                         ap_addr->sa_family = ARPHRD_ETHER;
403                         memcpy(&ap_addr->sa_data, sdata->u.sta.bssid, ETH_ALEN);
404                         return 0;
405                 } else {
406                         memset(&ap_addr->sa_data, 0, ETH_ALEN);
407                         return 0;
408                 }
409         } else if (sdata->vif.type == NL80211_IFTYPE_WDS) {
410                 ap_addr->sa_family = ARPHRD_ETHER;
411                 memcpy(&ap_addr->sa_data, sdata->u.wds.remote_addr, ETH_ALEN);
412                 return 0;
413         }
414
415         return -EOPNOTSUPP;
416 }
417
418
419 static int ieee80211_ioctl_siwrate(struct net_device *dev,
420                                   struct iw_request_info *info,
421                                   struct iw_param *rate, char *extra)
422 {
423         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
424         int i, err = -EINVAL;
425         u32 target_rate = rate->value / 100000;
426         struct ieee80211_sub_if_data *sdata;
427         struct ieee80211_supported_band *sband;
428
429         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
430
431         sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
432
433         /* target_rate = -1, rate->fixed = 0 means auto only, so use all rates
434          * target_rate = X, rate->fixed = 1 means only rate X
435          * target_rate = X, rate->fixed = 0 means all rates <= X */
436         sdata->max_ratectrl_rateidx = -1;
437         sdata->force_unicast_rateidx = -1;
438         if (rate->value < 0)
439                 return 0;
440
441         for (i=0; i< sband->n_bitrates; i++) {
442                 struct ieee80211_rate *brate = &sband->bitrates[i];
443                 int this_rate = brate->bitrate;
444
445                 if (target_rate == this_rate) {
446                         sdata->max_ratectrl_rateidx = i;
447                         if (rate->fixed)
448                                 sdata->force_unicast_rateidx = i;
449                         err = 0;
450                         break;
451                 }
452         }
453         return err;
454 }
455
456 static int ieee80211_ioctl_giwrate(struct net_device *dev,
457                                   struct iw_request_info *info,
458                                   struct iw_param *rate, char *extra)
459 {
460         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
461         struct sta_info *sta;
462         struct ieee80211_sub_if_data *sdata;
463         struct ieee80211_supported_band *sband;
464
465         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
466
467         if (sdata->vif.type != NL80211_IFTYPE_STATION)
468                 return -EOPNOTSUPP;
469
470         sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
471
472         rcu_read_lock();
473
474         sta = sta_info_get(local, sdata->u.sta.bssid);
475
476         if (sta && !(sta->last_tx_rate.flags & IEEE80211_TX_RC_MCS))
477                 rate->value = sband->bitrates[sta->last_tx_rate.idx].bitrate;
478         else
479                 rate->value = 0;
480
481         rcu_read_unlock();
482
483         if (!sta)
484                 return -ENODEV;
485
486         rate->value *= 100000;
487
488         return 0;
489 }
490
491 static int ieee80211_ioctl_siwtxpower(struct net_device *dev,
492                                       struct iw_request_info *info,
493                                       union iwreq_data *data, char *extra)
494 {
495         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
496         struct ieee80211_channel* chan = local->hw.conf.channel;
497         u32 reconf_flags = 0;
498         int new_power_level;
499
500         if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
501                 return -EINVAL;
502         if (data->txpower.flags & IW_TXPOW_RANGE)
503                 return -EINVAL;
504         if (!chan)
505                 return -EINVAL;
506
507         if (data->txpower.fixed)
508                 new_power_level = min(data->txpower.value, chan->max_power);
509         else /* Automatic power level setting */
510                 new_power_level = chan->max_power;
511
512         local->user_power_level = new_power_level;
513         if (local->hw.conf.power_level != new_power_level)
514                 reconf_flags |= IEEE80211_CONF_CHANGE_POWER;
515
516         if (local->hw.conf.radio_enabled != !(data->txpower.disabled)) {
517                 local->hw.conf.radio_enabled = !(data->txpower.disabled);
518                 reconf_flags |= IEEE80211_CONF_CHANGE_RADIO_ENABLED;
519                 ieee80211_led_radio(local, local->hw.conf.radio_enabled);
520         }
521
522         if (reconf_flags)
523                 ieee80211_hw_config(local, reconf_flags);
524
525         return 0;
526 }
527
528 static int ieee80211_ioctl_giwtxpower(struct net_device *dev,
529                                    struct iw_request_info *info,
530                                    union iwreq_data *data, char *extra)
531 {
532         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
533
534         data->txpower.fixed = 1;
535         data->txpower.disabled = !(local->hw.conf.radio_enabled);
536         data->txpower.value = local->hw.conf.power_level;
537         data->txpower.flags = IW_TXPOW_DBM;
538
539         return 0;
540 }
541
542 static int ieee80211_ioctl_siwrts(struct net_device *dev,
543                                   struct iw_request_info *info,
544                                   struct iw_param *rts, char *extra)
545 {
546         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
547
548         if (rts->disabled)
549                 local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
550         else if (!rts->fixed)
551                 /* if the rts value is not fixed, then take default */
552                 local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
553         else if (rts->value < 0 || rts->value > IEEE80211_MAX_RTS_THRESHOLD)
554                 return -EINVAL;
555         else
556                 local->rts_threshold = rts->value;
557
558         /* If the wlan card performs RTS/CTS in hardware/firmware,
559          * configure it here */
560
561         if (local->ops->set_rts_threshold)
562                 local->ops->set_rts_threshold(local_to_hw(local),
563                                              local->rts_threshold);
564
565         return 0;
566 }
567
568 static int ieee80211_ioctl_giwrts(struct net_device *dev,
569                                   struct iw_request_info *info,
570                                   struct iw_param *rts, char *extra)
571 {
572         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
573
574         rts->value = local->rts_threshold;
575         rts->disabled = (rts->value >= IEEE80211_MAX_RTS_THRESHOLD);
576         rts->fixed = 1;
577
578         return 0;
579 }
580
581
582 static int ieee80211_ioctl_siwfrag(struct net_device *dev,
583                                    struct iw_request_info *info,
584                                    struct iw_param *frag, char *extra)
585 {
586         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
587
588         if (frag->disabled)
589                 local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD;
590         else if (!frag->fixed)
591                 local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD;
592         else if (frag->value < 256 ||
593                  frag->value > IEEE80211_MAX_FRAG_THRESHOLD)
594                 return -EINVAL;
595         else {
596                 /* Fragment length must be even, so strip LSB. */
597                 local->fragmentation_threshold = frag->value & ~0x1;
598         }
599
600         return 0;
601 }
602
603 static int ieee80211_ioctl_giwfrag(struct net_device *dev,
604                                    struct iw_request_info *info,
605                                    struct iw_param *frag, char *extra)
606 {
607         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
608
609         frag->value = local->fragmentation_threshold;
610         frag->disabled = (frag->value >= IEEE80211_MAX_RTS_THRESHOLD);
611         frag->fixed = 1;
612
613         return 0;
614 }
615
616
617 static int ieee80211_ioctl_siwretry(struct net_device *dev,
618                                     struct iw_request_info *info,
619                                     struct iw_param *retry, char *extra)
620 {
621         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
622
623         if (retry->disabled ||
624             (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
625                 return -EINVAL;
626
627         if (retry->flags & IW_RETRY_MAX) {
628                 local->hw.conf.long_frame_max_tx_count = retry->value;
629         } else if (retry->flags & IW_RETRY_MIN) {
630                 local->hw.conf.short_frame_max_tx_count = retry->value;
631         } else {
632                 local->hw.conf.long_frame_max_tx_count = retry->value;
633                 local->hw.conf.short_frame_max_tx_count = retry->value;
634         }
635
636         ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);
637
638         return 0;
639 }
640
641
642 static int ieee80211_ioctl_giwretry(struct net_device *dev,
643                                     struct iw_request_info *info,
644                                     struct iw_param *retry, char *extra)
645 {
646         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
647
648         retry->disabled = 0;
649         if (retry->flags == 0 || retry->flags & IW_RETRY_MIN) {
650                 /* first return min value, iwconfig will ask max value
651                  * later if needed */
652                 retry->flags |= IW_RETRY_LIMIT;
653                 retry->value = local->hw.conf.short_frame_max_tx_count;
654                 if (local->hw.conf.long_frame_max_tx_count !=
655                     local->hw.conf.short_frame_max_tx_count)
656                         retry->flags |= IW_RETRY_MIN;
657                 return 0;
658         }
659         if (retry->flags & IW_RETRY_MAX) {
660                 retry->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
661                 retry->value = local->hw.conf.long_frame_max_tx_count;
662         }
663
664         return 0;
665 }
666
667 static int ieee80211_ioctl_siwmlme(struct net_device *dev,
668                                    struct iw_request_info *info,
669                                    struct iw_point *data, char *extra)
670 {
671         struct ieee80211_sub_if_data *sdata;
672         struct iw_mlme *mlme = (struct iw_mlme *) extra;
673
674         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
675         if (sdata->vif.type != NL80211_IFTYPE_STATION &&
676             sdata->vif.type != NL80211_IFTYPE_ADHOC)
677                 return -EINVAL;
678
679         switch (mlme->cmd) {
680         case IW_MLME_DEAUTH:
681                 /* TODO: mlme->addr.sa_data */
682                 return ieee80211_sta_deauthenticate(sdata, mlme->reason_code);
683         case IW_MLME_DISASSOC:
684                 /* TODO: mlme->addr.sa_data */
685                 return ieee80211_sta_disassociate(sdata, mlme->reason_code);
686         default:
687                 return -EOPNOTSUPP;
688         }
689 }
690
691
692 static int ieee80211_ioctl_siwencode(struct net_device *dev,
693                                      struct iw_request_info *info,
694                                      struct iw_point *erq, char *keybuf)
695 {
696         struct ieee80211_sub_if_data *sdata;
697         int idx, i, alg = ALG_WEP;
698         u8 bcaddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
699         int remove = 0;
700
701         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
702
703         idx = erq->flags & IW_ENCODE_INDEX;
704         if (idx == 0) {
705                 if (sdata->default_key)
706                         for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
707                                 if (sdata->default_key == sdata->keys[i]) {
708                                         idx = i;
709                                         break;
710                                 }
711                         }
712         } else if (idx < 1 || idx > 4)
713                 return -EINVAL;
714         else
715                 idx--;
716
717         if (erq->flags & IW_ENCODE_DISABLED)
718                 remove = 1;
719         else if (erq->length == 0) {
720                 /* No key data - just set the default TX key index */
721                 ieee80211_set_default_key(sdata, idx);
722                 return 0;
723         }
724
725         return ieee80211_set_encryption(
726                 sdata, bcaddr,
727                 idx, alg, remove,
728                 !sdata->default_key,
729                 keybuf, erq->length);
730 }
731
732
733 static int ieee80211_ioctl_giwencode(struct net_device *dev,
734                                      struct iw_request_info *info,
735                                      struct iw_point *erq, char *key)
736 {
737         struct ieee80211_sub_if_data *sdata;
738         int idx, i;
739
740         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
741
742         idx = erq->flags & IW_ENCODE_INDEX;
743         if (idx < 1 || idx > 4) {
744                 idx = -1;
745                 if (!sdata->default_key)
746                         idx = 0;
747                 else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
748                         if (sdata->default_key == sdata->keys[i]) {
749                                 idx = i;
750                                 break;
751                         }
752                 }
753                 if (idx < 0)
754                         return -EINVAL;
755         } else
756                 idx--;
757
758         erq->flags = idx + 1;
759
760         if (!sdata->keys[idx]) {
761                 erq->length = 0;
762                 erq->flags |= IW_ENCODE_DISABLED;
763                 return 0;
764         }
765
766         memcpy(key, sdata->keys[idx]->conf.key,
767                min_t(int, erq->length, sdata->keys[idx]->conf.keylen));
768         erq->length = sdata->keys[idx]->conf.keylen;
769         erq->flags |= IW_ENCODE_ENABLED;
770
771         if (sdata->vif.type == NL80211_IFTYPE_STATION) {
772                 struct ieee80211_if_sta *ifsta = &sdata->u.sta;
773                 switch (ifsta->auth_alg) {
774                 case WLAN_AUTH_OPEN:
775                 case WLAN_AUTH_LEAP:
776                         erq->flags |= IW_ENCODE_OPEN;
777                         break;
778                 case WLAN_AUTH_SHARED_KEY:
779                         erq->flags |= IW_ENCODE_RESTRICTED;
780                         break;
781                 }
782         }
783
784         return 0;
785 }
786
787 static int ieee80211_ioctl_siwpower(struct net_device *dev,
788                                     struct iw_request_info *info,
789                                     struct iw_param *wrq,
790                                     char *extra)
791 {
792         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
793         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
794         struct ieee80211_conf *conf = &local->hw.conf;
795         int ret = 0, timeout = 0;
796         bool ps;
797
798         if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS))
799                 return -EOPNOTSUPP;
800
801         if (sdata->vif.type != NL80211_IFTYPE_STATION)
802                 return -EINVAL;
803
804         if (wrq->disabled) {
805                 ps = false;
806                 timeout = 0;
807                 goto set;
808         }
809
810         switch (wrq->flags & IW_POWER_MODE) {
811         case IW_POWER_ON:       /* If not specified */
812         case IW_POWER_MODE:     /* If set all mask */
813         case IW_POWER_ALL_R:    /* If explicitely state all */
814                 ps = true;
815                 break;
816         default:                /* Otherwise we ignore */
817                 return -EINVAL;
818         }
819
820         if (wrq->flags & ~(IW_POWER_MODE | IW_POWER_TIMEOUT))
821                 return -EINVAL;
822
823         if (wrq->flags & IW_POWER_TIMEOUT)
824                 timeout = wrq->value / 1000;
825
826  set:
827         if (ps == local->powersave && timeout == conf->dynamic_ps_timeout)
828                 return ret;
829
830         local->powersave = ps;
831         conf->dynamic_ps_timeout = timeout;
832
833         if (local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS)
834                 ret = ieee80211_hw_config(local,
835                                           IEEE80211_CONF_CHANGE_DYNPS_TIMEOUT);
836
837         if (!(sdata->u.sta.flags & IEEE80211_STA_ASSOCIATED))
838                 return ret;
839
840         if (conf->dynamic_ps_timeout > 0 &&
841             !(local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS)) {
842                 mod_timer(&local->dynamic_ps_timer, jiffies +
843                           msecs_to_jiffies(conf->dynamic_ps_timeout));
844         } else {
845                 if (local->powersave) {
846                         if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)
847                                 ieee80211_send_nullfunc(local, sdata, 1);
848                         conf->flags |= IEEE80211_CONF_PS;
849                         ret = ieee80211_hw_config(local,
850                                         IEEE80211_CONF_CHANGE_PS);
851                 } else {
852                         conf->flags &= ~IEEE80211_CONF_PS;
853                         ret = ieee80211_hw_config(local,
854                                         IEEE80211_CONF_CHANGE_PS);
855                         if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)
856                                 ieee80211_send_nullfunc(local, sdata, 0);
857                         del_timer_sync(&local->dynamic_ps_timer);
858                         cancel_work_sync(&local->dynamic_ps_enable_work);
859                 }
860         }
861
862         return ret;
863 }
864
865 static int ieee80211_ioctl_giwpower(struct net_device *dev,
866                                     struct iw_request_info *info,
867                                     union iwreq_data *wrqu,
868                                     char *extra)
869 {
870         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
871
872         wrqu->power.disabled = !local->powersave;
873
874         return 0;
875 }
876
877 static int ieee80211_ioctl_siwauth(struct net_device *dev,
878                                    struct iw_request_info *info,
879                                    struct iw_param *data, char *extra)
880 {
881         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
882         int ret = 0;
883
884         switch (data->flags & IW_AUTH_INDEX) {
885         case IW_AUTH_WPA_VERSION:
886         case IW_AUTH_CIPHER_GROUP:
887         case IW_AUTH_WPA_ENABLED:
888         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
889         case IW_AUTH_KEY_MGMT:
890         case IW_AUTH_CIPHER_GROUP_MGMT:
891                 break;
892         case IW_AUTH_CIPHER_PAIRWISE:
893                 if (sdata->vif.type == NL80211_IFTYPE_STATION) {
894                         if (data->value & (IW_AUTH_CIPHER_WEP40 |
895                             IW_AUTH_CIPHER_WEP104 | IW_AUTH_CIPHER_TKIP))
896                                 sdata->u.sta.flags |=
897                                         IEEE80211_STA_TKIP_WEP_USED;
898                         else
899                                 sdata->u.sta.flags &=
900                                         ~IEEE80211_STA_TKIP_WEP_USED;
901                 }
902                 break;
903         case IW_AUTH_DROP_UNENCRYPTED:
904                 sdata->drop_unencrypted = !!data->value;
905                 break;
906         case IW_AUTH_PRIVACY_INVOKED:
907                 if (sdata->vif.type != NL80211_IFTYPE_STATION)
908                         ret = -EINVAL;
909                 else {
910                         sdata->u.sta.flags &= ~IEEE80211_STA_PRIVACY_INVOKED;
911                         /*
912                          * Privacy invoked by wpa_supplicant, store the
913                          * value and allow associating to a protected
914                          * network without having a key up front.
915                          */
916                         if (data->value)
917                                 sdata->u.sta.flags |=
918                                         IEEE80211_STA_PRIVACY_INVOKED;
919                 }
920                 break;
921         case IW_AUTH_80211_AUTH_ALG:
922                 if (sdata->vif.type == NL80211_IFTYPE_STATION ||
923                     sdata->vif.type == NL80211_IFTYPE_ADHOC)
924                         sdata->u.sta.auth_algs = data->value;
925                 else
926                         ret = -EOPNOTSUPP;
927                 break;
928         case IW_AUTH_MFP:
929                 if (!(sdata->local->hw.flags & IEEE80211_HW_MFP_CAPABLE)) {
930                         ret = -EOPNOTSUPP;
931                         break;
932                 }
933                 if (sdata->vif.type == NL80211_IFTYPE_STATION ||
934                     sdata->vif.type == NL80211_IFTYPE_ADHOC) {
935                         switch (data->value) {
936                         case IW_AUTH_MFP_DISABLED:
937                                 sdata->u.sta.mfp = IEEE80211_MFP_DISABLED;
938                                 break;
939                         case IW_AUTH_MFP_OPTIONAL:
940                                 sdata->u.sta.mfp = IEEE80211_MFP_OPTIONAL;
941                                 break;
942                         case IW_AUTH_MFP_REQUIRED:
943                                 sdata->u.sta.mfp = IEEE80211_MFP_REQUIRED;
944                                 break;
945                         default:
946                                 ret = -EINVAL;
947                         }
948                 } else
949                         ret = -EOPNOTSUPP;
950                 break;
951         default:
952                 ret = -EOPNOTSUPP;
953                 break;
954         }
955         return ret;
956 }
957
958 /* Get wireless statistics.  Called by /proc/net/wireless and by SIOCGIWSTATS */
959 static struct iw_statistics *ieee80211_get_wireless_stats(struct net_device *dev)
960 {
961         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
962         struct iw_statistics *wstats = &local->wstats;
963         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
964         struct sta_info *sta = NULL;
965
966         rcu_read_lock();
967
968         if (sdata->vif.type == NL80211_IFTYPE_STATION ||
969             sdata->vif.type == NL80211_IFTYPE_ADHOC)
970                 sta = sta_info_get(local, sdata->u.sta.bssid);
971         if (!sta) {
972                 wstats->discard.fragment = 0;
973                 wstats->discard.misc = 0;
974                 wstats->qual.qual = 0;
975                 wstats->qual.level = 0;
976                 wstats->qual.noise = 0;
977                 wstats->qual.updated = IW_QUAL_ALL_INVALID;
978         } else {
979                 wstats->qual.level = sta->last_signal;
980                 wstats->qual.qual = sta->last_qual;
981                 wstats->qual.noise = sta->last_noise;
982                 wstats->qual.updated = local->wstats_flags;
983         }
984
985         rcu_read_unlock();
986
987         return wstats;
988 }
989
990 static int ieee80211_ioctl_giwauth(struct net_device *dev,
991                                    struct iw_request_info *info,
992                                    struct iw_param *data, char *extra)
993 {
994         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
995         int ret = 0;
996
997         switch (data->flags & IW_AUTH_INDEX) {
998         case IW_AUTH_80211_AUTH_ALG:
999                 if (sdata->vif.type == NL80211_IFTYPE_STATION ||
1000                     sdata->vif.type == NL80211_IFTYPE_ADHOC)
1001                         data->value = sdata->u.sta.auth_algs;
1002                 else
1003                         ret = -EOPNOTSUPP;
1004                 break;
1005         default:
1006                 ret = -EOPNOTSUPP;
1007                 break;
1008         }
1009         return ret;
1010 }
1011
1012
1013 static int ieee80211_ioctl_siwencodeext(struct net_device *dev,
1014                                         struct iw_request_info *info,
1015                                         struct iw_point *erq, char *extra)
1016 {
1017         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1018         struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
1019         int uninitialized_var(alg), idx, i, remove = 0;
1020
1021         switch (ext->alg) {
1022         case IW_ENCODE_ALG_NONE:
1023                 remove = 1;
1024                 break;
1025         case IW_ENCODE_ALG_WEP:
1026                 alg = ALG_WEP;
1027                 break;
1028         case IW_ENCODE_ALG_TKIP:
1029                 alg = ALG_TKIP;
1030                 break;
1031         case IW_ENCODE_ALG_CCMP:
1032                 alg = ALG_CCMP;
1033                 break;
1034         case IW_ENCODE_ALG_AES_CMAC:
1035                 alg = ALG_AES_CMAC;
1036                 break;
1037         default:
1038                 return -EOPNOTSUPP;
1039         }
1040
1041         if (erq->flags & IW_ENCODE_DISABLED)
1042                 remove = 1;
1043
1044         idx = erq->flags & IW_ENCODE_INDEX;
1045         if (alg == ALG_AES_CMAC) {
1046                 if (idx < NUM_DEFAULT_KEYS + 1 ||
1047                     idx > NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS) {
1048                         idx = -1;
1049                         if (!sdata->default_mgmt_key)
1050                                 idx = 0;
1051                         else for (i = NUM_DEFAULT_KEYS;
1052                                   i < NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS;
1053                                   i++) {
1054                                 if (sdata->default_mgmt_key == sdata->keys[i])
1055                                 {
1056                                         idx = i;
1057                                         break;
1058                                 }
1059                         }
1060                         if (idx < 0)
1061                                 return -EINVAL;
1062                 } else
1063                         idx--;
1064         } else {
1065                 if (idx < 1 || idx > 4) {
1066                         idx = -1;
1067                         if (!sdata->default_key)
1068                                 idx = 0;
1069                         else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1070                                 if (sdata->default_key == sdata->keys[i]) {
1071                                         idx = i;
1072                                         break;
1073                                 }
1074                         }
1075                         if (idx < 0)
1076                                 return -EINVAL;
1077                 } else
1078                         idx--;
1079         }
1080
1081         return ieee80211_set_encryption(sdata, ext->addr.sa_data, idx, alg,
1082                                         remove,
1083                                         ext->ext_flags &
1084                                         IW_ENCODE_EXT_SET_TX_KEY,
1085                                         ext->key, ext->key_len);
1086 }
1087
1088
1089 /* Structures to export the Wireless Handlers */
1090
1091 static const iw_handler ieee80211_handler[] =
1092 {
1093         (iw_handler) NULL,                              /* SIOCSIWCOMMIT */
1094         (iw_handler) cfg80211_wext_giwname,             /* SIOCGIWNAME */
1095         (iw_handler) NULL,                              /* SIOCSIWNWID */
1096         (iw_handler) NULL,                              /* SIOCGIWNWID */
1097         (iw_handler) ieee80211_ioctl_siwfreq,           /* SIOCSIWFREQ */
1098         (iw_handler) ieee80211_ioctl_giwfreq,           /* SIOCGIWFREQ */
1099         (iw_handler) cfg80211_wext_siwmode,             /* SIOCSIWMODE */
1100         (iw_handler) cfg80211_wext_giwmode,             /* SIOCGIWMODE */
1101         (iw_handler) NULL,                              /* SIOCSIWSENS */
1102         (iw_handler) NULL,                              /* SIOCGIWSENS */
1103         (iw_handler) NULL /* not used */,               /* SIOCSIWRANGE */
1104         (iw_handler) ieee80211_ioctl_giwrange,          /* SIOCGIWRANGE */
1105         (iw_handler) NULL /* not used */,               /* SIOCSIWPRIV */
1106         (iw_handler) NULL /* kernel code */,            /* SIOCGIWPRIV */
1107         (iw_handler) NULL /* not used */,               /* SIOCSIWSTATS */
1108         (iw_handler) NULL /* kernel code */,            /* SIOCGIWSTATS */
1109         (iw_handler) NULL,                              /* SIOCSIWSPY */
1110         (iw_handler) NULL,                              /* SIOCGIWSPY */
1111         (iw_handler) NULL,                              /* SIOCSIWTHRSPY */
1112         (iw_handler) NULL,                              /* SIOCGIWTHRSPY */
1113         (iw_handler) ieee80211_ioctl_siwap,             /* SIOCSIWAP */
1114         (iw_handler) ieee80211_ioctl_giwap,             /* SIOCGIWAP */
1115         (iw_handler) ieee80211_ioctl_siwmlme,           /* SIOCSIWMLME */
1116         (iw_handler) NULL,                              /* SIOCGIWAPLIST */
1117         (iw_handler) cfg80211_wext_siwscan,             /* SIOCSIWSCAN */
1118         (iw_handler) cfg80211_wext_giwscan,             /* SIOCGIWSCAN */
1119         (iw_handler) ieee80211_ioctl_siwessid,          /* SIOCSIWESSID */
1120         (iw_handler) ieee80211_ioctl_giwessid,          /* SIOCGIWESSID */
1121         (iw_handler) NULL,                              /* SIOCSIWNICKN */
1122         (iw_handler) NULL,                              /* SIOCGIWNICKN */
1123         (iw_handler) NULL,                              /* -- hole -- */
1124         (iw_handler) NULL,                              /* -- hole -- */
1125         (iw_handler) ieee80211_ioctl_siwrate,           /* SIOCSIWRATE */
1126         (iw_handler) ieee80211_ioctl_giwrate,           /* SIOCGIWRATE */
1127         (iw_handler) ieee80211_ioctl_siwrts,            /* SIOCSIWRTS */
1128         (iw_handler) ieee80211_ioctl_giwrts,            /* SIOCGIWRTS */
1129         (iw_handler) ieee80211_ioctl_siwfrag,           /* SIOCSIWFRAG */
1130         (iw_handler) ieee80211_ioctl_giwfrag,           /* SIOCGIWFRAG */
1131         (iw_handler) ieee80211_ioctl_siwtxpower,        /* SIOCSIWTXPOW */
1132         (iw_handler) ieee80211_ioctl_giwtxpower,        /* SIOCGIWTXPOW */
1133         (iw_handler) ieee80211_ioctl_siwretry,          /* SIOCSIWRETRY */
1134         (iw_handler) ieee80211_ioctl_giwretry,          /* SIOCGIWRETRY */
1135         (iw_handler) ieee80211_ioctl_siwencode,         /* SIOCSIWENCODE */
1136         (iw_handler) ieee80211_ioctl_giwencode,         /* SIOCGIWENCODE */
1137         (iw_handler) ieee80211_ioctl_siwpower,          /* SIOCSIWPOWER */
1138         (iw_handler) ieee80211_ioctl_giwpower,          /* SIOCGIWPOWER */
1139         (iw_handler) NULL,                              /* -- hole -- */
1140         (iw_handler) NULL,                              /* -- hole -- */
1141         (iw_handler) ieee80211_ioctl_siwgenie,          /* SIOCSIWGENIE */
1142         (iw_handler) NULL,                              /* SIOCGIWGENIE */
1143         (iw_handler) ieee80211_ioctl_siwauth,           /* SIOCSIWAUTH */
1144         (iw_handler) ieee80211_ioctl_giwauth,           /* SIOCGIWAUTH */
1145         (iw_handler) ieee80211_ioctl_siwencodeext,      /* SIOCSIWENCODEEXT */
1146         (iw_handler) NULL,                              /* SIOCGIWENCODEEXT */
1147         (iw_handler) NULL,                              /* SIOCSIWPMKSA */
1148         (iw_handler) NULL,                              /* -- hole -- */
1149 };
1150
1151 const struct iw_handler_def ieee80211_iw_handler_def =
1152 {
1153         .num_standard   = ARRAY_SIZE(ieee80211_handler),
1154         .standard       = (iw_handler *) ieee80211_handler,
1155         .get_wireless_stats = ieee80211_get_wireless_stats,
1156 };