net/wireless/wext-compat.c

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