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  * 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
  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
  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
  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
 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  */
 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         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
 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
 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
 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
 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(&params, 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, &params);
 621 }
 622
 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(&params, 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, &params);
 712 }
 713
 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
 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
 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
 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
 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
 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
 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
 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
 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
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
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
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
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
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
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
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
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
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 */
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
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
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
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
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
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 };