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