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