7df42f54187319c564671e60eb9d4f590e197ea4
[firefly-linux-kernel-4.4.55.git] / net / wireless / wext-compat.c
1 /*
2  * cfg80211 - wext compat code
3  *
4  * This is temporary code until all wireless functionality is migrated
5  * into cfg80211, when that happens all the exports here go away and
6  * we directly assign the wireless handlers of wireless interfaces.
7  *
8  * Copyright 2008-2009  Johannes Berg <johannes@sipsolutions.net>
9  */
10
11 #include <linux/export.h>
12 #include <linux/wireless.h>
13 #include <linux/nl80211.h>
14 #include <linux/if_arp.h>
15 #include <linux/etherdevice.h>
16 #include <linux/slab.h>
17 #include <net/iw_handler.h>
18 #include <net/cfg80211.h>
19 #include <net/cfg80211-wext.h>
20 #include "wext-compat.h"
21 #include "core.h"
22
23 int cfg80211_wext_giwname(struct net_device *dev,
24                           struct iw_request_info *info,
25                           char *name, char *extra)
26 {
27         struct wireless_dev *wdev = dev->ieee80211_ptr;
28         struct ieee80211_supported_band *sband;
29         bool is_ht = false, is_a = false, is_b = false, is_g = false;
30
31         if (!wdev)
32                 return -EOPNOTSUPP;
33
34         sband = wdev->wiphy->bands[IEEE80211_BAND_5GHZ];
35         if (sband) {
36                 is_a = true;
37                 is_ht |= sband->ht_cap.ht_supported;
38         }
39
40         sband = wdev->wiphy->bands[IEEE80211_BAND_2GHZ];
41         if (sband) {
42                 int i;
43                 /* Check for mandatory rates */
44                 for (i = 0; i < sband->n_bitrates; i++) {
45                         if (sband->bitrates[i].bitrate == 10)
46                                 is_b = true;
47                         if (sband->bitrates[i].bitrate == 60)
48                                 is_g = true;
49                 }
50                 is_ht |= sband->ht_cap.ht_supported;
51         }
52
53         strcpy(name, "IEEE 802.11");
54         if (is_a)
55                 strcat(name, "a");
56         if (is_b)
57                 strcat(name, "b");
58         if (is_g)
59                 strcat(name, "g");
60         if (is_ht)
61                 strcat(name, "n");
62
63         return 0;
64 }
65 EXPORT_SYMBOL_GPL(cfg80211_wext_giwname);
66
67 int cfg80211_wext_siwmode(struct net_device *dev, struct iw_request_info *info,
68                           u32 *mode, char *extra)
69 {
70         struct wireless_dev *wdev = dev->ieee80211_ptr;
71         struct cfg80211_registered_device *rdev;
72         struct vif_params vifparams;
73         enum nl80211_iftype type;
74         int ret;
75
76         rdev = wiphy_to_dev(wdev->wiphy);
77
78         switch (*mode) {
79         case IW_MODE_INFRA:
80                 type = NL80211_IFTYPE_STATION;
81                 break;
82         case IW_MODE_ADHOC:
83                 type = NL80211_IFTYPE_ADHOC;
84                 break;
85         case IW_MODE_REPEAT:
86                 type = NL80211_IFTYPE_WDS;
87                 break;
88         case IW_MODE_MONITOR:
89                 type = NL80211_IFTYPE_MONITOR;
90                 break;
91         default:
92                 return -EINVAL;
93         }
94
95         if (type == wdev->iftype)
96                 return 0;
97
98         memset(&vifparams, 0, sizeof(vifparams));
99
100         cfg80211_lock_rdev(rdev);
101         ret = cfg80211_change_iface(rdev, dev, type, NULL, &vifparams);
102         cfg80211_unlock_rdev(rdev);
103
104         return ret;
105 }
106 EXPORT_SYMBOL_GPL(cfg80211_wext_siwmode);
107
108 int cfg80211_wext_giwmode(struct net_device *dev, struct iw_request_info *info,
109                           u32 *mode, char *extra)
110 {
111         struct wireless_dev *wdev = dev->ieee80211_ptr;
112
113         if (!wdev)
114                 return -EOPNOTSUPP;
115
116         switch (wdev->iftype) {
117         case NL80211_IFTYPE_AP:
118                 *mode = IW_MODE_MASTER;
119                 break;
120         case NL80211_IFTYPE_STATION:
121                 *mode = IW_MODE_INFRA;
122                 break;
123         case NL80211_IFTYPE_ADHOC:
124                 *mode = IW_MODE_ADHOC;
125                 break;
126         case NL80211_IFTYPE_MONITOR:
127                 *mode = IW_MODE_MONITOR;
128                 break;
129         case NL80211_IFTYPE_WDS:
130                 *mode = IW_MODE_REPEAT;
131                 break;
132         case NL80211_IFTYPE_AP_VLAN:
133                 *mode = IW_MODE_SECOND;         /* FIXME */
134                 break;
135         default:
136                 *mode = IW_MODE_AUTO;
137                 break;
138         }
139         return 0;
140 }
141 EXPORT_SYMBOL_GPL(cfg80211_wext_giwmode);
142
143
144 int cfg80211_wext_giwrange(struct net_device *dev,
145                            struct iw_request_info *info,
146                            struct iw_point *data, char *extra)
147 {
148         struct wireless_dev *wdev = dev->ieee80211_ptr;
149         struct iw_range *range = (struct iw_range *) extra;
150         enum ieee80211_band band;
151         int i, c = 0;
152
153         if (!wdev)
154                 return -EOPNOTSUPP;
155
156         data->length = sizeof(struct iw_range);
157         memset(range, 0, sizeof(struct iw_range));
158
159         range->we_version_compiled = WIRELESS_EXT;
160         range->we_version_source = 21;
161         range->retry_capa = IW_RETRY_LIMIT;
162         range->retry_flags = IW_RETRY_LIMIT;
163         range->min_retry = 0;
164         range->max_retry = 255;
165         range->min_rts = 0;
166         range->max_rts = 2347;
167         range->min_frag = 256;
168         range->max_frag = 2346;
169
170         range->max_encoding_tokens = 4;
171
172         range->max_qual.updated = IW_QUAL_NOISE_INVALID;
173
174         switch (wdev->wiphy->signal_type) {
175         case CFG80211_SIGNAL_TYPE_NONE:
176                 break;
177         case CFG80211_SIGNAL_TYPE_MBM:
178                 range->max_qual.level = -110;
179                 range->max_qual.qual = 70;
180                 range->avg_qual.qual = 35;
181                 range->max_qual.updated |= IW_QUAL_DBM;
182                 range->max_qual.updated |= IW_QUAL_QUAL_UPDATED;
183                 range->max_qual.updated |= IW_QUAL_LEVEL_UPDATED;
184                 break;
185         case CFG80211_SIGNAL_TYPE_UNSPEC:
186                 range->max_qual.level = 100;
187                 range->max_qual.qual = 100;
188                 range->avg_qual.qual = 50;
189                 range->max_qual.updated |= IW_QUAL_QUAL_UPDATED;
190                 range->max_qual.updated |= IW_QUAL_LEVEL_UPDATED;
191                 break;
192         }
193
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 = range->max_qual.updated;
197
198         for (i = 0; i < wdev->wiphy->n_cipher_suites; i++) {
199                 switch (wdev->wiphy->cipher_suites[i]) {
200                 case WLAN_CIPHER_SUITE_TKIP:
201                         range->enc_capa |= (IW_ENC_CAPA_CIPHER_TKIP |
202                                             IW_ENC_CAPA_WPA);
203                         break;
204
205                 case WLAN_CIPHER_SUITE_CCMP:
206                         range->enc_capa |= (IW_ENC_CAPA_CIPHER_CCMP |
207                                             IW_ENC_CAPA_WPA2);
208                         break;
209
210                 case WLAN_CIPHER_SUITE_WEP40:
211                         range->encoding_size[range->num_encoding_sizes++] =
212                                 WLAN_KEY_LEN_WEP40;
213                         break;
214
215                 case WLAN_CIPHER_SUITE_WEP104:
216                         range->encoding_size[range->num_encoding_sizes++] =
217                                 WLAN_KEY_LEN_WEP104;
218                         break;
219                 }
220         }
221
222         for (band = 0; band < IEEE80211_NUM_BANDS; band ++) {
223                 struct ieee80211_supported_band *sband;
224
225                 sband = wdev->wiphy->bands[band];
226
227                 if (!sband)
228                         continue;
229
230                 for (i = 0; i < sband->n_channels && c < IW_MAX_FREQUENCIES; i++) {
231                         struct ieee80211_channel *chan = &sband->channels[i];
232
233                         if (!(chan->flags & IEEE80211_CHAN_DISABLED)) {
234                                 range->freq[c].i =
235                                         ieee80211_frequency_to_channel(
236                                                 chan->center_freq);
237                                 range->freq[c].m = chan->center_freq;
238                                 range->freq[c].e = 6;
239                                 c++;
240                         }
241                 }
242         }
243         range->num_channels = c;
244         range->num_frequency = c;
245
246         IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
247         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
248         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
249
250         if (wdev->wiphy->max_scan_ssids > 0)
251                 range->scan_capa |= IW_SCAN_CAPA_ESSID;
252
253         return 0;
254 }
255 EXPORT_SYMBOL_GPL(cfg80211_wext_giwrange);
256
257
258 /**
259  * cfg80211_wext_freq - get wext frequency for non-"auto"
260  * @wiphy: the wiphy
261  * @freq: the wext freq encoding
262  *
263  * Returns a frequency, or a negative error code, or 0 for auto.
264  */
265 int cfg80211_wext_freq(struct wiphy *wiphy, struct iw_freq *freq)
266 {
267         /*
268          * Parse frequency - return 0 for auto and
269          * -EINVAL for impossible things.
270          */
271         if (freq->e == 0) {
272                 enum ieee80211_band band = IEEE80211_BAND_2GHZ;
273                 if (freq->m < 0)
274                         return 0;
275                 if (freq->m > 14)
276                         band = IEEE80211_BAND_5GHZ;
277                 return ieee80211_channel_to_frequency(freq->m, band);
278         } else {
279                 int i, div = 1000000;
280                 for (i = 0; i < freq->e; i++)
281                         div /= 10;
282                 if (div <= 0)
283                         return -EINVAL;
284                 return freq->m / div;
285         }
286 }
287
288 int cfg80211_wext_siwrts(struct net_device *dev,
289                          struct iw_request_info *info,
290                          struct iw_param *rts, char *extra)
291 {
292         struct wireless_dev *wdev = dev->ieee80211_ptr;
293         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
294         u32 orts = wdev->wiphy->rts_threshold;
295         int err;
296
297         if (rts->disabled || !rts->fixed)
298                 wdev->wiphy->rts_threshold = (u32) -1;
299         else if (rts->value < 0)
300                 return -EINVAL;
301         else
302                 wdev->wiphy->rts_threshold = rts->value;
303
304         err = rdev->ops->set_wiphy_params(wdev->wiphy,
305                                           WIPHY_PARAM_RTS_THRESHOLD);
306         if (err)
307                 wdev->wiphy->rts_threshold = orts;
308
309         return err;
310 }
311 EXPORT_SYMBOL_GPL(cfg80211_wext_siwrts);
312
313 int cfg80211_wext_giwrts(struct net_device *dev,
314                          struct iw_request_info *info,
315                          struct iw_param *rts, char *extra)
316 {
317         struct wireless_dev *wdev = dev->ieee80211_ptr;
318
319         rts->value = wdev->wiphy->rts_threshold;
320         rts->disabled = rts->value == (u32) -1;
321         rts->fixed = 1;
322
323         return 0;
324 }
325 EXPORT_SYMBOL_GPL(cfg80211_wext_giwrts);
326
327 int cfg80211_wext_siwfrag(struct net_device *dev,
328                           struct iw_request_info *info,
329                           struct iw_param *frag, char *extra)
330 {
331         struct wireless_dev *wdev = dev->ieee80211_ptr;
332         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
333         u32 ofrag = wdev->wiphy->frag_threshold;
334         int err;
335
336         if (frag->disabled || !frag->fixed)
337                 wdev->wiphy->frag_threshold = (u32) -1;
338         else if (frag->value < 256)
339                 return -EINVAL;
340         else {
341                 /* Fragment length must be even, so strip LSB. */
342                 wdev->wiphy->frag_threshold = frag->value & ~0x1;
343         }
344
345         err = rdev->ops->set_wiphy_params(wdev->wiphy,
346                                           WIPHY_PARAM_FRAG_THRESHOLD);
347         if (err)
348                 wdev->wiphy->frag_threshold = ofrag;
349
350         return err;
351 }
352 EXPORT_SYMBOL_GPL(cfg80211_wext_siwfrag);
353
354 int cfg80211_wext_giwfrag(struct net_device *dev,
355                           struct iw_request_info *info,
356                           struct iw_param *frag, char *extra)
357 {
358         struct wireless_dev *wdev = dev->ieee80211_ptr;
359
360         frag->value = wdev->wiphy->frag_threshold;
361         frag->disabled = frag->value == (u32) -1;
362         frag->fixed = 1;
363
364         return 0;
365 }
366 EXPORT_SYMBOL_GPL(cfg80211_wext_giwfrag);
367
368 static int cfg80211_wext_siwretry(struct net_device *dev,
369                                   struct iw_request_info *info,
370                                   struct iw_param *retry, char *extra)
371 {
372         struct wireless_dev *wdev = dev->ieee80211_ptr;
373         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
374         u32 changed = 0;
375         u8 olong = wdev->wiphy->retry_long;
376         u8 oshort = wdev->wiphy->retry_short;
377         int err;
378
379         if (retry->disabled ||
380             (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
381                 return -EINVAL;
382
383         if (retry->flags & IW_RETRY_LONG) {
384                 wdev->wiphy->retry_long = retry->value;
385                 changed |= WIPHY_PARAM_RETRY_LONG;
386         } else if (retry->flags & IW_RETRY_SHORT) {
387                 wdev->wiphy->retry_short = retry->value;
388                 changed |= WIPHY_PARAM_RETRY_SHORT;
389         } else {
390                 wdev->wiphy->retry_short = retry->value;
391                 wdev->wiphy->retry_long = retry->value;
392                 changed |= WIPHY_PARAM_RETRY_LONG;
393                 changed |= WIPHY_PARAM_RETRY_SHORT;
394         }
395
396         if (!changed)
397                 return 0;
398
399         err = rdev->ops->set_wiphy_params(wdev->wiphy, changed);
400         if (err) {
401                 wdev->wiphy->retry_short = oshort;
402                 wdev->wiphy->retry_long = olong;
403         }
404
405         return err;
406 }
407
408 int cfg80211_wext_giwretry(struct net_device *dev,
409                            struct iw_request_info *info,
410                            struct iw_param *retry, char *extra)
411 {
412         struct wireless_dev *wdev = dev->ieee80211_ptr;
413
414         retry->disabled = 0;
415
416         if (retry->flags == 0 || (retry->flags & IW_RETRY_SHORT)) {
417                 /*
418                  * First return short value, iwconfig will ask long value
419                  * later if needed
420                  */
421                 retry->flags |= IW_RETRY_LIMIT;
422                 retry->value = wdev->wiphy->retry_short;
423                 if (wdev->wiphy->retry_long != wdev->wiphy->retry_short)
424                         retry->flags |= IW_RETRY_LONG;
425
426                 return 0;
427         }
428
429         if (retry->flags & IW_RETRY_LONG) {
430                 retry->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
431                 retry->value = wdev->wiphy->retry_long;
432         }
433
434         return 0;
435 }
436 EXPORT_SYMBOL_GPL(cfg80211_wext_giwretry);
437
438 static int __cfg80211_set_encryption(struct cfg80211_registered_device *rdev,
439                                      struct net_device *dev, bool pairwise,
440                                      const u8 *addr, bool remove, bool tx_key,
441                                      int idx, struct key_params *params)
442 {
443         struct wireless_dev *wdev = dev->ieee80211_ptr;
444         int err, i;
445         bool rejoin = false;
446
447         if (pairwise && !addr)
448                 return -EINVAL;
449
450         if (!wdev->wext.keys) {
451                 wdev->wext.keys = kzalloc(sizeof(*wdev->wext.keys),
452                                               GFP_KERNEL);
453                 if (!wdev->wext.keys)
454                         return -ENOMEM;
455                 for (i = 0; i < 6; i++)
456                         wdev->wext.keys->params[i].key =
457                                 wdev->wext.keys->data[i];
458         }
459
460         if (wdev->iftype != NL80211_IFTYPE_ADHOC &&
461             wdev->iftype != NL80211_IFTYPE_STATION)
462                 return -EOPNOTSUPP;
463
464         if (params->cipher == WLAN_CIPHER_SUITE_AES_CMAC) {
465                 if (!wdev->current_bss)
466                         return -ENOLINK;
467
468                 if (!rdev->ops->set_default_mgmt_key)
469                         return -EOPNOTSUPP;
470
471                 if (idx < 4 || idx > 5)
472                         return -EINVAL;
473         } else if (idx < 0 || idx > 3)
474                 return -EINVAL;
475
476         if (remove) {
477                 err = 0;
478                 if (wdev->current_bss) {
479                         /*
480                          * If removing the current TX key, we will need to
481                          * join a new IBSS without the privacy bit clear.
482                          */
483                         if (idx == wdev->wext.default_key &&
484                             wdev->iftype == NL80211_IFTYPE_ADHOC) {
485                                 __cfg80211_leave_ibss(rdev, wdev->netdev, true);
486                                 rejoin = true;
487                         }
488
489                         if (!pairwise && addr &&
490                             !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
491                                 err = -ENOENT;
492                         else
493                                 err = rdev->ops->del_key(&rdev->wiphy, dev, idx,
494                                                          pairwise, addr);
495                 }
496                 wdev->wext.connect.privacy = false;
497                 /*
498                  * Applications using wireless extensions expect to be
499                  * able to delete keys that don't exist, so allow that.
500                  */
501                 if (err == -ENOENT)
502                         err = 0;
503                 if (!err) {
504                         if (!addr) {
505                                 wdev->wext.keys->params[idx].key_len = 0;
506                                 wdev->wext.keys->params[idx].cipher = 0;
507                         }
508                         if (idx == wdev->wext.default_key)
509                                 wdev->wext.default_key = -1;
510                         else if (idx == wdev->wext.default_mgmt_key)
511                                 wdev->wext.default_mgmt_key = -1;
512                 }
513
514                 if (!err && rejoin)
515                         err = cfg80211_ibss_wext_join(rdev, wdev);
516
517                 return err;
518         }
519
520         if (addr)
521                 tx_key = false;
522
523         if (cfg80211_validate_key_settings(rdev, params, idx, pairwise, addr))
524                 return -EINVAL;
525
526         err = 0;
527         if (wdev->current_bss)
528                 err = rdev->ops->add_key(&rdev->wiphy, dev, idx,
529                                          pairwise, addr, params);
530         if (err)
531                 return err;
532
533         if (!addr) {
534                 wdev->wext.keys->params[idx] = *params;
535                 memcpy(wdev->wext.keys->data[idx],
536                         params->key, params->key_len);
537                 wdev->wext.keys->params[idx].key =
538                         wdev->wext.keys->data[idx];
539         }
540
541         if ((params->cipher == WLAN_CIPHER_SUITE_WEP40 ||
542              params->cipher == WLAN_CIPHER_SUITE_WEP104) &&
543             (tx_key || (!addr && wdev->wext.default_key == -1))) {
544                 if (wdev->current_bss) {
545                         /*
546                          * If we are getting a new TX key from not having
547                          * had one before we need to join a new IBSS with
548                          * the privacy bit set.
549                          */
550                         if (wdev->iftype == NL80211_IFTYPE_ADHOC &&
551                             wdev->wext.default_key == -1) {
552                                 __cfg80211_leave_ibss(rdev, wdev->netdev, true);
553                                 rejoin = true;
554                         }
555                         err = rdev->ops->set_default_key(&rdev->wiphy, dev,
556                                                          idx, true, true);
557                 }
558                 if (!err) {
559                         wdev->wext.default_key = idx;
560                         if (rejoin)
561                                 err = cfg80211_ibss_wext_join(rdev, wdev);
562                 }
563                 return err;
564         }
565
566         if (params->cipher == WLAN_CIPHER_SUITE_AES_CMAC &&
567             (tx_key || (!addr && wdev->wext.default_mgmt_key == -1))) {
568                 if (wdev->current_bss)
569                         err = rdev->ops->set_default_mgmt_key(&rdev->wiphy,
570                                                               dev, idx);
571                 if (!err)
572                         wdev->wext.default_mgmt_key = idx;
573                 return err;
574         }
575
576         return 0;
577 }
578
579 static int cfg80211_set_encryption(struct cfg80211_registered_device *rdev,
580                                    struct net_device *dev, bool pairwise,
581                                    const u8 *addr, bool remove, bool tx_key,
582                                    int idx, struct key_params *params)
583 {
584         int err;
585
586         /* devlist mutex needed for possible IBSS re-join */
587         mutex_lock(&rdev->devlist_mtx);
588         wdev_lock(dev->ieee80211_ptr);
589         err = __cfg80211_set_encryption(rdev, dev, pairwise, addr,
590                                         remove, tx_key, idx, params);
591         wdev_unlock(dev->ieee80211_ptr);
592         mutex_unlock(&rdev->devlist_mtx);
593
594         return err;
595 }
596
597 static int cfg80211_wext_siwencode(struct net_device *dev,
598                                    struct iw_request_info *info,
599                                    struct iw_point *erq, char *keybuf)
600 {
601         struct wireless_dev *wdev = dev->ieee80211_ptr;
602         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
603         int idx, err;
604         bool remove = false;
605         struct key_params params;
606
607         if (wdev->iftype != NL80211_IFTYPE_STATION &&
608             wdev->iftype != NL80211_IFTYPE_ADHOC)
609                 return -EOPNOTSUPP;
610
611         /* no use -- only MFP (set_default_mgmt_key) is optional */
612         if (!rdev->ops->del_key ||
613             !rdev->ops->add_key ||
614             !rdev->ops->set_default_key)
615                 return -EOPNOTSUPP;
616
617         idx = erq->flags & IW_ENCODE_INDEX;
618         if (idx == 0) {
619                 idx = wdev->wext.default_key;
620                 if (idx < 0)
621                         idx = 0;
622         } else if (idx < 1 || idx > 4)
623                 return -EINVAL;
624         else
625                 idx--;
626
627         if (erq->flags & IW_ENCODE_DISABLED)
628                 remove = true;
629         else if (erq->length == 0) {
630                 /* No key data - just set the default TX key index */
631                 err = 0;
632                 wdev_lock(wdev);
633                 if (wdev->current_bss)
634                         err = rdev->ops->set_default_key(&rdev->wiphy, dev,
635                                                          idx, true, true);
636                 if (!err)
637                         wdev->wext.default_key = idx;
638                 wdev_unlock(wdev);
639                 return err;
640         }
641
642         memset(&params, 0, sizeof(params));
643         params.key = keybuf;
644         params.key_len = erq->length;
645         if (erq->length == 5)
646                 params.cipher = WLAN_CIPHER_SUITE_WEP40;
647         else if (erq->length == 13)
648                 params.cipher = WLAN_CIPHER_SUITE_WEP104;
649         else if (!remove)
650                 return -EINVAL;
651
652         return cfg80211_set_encryption(rdev, dev, false, NULL, remove,
653                                        wdev->wext.default_key == -1,
654                                        idx, &params);
655 }
656
657 static int cfg80211_wext_siwencodeext(struct net_device *dev,
658                                       struct iw_request_info *info,
659                                       struct iw_point *erq, char *extra)
660 {
661         struct wireless_dev *wdev = dev->ieee80211_ptr;
662         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
663         struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
664         const u8 *addr;
665         int idx;
666         bool remove = false;
667         struct key_params params;
668         u32 cipher;
669
670         if (wdev->iftype != NL80211_IFTYPE_STATION &&
671             wdev->iftype != NL80211_IFTYPE_ADHOC)
672                 return -EOPNOTSUPP;
673
674         /* no use -- only MFP (set_default_mgmt_key) is optional */
675         if (!rdev->ops->del_key ||
676             !rdev->ops->add_key ||
677             !rdev->ops->set_default_key)
678                 return -EOPNOTSUPP;
679
680         switch (ext->alg) {
681         case IW_ENCODE_ALG_NONE:
682                 remove = true;
683                 cipher = 0;
684                 break;
685         case IW_ENCODE_ALG_WEP:
686                 if (ext->key_len == 5)
687                         cipher = WLAN_CIPHER_SUITE_WEP40;
688                 else if (ext->key_len == 13)
689                         cipher = WLAN_CIPHER_SUITE_WEP104;
690                 else
691                         return -EINVAL;
692                 break;
693         case IW_ENCODE_ALG_TKIP:
694                 cipher = WLAN_CIPHER_SUITE_TKIP;
695                 break;
696         case IW_ENCODE_ALG_CCMP:
697                 cipher = WLAN_CIPHER_SUITE_CCMP;
698                 break;
699         case IW_ENCODE_ALG_AES_CMAC:
700                 cipher = WLAN_CIPHER_SUITE_AES_CMAC;
701                 break;
702         default:
703                 return -EOPNOTSUPP;
704         }
705
706         if (erq->flags & IW_ENCODE_DISABLED)
707                 remove = true;
708
709         idx = erq->flags & IW_ENCODE_INDEX;
710         if (cipher == WLAN_CIPHER_SUITE_AES_CMAC) {
711                 if (idx < 4 || idx > 5) {
712                         idx = wdev->wext.default_mgmt_key;
713                         if (idx < 0)
714                                 return -EINVAL;
715                 } else
716                         idx--;
717         } else {
718                 if (idx < 1 || idx > 4) {
719                         idx = wdev->wext.default_key;
720                         if (idx < 0)
721                                 return -EINVAL;
722                 } else
723                         idx--;
724         }
725
726         addr = ext->addr.sa_data;
727         if (is_broadcast_ether_addr(addr))
728                 addr = NULL;
729
730         memset(&params, 0, sizeof(params));
731         params.key = ext->key;
732         params.key_len = ext->key_len;
733         params.cipher = cipher;
734
735         if (ext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
736                 params.seq = ext->rx_seq;
737                 params.seq_len = 6;
738         }
739
740         return cfg80211_set_encryption(
741                         rdev, dev,
742                         !(ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY),
743                         addr, remove,
744                         ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY,
745                         idx, &params);
746 }
747
748 static int cfg80211_wext_giwencode(struct net_device *dev,
749                                    struct iw_request_info *info,
750                                    struct iw_point *erq, char *keybuf)
751 {
752         struct wireless_dev *wdev = dev->ieee80211_ptr;
753         int idx;
754
755         if (wdev->iftype != NL80211_IFTYPE_STATION &&
756             wdev->iftype != NL80211_IFTYPE_ADHOC)
757                 return -EOPNOTSUPP;
758
759         idx = erq->flags & IW_ENCODE_INDEX;
760         if (idx == 0) {
761                 idx = wdev->wext.default_key;
762                 if (idx < 0)
763                         idx = 0;
764         } else if (idx < 1 || idx > 4)
765                 return -EINVAL;
766         else
767                 idx--;
768
769         erq->flags = idx + 1;
770
771         if (!wdev->wext.keys || !wdev->wext.keys->params[idx].cipher) {
772                 erq->flags |= IW_ENCODE_DISABLED;
773                 erq->length = 0;
774                 return 0;
775         }
776
777         erq->length = min_t(size_t, erq->length,
778                             wdev->wext.keys->params[idx].key_len);
779         memcpy(keybuf, wdev->wext.keys->params[idx].key, erq->length);
780         erq->flags |= IW_ENCODE_ENABLED;
781
782         return 0;
783 }
784
785 static int cfg80211_wext_siwfreq(struct net_device *dev,
786                                  struct iw_request_info *info,
787                                  struct iw_freq *wextfreq, char *extra)
788 {
789         struct wireless_dev *wdev = dev->ieee80211_ptr;
790         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
791         int freq, err;
792
793         switch (wdev->iftype) {
794         case NL80211_IFTYPE_STATION:
795                 return cfg80211_mgd_wext_siwfreq(dev, info, wextfreq, extra);
796         case NL80211_IFTYPE_ADHOC:
797                 return cfg80211_ibss_wext_siwfreq(dev, info, wextfreq, extra);
798         case NL80211_IFTYPE_MONITOR:
799                 freq = cfg80211_wext_freq(wdev->wiphy, wextfreq);
800                 if (freq < 0)
801                         return freq;
802                 if (freq == 0)
803                         return -EINVAL;
804                 mutex_lock(&rdev->devlist_mtx);
805                 err = cfg80211_set_monitor_channel(rdev, freq, NL80211_CHAN_NO_HT);
806                 mutex_unlock(&rdev->devlist_mtx);
807                 return err;
808         case NL80211_IFTYPE_MESH_POINT:
809                 freq = cfg80211_wext_freq(wdev->wiphy, wextfreq);
810                 if (freq < 0)
811                         return freq;
812                 if (freq == 0)
813                         return -EINVAL;
814                 mutex_lock(&rdev->devlist_mtx);
815                 err = cfg80211_set_mesh_freq(rdev, wdev, freq,
816                                              NL80211_CHAN_NO_HT);
817                 mutex_unlock(&rdev->devlist_mtx);
818                 return err;
819         default:
820                 return -EOPNOTSUPP;
821         }
822 }
823
824 static int cfg80211_wext_giwfreq(struct net_device *dev,
825                                  struct iw_request_info *info,
826                                  struct iw_freq *freq, char *extra)
827 {
828         struct wireless_dev *wdev = dev->ieee80211_ptr;
829         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
830
831         switch (wdev->iftype) {
832         case NL80211_IFTYPE_STATION:
833                 return cfg80211_mgd_wext_giwfreq(dev, info, freq, extra);
834         case NL80211_IFTYPE_ADHOC:
835                 return cfg80211_ibss_wext_giwfreq(dev, info, freq, extra);
836         case NL80211_IFTYPE_MONITOR:
837                 if (!rdev->monitor_channel)
838                         return -EINVAL;
839
840                 freq->m = rdev->monitor_channel->center_freq;
841                 freq->e = 6;
842                 return 0;
843         default:
844                 return -EINVAL;
845         }
846 }
847
848 static int cfg80211_wext_siwtxpower(struct net_device *dev,
849                                     struct iw_request_info *info,
850                                     union iwreq_data *data, char *extra)
851 {
852         struct wireless_dev *wdev = dev->ieee80211_ptr;
853         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
854         enum nl80211_tx_power_setting type;
855         int dbm = 0;
856
857         if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
858                 return -EINVAL;
859         if (data->txpower.flags & IW_TXPOW_RANGE)
860                 return -EINVAL;
861
862         if (!rdev->ops->set_tx_power)
863                 return -EOPNOTSUPP;
864
865         /* only change when not disabling */
866         if (!data->txpower.disabled) {
867                 rfkill_set_sw_state(rdev->rfkill, false);
868
869                 if (data->txpower.fixed) {
870                         /*
871                          * wext doesn't support negative values, see
872                          * below where it's for automatic
873                          */
874                         if (data->txpower.value < 0)
875                                 return -EINVAL;
876                         dbm = data->txpower.value;
877                         type = NL80211_TX_POWER_FIXED;
878                         /* TODO: do regulatory check! */
879                 } else {
880                         /*
881                          * Automatic power level setting, max being the value
882                          * passed in from userland.
883                          */
884                         if (data->txpower.value < 0) {
885                                 type = NL80211_TX_POWER_AUTOMATIC;
886                         } else {
887                                 dbm = data->txpower.value;
888                                 type = NL80211_TX_POWER_LIMITED;
889                         }
890                 }
891         } else {
892                 rfkill_set_sw_state(rdev->rfkill, true);
893                 schedule_work(&rdev->rfkill_sync);
894                 return 0;
895         }
896
897         return rdev->ops->set_tx_power(wdev->wiphy, type, DBM_TO_MBM(dbm));
898 }
899
900 static int cfg80211_wext_giwtxpower(struct net_device *dev,
901                                     struct iw_request_info *info,
902                                     union iwreq_data *data, char *extra)
903 {
904         struct wireless_dev *wdev = dev->ieee80211_ptr;
905         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
906         int err, val;
907
908         if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
909                 return -EINVAL;
910         if (data->txpower.flags & IW_TXPOW_RANGE)
911                 return -EINVAL;
912
913         if (!rdev->ops->get_tx_power)
914                 return -EOPNOTSUPP;
915
916         err = rdev->ops->get_tx_power(wdev->wiphy, &val);
917         if (err)
918                 return err;
919
920         /* well... oh well */
921         data->txpower.fixed = 1;
922         data->txpower.disabled = rfkill_blocked(rdev->rfkill);
923         data->txpower.value = val;
924         data->txpower.flags = IW_TXPOW_DBM;
925
926         return 0;
927 }
928
929 static int cfg80211_set_auth_alg(struct wireless_dev *wdev,
930                                  s32 auth_alg)
931 {
932         int nr_alg = 0;
933
934         if (!auth_alg)
935                 return -EINVAL;
936
937         if (auth_alg & ~(IW_AUTH_ALG_OPEN_SYSTEM |
938                          IW_AUTH_ALG_SHARED_KEY |
939                          IW_AUTH_ALG_LEAP))
940                 return -EINVAL;
941
942         if (auth_alg & IW_AUTH_ALG_OPEN_SYSTEM) {
943                 nr_alg++;
944                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_OPEN_SYSTEM;
945         }
946
947         if (auth_alg & IW_AUTH_ALG_SHARED_KEY) {
948                 nr_alg++;
949                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_SHARED_KEY;
950         }
951
952         if (auth_alg & IW_AUTH_ALG_LEAP) {
953                 nr_alg++;
954                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_NETWORK_EAP;
955         }
956
957         if (nr_alg > 1)
958                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
959
960         return 0;
961 }
962
963 static int cfg80211_set_wpa_version(struct wireless_dev *wdev, u32 wpa_versions)
964 {
965         if (wpa_versions & ~(IW_AUTH_WPA_VERSION_WPA |
966                              IW_AUTH_WPA_VERSION_WPA2|
967                              IW_AUTH_WPA_VERSION_DISABLED))
968                 return -EINVAL;
969
970         if ((wpa_versions & IW_AUTH_WPA_VERSION_DISABLED) &&
971             (wpa_versions & (IW_AUTH_WPA_VERSION_WPA|
972                              IW_AUTH_WPA_VERSION_WPA2)))
973                 return -EINVAL;
974
975         if (wpa_versions & IW_AUTH_WPA_VERSION_DISABLED)
976                 wdev->wext.connect.crypto.wpa_versions &=
977                         ~(NL80211_WPA_VERSION_1|NL80211_WPA_VERSION_2);
978
979         if (wpa_versions & IW_AUTH_WPA_VERSION_WPA)
980                 wdev->wext.connect.crypto.wpa_versions |=
981                         NL80211_WPA_VERSION_1;
982
983         if (wpa_versions & IW_AUTH_WPA_VERSION_WPA2)
984                 wdev->wext.connect.crypto.wpa_versions |=
985                         NL80211_WPA_VERSION_2;
986
987         return 0;
988 }
989
990 static int cfg80211_set_cipher_group(struct wireless_dev *wdev, u32 cipher)
991 {
992         if (cipher & IW_AUTH_CIPHER_WEP40)
993                 wdev->wext.connect.crypto.cipher_group =
994                         WLAN_CIPHER_SUITE_WEP40;
995         else if (cipher & IW_AUTH_CIPHER_WEP104)
996                 wdev->wext.connect.crypto.cipher_group =
997                         WLAN_CIPHER_SUITE_WEP104;
998         else if (cipher & IW_AUTH_CIPHER_TKIP)
999                 wdev->wext.connect.crypto.cipher_group =
1000                         WLAN_CIPHER_SUITE_TKIP;
1001         else if (cipher & IW_AUTH_CIPHER_CCMP)
1002                 wdev->wext.connect.crypto.cipher_group =
1003                         WLAN_CIPHER_SUITE_CCMP;
1004         else if (cipher & IW_AUTH_CIPHER_AES_CMAC)
1005                 wdev->wext.connect.crypto.cipher_group =
1006                         WLAN_CIPHER_SUITE_AES_CMAC;
1007         else if (cipher & IW_AUTH_CIPHER_NONE)
1008                 wdev->wext.connect.crypto.cipher_group = 0;
1009         else
1010                 return -EINVAL;
1011
1012         return 0;
1013 }
1014
1015 static int cfg80211_set_cipher_pairwise(struct wireless_dev *wdev, u32 cipher)
1016 {
1017         int nr_ciphers = 0;
1018         u32 *ciphers_pairwise = wdev->wext.connect.crypto.ciphers_pairwise;
1019
1020         if (cipher & IW_AUTH_CIPHER_WEP40) {
1021                 ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_WEP40;
1022                 nr_ciphers++;
1023         }
1024
1025         if (cipher & IW_AUTH_CIPHER_WEP104) {
1026                 ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_WEP104;
1027                 nr_ciphers++;
1028         }
1029
1030         if (cipher & IW_AUTH_CIPHER_TKIP) {
1031                 ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_TKIP;
1032                 nr_ciphers++;
1033         }
1034
1035         if (cipher & IW_AUTH_CIPHER_CCMP) {
1036                 ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_CCMP;
1037                 nr_ciphers++;
1038         }
1039
1040         if (cipher & IW_AUTH_CIPHER_AES_CMAC) {
1041                 ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_AES_CMAC;
1042                 nr_ciphers++;
1043         }
1044
1045         BUILD_BUG_ON(NL80211_MAX_NR_CIPHER_SUITES < 5);
1046
1047         wdev->wext.connect.crypto.n_ciphers_pairwise = nr_ciphers;
1048
1049         return 0;
1050 }
1051
1052
1053 static int cfg80211_set_key_mgt(struct wireless_dev *wdev, u32 key_mgt)
1054 {
1055         int nr_akm_suites = 0;
1056
1057         if (key_mgt & ~(IW_AUTH_KEY_MGMT_802_1X |
1058                         IW_AUTH_KEY_MGMT_PSK))
1059                 return -EINVAL;
1060
1061         if (key_mgt & IW_AUTH_KEY_MGMT_802_1X) {
1062                 wdev->wext.connect.crypto.akm_suites[nr_akm_suites] =
1063                         WLAN_AKM_SUITE_8021X;
1064                 nr_akm_suites++;
1065         }
1066
1067         if (key_mgt & IW_AUTH_KEY_MGMT_PSK) {
1068                 wdev->wext.connect.crypto.akm_suites[nr_akm_suites] =
1069                         WLAN_AKM_SUITE_PSK;
1070                 nr_akm_suites++;
1071         }
1072
1073         wdev->wext.connect.crypto.n_akm_suites = nr_akm_suites;
1074
1075         return 0;
1076 }
1077
1078 static int cfg80211_wext_siwauth(struct net_device *dev,
1079                                  struct iw_request_info *info,
1080                                  struct iw_param *data, char *extra)
1081 {
1082         struct wireless_dev *wdev = dev->ieee80211_ptr;
1083
1084         if (wdev->iftype != NL80211_IFTYPE_STATION)
1085                 return -EOPNOTSUPP;
1086
1087         switch (data->flags & IW_AUTH_INDEX) {
1088         case IW_AUTH_PRIVACY_INVOKED:
1089                 wdev->wext.connect.privacy = data->value;
1090                 return 0;
1091         case IW_AUTH_WPA_VERSION:
1092                 return cfg80211_set_wpa_version(wdev, data->value);
1093         case IW_AUTH_CIPHER_GROUP:
1094                 return cfg80211_set_cipher_group(wdev, data->value);
1095         case IW_AUTH_KEY_MGMT:
1096                 return cfg80211_set_key_mgt(wdev, data->value);
1097         case IW_AUTH_CIPHER_PAIRWISE:
1098                 return cfg80211_set_cipher_pairwise(wdev, data->value);
1099         case IW_AUTH_80211_AUTH_ALG:
1100                 return cfg80211_set_auth_alg(wdev, data->value);
1101         case IW_AUTH_WPA_ENABLED:
1102         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1103         case IW_AUTH_DROP_UNENCRYPTED:
1104         case IW_AUTH_MFP:
1105                 return 0;
1106         default:
1107                 return -EOPNOTSUPP;
1108         }
1109 }
1110
1111 static int cfg80211_wext_giwauth(struct net_device *dev,
1112                                  struct iw_request_info *info,
1113                                  struct iw_param *data, char *extra)
1114 {
1115         /* XXX: what do we need? */
1116
1117         return -EOPNOTSUPP;
1118 }
1119
1120 static int cfg80211_wext_siwpower(struct net_device *dev,
1121                                   struct iw_request_info *info,
1122                                   struct iw_param *wrq, char *extra)
1123 {
1124         struct wireless_dev *wdev = dev->ieee80211_ptr;
1125         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1126         bool ps = wdev->ps;
1127         int timeout = wdev->ps_timeout;
1128         int err;
1129
1130         if (wdev->iftype != NL80211_IFTYPE_STATION)
1131                 return -EINVAL;
1132
1133         if (!rdev->ops->set_power_mgmt)
1134                 return -EOPNOTSUPP;
1135
1136         if (wrq->disabled) {
1137                 ps = false;
1138         } else {
1139                 switch (wrq->flags & IW_POWER_MODE) {
1140                 case IW_POWER_ON:       /* If not specified */
1141                 case IW_POWER_MODE:     /* If set all mask */
1142                 case IW_POWER_ALL_R:    /* If explicitely state all */
1143                         ps = true;
1144                         break;
1145                 default:                /* Otherwise we ignore */
1146                         return -EINVAL;
1147                 }
1148
1149                 if (wrq->flags & ~(IW_POWER_MODE | IW_POWER_TIMEOUT))
1150                         return -EINVAL;
1151
1152                 if (wrq->flags & IW_POWER_TIMEOUT)
1153                         timeout = wrq->value / 1000;
1154         }
1155
1156         err = rdev->ops->set_power_mgmt(wdev->wiphy, dev, ps, timeout);
1157         if (err)
1158                 return err;
1159
1160         wdev->ps = ps;
1161         wdev->ps_timeout = timeout;
1162
1163         return 0;
1164
1165 }
1166
1167 static int cfg80211_wext_giwpower(struct net_device *dev,
1168                                   struct iw_request_info *info,
1169                                   struct iw_param *wrq, char *extra)
1170 {
1171         struct wireless_dev *wdev = dev->ieee80211_ptr;
1172
1173         wrq->disabled = !wdev->ps;
1174
1175         return 0;
1176 }
1177
1178 static int cfg80211_wds_wext_siwap(struct net_device *dev,
1179                                    struct iw_request_info *info,
1180                                    struct sockaddr *addr, char *extra)
1181 {
1182         struct wireless_dev *wdev = dev->ieee80211_ptr;
1183         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1184         int err;
1185
1186         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_WDS))
1187                 return -EINVAL;
1188
1189         if (addr->sa_family != ARPHRD_ETHER)
1190                 return -EINVAL;
1191
1192         if (netif_running(dev))
1193                 return -EBUSY;
1194
1195         if (!rdev->ops->set_wds_peer)
1196                 return -EOPNOTSUPP;
1197
1198         err = rdev->ops->set_wds_peer(wdev->wiphy, dev, (u8 *) &addr->sa_data);
1199         if (err)
1200                 return err;
1201
1202         memcpy(&wdev->wext.bssid, (u8 *) &addr->sa_data, ETH_ALEN);
1203
1204         return 0;
1205 }
1206
1207 static int cfg80211_wds_wext_giwap(struct net_device *dev,
1208                                    struct iw_request_info *info,
1209                                    struct sockaddr *addr, char *extra)
1210 {
1211         struct wireless_dev *wdev = dev->ieee80211_ptr;
1212
1213         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_WDS))
1214                 return -EINVAL;
1215
1216         addr->sa_family = ARPHRD_ETHER;
1217         memcpy(&addr->sa_data, wdev->wext.bssid, ETH_ALEN);
1218
1219         return 0;
1220 }
1221
1222 static int cfg80211_wext_siwrate(struct net_device *dev,
1223                                  struct iw_request_info *info,
1224                                  struct iw_param *rate, char *extra)
1225 {
1226         struct wireless_dev *wdev = dev->ieee80211_ptr;
1227         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1228         struct cfg80211_bitrate_mask mask;
1229         u32 fixed, maxrate;
1230         struct ieee80211_supported_band *sband;
1231         int band, ridx;
1232         bool match = false;
1233
1234         if (!rdev->ops->set_bitrate_mask)
1235                 return -EOPNOTSUPP;
1236
1237         memset(&mask, 0, sizeof(mask));
1238         fixed = 0;
1239         maxrate = (u32)-1;
1240
1241         if (rate->value < 0) {
1242                 /* nothing */
1243         } else if (rate->fixed) {
1244                 fixed = rate->value / 100000;
1245         } else {
1246                 maxrate = rate->value / 100000;
1247         }
1248
1249         for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
1250                 sband = wdev->wiphy->bands[band];
1251                 if (sband == NULL)
1252                         continue;
1253                 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
1254                         struct ieee80211_rate *srate = &sband->bitrates[ridx];
1255                         if (fixed == srate->bitrate) {
1256                                 mask.control[band].legacy = 1 << ridx;
1257                                 match = true;
1258                                 break;
1259                         }
1260                         if (srate->bitrate <= maxrate) {
1261                                 mask.control[band].legacy |= 1 << ridx;
1262                                 match = true;
1263                         }
1264                 }
1265         }
1266
1267         if (!match)
1268                 return -EINVAL;
1269
1270         return rdev->ops->set_bitrate_mask(wdev->wiphy, dev, NULL, &mask);
1271 }
1272
1273 static int cfg80211_wext_giwrate(struct net_device *dev,
1274                                  struct iw_request_info *info,
1275                                  struct iw_param *rate, char *extra)
1276 {
1277         struct wireless_dev *wdev = dev->ieee80211_ptr;
1278         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1279         /* we are under RTNL - globally locked - so can use a static struct */
1280         static struct station_info sinfo;
1281         u8 addr[ETH_ALEN];
1282         int err;
1283
1284         if (wdev->iftype != NL80211_IFTYPE_STATION)
1285                 return -EOPNOTSUPP;
1286
1287         if (!rdev->ops->get_station)
1288                 return -EOPNOTSUPP;
1289
1290         err = 0;
1291         wdev_lock(wdev);
1292         if (wdev->current_bss)
1293                 memcpy(addr, wdev->current_bss->pub.bssid, ETH_ALEN);
1294         else
1295                 err = -EOPNOTSUPP;
1296         wdev_unlock(wdev);
1297         if (err)
1298                 return err;
1299
1300         err = rdev->ops->get_station(&rdev->wiphy, dev, addr, &sinfo);
1301         if (err)
1302                 return err;
1303
1304         if (!(sinfo.filled & STATION_INFO_TX_BITRATE))
1305                 return -EOPNOTSUPP;
1306
1307         rate->value = 100000 * cfg80211_calculate_bitrate(&sinfo.txrate);
1308
1309         return 0;
1310 }
1311
1312 /* Get wireless statistics.  Called by /proc/net/wireless and by SIOCGIWSTATS */
1313 static struct iw_statistics *cfg80211_wireless_stats(struct net_device *dev)
1314 {
1315         struct wireless_dev *wdev = dev->ieee80211_ptr;
1316         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1317         /* we are under RTNL - globally locked - so can use static structs */
1318         static struct iw_statistics wstats;
1319         static struct station_info sinfo;
1320         u8 bssid[ETH_ALEN];
1321
1322         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION)
1323                 return NULL;
1324
1325         if (!rdev->ops->get_station)
1326                 return NULL;
1327
1328         /* Grab BSSID of current BSS, if any */
1329         wdev_lock(wdev);
1330         if (!wdev->current_bss) {
1331                 wdev_unlock(wdev);
1332                 return NULL;
1333         }
1334         memcpy(bssid, wdev->current_bss->pub.bssid, ETH_ALEN);
1335         wdev_unlock(wdev);
1336
1337         if (rdev->ops->get_station(&rdev->wiphy, dev, bssid, &sinfo))
1338                 return NULL;
1339
1340         memset(&wstats, 0, sizeof(wstats));
1341
1342         switch (rdev->wiphy.signal_type) {
1343         case CFG80211_SIGNAL_TYPE_MBM:
1344                 if (sinfo.filled & STATION_INFO_SIGNAL) {
1345                         int sig = sinfo.signal;
1346                         wstats.qual.updated |= IW_QUAL_LEVEL_UPDATED;
1347                         wstats.qual.updated |= IW_QUAL_QUAL_UPDATED;
1348                         wstats.qual.updated |= IW_QUAL_DBM;
1349                         wstats.qual.level = sig;
1350                         if (sig < -110)
1351                                 sig = -110;
1352                         else if (sig > -40)
1353                                 sig = -40;
1354                         wstats.qual.qual = sig + 110;
1355                         break;
1356                 }
1357         case CFG80211_SIGNAL_TYPE_UNSPEC:
1358                 if (sinfo.filled & STATION_INFO_SIGNAL) {
1359                         wstats.qual.updated |= IW_QUAL_LEVEL_UPDATED;
1360                         wstats.qual.updated |= IW_QUAL_QUAL_UPDATED;
1361                         wstats.qual.level = sinfo.signal;
1362                         wstats.qual.qual = sinfo.signal;
1363                         break;
1364                 }
1365         default:
1366                 wstats.qual.updated |= IW_QUAL_LEVEL_INVALID;
1367                 wstats.qual.updated |= IW_QUAL_QUAL_INVALID;
1368         }
1369
1370         wstats.qual.updated |= IW_QUAL_NOISE_INVALID;
1371         if (sinfo.filled & STATION_INFO_RX_DROP_MISC)
1372                 wstats.discard.misc = sinfo.rx_dropped_misc;
1373         if (sinfo.filled & STATION_INFO_TX_FAILED)
1374                 wstats.discard.retries = sinfo.tx_failed;
1375
1376         return &wstats;
1377 }
1378
1379 static int cfg80211_wext_siwap(struct net_device *dev,
1380                                struct iw_request_info *info,
1381                                struct sockaddr *ap_addr, char *extra)
1382 {
1383         struct wireless_dev *wdev = dev->ieee80211_ptr;
1384
1385         switch (wdev->iftype) {
1386         case NL80211_IFTYPE_ADHOC:
1387                 return cfg80211_ibss_wext_siwap(dev, info, ap_addr, extra);
1388         case NL80211_IFTYPE_STATION:
1389                 return cfg80211_mgd_wext_siwap(dev, info, ap_addr, extra);
1390         case NL80211_IFTYPE_WDS:
1391                 return cfg80211_wds_wext_siwap(dev, info, ap_addr, extra);
1392         default:
1393                 return -EOPNOTSUPP;
1394         }
1395 }
1396
1397 static int cfg80211_wext_giwap(struct net_device *dev,
1398                                struct iw_request_info *info,
1399                                struct sockaddr *ap_addr, char *extra)
1400 {
1401         struct wireless_dev *wdev = dev->ieee80211_ptr;
1402
1403         switch (wdev->iftype) {
1404         case NL80211_IFTYPE_ADHOC:
1405                 return cfg80211_ibss_wext_giwap(dev, info, ap_addr, extra);
1406         case NL80211_IFTYPE_STATION:
1407                 return cfg80211_mgd_wext_giwap(dev, info, ap_addr, extra);
1408         case NL80211_IFTYPE_WDS:
1409                 return cfg80211_wds_wext_giwap(dev, info, ap_addr, extra);
1410         default:
1411                 return -EOPNOTSUPP;
1412         }
1413 }
1414
1415 static int cfg80211_wext_siwessid(struct net_device *dev,
1416                                   struct iw_request_info *info,
1417                                   struct iw_point *data, char *ssid)
1418 {
1419         struct wireless_dev *wdev = dev->ieee80211_ptr;
1420
1421         switch (wdev->iftype) {
1422         case NL80211_IFTYPE_ADHOC:
1423                 return cfg80211_ibss_wext_siwessid(dev, info, data, ssid);
1424         case NL80211_IFTYPE_STATION:
1425                 return cfg80211_mgd_wext_siwessid(dev, info, data, ssid);
1426         default:
1427                 return -EOPNOTSUPP;
1428         }
1429 }
1430
1431 static int cfg80211_wext_giwessid(struct net_device *dev,
1432                                   struct iw_request_info *info,
1433                                   struct iw_point *data, char *ssid)
1434 {
1435         struct wireless_dev *wdev = dev->ieee80211_ptr;
1436
1437         data->flags = 0;
1438         data->length = 0;
1439
1440         switch (wdev->iftype) {
1441         case NL80211_IFTYPE_ADHOC:
1442                 return cfg80211_ibss_wext_giwessid(dev, info, data, ssid);
1443         case NL80211_IFTYPE_STATION:
1444                 return cfg80211_mgd_wext_giwessid(dev, info, data, ssid);
1445         default:
1446                 return -EOPNOTSUPP;
1447         }
1448 }
1449
1450 static int cfg80211_wext_siwpmksa(struct net_device *dev,
1451                                   struct iw_request_info *info,
1452                                   struct iw_point *data, char *extra)
1453 {
1454         struct wireless_dev *wdev = dev->ieee80211_ptr;
1455         struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1456         struct cfg80211_pmksa cfg_pmksa;
1457         struct iw_pmksa *pmksa = (struct iw_pmksa *)extra;
1458
1459         memset(&cfg_pmksa, 0, sizeof(struct cfg80211_pmksa));
1460
1461         if (wdev->iftype != NL80211_IFTYPE_STATION)
1462                 return -EINVAL;
1463
1464         cfg_pmksa.bssid = pmksa->bssid.sa_data;
1465         cfg_pmksa.pmkid = pmksa->pmkid;
1466
1467         switch (pmksa->cmd) {
1468         case IW_PMKSA_ADD:
1469                 if (!rdev->ops->set_pmksa)
1470                         return -EOPNOTSUPP;
1471
1472                 return rdev->ops->set_pmksa(&rdev->wiphy, dev, &cfg_pmksa);
1473
1474         case IW_PMKSA_REMOVE:
1475                 if (!rdev->ops->del_pmksa)
1476                         return -EOPNOTSUPP;
1477
1478                 return rdev->ops->del_pmksa(&rdev->wiphy, dev, &cfg_pmksa);
1479
1480         case IW_PMKSA_FLUSH:
1481                 if (!rdev->ops->flush_pmksa)
1482                         return -EOPNOTSUPP;
1483
1484                 return rdev->ops->flush_pmksa(&rdev->wiphy, dev);
1485
1486         default:
1487                 return -EOPNOTSUPP;
1488         }
1489 }
1490
1491 static const iw_handler cfg80211_handlers[] = {
1492         [IW_IOCTL_IDX(SIOCGIWNAME)]     = (iw_handler) cfg80211_wext_giwname,
1493         [IW_IOCTL_IDX(SIOCSIWFREQ)]     = (iw_handler) cfg80211_wext_siwfreq,
1494         [IW_IOCTL_IDX(SIOCGIWFREQ)]     = (iw_handler) cfg80211_wext_giwfreq,
1495         [IW_IOCTL_IDX(SIOCSIWMODE)]     = (iw_handler) cfg80211_wext_siwmode,
1496         [IW_IOCTL_IDX(SIOCGIWMODE)]     = (iw_handler) cfg80211_wext_giwmode,
1497         [IW_IOCTL_IDX(SIOCGIWRANGE)]    = (iw_handler) cfg80211_wext_giwrange,
1498         [IW_IOCTL_IDX(SIOCSIWAP)]       = (iw_handler) cfg80211_wext_siwap,
1499         [IW_IOCTL_IDX(SIOCGIWAP)]       = (iw_handler) cfg80211_wext_giwap,
1500         [IW_IOCTL_IDX(SIOCSIWMLME)]     = (iw_handler) cfg80211_wext_siwmlme,
1501         [IW_IOCTL_IDX(SIOCSIWSCAN)]     = (iw_handler) cfg80211_wext_siwscan,
1502         [IW_IOCTL_IDX(SIOCGIWSCAN)]     = (iw_handler) cfg80211_wext_giwscan,
1503         [IW_IOCTL_IDX(SIOCSIWESSID)]    = (iw_handler) cfg80211_wext_siwessid,
1504         [IW_IOCTL_IDX(SIOCGIWESSID)]    = (iw_handler) cfg80211_wext_giwessid,
1505         [IW_IOCTL_IDX(SIOCSIWRATE)]     = (iw_handler) cfg80211_wext_siwrate,
1506         [IW_IOCTL_IDX(SIOCGIWRATE)]     = (iw_handler) cfg80211_wext_giwrate,
1507         [IW_IOCTL_IDX(SIOCSIWRTS)]      = (iw_handler) cfg80211_wext_siwrts,
1508         [IW_IOCTL_IDX(SIOCGIWRTS)]      = (iw_handler) cfg80211_wext_giwrts,
1509         [IW_IOCTL_IDX(SIOCSIWFRAG)]     = (iw_handler) cfg80211_wext_siwfrag,
1510         [IW_IOCTL_IDX(SIOCGIWFRAG)]     = (iw_handler) cfg80211_wext_giwfrag,
1511         [IW_IOCTL_IDX(SIOCSIWTXPOW)]    = (iw_handler) cfg80211_wext_siwtxpower,
1512         [IW_IOCTL_IDX(SIOCGIWTXPOW)]    = (iw_handler) cfg80211_wext_giwtxpower,
1513         [IW_IOCTL_IDX(SIOCSIWRETRY)]    = (iw_handler) cfg80211_wext_siwretry,
1514         [IW_IOCTL_IDX(SIOCGIWRETRY)]    = (iw_handler) cfg80211_wext_giwretry,
1515         [IW_IOCTL_IDX(SIOCSIWENCODE)]   = (iw_handler) cfg80211_wext_siwencode,
1516         [IW_IOCTL_IDX(SIOCGIWENCODE)]   = (iw_handler) cfg80211_wext_giwencode,
1517         [IW_IOCTL_IDX(SIOCSIWPOWER)]    = (iw_handler) cfg80211_wext_siwpower,
1518         [IW_IOCTL_IDX(SIOCGIWPOWER)]    = (iw_handler) cfg80211_wext_giwpower,
1519         [IW_IOCTL_IDX(SIOCSIWGENIE)]    = (iw_handler) cfg80211_wext_siwgenie,
1520         [IW_IOCTL_IDX(SIOCSIWAUTH)]     = (iw_handler) cfg80211_wext_siwauth,
1521         [IW_IOCTL_IDX(SIOCGIWAUTH)]     = (iw_handler) cfg80211_wext_giwauth,
1522         [IW_IOCTL_IDX(SIOCSIWENCODEEXT)]= (iw_handler) cfg80211_wext_siwencodeext,
1523         [IW_IOCTL_IDX(SIOCSIWPMKSA)]    = (iw_handler) cfg80211_wext_siwpmksa,
1524 };
1525
1526 const struct iw_handler_def cfg80211_wext_handler = {
1527         .num_standard           = ARRAY_SIZE(cfg80211_handlers),
1528         .standard               = cfg80211_handlers,
1529         .get_wireless_stats = cfg80211_wireless_stats,
1530 };