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