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