net/mac80211/ieee80211_ioctl.c

   1 /*
   2  * Copyright 2002-2005, Instant802 Networks, Inc.
   3  * Copyright 2005-2006, Devicescape Software, Inc.
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2 as
   7  * published by the Free Software Foundation.
   8  */
   9
  10 #include <linux/module.h>
  11 #include <linux/init.h>
  12 #include <linux/netdevice.h>
  13 #include <linux/types.h>
  14 #include <linux/slab.h>
  15 #include <linux/skbuff.h>
  16 #include <linux/etherdevice.h>
  17 #include <linux/if_arp.h>
  18 #include <linux/wireless.h>
  19 #include <net/iw_handler.h>
  20 #include <asm/uaccess.h>
  21
  22 #include <net/mac80211.h>
  23 #include "ieee80211_i.h"
  24 #include "hostapd_ioctl.h"
  25 #include "ieee80211_rate.h"
  26 #include "wpa.h"
  27 #include "aes_ccm.h"
  28 #include "debugfs_key.h"
  29
  30 static int ieee80211_regdom = 0x10; /* FCC */
  31 module_param(ieee80211_regdom, int, 0444);
  32 MODULE_PARM_DESC(ieee80211_regdom, "IEEE 802.11 regulatory domain; 64=MKK");
  33
  34 /*
  35  * If firmware is upgraded by the vendor, additional channels can be used based
  36  * on the new Japanese regulatory rules. This is indicated by setting
  37  * ieee80211_japan_5ghz module parameter to one when loading the 80211 kernel
  38  * module.
  39  */
  40 static int ieee80211_japan_5ghz /* = 0 */;
  41 module_param(ieee80211_japan_5ghz, int, 0444);
  42 MODULE_PARM_DESC(ieee80211_japan_5ghz, "Vendor-updated firmware for 5 GHz");
  43
  44 static void ieee80211_set_hw_encryption(struct net_device *dev,
  45                                         struct sta_info *sta, u8 addr[ETH_ALEN],
  46                                         struct ieee80211_key *key)
  47 {
  48         struct ieee80211_key_conf *keyconf = NULL;
  49         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  50
  51         /* default to sw encryption; this will be cleared by low-level
  52          * driver if the hw supports requested encryption */
  53         if (key)
  54                 key->force_sw_encrypt = 1;
  55
  56         if (key && local->ops->set_key &&
  57             (keyconf = ieee80211_key_data2conf(local, key))) {
  58                 if (local->ops->set_key(local_to_hw(local), SET_KEY, addr,
  59                                        keyconf, sta ? sta->aid : 0)) {
  60                         key->force_sw_encrypt = 1;
  61                         key->hw_key_idx = HW_KEY_IDX_INVALID;
  62                 } else {
  63                         key->force_sw_encrypt =
  64                                 !!(keyconf->flags & IEEE80211_KEY_FORCE_SW_ENCRYPT);
  65                         key->hw_key_idx =
  66                                 keyconf->hw_key_idx;
  67
  68                 }
  69         }
  70         kfree(keyconf);
  71 }
  72
  73
  74 static int ieee80211_set_encryption(struct net_device *dev, u8 *sta_addr,
  75                                     int idx, int alg, int set_tx_key,
  76                                     const u8 *_key, size_t key_len)
  77 {
  78         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  79         int ret = 0;
  80         struct sta_info *sta;
  81         struct ieee80211_key *key, *old_key;
  82         int try_hwaccel = 1;
  83         struct ieee80211_key_conf *keyconf;
  84         struct ieee80211_sub_if_data *sdata;
  85
  86         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  87
  88         if (is_broadcast_ether_addr(sta_addr)) {
  89                 sta = NULL;
  90                 if (idx >= NUM_DEFAULT_KEYS) {
  91                         printk(KERN_DEBUG "%s: set_encrypt - invalid idx=%d\n",
  92                                dev->name, idx);
  93                         return -EINVAL;
  94                 }
  95                 key = sdata->keys[idx];
  96
  97                 /* TODO: consider adding hwaccel support for these; at least
  98                  * Atheros key cache should be able to handle this since AP is
  99                  * only transmitting frames with default keys. */
 100                 /* FIX: hw key cache can be used when only one virtual
 101                  * STA is associated with each AP. If more than one STA
 102                  * is associated to the same AP, software encryption
 103                  * must be used. This should be done automatically
 104                  * based on configured station devices. For the time
 105                  * being, this can be only set at compile time. */
 106         } else {
 107                 set_tx_key = 0;
 108                 if (idx != 0) {
 109                         printk(KERN_DEBUG "%s: set_encrypt - non-zero idx for "
 110                                "individual key\n", dev->name);
 111                         return -EINVAL;
 112                 }
 113
 114                 sta = sta_info_get(local, sta_addr);
 115                 if (!sta) {
 116 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
 117                         printk(KERN_DEBUG "%s: set_encrypt - unknown addr "
 118                                MAC_FMT "\n",
 119                                dev->name, MAC_ARG(sta_addr));
 120 #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
 121
 122                         return -ENOENT;
 123                 }
 124
 125                 key = sta->key;
 126         }
 127
 128         /* FIX:
 129          * Cannot configure default hwaccel keys with WEP algorithm, if
 130          * any of the virtual interfaces is using static WEP
 131          * configuration because hwaccel would otherwise try to decrypt
 132          * these frames.
 133          *
 134          * For now, just disable WEP hwaccel for broadcast when there is
 135          * possibility of conflict with default keys. This can maybe later be
 136          * optimized by using non-default keys (at least with Atheros ar521x).
 137          */
 138         if (!sta && alg == ALG_WEP && !local->default_wep_only &&
 139             sdata->type != IEEE80211_IF_TYPE_IBSS &&
 140             sdata->type != IEEE80211_IF_TYPE_AP) {
 141                 try_hwaccel = 0;
 142         }
 143
 144         if (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP) {
 145                 /* Software encryption cannot be used with devices that hide
 146                  * encryption from the host system, so always try to use
 147                  * hardware acceleration with such devices. */
 148                 try_hwaccel = 1;
 149         }
 150
 151         if ((local->hw.flags & IEEE80211_HW_NO_TKIP_WMM_HWACCEL) &&
 152             alg == ALG_TKIP) {
 153                 if (sta && (sta->flags & WLAN_STA_WME)) {
 154                 /* Hardware does not support hwaccel with TKIP when using WMM.
 155                  */
 156                         try_hwaccel = 0;
 157                 }
 158                 else if (sdata->type == IEEE80211_IF_TYPE_STA) {
 159                         sta = sta_info_get(local, sdata->u.sta.bssid);
 160                         if (sta) {
 161                                 if (sta->flags & WLAN_STA_WME) {
 162                                         try_hwaccel = 0;
 163                                 }
 164                                 sta_info_put(sta);
 165                                 sta = NULL;
 166                         }
 167                 }
 168         }
 169
 170         if (alg == ALG_NONE) {
 171                 keyconf = NULL;
 172                 if (try_hwaccel && key &&
 173                     key->hw_key_idx != HW_KEY_IDX_INVALID &&
 174                     local->ops->set_key &&
 175                     (keyconf = ieee80211_key_data2conf(local, key)) != NULL &&
 176                     local->ops->set_key(local_to_hw(local), DISABLE_KEY,
 177                                        sta_addr, keyconf, sta ? sta->aid : 0)) {
 178                         printk(KERN_DEBUG "%s: set_encrypt - low-level disable"
 179                                " failed\n", dev->name);
 180                         ret = -EINVAL;
 181                 }
 182                 kfree(keyconf);
 183
 184                 if (set_tx_key || sdata->default_key == key) {
 185                         ieee80211_debugfs_key_remove_default(sdata);
 186                         sdata->default_key = NULL;
 187                 }
 188                 ieee80211_debugfs_key_remove(key);
 189                 if (sta)
 190                         sta->key = NULL;
 191                 else
 192                         sdata->keys[idx] = NULL;
 193                 ieee80211_key_free(key);
 194                 key = NULL;
 195         } else {
 196                 old_key = key;
 197                 key = ieee80211_key_alloc(sta ? NULL : sdata, idx, key_len,
 198                                           GFP_KERNEL);
 199                 if (!key) {
 200                         ret = -ENOMEM;
 201                         goto err_out;
 202                 }
 203
 204                 /* default to sw encryption; low-level driver sets these if the
 205                  * requested encryption is supported */
 206                 key->hw_key_idx = HW_KEY_IDX_INVALID;
 207                 key->force_sw_encrypt = 1;
 208
 209                 key->alg = alg;
 210                 key->keyidx = idx;
 211                 key->keylen = key_len;
 212                 memcpy(key->key, _key, key_len);
 213                 if (set_tx_key)
 214                         key->default_tx_key = 1;
 215
 216                 if (alg == ALG_CCMP) {
 217                         /* Initialize AES key state here as an optimization
 218                          * so that it does not need to be initialized for every
 219                          * packet. */
 220                         key->u.ccmp.tfm = ieee80211_aes_key_setup_encrypt(
 221                                 key->key);
 222                         if (!key->u.ccmp.tfm) {
 223                                 ret = -ENOMEM;
 224                                 goto err_free;
 225                         }
 226                 }
 227
 228                 if (set_tx_key || sdata->default_key == old_key) {
 229                         ieee80211_debugfs_key_remove_default(sdata);
 230                         sdata->default_key = NULL;
 231                 }
 232                 ieee80211_debugfs_key_remove(old_key);
 233                 if (sta)
 234                         sta->key = key;
 235                 else
 236                         sdata->keys[idx] = key;
 237                 ieee80211_key_free(old_key);
 238                 ieee80211_debugfs_key_add(local, key);
 239                 if (sta)
 240                         ieee80211_debugfs_key_sta_link(key, sta);
 241
 242                 if (try_hwaccel &&
 243                     (alg == ALG_WEP || alg == ALG_TKIP || alg == ALG_CCMP))
 244                         ieee80211_set_hw_encryption(dev, sta, sta_addr, key);
 245         }
 246
 247         if (set_tx_key || (!sta && !sdata->default_key && key)) {
 248                 sdata->default_key = key;
 249                 if (key)
 250                         ieee80211_debugfs_key_add_default(sdata);
 251
 252                 if (local->ops->set_key_idx &&
 253                     local->ops->set_key_idx(local_to_hw(local), idx))
 254                         printk(KERN_DEBUG "%s: failed to set TX key idx for "
 255                                "low-level driver\n", dev->name);
 256         }
 257
 258         if (sta)
 259                 sta_info_put(sta);
 260
 261         return 0;
 262
 263 err_free:
 264         ieee80211_key_free(key);
 265 err_out:
 266         if (sta)
 267                 sta_info_put(sta);
 268         return ret;
 269 }
 270
 271 static int ieee80211_ioctl_siwgenie(struct net_device *dev,
 272                                     struct iw_request_info *info,
 273                                     struct iw_point *data, char *extra)
 274 {
 275         struct ieee80211_sub_if_data *sdata;
 276         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 277
 278         if (local->user_space_mlme)
 279                 return -EOPNOTSUPP;
 280
 281         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 282         if (sdata->type == IEEE80211_IF_TYPE_STA ||
 283             sdata->type == IEEE80211_IF_TYPE_IBSS) {
 284                 int ret = ieee80211_sta_set_extra_ie(dev, extra, data->length);
 285                 if (ret)
 286                         return ret;
 287                 sdata->u.sta.auto_bssid_sel = 0;
 288                 ieee80211_sta_req_auth(dev, &sdata->u.sta);
 289                 return 0;
 290         }
 291
 292         if (sdata->type == IEEE80211_IF_TYPE_AP) {
 293                 kfree(sdata->u.ap.generic_elem);
 294                 sdata->u.ap.generic_elem = kmalloc(data->length, GFP_KERNEL);
 295                 if (!sdata->u.ap.generic_elem)
 296                         return -ENOMEM;
 297                 memcpy(sdata->u.ap.generic_elem, extra, data->length);
 298                 sdata->u.ap.generic_elem_len = data->length;
 299                 return ieee80211_if_config(dev);
 300         }
 301         return -EOPNOTSUPP;
 302 }
 303
 304 static int ieee80211_ioctl_set_radio_enabled(struct net_device *dev,
 305                                              int val)
 306 {
 307         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 308         struct ieee80211_conf *conf = &local->hw.conf;
 309
 310         conf->radio_enabled = val;
 311         return ieee80211_hw_config(wdev_priv(dev->ieee80211_ptr));
 312 }
 313
 314 static int ieee80211_ioctl_giwname(struct net_device *dev,
 315                                    struct iw_request_info *info,
 316                                    char *name, char *extra)
 317 {
 318         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 319
 320         switch (local->hw.conf.phymode) {
 321         case MODE_IEEE80211A:
 322                 strcpy(name, "IEEE 802.11a");
 323                 break;
 324         case MODE_IEEE80211B:
 325                 strcpy(name, "IEEE 802.11b");
 326                 break;
 327         case MODE_IEEE80211G:
 328                 strcpy(name, "IEEE 802.11g");
 329                 break;
 330         case MODE_ATHEROS_TURBO:
 331                 strcpy(name, "5GHz Turbo");
 332                 break;
 333         default:
 334                 strcpy(name, "IEEE 802.11");
 335                 break;
 336         }
 337
 338         return 0;
 339 }
 340
 341
 342 static int ieee80211_ioctl_giwrange(struct net_device *dev,
 343                                  struct iw_request_info *info,
 344                                  struct iw_point *data, char *extra)
 345 {
 346         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 347         struct iw_range *range = (struct iw_range *) extra;
 348         struct ieee80211_hw_mode *mode = NULL;
 349         int c = 0;
 350
 351         data->length = sizeof(struct iw_range);
 352         memset(range, 0, sizeof(struct iw_range));
 353
 354         range->we_version_compiled = WIRELESS_EXT;
 355         range->we_version_source = 21;
 356         range->retry_capa = IW_RETRY_LIMIT;
 357         range->retry_flags = IW_RETRY_LIMIT;
 358         range->min_retry = 0;
 359         range->max_retry = 255;
 360         range->min_rts = 0;
 361         range->max_rts = 2347;
 362         range->min_frag = 256;
 363         range->max_frag = 2346;
 364
 365         range->encoding_size[0] = 5;
 366         range->encoding_size[1] = 13;
 367         range->num_encoding_sizes = 2;
 368         range->max_encoding_tokens = NUM_DEFAULT_KEYS;
 369
 370         range->max_qual.qual = local->hw.max_signal;
 371         range->max_qual.level = local->hw.max_rssi;
 372         range->max_qual.noise = local->hw.max_noise;
 373         range->max_qual.updated = local->wstats_flags;
 374
 375         range->avg_qual.qual = local->hw.max_signal/2;
 376         range->avg_qual.level = 0;
 377         range->avg_qual.noise = 0;
 378         range->avg_qual.updated = local->wstats_flags;
 379
 380         range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
 381                           IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
 382
 383         list_for_each_entry(mode, &local->modes_list, list) {
 384                 int i = 0;
 385
 386                 if (!(local->enabled_modes & (1 << mode->mode)) ||
 387                     (local->hw_modes & local->enabled_modes &
 388                      (1 << MODE_IEEE80211G) && mode->mode == MODE_IEEE80211B))
 389                         continue;
 390
 391                 while (i < mode->num_channels && c < IW_MAX_FREQUENCIES) {
 392                         struct ieee80211_channel *chan = &mode->channels[i];
 393
 394                         if (chan->flag & IEEE80211_CHAN_W_SCAN) {
 395                                 range->freq[c].i = chan->chan;
 396                                 range->freq[c].m = chan->freq * 100000;
 397                                 range->freq[c].e = 1;
 398                                 c++;
 399                         }
 400                         i++;
 401                 }
 402         }
 403         range->num_channels = c;
 404         range->num_frequency = c;
 405
 406         IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
 407         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWTHRSPY);
 408         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
 409         IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
 410
 411         return 0;
 412 }
 413
 414
 415 struct ieee80211_channel_range {
 416         short start_freq;
 417         short end_freq;
 418         unsigned char power_level;
 419         unsigned char antenna_max;
 420 };
 421
 422 static const struct ieee80211_channel_range ieee80211_fcc_channels[] = {
 423         { 2412, 2462, 27, 6 } /* IEEE 802.11b/g, channels 1..11 */,
 424         { 5180, 5240, 17, 6 } /* IEEE 802.11a, channels 36..48 */,
 425         { 5260, 5320, 23, 6 } /* IEEE 802.11a, channels 52..64 */,
 426         { 5745, 5825, 30, 6 } /* IEEE 802.11a, channels 149..165, outdoor */,
 427         { 0 }
 428 };
 429
 430 static const struct ieee80211_channel_range ieee80211_mkk_channels[] = {
 431         { 2412, 2472, 20, 6 } /* IEEE 802.11b/g, channels 1..13 */,
 432         { 5170, 5240, 20, 6 } /* IEEE 802.11a, channels 34..48 */,
 433         { 5260, 5320, 20, 6 } /* IEEE 802.11a, channels 52..64 */,
 434         { 0 }
 435 };
 436
 437
 438 static const struct ieee80211_channel_range *channel_range =
 439         ieee80211_fcc_channels;
 440
 441
 442 static void ieee80211_unmask_channel(struct net_device *dev, int mode,
 443                                      struct ieee80211_channel *chan)
 444 {
 445         int i;
 446
 447         chan->flag = 0;
 448
 449         if (ieee80211_regdom == 64 &&
 450             (mode == MODE_ATHEROS_TURBO || mode == MODE_ATHEROS_TURBOG)) {
 451                 /* Do not allow Turbo modes in Japan. */
 452                 return;
 453         }
 454
 455         for (i = 0; channel_range[i].start_freq; i++) {
 456                 const struct ieee80211_channel_range *r = &channel_range[i];
 457                 if (r->start_freq <= chan->freq && r->end_freq >= chan->freq) {
 458                         if (ieee80211_regdom == 64 && !ieee80211_japan_5ghz &&
 459                             chan->freq >= 5260 && chan->freq <= 5320) {
 460                                 /*
 461                                  * Skip new channels in Japan since the
 462                                  * firmware was not marked having been upgraded
 463                                  * by the vendor.
 464                                  */
 465                                 continue;
 466                         }
 467
 468                         if (ieee80211_regdom == 0x10 &&
 469                             (chan->freq == 5190 || chan->freq == 5210 ||
 470                              chan->freq == 5230)) {
 471                                     /* Skip MKK channels when in FCC domain. */
 472                                     continue;
 473                         }
 474
 475                         chan->flag |= IEEE80211_CHAN_W_SCAN |
 476                                 IEEE80211_CHAN_W_ACTIVE_SCAN |
 477                                 IEEE80211_CHAN_W_IBSS;
 478                         chan->power_level = r->power_level;
 479                         chan->antenna_max = r->antenna_max;
 480
 481                         if (ieee80211_regdom == 64 &&
 482                             (chan->freq == 5170 || chan->freq == 5190 ||
 483                              chan->freq == 5210 || chan->freq == 5230)) {
 484                                 /*
 485                                  * New regulatory rules in Japan have backwards
 486                                  * compatibility with old channels in 5.15-5.25
 487                                  * GHz band, but the station is not allowed to
 488                                  * use active scan on these old channels.
 489                                  */
 490                                 chan->flag &= ~IEEE80211_CHAN_W_ACTIVE_SCAN;
 491                         }
 492
 493                         if (ieee80211_regdom == 64 &&
 494                             (chan->freq == 5260 || chan->freq == 5280 ||
 495                              chan->freq == 5300 || chan->freq == 5320)) {
 496                                 /*
 497                                  * IBSS is not allowed on 5.25-5.35 GHz band
 498                                  * due to radar detection requirements.
 499                                  */
 500                                 chan->flag &= ~IEEE80211_CHAN_W_IBSS;
 501                         }
 502
 503                         break;
 504                 }
 505         }
 506 }
 507
 508
 509 static int ieee80211_unmask_channels(struct net_device *dev)
 510 {
 511         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 512         struct ieee80211_hw_mode *mode;
 513         int c;
 514
 515         list_for_each_entry(mode, &local->modes_list, list) {
 516                 for (c = 0; c < mode->num_channels; c++) {
 517                         ieee80211_unmask_channel(dev, mode->mode,
 518                                                  &mode->channels[c]);
 519                 }
 520         }
 521         return 0;
 522 }
 523
 524
 525 int ieee80211_init_client(struct net_device *dev)
 526 {
 527         if (ieee80211_regdom == 0x40)
 528                 channel_range = ieee80211_mkk_channels;
 529         ieee80211_unmask_channels(dev);
 530         return 0;
 531 }
 532
 533
 534 static int ieee80211_ioctl_siwmode(struct net_device *dev,
 535                                    struct iw_request_info *info,
 536                                    __u32 *mode, char *extra)
 537 {
 538         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 539         int type;
 540
 541         if (sdata->type == IEEE80211_IF_TYPE_VLAN)
 542                 return -EOPNOTSUPP;
 543
 544         switch (*mode) {
 545         case IW_MODE_INFRA:
 546                 type = IEEE80211_IF_TYPE_STA;
 547                 break;
 548         case IW_MODE_ADHOC:
 549                 type = IEEE80211_IF_TYPE_IBSS;
 550                 break;
 551         case IW_MODE_MONITOR:
 552                 type = IEEE80211_IF_TYPE_MNTR;
 553                 break;
 554         default:
 555                 return -EINVAL;
 556         }
 557
 558         if (type == sdata->type)
 559                 return 0;
 560         if (netif_running(dev))
 561                 return -EBUSY;
 562
 563         ieee80211_if_reinit(dev);
 564         ieee80211_if_set_type(dev, type);
 565
 566         return 0;
 567 }
 568
 569
 570 static int ieee80211_ioctl_giwmode(struct net_device *dev,
 571                                    struct iw_request_info *info,
 572                                    __u32 *mode, char *extra)
 573 {
 574         struct ieee80211_sub_if_data *sdata;
 575
 576         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 577         switch (sdata->type) {
 578         case IEEE80211_IF_TYPE_AP:
 579                 *mode = IW_MODE_MASTER;
 580                 break;
 581         case IEEE80211_IF_TYPE_STA:
 582                 *mode = IW_MODE_INFRA;
 583                 break;
 584         case IEEE80211_IF_TYPE_IBSS:
 585                 *mode = IW_MODE_ADHOC;
 586                 break;
 587         case IEEE80211_IF_TYPE_MNTR:
 588                 *mode = IW_MODE_MONITOR;
 589                 break;
 590         case IEEE80211_IF_TYPE_WDS:
 591                 *mode = IW_MODE_REPEAT;
 592                 break;
 593         case IEEE80211_IF_TYPE_VLAN:
 594                 *mode = IW_MODE_SECOND;         /* FIXME */
 595                 break;
 596         default:
 597                 *mode = IW_MODE_AUTO;
 598                 break;
 599         }
 600         return 0;
 601 }
 602
 603 int ieee80211_set_channel(struct ieee80211_local *local, int channel, int freq)
 604 {
 605         struct ieee80211_hw_mode *mode;
 606         int c, set = 0;
 607         int ret = -EINVAL;
 608
 609         list_for_each_entry(mode, &local->modes_list, list) {
 610                 if (!(local->enabled_modes & (1 << mode->mode)))
 611                         continue;
 612                 for (c = 0; c < mode->num_channels; c++) {
 613                         struct ieee80211_channel *chan = &mode->channels[c];
 614                         if (chan->flag & IEEE80211_CHAN_W_SCAN &&
 615                             ((chan->chan == channel) || (chan->freq == freq))) {
 616                                 /* Use next_mode as the mode preference to
 617                                  * resolve non-unique channel numbers. */
 618                                 if (set && mode->mode != local->next_mode)
 619                                         continue;
 620
 621                                 local->oper_channel = chan;
 622                                 local->oper_hw_mode = mode;
 623                                 set++;
 624                         }
 625                 }
 626         }
 627
 628         if (set) {
 629                 if (local->sta_scanning)
 630                         ret = 0;
 631                 else
 632                         ret = ieee80211_hw_config(local);
 633
 634                 rate_control_clear(local);
 635         }
 636
 637         return ret;
 638 }
 639
 640 static int ieee80211_ioctl_siwfreq(struct net_device *dev,
 641                                    struct iw_request_info *info,
 642                                    struct iw_freq *freq, char *extra)
 643 {
 644         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 645         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 646
 647         if (sdata->type == IEEE80211_IF_TYPE_STA)
 648                 sdata->u.sta.auto_channel_sel = 0;
 649
 650         /* freq->e == 0: freq->m = channel; otherwise freq = m * 10^e */
 651         if (freq->e == 0) {
 652                 if (freq->m < 0) {
 653                         if (sdata->type == IEEE80211_IF_TYPE_STA)
 654                                 sdata->u.sta.auto_channel_sel = 1;
 655                         return 0;
 656                 } else
 657                         return ieee80211_set_channel(local, freq->m, -1);
 658         } else {
 659                 int i, div = 1000000;
 660                 for (i = 0; i < freq->e; i++)
 661                         div /= 10;
 662                 if (div > 0)
 663                         return ieee80211_set_channel(local, -1, freq->m / div);
 664                 else
 665                         return -EINVAL;
 666         }
 667 }
 668
 669
 670 static int ieee80211_ioctl_giwfreq(struct net_device *dev,
 671                                    struct iw_request_info *info,
 672                                    struct iw_freq *freq, char *extra)
 673 {
 674         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 675
 676         /* TODO: in station mode (Managed/Ad-hoc) might need to poll low-level
 677          * driver for the current channel with firmware-based management */
 678
 679         freq->m = local->hw.conf.freq;
 680         freq->e = 6;
 681
 682         return 0;
 683 }
 684
 685
 686 static int ieee80211_ioctl_siwessid(struct net_device *dev,
 687                                     struct iw_request_info *info,
 688                                     struct iw_point *data, char *ssid)
 689 {
 690         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 691         struct ieee80211_sub_if_data *sdata;
 692         size_t len = data->length;
 693
 694         /* iwconfig uses nul termination in SSID.. */
 695         if (len > 0 && ssid[len - 1] == '\0')
 696                 len--;
 697
 698         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 699         if (sdata->type == IEEE80211_IF_TYPE_STA ||
 700             sdata->type == IEEE80211_IF_TYPE_IBSS) {
 701                 int ret;
 702                 if (local->user_space_mlme) {
 703                         if (len > IEEE80211_MAX_SSID_LEN)
 704                                 return -EINVAL;
 705                         memcpy(sdata->u.sta.ssid, ssid, len);
 706                         sdata->u.sta.ssid_len = len;
 707                         return 0;
 708                 }
 709                 sdata->u.sta.auto_ssid_sel = !data->flags;
 710                 ret = ieee80211_sta_set_ssid(dev, ssid, len);
 711                 if (ret)
 712                         return ret;
 713                 ieee80211_sta_req_auth(dev, &sdata->u.sta);
 714                 return 0;
 715         }
 716
 717         if (sdata->type == IEEE80211_IF_TYPE_AP) {
 718                 memcpy(sdata->u.ap.ssid, ssid, len);
 719                 memset(sdata->u.ap.ssid + len, 0,
 720                        IEEE80211_MAX_SSID_LEN - len);
 721                 sdata->u.ap.ssid_len = len;
 722                 return ieee80211_if_config(dev);
 723         }
 724         return -EOPNOTSUPP;
 725 }
 726
 727
 728 static int ieee80211_ioctl_giwessid(struct net_device *dev,
 729                                     struct iw_request_info *info,
 730                                     struct iw_point *data, char *ssid)
 731 {
 732         size_t len;
 733
 734         struct ieee80211_sub_if_data *sdata;
 735         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 736         if (sdata->type == IEEE80211_IF_TYPE_STA ||
 737             sdata->type == IEEE80211_IF_TYPE_IBSS) {
 738                 int res = ieee80211_sta_get_ssid(dev, ssid, &len);
 739                 if (res == 0) {
 740                         data->length = len;
 741                         data->flags = 1;
 742                 } else
 743                         data->flags = 0;
 744                 return res;
 745         }
 746
 747         if (sdata->type == IEEE80211_IF_TYPE_AP) {
 748                 len = sdata->u.ap.ssid_len;
 749                 if (len > IW_ESSID_MAX_SIZE)
 750                         len = IW_ESSID_MAX_SIZE;
 751                 memcpy(ssid, sdata->u.ap.ssid, len);
 752                 data->length = len;
 753                 data->flags = 1;
 754                 return 0;
 755         }
 756         return -EOPNOTSUPP;
 757 }
 758
 759
 760 static int ieee80211_ioctl_siwap(struct net_device *dev,
 761                                  struct iw_request_info *info,
 762                                  struct sockaddr *ap_addr, char *extra)
 763 {
 764         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 765         struct ieee80211_sub_if_data *sdata;
 766
 767         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 768         if (sdata->type == IEEE80211_IF_TYPE_STA ||
 769             sdata->type == IEEE80211_IF_TYPE_IBSS) {
 770                 int ret;
 771                 if (local->user_space_mlme) {
 772                         memcpy(sdata->u.sta.bssid, (u8 *) &ap_addr->sa_data,
 773                                ETH_ALEN);
 774                         return 0;
 775                 }
 776                 if (is_zero_ether_addr((u8 *) &ap_addr->sa_data)) {
 777                         sdata->u.sta.auto_bssid_sel = 1;
 778                         sdata->u.sta.auto_channel_sel = 1;
 779                 } else if (is_broadcast_ether_addr((u8 *) &ap_addr->sa_data))
 780                         sdata->u.sta.auto_bssid_sel = 1;
 781                 else
 782                         sdata->u.sta.auto_bssid_sel = 0;
 783                 ret = ieee80211_sta_set_bssid(dev, (u8 *) &ap_addr->sa_data);
 784                 if (ret)
 785                         return ret;
 786                 ieee80211_sta_req_auth(dev, &sdata->u.sta);
 787                 return 0;
 788         } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
 789                 if (memcmp(sdata->u.wds.remote_addr, (u8 *) &ap_addr->sa_data,
 790                            ETH_ALEN) == 0)
 791                         return 0;
 792                 return ieee80211_if_update_wds(dev, (u8 *) &ap_addr->sa_data);
 793         }
 794
 795         return -EOPNOTSUPP;
 796 }
 797
 798
 799 static int ieee80211_ioctl_giwap(struct net_device *dev,
 800                                  struct iw_request_info *info,
 801                                  struct sockaddr *ap_addr, char *extra)
 802 {
 803         struct ieee80211_sub_if_data *sdata;
 804
 805         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 806         if (sdata->type == IEEE80211_IF_TYPE_STA ||
 807             sdata->type == IEEE80211_IF_TYPE_IBSS) {
 808                 ap_addr->sa_family = ARPHRD_ETHER;
 809                 memcpy(&ap_addr->sa_data, sdata->u.sta.bssid, ETH_ALEN);
 810                 return 0;
 811         } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
 812                 ap_addr->sa_family = ARPHRD_ETHER;
 813                 memcpy(&ap_addr->sa_data, sdata->u.wds.remote_addr, ETH_ALEN);
 814                 return 0;
 815         }
 816
 817         return -EOPNOTSUPP;
 818 }
 819
 820
 821 static int ieee80211_ioctl_siwscan(struct net_device *dev,
 822                                    struct iw_request_info *info,
 823                                    struct iw_point *data, char *extra)
 824 {
 825         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 826         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 827         u8 *ssid = NULL;
 828         size_t ssid_len = 0;
 829
 830         if (!netif_running(dev))
 831                 return -ENETDOWN;
 832
 833         if (local->scan_flags & IEEE80211_SCAN_MATCH_SSID) {
 834                 if (sdata->type == IEEE80211_IF_TYPE_STA ||
 835                     sdata->type == IEEE80211_IF_TYPE_IBSS) {
 836                         ssid = sdata->u.sta.ssid;
 837                         ssid_len = sdata->u.sta.ssid_len;
 838                 } else if (sdata->type == IEEE80211_IF_TYPE_AP) {
 839                         ssid = sdata->u.ap.ssid;
 840                         ssid_len = sdata->u.ap.ssid_len;
 841                 } else
 842                         return -EINVAL;
 843         }
 844         return ieee80211_sta_req_scan(dev, ssid, ssid_len);
 845 }
 846
 847
 848 static int ieee80211_ioctl_giwscan(struct net_device *dev,
 849                                    struct iw_request_info *info,
 850                                    struct iw_point *data, char *extra)
 851 {
 852         int res;
 853         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 854         if (local->sta_scanning)
 855                 return -EAGAIN;
 856         res = ieee80211_sta_scan_results(dev, extra, data->length);
 857         if (res >= 0) {
 858                 data->length = res;
 859                 return 0;
 860         }
 861         data->length = 0;
 862         return res;
 863 }
 864
 865
 866 static int ieee80211_ioctl_siwrate(struct net_device *dev,
 867                                   struct iw_request_info *info,
 868                                   struct iw_param *rate, char *extra)
 869 {
 870         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 871         struct ieee80211_hw_mode *mode;
 872         int i;
 873         u32 target_rate = rate->value / 100000;
 874         struct ieee80211_sub_if_data *sdata;
 875
 876         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 877         if (!sdata->bss)
 878                 return -ENODEV;
 879         mode = local->oper_hw_mode;
 880         /* target_rate = -1, rate->fixed = 0 means auto only, so use all rates
 881          * target_rate = X, rate->fixed = 1 means only rate X
 882          * target_rate = X, rate->fixed = 0 means all rates <= X */
 883         sdata->bss->max_ratectrl_rateidx = -1;
 884         sdata->bss->force_unicast_rateidx = -1;
 885         if (rate->value < 0)
 886                 return 0;
 887         for (i=0; i< mode->num_rates; i++) {
 888                 struct ieee80211_rate *rates = &mode->rates[i];
 889                 int this_rate = rates->rate;
 890
 891                 if (mode->mode == MODE_ATHEROS_TURBO ||
 892                     mode->mode == MODE_ATHEROS_TURBOG)
 893                         this_rate *= 2;
 894                 if (target_rate == this_rate) {
 895                         sdata->bss->max_ratectrl_rateidx = i;
 896                         if (rate->fixed)
 897                                 sdata->bss->force_unicast_rateidx = i;
 898                         break;
 899                 }
 900         }
 901         return 0;
 902 }
 903
 904 static int ieee80211_ioctl_giwrate(struct net_device *dev,
 905                                   struct iw_request_info *info,
 906                                   struct iw_param *rate, char *extra)
 907 {
 908         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 909         struct sta_info *sta;
 910         struct ieee80211_sub_if_data *sdata;
 911
 912         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
 913         if (sdata->type == IEEE80211_IF_TYPE_STA)
 914                 sta = sta_info_get(local, sdata->u.sta.bssid);
 915         else
 916                 return -EOPNOTSUPP;
 917         if (!sta)
 918                 return -ENODEV;
 919         if (sta->txrate < local->oper_hw_mode->num_rates)
 920                 rate->value = local->oper_hw_mode->rates[sta->txrate].rate * 100000;
 921         else
 922                 rate->value = 0;
 923         sta_info_put(sta);
 924         return 0;
 925 }
 926
 927 static int ieee80211_ioctl_siwrts(struct net_device *dev,
 928                                   struct iw_request_info *info,
 929                                   struct iw_param *rts, char *extra)
 930 {
 931         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 932
 933         if (rts->disabled)
 934                 local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
 935         else if (rts->value < 0 || rts->value > IEEE80211_MAX_RTS_THRESHOLD)
 936                 return -EINVAL;
 937         else
 938                 local->rts_threshold = rts->value;
 939
 940         /* If the wlan card performs RTS/CTS in hardware/firmware,
 941          * configure it here */
 942
 943         if (local->ops->set_rts_threshold)
 944                 local->ops->set_rts_threshold(local_to_hw(local),
 945                                              local->rts_threshold);
 946
 947         return 0;
 948 }
 949
 950 static int ieee80211_ioctl_giwrts(struct net_device *dev,
 951                                   struct iw_request_info *info,
 952                                   struct iw_param *rts, char *extra)
 953 {
 954         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 955
 956         rts->value = local->rts_threshold;
 957         rts->disabled = (rts->value >= IEEE80211_MAX_RTS_THRESHOLD);
 958         rts->fixed = 1;
 959
 960         return 0;
 961 }
 962
 963
 964 static int ieee80211_ioctl_siwfrag(struct net_device *dev,
 965                                    struct iw_request_info *info,
 966                                    struct iw_param *frag, char *extra)
 967 {
 968         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 969
 970         if (frag->disabled)
 971                 local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD;
 972         else if (frag->value < 256 ||
 973                  frag->value > IEEE80211_MAX_FRAG_THRESHOLD)
 974                 return -EINVAL;
 975         else {
 976                 /* Fragment length must be even, so strip LSB. */
 977                 local->fragmentation_threshold = frag->value & ~0x1;
 978         }
 979
 980         /* If the wlan card performs fragmentation in hardware/firmware,
 981          * configure it here */
 982
 983         if (local->ops->set_frag_threshold)
 984                 local->ops->set_frag_threshold(
 985                         local_to_hw(local),
 986                         local->fragmentation_threshold);
 987
 988         return 0;
 989 }
 990
 991 static int ieee80211_ioctl_giwfrag(struct net_device *dev,
 992                                    struct iw_request_info *info,
 993                                    struct iw_param *frag, char *extra)
 994 {
 995         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
 996
 997         frag->value = local->fragmentation_threshold;
 998         frag->disabled = (frag->value >= IEEE80211_MAX_RTS_THRESHOLD);
 999         frag->fixed = 1;
1000
1001         return 0;
1002 }
1003
1004
1005 static int ieee80211_ioctl_siwretry(struct net_device *dev,
1006                                     struct iw_request_info *info,
1007                                     struct iw_param *retry, char *extra)
1008 {
1009         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1010
1011         if (retry->disabled ||
1012             (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
1013                 return -EINVAL;
1014
1015         if (retry->flags & IW_RETRY_MAX)
1016                 local->long_retry_limit = retry->value;
1017         else if (retry->flags & IW_RETRY_MIN)
1018                 local->short_retry_limit = retry->value;
1019         else {
1020                 local->long_retry_limit = retry->value;
1021                 local->short_retry_limit = retry->value;
1022         }
1023
1024         if (local->ops->set_retry_limit) {
1025                 return local->ops->set_retry_limit(
1026                         local_to_hw(local),
1027                         local->short_retry_limit,
1028                         local->long_retry_limit);
1029         }
1030
1031         return 0;
1032 }
1033
1034
1035 static int ieee80211_ioctl_giwretry(struct net_device *dev,
1036                                     struct iw_request_info *info,
1037                                     struct iw_param *retry, char *extra)
1038 {
1039         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1040
1041         retry->disabled = 0;
1042         if (retry->flags == 0 || retry->flags & IW_RETRY_MIN) {
1043                 /* first return min value, iwconfig will ask max value
1044                  * later if needed */
1045                 retry->flags |= IW_RETRY_LIMIT;
1046                 retry->value = local->short_retry_limit;
1047                 if (local->long_retry_limit != local->short_retry_limit)
1048                         retry->flags |= IW_RETRY_MIN;
1049                 return 0;
1050         }
1051         if (retry->flags & IW_RETRY_MAX) {
1052                 retry->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
1053                 retry->value = local->long_retry_limit;
1054         }
1055
1056         return 0;
1057 }
1058
1059 static void ieee80211_key_enable_hwaccel(struct ieee80211_local *local,
1060                                          struct ieee80211_key *key)
1061 {
1062         struct ieee80211_key_conf *keyconf;
1063         u8 addr[ETH_ALEN];
1064
1065         if (!key || key->alg != ALG_WEP || !key->force_sw_encrypt ||
1066             (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP))
1067                 return;
1068
1069         memset(addr, 0xff, ETH_ALEN);
1070         keyconf = ieee80211_key_data2conf(local, key);
1071         if (keyconf && local->ops->set_key &&
1072             local->ops->set_key(local_to_hw(local),
1073                                SET_KEY, addr, keyconf, 0) == 0) {
1074                 key->force_sw_encrypt =
1075                         !!(keyconf->flags & IEEE80211_KEY_FORCE_SW_ENCRYPT);
1076                 key->hw_key_idx = keyconf->hw_key_idx;
1077         }
1078         kfree(keyconf);
1079 }
1080
1081
1082 static void ieee80211_key_disable_hwaccel(struct ieee80211_local *local,
1083                                           struct ieee80211_key *key)
1084 {
1085         struct ieee80211_key_conf *keyconf;
1086         u8 addr[ETH_ALEN];
1087
1088         if (!key || key->alg != ALG_WEP || key->force_sw_encrypt ||
1089             (local->hw.flags & IEEE80211_HW_DEVICE_HIDES_WEP))
1090                 return;
1091
1092         memset(addr, 0xff, ETH_ALEN);
1093         keyconf = ieee80211_key_data2conf(local, key);
1094         if (keyconf && local->ops->set_key)
1095                 local->ops->set_key(local_to_hw(local), DISABLE_KEY,
1096                                    addr, keyconf, 0);
1097         kfree(keyconf);
1098         key->force_sw_encrypt = 1;
1099 }
1100
1101
1102 static int ieee80211_ioctl_default_wep_only(struct ieee80211_local *local,
1103                                             int value)
1104 {
1105         int i;
1106         struct ieee80211_sub_if_data *sdata;
1107
1108         local->default_wep_only = value;
1109         read_lock(&local->sub_if_lock);
1110         list_for_each_entry(sdata, &local->sub_if_list, list)
1111                 for (i = 0; i < NUM_DEFAULT_KEYS; i++)
1112                         if (value)
1113                                 ieee80211_key_enable_hwaccel(local,
1114                                                              sdata->keys[i]);
1115                         else
1116                                 ieee80211_key_disable_hwaccel(local,
1117                                                               sdata->keys[i]);
1118         read_unlock(&local->sub_if_lock);
1119
1120         return 0;
1121 }
1122
1123
1124 void ieee80211_update_default_wep_only(struct ieee80211_local *local)
1125 {
1126         int i = 0;
1127         struct ieee80211_sub_if_data *sdata;
1128
1129         read_lock(&local->sub_if_lock);
1130         list_for_each_entry(sdata, &local->sub_if_list, list) {
1131
1132                 if (sdata->dev == local->mdev)
1133                         continue;
1134
1135                 /* If there is an AP interface then depend on userspace to
1136                    set default_wep_only correctly. */
1137                 if (sdata->type == IEEE80211_IF_TYPE_AP) {
1138                         read_unlock(&local->sub_if_lock);
1139                         return;
1140                 }
1141
1142                 i++;
1143         }
1144
1145         read_unlock(&local->sub_if_lock);
1146
1147         if (i <= 1)
1148                 ieee80211_ioctl_default_wep_only(local, 1);
1149         else
1150                 ieee80211_ioctl_default_wep_only(local, 0);
1151 }
1152
1153
1154 static int ieee80211_ioctl_prism2_param(struct net_device *dev,
1155                                         struct iw_request_info *info,
1156                                         void *wrqu, char *extra)
1157 {
1158         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1159         struct ieee80211_sub_if_data *sdata;
1160         int *i = (int *) extra;
1161         int param = *i;
1162         int value = *(i + 1);
1163         int ret = 0;
1164
1165         if (!capable(CAP_NET_ADMIN))
1166                 return -EPERM;
1167
1168         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1169
1170         switch (param) {
1171         case PRISM2_PARAM_IEEE_802_1X:
1172                 if (local->ops->set_ieee8021x)
1173                         ret = local->ops->set_ieee8021x(local_to_hw(local),
1174                                                         value);
1175                 if (ret)
1176                         printk(KERN_DEBUG "%s: failed to set IEEE 802.1X (%d) "
1177                                "for low-level driver\n", dev->name, value);
1178                 else
1179                         sdata->ieee802_1x = value;
1180                 break;
1181
1182         case PRISM2_PARAM_CTS_PROTECT_ERP_FRAMES:
1183                 local->cts_protect_erp_frames = value;
1184                 break;
1185
1186         case PRISM2_PARAM_PREAMBLE:
1187                 local->short_preamble = value;
1188                 break;
1189
1190         case PRISM2_PARAM_STAT_TIME:
1191                 if (!local->stat_time && value) {
1192                         local->stat_timer.expires = jiffies + HZ * value / 100;
1193                         add_timer(&local->stat_timer);
1194                 } else if (local->stat_time && !value) {
1195                         del_timer_sync(&local->stat_timer);
1196                 }
1197                 local->stat_time = value;
1198                 break;
1199         case PRISM2_PARAM_SHORT_SLOT_TIME:
1200                 if (value)
1201                         local->hw.conf.flags |= IEEE80211_CONF_SHORT_SLOT_TIME;
1202                 else
1203                         local->hw.conf.flags &= ~IEEE80211_CONF_SHORT_SLOT_TIME;
1204                 if (ieee80211_hw_config(local))
1205                         ret = -EINVAL;
1206                 break;
1207
1208         case PRISM2_PARAM_NEXT_MODE:
1209                 local->next_mode = value;
1210                 break;
1211
1212         case PRISM2_PARAM_RADIO_ENABLED:
1213                 ret = ieee80211_ioctl_set_radio_enabled(dev, value);
1214                 break;
1215
1216         case PRISM2_PARAM_ANTENNA_MODE:
1217                 local->hw.conf.antenna_mode = value;
1218                 if (ieee80211_hw_config(local))
1219                         ret = -EINVAL;
1220                 break;
1221
1222         case PRISM2_PARAM_STA_ANTENNA_SEL:
1223                 local->sta_antenna_sel = value;
1224                 break;
1225
1226         case PRISM2_PARAM_TX_POWER_REDUCTION:
1227                 if (value < 0)
1228                         ret = -EINVAL;
1229                 else
1230                         local->hw.conf.tx_power_reduction = value;
1231                 break;
1232
1233         case PRISM2_PARAM_KEY_TX_RX_THRESHOLD:
1234                 local->key_tx_rx_threshold = value;
1235                 break;
1236
1237         case PRISM2_PARAM_DEFAULT_WEP_ONLY:
1238                 ret = ieee80211_ioctl_default_wep_only(local, value);
1239                 break;
1240
1241         case PRISM2_PARAM_WIFI_WME_NOACK_TEST:
1242                 local->wifi_wme_noack_test = value;
1243                 break;
1244
1245         case PRISM2_PARAM_SCAN_FLAGS:
1246                 local->scan_flags = value;
1247                 break;
1248
1249         case PRISM2_PARAM_MIXED_CELL:
1250                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1251                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1252                         ret = -EINVAL;
1253                 else
1254                         sdata->u.sta.mixed_cell = !!value;
1255                 break;
1256
1257         case PRISM2_PARAM_HW_MODES:
1258                 local->enabled_modes = value;
1259                 break;
1260
1261         case PRISM2_PARAM_CREATE_IBSS:
1262                 if (sdata->type != IEEE80211_IF_TYPE_IBSS)
1263                         ret = -EINVAL;
1264                 else
1265                         sdata->u.sta.create_ibss = !!value;
1266                 break;
1267         case PRISM2_PARAM_WMM_ENABLED:
1268                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1269                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1270                         ret = -EINVAL;
1271                 else
1272                         sdata->u.sta.wmm_enabled = !!value;
1273                 break;
1274         case PRISM2_PARAM_RADAR_DETECT:
1275                 local->hw.conf.radar_detect = value;
1276                 break;
1277         case PRISM2_PARAM_SPECTRUM_MGMT:
1278                 local->hw.conf.spect_mgmt = value;
1279                 break;
1280         default:
1281                 ret = -EOPNOTSUPP;
1282                 break;
1283         }
1284
1285         return ret;
1286 }
1287
1288
1289 static int ieee80211_ioctl_get_prism2_param(struct net_device *dev,
1290                                             struct iw_request_info *info,
1291                                             void *wrqu, char *extra)
1292 {
1293         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1294         struct ieee80211_sub_if_data *sdata;
1295         int *param = (int *) extra;
1296         int ret = 0;
1297
1298         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1299
1300         switch (*param) {
1301         case PRISM2_PARAM_IEEE_802_1X:
1302                 *param = sdata->ieee802_1x;
1303                 break;
1304
1305         case PRISM2_PARAM_CTS_PROTECT_ERP_FRAMES:
1306                 *param = local->cts_protect_erp_frames;
1307                 break;
1308
1309         case PRISM2_PARAM_PREAMBLE:
1310                 *param = local->short_preamble;
1311                 break;
1312
1313         case PRISM2_PARAM_STAT_TIME:
1314                 *param = local->stat_time;
1315                 break;
1316         case PRISM2_PARAM_SHORT_SLOT_TIME:
1317                 *param = !!(local->hw.conf.flags & IEEE80211_CONF_SHORT_SLOT_TIME);
1318                 break;
1319
1320         case PRISM2_PARAM_NEXT_MODE:
1321                 *param = local->next_mode;
1322                 break;
1323
1324         case PRISM2_PARAM_ANTENNA_MODE:
1325                 *param = local->hw.conf.antenna_mode;
1326                 break;
1327
1328         case PRISM2_PARAM_STA_ANTENNA_SEL:
1329                 *param = local->sta_antenna_sel;
1330                 break;
1331
1332         case PRISM2_PARAM_TX_POWER_REDUCTION:
1333                 *param = local->hw.conf.tx_power_reduction;
1334                 break;
1335
1336         case PRISM2_PARAM_KEY_TX_RX_THRESHOLD:
1337                 *param = local->key_tx_rx_threshold;
1338                 break;
1339
1340         case PRISM2_PARAM_DEFAULT_WEP_ONLY:
1341                 *param = local->default_wep_only;
1342                 break;
1343
1344         case PRISM2_PARAM_WIFI_WME_NOACK_TEST:
1345                 *param = local->wifi_wme_noack_test;
1346                 break;
1347
1348         case PRISM2_PARAM_SCAN_FLAGS:
1349                 *param = local->scan_flags;
1350                 break;
1351
1352         case PRISM2_PARAM_HW_MODES:
1353                 *param = local->enabled_modes;
1354                 break;
1355
1356         case PRISM2_PARAM_CREATE_IBSS:
1357                 if (sdata->type != IEEE80211_IF_TYPE_IBSS)
1358                         ret = -EINVAL;
1359                 else
1360                         *param = !!sdata->u.sta.create_ibss;
1361                 break;
1362
1363         case PRISM2_PARAM_MIXED_CELL:
1364                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1365                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1366                         ret = -EINVAL;
1367                 else
1368                         *param = !!sdata->u.sta.mixed_cell;
1369                 break;
1370         case PRISM2_PARAM_WMM_ENABLED:
1371                 if (sdata->type != IEEE80211_IF_TYPE_STA &&
1372                     sdata->type != IEEE80211_IF_TYPE_IBSS)
1373                         ret = -EINVAL;
1374                 else
1375                         *param = !!sdata->u.sta.wmm_enabled;
1376                 break;
1377         default:
1378                 ret = -EOPNOTSUPP;
1379                 break;
1380         }
1381
1382         return ret;
1383 }
1384
1385 static int ieee80211_ioctl_siwmlme(struct net_device *dev,
1386                                    struct iw_request_info *info,
1387                                    struct iw_point *data, char *extra)
1388 {
1389         struct ieee80211_sub_if_data *sdata;
1390         struct iw_mlme *mlme = (struct iw_mlme *) extra;
1391
1392         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1393         if (sdata->type != IEEE80211_IF_TYPE_STA &&
1394             sdata->type != IEEE80211_IF_TYPE_IBSS)
1395                 return -EINVAL;
1396
1397         switch (mlme->cmd) {
1398         case IW_MLME_DEAUTH:
1399                 /* TODO: mlme->addr.sa_data */
1400                 return ieee80211_sta_deauthenticate(dev, mlme->reason_code);
1401         case IW_MLME_DISASSOC:
1402                 /* TODO: mlme->addr.sa_data */
1403                 return ieee80211_sta_disassociate(dev, mlme->reason_code);
1404         default:
1405                 return -EOPNOTSUPP;
1406         }
1407 }
1408
1409
1410 static int ieee80211_ioctl_siwencode(struct net_device *dev,
1411                                      struct iw_request_info *info,
1412                                      struct iw_point *erq, char *keybuf)
1413 {
1414         struct ieee80211_sub_if_data *sdata;
1415         int idx, i, alg = ALG_WEP;
1416         u8 bcaddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
1417
1418         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1419
1420         idx = erq->flags & IW_ENCODE_INDEX;
1421         if (idx == 0) {
1422                 if (sdata->default_key)
1423                         for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1424                                 if (sdata->default_key == sdata->keys[i]) {
1425                                         idx = i;
1426                                         break;
1427                                 }
1428                         }
1429         } else if (idx < 1 || idx > 4)
1430                 return -EINVAL;
1431         else
1432                 idx--;
1433
1434         if (erq->flags & IW_ENCODE_DISABLED)
1435                 alg = ALG_NONE;
1436         else if (erq->length == 0) {
1437                 /* No key data - just set the default TX key index */
1438                 if (sdata->default_key != sdata->keys[idx]) {
1439                         ieee80211_debugfs_key_remove_default(sdata);
1440                         sdata->default_key = sdata->keys[idx];
1441                         if (sdata->default_key)
1442                                 ieee80211_debugfs_key_add_default(sdata);
1443                 }
1444                 return 0;
1445         }
1446
1447         return ieee80211_set_encryption(
1448                 dev, bcaddr,
1449                 idx, alg,
1450                 !sdata->default_key,
1451                 keybuf, erq->length);
1452 }
1453
1454
1455 static int ieee80211_ioctl_giwencode(struct net_device *dev,
1456                                      struct iw_request_info *info,
1457                                      struct iw_point *erq, char *key)
1458 {
1459         struct ieee80211_sub_if_data *sdata;
1460         int idx, i;
1461
1462         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1463
1464         idx = erq->flags & IW_ENCODE_INDEX;
1465         if (idx < 1 || idx > 4) {
1466                 idx = -1;
1467                 if (!sdata->default_key)
1468                         idx = 0;
1469                 else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1470                         if (sdata->default_key == sdata->keys[i]) {
1471                                 idx = i;
1472                                 break;
1473                         }
1474                 }
1475                 if (idx < 0)
1476                         return -EINVAL;
1477         } else
1478                 idx--;
1479
1480         erq->flags = idx + 1;
1481
1482         if (!sdata->keys[idx]) {
1483                 erq->length = 0;
1484                 erq->flags |= IW_ENCODE_DISABLED;
1485                 return 0;
1486         }
1487
1488         memcpy(key, sdata->keys[idx]->key,
1489                min((int)erq->length, sdata->keys[idx]->keylen));
1490         erq->length = sdata->keys[idx]->keylen;
1491         erq->flags |= IW_ENCODE_ENABLED;
1492
1493         return 0;
1494 }
1495
1496 static int ieee80211_ioctl_siwauth(struct net_device *dev,
1497                                    struct iw_request_info *info,
1498                                    struct iw_param *data, char *extra)
1499 {
1500         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1501         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1502         int ret = 0;
1503
1504         switch (data->flags & IW_AUTH_INDEX) {
1505         case IW_AUTH_WPA_VERSION:
1506         case IW_AUTH_CIPHER_PAIRWISE:
1507         case IW_AUTH_CIPHER_GROUP:
1508         case IW_AUTH_WPA_ENABLED:
1509         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1510                 break;
1511         case IW_AUTH_KEY_MGMT:
1512                 if (sdata->type != IEEE80211_IF_TYPE_STA)
1513                         ret = -EINVAL;
1514                 else {
1515                         /*
1516                          * TODO: sdata->u.sta.key_mgmt does not match with WE18
1517                          * value completely; could consider modifying this to
1518                          * be closer to WE18. For now, this value is not really
1519                          * used for anything else than Privacy matching, so the
1520                          * current code here should be more or less OK.
1521                          */
1522                         if (data->value & IW_AUTH_KEY_MGMT_802_1X) {
1523                                 sdata->u.sta.key_mgmt =
1524                                         IEEE80211_KEY_MGMT_WPA_EAP;
1525                         } else if (data->value & IW_AUTH_KEY_MGMT_PSK) {
1526                                 sdata->u.sta.key_mgmt =
1527                                         IEEE80211_KEY_MGMT_WPA_PSK;
1528                         } else {
1529                                 sdata->u.sta.key_mgmt =
1530                                         IEEE80211_KEY_MGMT_NONE;
1531                         }
1532                 }
1533                 break;
1534         case IW_AUTH_80211_AUTH_ALG:
1535                 if (sdata->type == IEEE80211_IF_TYPE_STA ||
1536                     sdata->type == IEEE80211_IF_TYPE_IBSS)
1537                         sdata->u.sta.auth_algs = data->value;
1538                 else
1539                         ret = -EOPNOTSUPP;
1540                 break;
1541         case IW_AUTH_PRIVACY_INVOKED:
1542                 if (local->ops->set_privacy_invoked)
1543                         ret = local->ops->set_privacy_invoked(
1544                                         local_to_hw(local), data->value);
1545                 break;
1546         default:
1547                 ret = -EOPNOTSUPP;
1548                 break;
1549         }
1550         return ret;
1551 }
1552
1553 /* Get wireless statistics.  Called by /proc/net/wireless and by SIOCGIWSTATS */
1554 static struct iw_statistics *ieee80211_get_wireless_stats(struct net_device *dev)
1555 {
1556         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
1557         struct iw_statistics *wstats = &local->wstats;
1558         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1559         struct sta_info *sta = NULL;
1560
1561         if (sdata->type == IEEE80211_IF_TYPE_STA ||
1562             sdata->type == IEEE80211_IF_TYPE_IBSS)
1563                 sta = sta_info_get(local, sdata->u.sta.bssid);
1564         if (!sta) {
1565                 wstats->discard.fragment = 0;
1566                 wstats->discard.misc = 0;
1567                 wstats->qual.qual = 0;
1568                 wstats->qual.level = 0;
1569                 wstats->qual.noise = 0;
1570                 wstats->qual.updated = IW_QUAL_ALL_INVALID;
1571         } else {
1572                 wstats->qual.level = sta->last_rssi;
1573                 wstats->qual.qual = sta->last_signal;
1574                 wstats->qual.noise = sta->last_noise;
1575                 wstats->qual.updated = local->wstats_flags;
1576                 sta_info_put(sta);
1577         }
1578         return wstats;
1579 }
1580
1581 static int ieee80211_ioctl_giwauth(struct net_device *dev,
1582                                    struct iw_request_info *info,
1583                                    struct iw_param *data, char *extra)
1584 {
1585         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1586         int ret = 0;
1587
1588         switch (data->flags & IW_AUTH_INDEX) {
1589         case IW_AUTH_80211_AUTH_ALG:
1590                 if (sdata->type == IEEE80211_IF_TYPE_STA ||
1591                     sdata->type == IEEE80211_IF_TYPE_IBSS)
1592                         data->value = sdata->u.sta.auth_algs;
1593                 else
1594                         ret = -EOPNOTSUPP;
1595                 break;
1596         default:
1597                 ret = -EOPNOTSUPP;
1598                 break;
1599         }
1600         return ret;
1601 }
1602
1603
1604 static int ieee80211_ioctl_siwencodeext(struct net_device *dev,
1605                                         struct iw_request_info *info,
1606                                         struct iw_point *erq, char *extra)
1607 {
1608         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1609         struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
1610         int alg, idx, i;
1611
1612         switch (ext->alg) {
1613         case IW_ENCODE_ALG_NONE:
1614                 alg = ALG_NONE;
1615                 break;
1616         case IW_ENCODE_ALG_WEP:
1617                 alg = ALG_WEP;
1618                 break;
1619         case IW_ENCODE_ALG_TKIP:
1620                 alg = ALG_TKIP;
1621                 break;
1622         case IW_ENCODE_ALG_CCMP:
1623                 alg = ALG_CCMP;
1624                 break;
1625         default:
1626                 return -EOPNOTSUPP;
1627         }
1628
1629         if (erq->flags & IW_ENCODE_DISABLED)
1630                 alg = ALG_NONE;
1631
1632         idx = erq->flags & IW_ENCODE_INDEX;
1633         if (idx < 1 || idx > 4) {
1634                 idx = -1;
1635                 if (!sdata->default_key)
1636                         idx = 0;
1637                 else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
1638                         if (sdata->default_key == sdata->keys[i]) {
1639                                 idx = i;
1640                                 break;
1641                         }
1642                 }
1643                 if (idx < 0)
1644                         return -EINVAL;
1645         } else
1646                 idx--;
1647
1648         return ieee80211_set_encryption(dev, ext->addr.sa_data, idx, alg,
1649                                         ext->ext_flags &
1650                                         IW_ENCODE_EXT_SET_TX_KEY,
1651                                         ext->key, ext->key_len);
1652 }
1653
1654
1655 static const struct iw_priv_args ieee80211_ioctl_priv[] = {
1656         { PRISM2_IOCTL_PRISM2_PARAM,
1657           IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "param" },
1658         { PRISM2_IOCTL_GET_PRISM2_PARAM,
1659           IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1660           IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "get_param" },
1661 };
1662
1663 /* Structures to export the Wireless Handlers */
1664
1665 static const iw_handler ieee80211_handler[] =
1666 {
1667         (iw_handler) NULL,                              /* SIOCSIWCOMMIT */
1668         (iw_handler) ieee80211_ioctl_giwname,           /* SIOCGIWNAME */
1669         (iw_handler) NULL,                              /* SIOCSIWNWID */
1670         (iw_handler) NULL,                              /* SIOCGIWNWID */
1671         (iw_handler) ieee80211_ioctl_siwfreq,           /* SIOCSIWFREQ */
1672         (iw_handler) ieee80211_ioctl_giwfreq,           /* SIOCGIWFREQ */
1673         (iw_handler) ieee80211_ioctl_siwmode,           /* SIOCSIWMODE */
1674         (iw_handler) ieee80211_ioctl_giwmode,           /* SIOCGIWMODE */
1675         (iw_handler) NULL,                              /* SIOCSIWSENS */
1676         (iw_handler) NULL,                              /* SIOCGIWSENS */
1677         (iw_handler) NULL /* not used */,               /* SIOCSIWRANGE */
1678         (iw_handler) ieee80211_ioctl_giwrange,          /* SIOCGIWRANGE */
1679         (iw_handler) NULL /* not used */,               /* SIOCSIWPRIV */
1680         (iw_handler) NULL /* kernel code */,            /* SIOCGIWPRIV */
1681         (iw_handler) NULL /* not used */,               /* SIOCSIWSTATS */
1682         (iw_handler) NULL /* kernel code */,            /* SIOCGIWSTATS */
1683         iw_handler_set_spy,                             /* SIOCSIWSPY */
1684         iw_handler_get_spy,                             /* SIOCGIWSPY */
1685         iw_handler_set_thrspy,                          /* SIOCSIWTHRSPY */
1686         iw_handler_get_thrspy,                          /* SIOCGIWTHRSPY */
1687         (iw_handler) ieee80211_ioctl_siwap,             /* SIOCSIWAP */
1688         (iw_handler) ieee80211_ioctl_giwap,             /* SIOCGIWAP */
1689         (iw_handler) ieee80211_ioctl_siwmlme,           /* SIOCSIWMLME */
1690         (iw_handler) NULL,                              /* SIOCGIWAPLIST */
1691         (iw_handler) ieee80211_ioctl_siwscan,           /* SIOCSIWSCAN */
1692         (iw_handler) ieee80211_ioctl_giwscan,           /* SIOCGIWSCAN */
1693         (iw_handler) ieee80211_ioctl_siwessid,          /* SIOCSIWESSID */
1694         (iw_handler) ieee80211_ioctl_giwessid,          /* SIOCGIWESSID */
1695         (iw_handler) NULL,                              /* SIOCSIWNICKN */
1696         (iw_handler) NULL,                              /* SIOCGIWNICKN */
1697         (iw_handler) NULL,                              /* -- hole -- */
1698         (iw_handler) NULL,                              /* -- hole -- */
1699         (iw_handler) ieee80211_ioctl_siwrate,           /* SIOCSIWRATE */
1700         (iw_handler) ieee80211_ioctl_giwrate,           /* SIOCGIWRATE */
1701         (iw_handler) ieee80211_ioctl_siwrts,            /* SIOCSIWRTS */
1702         (iw_handler) ieee80211_ioctl_giwrts,            /* SIOCGIWRTS */
1703         (iw_handler) ieee80211_ioctl_siwfrag,           /* SIOCSIWFRAG */
1704         (iw_handler) ieee80211_ioctl_giwfrag,           /* SIOCGIWFRAG */
1705         (iw_handler) NULL,                              /* SIOCSIWTXPOW */
1706         (iw_handler) NULL,                              /* SIOCGIWTXPOW */
1707         (iw_handler) ieee80211_ioctl_siwretry,          /* SIOCSIWRETRY */
1708         (iw_handler) ieee80211_ioctl_giwretry,          /* SIOCGIWRETRY */
1709         (iw_handler) ieee80211_ioctl_siwencode,         /* SIOCSIWENCODE */
1710         (iw_handler) ieee80211_ioctl_giwencode,         /* SIOCGIWENCODE */
1711         (iw_handler) NULL,                              /* SIOCSIWPOWER */
1712         (iw_handler) NULL,                              /* SIOCGIWPOWER */
1713         (iw_handler) NULL,                              /* -- hole -- */
1714         (iw_handler) NULL,                              /* -- hole -- */
1715         (iw_handler) ieee80211_ioctl_siwgenie,          /* SIOCSIWGENIE */
1716         (iw_handler) NULL,                              /* SIOCGIWGENIE */
1717         (iw_handler) ieee80211_ioctl_siwauth,           /* SIOCSIWAUTH */
1718         (iw_handler) ieee80211_ioctl_giwauth,           /* SIOCGIWAUTH */
1719         (iw_handler) ieee80211_ioctl_siwencodeext,      /* SIOCSIWENCODEEXT */
1720         (iw_handler) NULL,                              /* SIOCGIWENCODEEXT */
1721         (iw_handler) NULL,                              /* SIOCSIWPMKSA */
1722         (iw_handler) NULL,                              /* -- hole -- */
1723 };
1724
1725 static const iw_handler ieee80211_private_handler[] =
1726 {                                                       /* SIOCIWFIRSTPRIV + */
1727         (iw_handler) ieee80211_ioctl_prism2_param,      /* 0 */
1728         (iw_handler) ieee80211_ioctl_get_prism2_param,  /* 1 */
1729 };
1730
1731 const struct iw_handler_def ieee80211_iw_handler_def =
1732 {
1733         .num_standard   = ARRAY_SIZE(ieee80211_handler),
1734         .num_private    = ARRAY_SIZE(ieee80211_private_handler),
1735         .num_private_args = ARRAY_SIZE(ieee80211_ioctl_priv),
1736         .standard       = (iw_handler *) ieee80211_handler,
1737         .private        = (iw_handler *) ieee80211_private_handler,
1738         .private_args   = (struct iw_priv_args *) ieee80211_ioctl_priv,
1739         .get_wireless_stats = ieee80211_get_wireless_stats,
1740 };