drivers/net/wireless/intersil/prism54/isl_ioctl.c

   1 /*
   2  *  Copyright (C) 2002 Intersil Americas Inc.
   3  *            (C) 2003,2004 Aurelien Alleaume <[email protected]>
   4  *            (C) 2003 Herbert Valerio Riedel <[email protected]>
   5  *            (C) 2003 Luis R. Rodriguez <[email protected]>
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License as published by
   9  *  the Free Software Foundation; either version 2 of the License
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, see <http://www.gnu.org/licenses/>.
  18  *
  19  */
  20
  21 #include <linux/capability.h>
  22 #include <linux/module.h>
  23 #include <linux/kernel.h>
  24 #include <linux/if_arp.h>
  25 #include <linux/slab.h>
  26 #include <linux/pci.h>
  27 #include <linux/etherdevice.h>
  28
  29 #include <linux/uaccess.h>
  30
  31 #include "prismcompat.h"
  32 #include "isl_ioctl.h"
  33 #include "islpci_mgt.h"
  34 #include "isl_oid.h"            /* additional types and defs for isl38xx fw */
  35 #include "oid_mgt.h"
  36
  37 #include <net/iw_handler.h>     /* New driver API */
  38
  39 #define KEY_SIZE_WEP104 13      /* 104/128-bit WEP keys */
  40 #define KEY_SIZE_WEP40  5       /* 40/64-bit WEP keys */
  41 /* KEY_SIZE_TKIP should match isl_oid.h, struct obj_key.key[] size */
  42 #define KEY_SIZE_TKIP   32      /* TKIP keys */
  43
  44 static void prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
  45                                 u8 *wpa_ie, size_t wpa_ie_len);
  46 static size_t prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie);
  47 static int prism54_set_wpa(struct net_device *, struct iw_request_info *,
  48                                 __u32 *, char *);
  49
  50 /* In 500 kbps */
  51 static const unsigned char scan_rate_list[] = { 2, 4, 11, 22,
  52                                                 12, 18, 24, 36,
  53                                                 48, 72, 96, 108 };
  54
  55 /**
  56  * prism54_mib_mode_helper - MIB change mode helper function
  57  * @priv: the &struct islpci_private object to modify
  58  * @iw_mode: new mode (%IW_MODE_*)
  59  *
  60  *  This is a helper function, hence it does not lock. Make sure
  61  *  caller deals with locking *if* necessary. This function sets the
  62  *  mode-dependent mib values and does the mapping of the Linux
  63  *  Wireless API modes to Device firmware modes. It also checks for
  64  *  correct valid Linux wireless modes.
  65  */
  66 static int
  67 prism54_mib_mode_helper(islpci_private *priv, u32 iw_mode)
  68 {
  69         u32 config = INL_CONFIG_MANUALRUN;
  70         u32 mode, bsstype;
  71
  72         /* For now, just catch early the Repeater and Secondary modes here */
  73         if (iw_mode == IW_MODE_REPEAT || iw_mode == IW_MODE_SECOND) {
  74                 printk(KERN_DEBUG
  75                        "%s(): Sorry, Repeater mode and Secondary mode "
  76                        "are not yet supported by this driver.\n", __func__);
  77                 return -EINVAL;
  78         }
  79
  80         priv->iw_mode = iw_mode;
  81
  82         switch (iw_mode) {
  83         case IW_MODE_AUTO:
  84                 mode = INL_MODE_CLIENT;
  85                 bsstype = DOT11_BSSTYPE_ANY;
  86                 break;
  87         case IW_MODE_ADHOC:
  88                 mode = INL_MODE_CLIENT;
  89                 bsstype = DOT11_BSSTYPE_IBSS;
  90                 break;
  91         case IW_MODE_INFRA:
  92                 mode = INL_MODE_CLIENT;
  93                 bsstype = DOT11_BSSTYPE_INFRA;
  94                 break;
  95         case IW_MODE_MASTER:
  96                 mode = INL_MODE_AP;
  97                 bsstype = DOT11_BSSTYPE_INFRA;
  98                 break;
  99         case IW_MODE_MONITOR:
 100                 mode = INL_MODE_PROMISCUOUS;
 101                 bsstype = DOT11_BSSTYPE_ANY;
 102                 config |= INL_CONFIG_RXANNEX;
 103                 break;
 104         default:
 105                 return -EINVAL;
 106         }
 107
 108         if (init_wds)
 109                 config |= INL_CONFIG_WDS;
 110         mgt_set(priv, DOT11_OID_BSSTYPE, &bsstype);
 111         mgt_set(priv, OID_INL_CONFIG, &config);
 112         mgt_set(priv, OID_INL_MODE, &mode);
 113
 114         return 0;
 115 }
 116
 117 /*
 118  * prism54_mib_init - fill MIB cache with defaults
 119  *
 120  *  this function initializes the struct given as @mib with defaults,
 121  *  of which many are retrieved from the global module parameter
 122  *  variables.
 123  */
 124 void
 125 prism54_mib_init(islpci_private *priv)
 126 {
 127         u32 channel, authen, wep, filter, dot1x, mlme, conformance, power, mode;
 128         struct obj_buffer psm_buffer = {
 129                 .size = PSM_BUFFER_SIZE,
 130                 .addr = priv->device_psm_buffer
 131         };
 132
 133         channel = CARD_DEFAULT_CHANNEL;
 134         authen = CARD_DEFAULT_AUTHEN;
 135         wep = CARD_DEFAULT_WEP;
 136         filter = CARD_DEFAULT_FILTER; /* (0) Do not filter un-encrypted data */
 137         dot1x = CARD_DEFAULT_DOT1X;
 138         mlme = CARD_DEFAULT_MLME_MODE;
 139         conformance = CARD_DEFAULT_CONFORMANCE;
 140         power = 127;
 141         mode = CARD_DEFAULT_IW_MODE;
 142
 143         mgt_set(priv, DOT11_OID_CHANNEL, &channel);
 144         mgt_set(priv, DOT11_OID_AUTHENABLE, &authen);
 145         mgt_set(priv, DOT11_OID_PRIVACYINVOKED, &wep);
 146         mgt_set(priv, DOT11_OID_PSMBUFFER, &psm_buffer);
 147         mgt_set(priv, DOT11_OID_EXUNENCRYPTED, &filter);
 148         mgt_set(priv, DOT11_OID_DOT1XENABLE, &dot1x);
 149         mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlme);
 150         mgt_set(priv, OID_INL_DOT11D_CONFORMANCE, &conformance);
 151         mgt_set(priv, OID_INL_OUTPUTPOWER, &power);
 152
 153         /* This sets all of the mode-dependent values */
 154         prism54_mib_mode_helper(priv, mode);
 155 }
 156
 157 /* this will be executed outside of atomic context thanks to
 158  * schedule_work(), thus we can as well use sleeping semaphore
 159  * locking */
 160 void
 161 prism54_update_stats(struct work_struct *work)
 162 {
 163         islpci_private *priv = container_of(work, islpci_private, stats_work);
 164         char *data;
 165         struct obj_bss bss, *bss2;
 166         union oid_res_t r;
 167
 168         mutex_lock(&priv->stats_lock);
 169
 170 /* Noise floor.
 171  * I'm not sure if the unit is dBm.
 172  * Note : If we are not connected, this value seems to be irrelevant. */
 173
 174         mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
 175         priv->local_iwstatistics.qual.noise = r.u;
 176
 177 /* Get the rssi of the link. To do this we need to retrieve a bss. */
 178
 179         /* First get the MAC address of the AP we are associated with. */
 180         mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
 181         data = r.ptr;
 182
 183         /* copy this MAC to the bss */
 184         memcpy(bss.address, data, ETH_ALEN);
 185         kfree(data);
 186
 187         /* now ask for the corresponding bss */
 188         mgt_get_request(priv, DOT11_OID_BSSFIND, 0, (void *) &bss, &r);
 189         bss2 = r.ptr;
 190         /* report the rssi and use it to calculate
 191          *  link quality through a signal-noise
 192          *  ratio */
 193         priv->local_iwstatistics.qual.level = bss2->rssi;
 194         priv->local_iwstatistics.qual.qual =
 195             bss2->rssi - priv->iwstatistics.qual.noise;
 196
 197         kfree(bss2);
 198
 199         /* report that the stats are new */
 200         priv->local_iwstatistics.qual.updated = 0x7;
 201
 202 /* Rx : unable to decrypt the MPDU */
 203         mgt_get_request(priv, DOT11_OID_PRIVRXFAILED, 0, NULL, &r);
 204         priv->local_iwstatistics.discard.code = r.u;
 205
 206 /* Tx : Max MAC retries num reached */
 207         mgt_get_request(priv, DOT11_OID_MPDUTXFAILED, 0, NULL, &r);
 208         priv->local_iwstatistics.discard.retries = r.u;
 209
 210         mutex_unlock(&priv->stats_lock);
 211 }
 212
 213 struct iw_statistics *
 214 prism54_get_wireless_stats(struct net_device *ndev)
 215 {
 216         islpci_private *priv = netdev_priv(ndev);
 217
 218         /* If the stats are being updated return old data */
 219         if (mutex_trylock(&priv->stats_lock)) {
 220                 memcpy(&priv->iwstatistics, &priv->local_iwstatistics,
 221                        sizeof (struct iw_statistics));
 222                 /* They won't be marked updated for the next time */
 223                 priv->local_iwstatistics.qual.updated = 0;
 224                 mutex_unlock(&priv->stats_lock);
 225         } else
 226                 priv->iwstatistics.qual.updated = 0;
 227
 228         /* Update our wireless stats, but do not schedule to often
 229          * (max 1 HZ) */
 230         if ((priv->stats_timestamp == 0) ||
 231             time_after(jiffies, priv->stats_timestamp + 1 * HZ)) {
 232                 schedule_work(&priv->stats_work);
 233                 priv->stats_timestamp = jiffies;
 234         }
 235
 236         return &priv->iwstatistics;
 237 }
 238
 239 static int
 240 prism54_commit(struct net_device *ndev, struct iw_request_info *info,
 241                char *cwrq, char *extra)
 242 {
 243         islpci_private *priv = netdev_priv(ndev);
 244
 245         /* simply re-set the last set SSID, this should commit most stuff */
 246
 247         /* Commit in Monitor mode is not necessary, also setting essid
 248          * in Monitor mode does not make sense and isn't allowed for this
 249          * device's firmware */
 250         if (priv->iw_mode != IW_MODE_MONITOR)
 251                 return mgt_set_request(priv, DOT11_OID_SSID, 0, NULL);
 252         return 0;
 253 }
 254
 255 static int
 256 prism54_get_name(struct net_device *ndev, struct iw_request_info *info,
 257                  char *cwrq, char *extra)
 258 {
 259         islpci_private *priv = netdev_priv(ndev);
 260         char *capabilities;
 261         union oid_res_t r;
 262         int rvalue;
 263
 264         if (islpci_get_state(priv) < PRV_STATE_INIT) {
 265                 strncpy(cwrq, "NOT READY!", IFNAMSIZ);
 266                 return 0;
 267         }
 268         rvalue = mgt_get_request(priv, OID_INL_PHYCAPABILITIES, 0, NULL, &r);
 269
 270         switch (r.u) {
 271         case INL_PHYCAP_5000MHZ:
 272                 capabilities = "IEEE 802.11a/b/g";
 273                 break;
 274         case INL_PHYCAP_FAA:
 275                 capabilities = "IEEE 802.11b/g - FAA Support";
 276                 break;
 277         case INL_PHYCAP_2400MHZ:
 278         default:
 279                 capabilities = "IEEE 802.11b/g";        /* Default */
 280                 break;
 281         }
 282         strncpy(cwrq, capabilities, IFNAMSIZ);
 283         return rvalue;
 284 }
 285
 286 static int
 287 prism54_set_freq(struct net_device *ndev, struct iw_request_info *info,
 288                  struct iw_freq *fwrq, char *extra)
 289 {
 290         islpci_private *priv = netdev_priv(ndev);
 291         int rvalue;
 292         u32 c;
 293
 294         if (fwrq->m < 1000)
 295                 /* we have a channel number */
 296                 c = fwrq->m;
 297         else
 298                 c = (fwrq->e == 1) ? channel_of_freq(fwrq->m / 100000) : 0;
 299
 300         rvalue = c ? mgt_set_request(priv, DOT11_OID_CHANNEL, 0, &c) : -EINVAL;
 301
 302         /* Call commit handler */
 303         return (rvalue ? rvalue : -EINPROGRESS);
 304 }
 305
 306 static int
 307 prism54_get_freq(struct net_device *ndev, struct iw_request_info *info,
 308                  struct iw_freq *fwrq, char *extra)
 309 {
 310         islpci_private *priv = netdev_priv(ndev);
 311         union oid_res_t r;
 312         int rvalue;
 313
 314         rvalue = mgt_get_request(priv, DOT11_OID_CHANNEL, 0, NULL, &r);
 315         fwrq->i = r.u;
 316         rvalue |= mgt_get_request(priv, DOT11_OID_FREQUENCY, 0, NULL, &r);
 317         fwrq->m = r.u;
 318         fwrq->e = 3;
 319
 320         return rvalue;
 321 }
 322
 323 static int
 324 prism54_set_mode(struct net_device *ndev, struct iw_request_info *info,
 325                  __u32 * uwrq, char *extra)
 326 {
 327         islpci_private *priv = netdev_priv(ndev);
 328         u32 mlmeautolevel = CARD_DEFAULT_MLME_MODE;
 329
 330         /* Let's see if the user passed a valid Linux Wireless mode */
 331         if (*uwrq > IW_MODE_MONITOR || *uwrq < IW_MODE_AUTO) {
 332                 printk(KERN_DEBUG
 333                        "%s: %s() You passed a non-valid init_mode.\n",
 334                        priv->ndev->name, __func__);
 335                 return -EINVAL;
 336         }
 337
 338         down_write(&priv->mib_sem);
 339
 340         if (prism54_mib_mode_helper(priv, *uwrq)) {
 341                 up_write(&priv->mib_sem);
 342                 return -EOPNOTSUPP;
 343         }
 344
 345         /* the ACL code needs an intermediate mlmeautolevel. The wpa stuff an
 346          * extended one.
 347          */
 348         if ((*uwrq == IW_MODE_MASTER) && (priv->acl.policy != MAC_POLICY_OPEN))
 349                 mlmeautolevel = DOT11_MLME_INTERMEDIATE;
 350         if (priv->wpa)
 351                 mlmeautolevel = DOT11_MLME_EXTENDED;
 352
 353         mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
 354
 355         if (mgt_commit(priv)) {
 356                 up_write(&priv->mib_sem);
 357                 return -EIO;
 358         }
 359         priv->ndev->type = (priv->iw_mode == IW_MODE_MONITOR)
 360             ? priv->monitor_type : ARPHRD_ETHER;
 361         up_write(&priv->mib_sem);
 362
 363         return 0;
 364 }
 365
 366 /* Use mib cache */
 367 static int
 368 prism54_get_mode(struct net_device *ndev, struct iw_request_info *info,
 369                  __u32 * uwrq, char *extra)
 370 {
 371         islpci_private *priv = netdev_priv(ndev);
 372
 373         BUG_ON((priv->iw_mode < IW_MODE_AUTO) || (priv->iw_mode >
 374                                                   IW_MODE_MONITOR));
 375         *uwrq = priv->iw_mode;
 376
 377         return 0;
 378 }
 379
 380 /* we use DOT11_OID_EDTHRESHOLD. From what I guess the card will not try to
 381  * emit data if (sensitivity > rssi - noise) (in dBm).
 382  * prism54_set_sens does not seem to work.
 383  */
 384
 385 static int
 386 prism54_set_sens(struct net_device *ndev, struct iw_request_info *info,
 387                  struct iw_param *vwrq, char *extra)
 388 {
 389         islpci_private *priv = netdev_priv(ndev);
 390         u32 sens;
 391
 392         /* by default  the card sets this to 20. */
 393         sens = vwrq->disabled ? 20 : vwrq->value;
 394
 395         return mgt_set_request(priv, DOT11_OID_EDTHRESHOLD, 0, &sens);
 396 }
 397
 398 static int
 399 prism54_get_sens(struct net_device *ndev, struct iw_request_info *info,
 400                  struct iw_param *vwrq, char *extra)
 401 {
 402         islpci_private *priv = netdev_priv(ndev);
 403         union oid_res_t r;
 404         int rvalue;
 405
 406         rvalue = mgt_get_request(priv, DOT11_OID_EDTHRESHOLD, 0, NULL, &r);
 407
 408         vwrq->value = r.u;
 409         vwrq->disabled = (vwrq->value == 0);
 410         vwrq->fixed = 1;
 411
 412         return rvalue;
 413 }
 414
 415 static int
 416 prism54_get_range(struct net_device *ndev, struct iw_request_info *info,
 417                   struct iw_point *dwrq, char *extra)
 418 {
 419         struct iw_range *range = (struct iw_range *) extra;
 420         islpci_private *priv = netdev_priv(ndev);
 421         u8 *data;
 422         int i, m, rvalue;
 423         struct obj_frequencies *freq;
 424         union oid_res_t r;
 425
 426         memset(range, 0, sizeof (struct iw_range));
 427         dwrq->length = sizeof (struct iw_range);
 428
 429         /* set the wireless extension version number */
 430         range->we_version_source = SUPPORTED_WIRELESS_EXT;
 431         range->we_version_compiled = WIRELESS_EXT;
 432
 433         /* Now the encoding capabilities */
 434         range->num_encoding_sizes = 3;
 435         /* 64(40) bits WEP */
 436         range->encoding_size[0] = 5;
 437         /* 128(104) bits WEP */
 438         range->encoding_size[1] = 13;
 439         /* 256 bits for WPA-PSK */
 440         range->encoding_size[2] = 32;
 441         /* 4 keys are allowed */
 442         range->max_encoding_tokens = 4;
 443
 444         /* we don't know the quality range... */
 445         range->max_qual.level = 0;
 446         range->max_qual.noise = 0;
 447         range->max_qual.qual = 0;
 448         /* these value describe an average quality. Needs more tweaking... */
 449         range->avg_qual.level = -80;    /* -80 dBm */
 450         range->avg_qual.noise = 0;      /* don't know what to put here */
 451         range->avg_qual.qual = 0;
 452
 453         range->sensitivity = 200;
 454
 455         /* retry limit capabilities */
 456         range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
 457         range->retry_flags = IW_RETRY_LIMIT;
 458         range->r_time_flags = IW_RETRY_LIFETIME;
 459
 460         /* I don't know the range. Put stupid things here */
 461         range->min_retry = 1;
 462         range->max_retry = 65535;
 463         range->min_r_time = 1024;
 464         range->max_r_time = 65535 * 1024;
 465
 466         /* txpower is supported in dBm's */
 467         range->txpower_capa = IW_TXPOW_DBM;
 468
 469         /* Event capability (kernel + driver) */
 470         range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
 471         IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
 472         IW_EVENT_CAPA_MASK(SIOCGIWAP));
 473         range->event_capa[1] = IW_EVENT_CAPA_K_1;
 474         range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVCUSTOM);
 475
 476         range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
 477                 IW_ENC_CAPA_CIPHER_TKIP;
 478
 479         if (islpci_get_state(priv) < PRV_STATE_INIT)
 480                 return 0;
 481
 482         /* Request the device for the supported frequencies
 483          * not really relevant since some devices will report the 5 GHz band
 484          * frequencies even if they don't support them.
 485          */
 486         rvalue =
 487             mgt_get_request(priv, DOT11_OID_SUPPORTEDFREQUENCIES, 0, NULL, &r);
 488         freq = r.ptr;
 489
 490         range->num_channels = freq->nr;
 491         range->num_frequency = freq->nr;
 492
 493         m = min(IW_MAX_FREQUENCIES, (int) freq->nr);
 494         for (i = 0; i < m; i++) {
 495                 range->freq[i].m = freq->mhz[i];
 496                 range->freq[i].e = 6;
 497                 range->freq[i].i = channel_of_freq(freq->mhz[i]);
 498         }
 499         kfree(freq);
 500
 501         rvalue |= mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r);
 502         data = r.ptr;
 503
 504         /* We got an array of char. It is NULL terminated. */
 505         i = 0;
 506         while ((i < IW_MAX_BITRATES) && (*data != 0)) {
 507                 /*       the result must be in bps. The card gives us 500Kbps */
 508                 range->bitrate[i] = *data * 500000;
 509                 i++;
 510                 data++;
 511         }
 512         range->num_bitrates = i;
 513         kfree(r.ptr);
 514
 515         return rvalue;
 516 }
 517
 518 /* Set AP address*/
 519
 520 static int
 521 prism54_set_wap(struct net_device *ndev, struct iw_request_info *info,
 522                 struct sockaddr *awrq, char *extra)
 523 {
 524         islpci_private *priv = netdev_priv(ndev);
 525         char bssid[6];
 526         int rvalue;
 527
 528         if (awrq->sa_family != ARPHRD_ETHER)
 529                 return -EINVAL;
 530
 531         /* prepare the structure for the set object */
 532         memcpy(&bssid[0], awrq->sa_data, ETH_ALEN);
 533
 534         /* set the bssid -- does this make sense when in AP mode? */
 535         rvalue = mgt_set_request(priv, DOT11_OID_BSSID, 0, &bssid);
 536
 537         return (rvalue ? rvalue : -EINPROGRESS);        /* Call commit handler */
 538 }
 539
 540 /* get AP address*/
 541
 542 static int
 543 prism54_get_wap(struct net_device *ndev, struct iw_request_info *info,
 544                 struct sockaddr *awrq, char *extra)
 545 {
 546         islpci_private *priv = netdev_priv(ndev);
 547         union oid_res_t r;
 548         int rvalue;
 549
 550         rvalue = mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
 551         memcpy(awrq->sa_data, r.ptr, ETH_ALEN);
 552         awrq->sa_family = ARPHRD_ETHER;
 553         kfree(r.ptr);
 554
 555         return rvalue;
 556 }
 557
 558 static int
 559 prism54_set_scan(struct net_device *dev, struct iw_request_info *info,
 560                  struct iw_param *vwrq, char *extra)
 561 {
 562         /* hehe the device does this automagicaly */
 563         return 0;
 564 }
 565
 566 /* a little helper that will translate our data into a card independent
 567  * format that the Wireless Tools will understand. This was inspired by
 568  * the "Aironet driver for 4500 and 4800 series cards" (GPL)
 569  */
 570
 571 static char *
 572 prism54_translate_bss(struct net_device *ndev, struct iw_request_info *info,
 573                       char *current_ev, char *end_buf, struct obj_bss *bss,
 574                       char noise)
 575 {
 576         struct iw_event iwe;    /* Temporary buffer */
 577         short cap;
 578         islpci_private *priv = netdev_priv(ndev);
 579         u8 wpa_ie[MAX_WPA_IE_LEN];
 580         size_t wpa_ie_len;
 581
 582         /* The first entry must be the MAC address */
 583         memcpy(iwe.u.ap_addr.sa_data, bss->address, ETH_ALEN);
 584         iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
 585         iwe.cmd = SIOCGIWAP;
 586         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
 587                                           &iwe, IW_EV_ADDR_LEN);
 588
 589         /* The following entries will be displayed in the same order we give them */
 590
 591         /* The ESSID. */
 592         iwe.u.data.length = bss->ssid.length;
 593         iwe.u.data.flags = 1;
 594         iwe.cmd = SIOCGIWESSID;
 595         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
 596                                           &iwe, bss->ssid.octets);
 597
 598         /* Capabilities */
 599 #define CAP_ESS 0x01
 600 #define CAP_IBSS 0x02
 601 #define CAP_CRYPT 0x10
 602
 603         /* Mode */
 604         cap = bss->capinfo;
 605         iwe.u.mode = 0;
 606         if (cap & CAP_ESS)
 607                 iwe.u.mode = IW_MODE_MASTER;
 608         else if (cap & CAP_IBSS)
 609                 iwe.u.mode = IW_MODE_ADHOC;
 610         iwe.cmd = SIOCGIWMODE;
 611         if (iwe.u.mode)
 612                 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
 613                                                   &iwe, IW_EV_UINT_LEN);
 614
 615         /* Encryption capability */
 616         if (cap & CAP_CRYPT)
 617                 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
 618         else
 619                 iwe.u.data.flags = IW_ENCODE_DISABLED;
 620         iwe.u.data.length = 0;
 621         iwe.cmd = SIOCGIWENCODE;
 622         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
 623                                           &iwe, NULL);
 624
 625         /* Add frequency. (short) bss->channel is the frequency in MHz */
 626         iwe.u.freq.m = bss->channel;
 627         iwe.u.freq.e = 6;
 628         iwe.cmd = SIOCGIWFREQ;
 629         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
 630                                           &iwe, IW_EV_FREQ_LEN);
 631
 632         /* Add quality statistics */
 633         iwe.u.qual.level = bss->rssi;
 634         iwe.u.qual.noise = noise;
 635         /* do a simple SNR for quality */
 636         iwe.u.qual.qual = bss->rssi - noise;
 637         iwe.cmd = IWEVQUAL;
 638         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
 639                                           &iwe, IW_EV_QUAL_LEN);
 640
 641         /* Add WPA/RSN Information Element, if any */
 642         wpa_ie_len = prism54_wpa_bss_ie_get(priv, bss->address, wpa_ie);
 643         if (wpa_ie_len > 0) {
 644                 iwe.cmd = IWEVGENIE;
 645                 iwe.u.data.length = min_t(size_t, wpa_ie_len, MAX_WPA_IE_LEN);
 646                 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
 647                                                   &iwe, wpa_ie);
 648         }
 649         /* Do the bitrates */
 650         {
 651                 char *current_val = current_ev + iwe_stream_lcp_len(info);
 652                 int i;
 653                 int mask;
 654
 655                 iwe.cmd = SIOCGIWRATE;
 656                 /* Those two flags are ignored... */
 657                 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
 658
 659                 /* Parse the bitmask */
 660                 mask = 0x1;
 661                 for(i = 0; i < sizeof(scan_rate_list); i++) {
 662                         if(bss->rates & mask) {
 663                                 iwe.u.bitrate.value = (scan_rate_list[i] * 500000);
 664                                 current_val = iwe_stream_add_value(
 665                                         info, current_ev, current_val,
 666                                         end_buf, &iwe, IW_EV_PARAM_LEN);
 667                         }
 668                         mask <<= 1;
 669                 }
 670                 /* Check if we added any event */
 671                 if ((current_val - current_ev) > iwe_stream_lcp_len(info))
 672                         current_ev = current_val;
 673         }
 674
 675         return current_ev;
 676 }
 677
 678 static int
 679 prism54_get_scan(struct net_device *ndev, struct iw_request_info *info,
 680                  struct iw_point *dwrq, char *extra)
 681 {
 682         islpci_private *priv = netdev_priv(ndev);
 683         int i, rvalue;
 684         struct obj_bsslist *bsslist;
 685         u32 noise = 0;
 686         char *current_ev = extra;
 687         union oid_res_t r;
 688
 689         if (islpci_get_state(priv) < PRV_STATE_INIT) {
 690                 /* device is not ready, fail gently */
 691                 dwrq->length = 0;
 692                 return 0;
 693         }
 694
 695         /* first get the noise value. We will use it to report the link quality */
 696         rvalue = mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
 697         noise = r.u;
 698
 699         /* Ask the device for a list of known bss.
 700         * The old API, using SIOCGIWAPLIST, had a hard limit of IW_MAX_AP=64.
 701         * The new API, using SIOCGIWSCAN, is only limited by the buffer size.
 702         * WE-14->WE-16, the buffer is limited to IW_SCAN_MAX_DATA bytes.
 703         * Starting with WE-17, the buffer can be as big as needed.
 704         * But the device won't repport anything if you change the value
 705         * of IWMAX_BSS=24. */
 706
 707         rvalue |= mgt_get_request(priv, DOT11_OID_BSSLIST, 0, NULL, &r);
 708         bsslist = r.ptr;
 709
 710         /* ok now, scan the list and translate its info */
 711         for (i = 0; i < (int) bsslist->nr; i++) {
 712                 current_ev = prism54_translate_bss(ndev, info, current_ev,
 713                                                    extra + dwrq->length,
 714                                                    &(bsslist->bsslist[i]),
 715                                                    noise);
 716
 717                 /* Check if there is space for one more entry */
 718                 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
 719                         /* Ask user space to try again with a bigger buffer */
 720                         rvalue = -E2BIG;
 721                         break;
 722                 }
 723         }
 724
 725         kfree(bsslist);
 726         dwrq->length = (current_ev - extra);
 727         dwrq->flags = 0;        /* todo */
 728
 729         return rvalue;
 730 }
 731
 732 static int
 733 prism54_set_essid(struct net_device *ndev, struct iw_request_info *info,
 734                   struct iw_point *dwrq, char *extra)
 735 {
 736         islpci_private *priv = netdev_priv(ndev);
 737         struct obj_ssid essid;
 738
 739         memset(essid.octets, 0, 33);
 740
 741         /* Check if we were asked for `any' */
 742         if (dwrq->flags && dwrq->length) {
 743                 if (dwrq->length > 32)
 744                         return -E2BIG;
 745                 essid.length = dwrq->length;
 746                 memcpy(essid.octets, extra, dwrq->length);
 747         } else
 748                 essid.length = 0;
 749
 750         if (priv->iw_mode != IW_MODE_MONITOR)
 751                 return mgt_set_request(priv, DOT11_OID_SSID, 0, &essid);
 752
 753         /* If in monitor mode, just save to mib */
 754         mgt_set(priv, DOT11_OID_SSID, &essid);
 755         return 0;
 756
 757 }
 758
 759 static int
 760 prism54_get_essid(struct net_device *ndev, struct iw_request_info *info,
 761                   struct iw_point *dwrq, char *extra)
 762 {
 763         islpci_private *priv = netdev_priv(ndev);
 764         struct obj_ssid *essid;
 765         union oid_res_t r;
 766         int rvalue;
 767
 768         rvalue = mgt_get_request(priv, DOT11_OID_SSID, 0, NULL, &r);
 769         essid = r.ptr;
 770
 771         if (essid->length) {
 772                 dwrq->flags = 1;        /* set ESSID to ON for Wireless Extensions */
 773                 /* if it is too big, trunk it */
 774                 dwrq->length = min((u8)IW_ESSID_MAX_SIZE, essid->length);
 775         } else {
 776                 dwrq->flags = 0;
 777                 dwrq->length = 0;
 778         }
 779         essid->octets[dwrq->length] = '\0';
 780         memcpy(extra, essid->octets, dwrq->length);
 781         kfree(essid);
 782
 783         return rvalue;
 784 }
 785
 786 /* Provides no functionality, just completes the ioctl. In essence this is a
 787  * just a cosmetic ioctl.
 788  */
 789 static int
 790 prism54_set_nick(struct net_device *ndev, struct iw_request_info *info,
 791                  struct iw_point *dwrq, char *extra)
 792 {
 793         islpci_private *priv = netdev_priv(ndev);
 794
 795         if (dwrq->length > IW_ESSID_MAX_SIZE)
 796                 return -E2BIG;
 797
 798         down_write(&priv->mib_sem);
 799         memset(priv->nickname, 0, sizeof (priv->nickname));
 800         memcpy(priv->nickname, extra, dwrq->length);
 801         up_write(&priv->mib_sem);
 802
 803         return 0;
 804 }
 805
 806 static int
 807 prism54_get_nick(struct net_device *ndev, struct iw_request_info *info,
 808                  struct iw_point *dwrq, char *extra)
 809 {
 810         islpci_private *priv = netdev_priv(ndev);
 811
 812         dwrq->length = 0;
 813
 814         down_read(&priv->mib_sem);
 815         dwrq->length = strlen(priv->nickname);
 816         memcpy(extra, priv->nickname, dwrq->length);
 817         up_read(&priv->mib_sem);
 818
 819         return 0;
 820 }
 821
 822 /* Set the allowed Bitrates */
 823
 824 static int
 825 prism54_set_rate(struct net_device *ndev,
 826                  struct iw_request_info *info,
 827                  struct iw_param *vwrq, char *extra)
 828 {
 829
 830         islpci_private *priv = netdev_priv(ndev);
 831         u32 rate, profile;
 832         char *data;
 833         int ret, i;
 834         union oid_res_t r;
 835
 836         if (vwrq->value == -1) {
 837                 /* auto mode. No limit. */
 838                 profile = 1;
 839                 return mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile);
 840         }
 841
 842         ret = mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r);
 843         if (ret) {
 844                 kfree(r.ptr);
 845                 return ret;
 846         }
 847
 848         rate = (u32) (vwrq->value / 500000);
 849         data = r.ptr;
 850         i = 0;
 851
 852         while (data[i]) {
 853                 if (rate && (data[i] == rate)) {
 854                         break;
 855                 }
 856                 if (vwrq->value == i) {
 857                         break;
 858                 }
 859                 data[i] |= 0x80;
 860                 i++;
 861         }
 862
 863         if (!data[i]) {
 864                 kfree(r.ptr);
 865                 return -EINVAL;
 866         }
 867
 868         data[i] |= 0x80;
 869         data[i + 1] = 0;
 870
 871         /* Now, check if we want a fixed or auto value */
 872         if (vwrq->fixed) {
 873                 data[0] = data[i];
 874                 data[1] = 0;
 875         }
 876
 877 /*
 878         i = 0;
 879         printk("prism54 rate: ");
 880         while(data[i]) {
 881                 printk("%u ", data[i]);
 882                 i++;
 883         }
 884         printk("0\n");
 885 */
 886         profile = -1;
 887         ret = mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile);
 888         ret |= mgt_set_request(priv, DOT11_OID_EXTENDEDRATES, 0, data);
 889         ret |= mgt_set_request(priv, DOT11_OID_RATES, 0, data);
 890
 891         kfree(r.ptr);
 892
 893         return ret;
 894 }
 895
 896 /* Get the current bit rate */
 897 static int
 898 prism54_get_rate(struct net_device *ndev,
 899                  struct iw_request_info *info,
 900                  struct iw_param *vwrq, char *extra)
 901 {
 902         islpci_private *priv = netdev_priv(ndev);
 903         int rvalue;
 904         char *data;
 905         union oid_res_t r;
 906
 907         /* Get the current bit rate */
 908         if ((rvalue = mgt_get_request(priv, GEN_OID_LINKSTATE, 0, NULL, &r)))
 909                 return rvalue;
 910         vwrq->value = r.u * 500000;
 911
 912         /* request the device for the enabled rates */
 913         rvalue = mgt_get_request(priv, DOT11_OID_RATES, 0, NULL, &r);
 914         if (rvalue) {
 915                 kfree(r.ptr);
 916                 return rvalue;
 917         }
 918         data = r.ptr;
 919         vwrq->fixed = (data[0] != 0) && (data[1] == 0);
 920         kfree(r.ptr);
 921
 922         return 0;
 923 }
 924
 925 static int
 926 prism54_set_rts(struct net_device *ndev, struct iw_request_info *info,
 927                 struct iw_param *vwrq, char *extra)
 928 {
 929         islpci_private *priv = netdev_priv(ndev);
 930
 931         return mgt_set_request(priv, DOT11_OID_RTSTHRESH, 0, &vwrq->value);
 932 }
 933
 934 static int
 935 prism54_get_rts(struct net_device *ndev, struct iw_request_info *info,
 936                 struct iw_param *vwrq, char *extra)
 937 {
 938         islpci_private *priv = netdev_priv(ndev);
 939         union oid_res_t r;
 940         int rvalue;
 941
 942         /* get the rts threshold */
 943         rvalue = mgt_get_request(priv, DOT11_OID_RTSTHRESH, 0, NULL, &r);
 944         vwrq->value = r.u;
 945
 946         return rvalue;
 947 }
 948
 949 static int
 950 prism54_set_frag(struct net_device *ndev, struct iw_request_info *info,
 951                  struct iw_param *vwrq, char *extra)
 952 {
 953         islpci_private *priv = netdev_priv(ndev);
 954
 955         return mgt_set_request(priv, DOT11_OID_FRAGTHRESH, 0, &vwrq->value);
 956 }
 957
 958 static int
 959 prism54_get_frag(struct net_device *ndev, struct iw_request_info *info,
 960                  struct iw_param *vwrq, char *extra)
 961 {
 962         islpci_private *priv = netdev_priv(ndev);
 963         union oid_res_t r;
 964         int rvalue;
 965
 966         rvalue = mgt_get_request(priv, DOT11_OID_FRAGTHRESH, 0, NULL, &r);
 967         vwrq->value = r.u;
 968
 969         return rvalue;
 970 }
 971
 972 /* Here we have (min,max) = max retries for (small frames, big frames). Where
 973  * big frame <=>  bigger than the rts threshold
 974  * small frame <=>  smaller than the rts threshold
 975  * This is not really the behavior expected by the wireless tool but it seems
 976  * to be a common behavior in other drivers.
 977  */
 978
 979 static int
 980 prism54_set_retry(struct net_device *ndev, struct iw_request_info *info,
 981                   struct iw_param *vwrq, char *extra)
 982 {
 983         islpci_private *priv = netdev_priv(ndev);
 984         u32 slimit = 0, llimit = 0;     /* short and long limit */
 985         u32 lifetime = 0;
 986         int rvalue = 0;
 987
 988         if (vwrq->disabled)
 989                 /* we cannot disable this feature */
 990                 return -EINVAL;
 991
 992         if (vwrq->flags & IW_RETRY_LIMIT) {
 993                 if (vwrq->flags & IW_RETRY_SHORT)
 994                         slimit = vwrq->value;
 995                 else if (vwrq->flags & IW_RETRY_LONG)
 996                         llimit = vwrq->value;
 997                 else {
 998                         /* we are asked to set both */
 999                         slimit = vwrq->value;
1000                         llimit = vwrq->value;
1001                 }
1002         }
1003         if (vwrq->flags & IW_RETRY_LIFETIME)
1004                 /* Wireless tools use us unit while the device uses 1024 us unit */
1005                 lifetime = vwrq->value / 1024;
1006
1007         /* now set what is requested */
1008         if (slimit)
1009                 rvalue =
1010                     mgt_set_request(priv, DOT11_OID_SHORTRETRIES, 0, &slimit);
1011         if (llimit)
1012                 rvalue |=
1013                     mgt_set_request(priv, DOT11_OID_LONGRETRIES, 0, &llimit);
1014         if (lifetime)
1015                 rvalue |=
1016                     mgt_set_request(priv, DOT11_OID_MAXTXLIFETIME, 0,
1017                                     &lifetime);
1018         return rvalue;
1019 }
1020
1021 static int
1022 prism54_get_retry(struct net_device *ndev, struct iw_request_info *info,
1023                   struct iw_param *vwrq, char *extra)
1024 {
1025         islpci_private *priv = netdev_priv(ndev);
1026         union oid_res_t r;
1027         int rvalue = 0;
1028         vwrq->disabled = 0;     /* It cannot be disabled */
1029
1030         if ((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
1031                 /* we are asked for the life time */
1032                 rvalue =
1033                     mgt_get_request(priv, DOT11_OID_MAXTXLIFETIME, 0, NULL, &r);
1034                 vwrq->value = r.u * 1024;
1035                 vwrq->flags = IW_RETRY_LIFETIME;
1036         } else if ((vwrq->flags & IW_RETRY_LONG)) {
1037                 /* we are asked for the long retry limit */
1038                 rvalue |=
1039                     mgt_get_request(priv, DOT11_OID_LONGRETRIES, 0, NULL, &r);
1040                 vwrq->value = r.u;
1041                 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
1042         } else {
1043                 /* default. get the  short retry limit */
1044                 rvalue |=
1045                     mgt_get_request(priv, DOT11_OID_SHORTRETRIES, 0, NULL, &r);
1046                 vwrq->value = r.u;
1047                 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
1048         }
1049
1050         return rvalue;
1051 }
1052
1053 static int
1054 prism54_set_encode(struct net_device *ndev, struct iw_request_info *info,
1055                    struct iw_point *dwrq, char *extra)
1056 {
1057         islpci_private *priv = netdev_priv(ndev);
1058         int rvalue = 0, force = 0;
1059         int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
1060         union oid_res_t r;
1061
1062         /* with the new API, it's impossible to get a NULL pointer.
1063          * New version of iwconfig set the IW_ENCODE_NOKEY flag
1064          * when no key is given, but older versions don't. */
1065
1066         if (dwrq->length > 0) {
1067                 /* we have a key to set */
1068                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1069                 int current_index;
1070                 struct obj_key key = { DOT11_PRIV_WEP, 0, "" };
1071
1072                 /* get the current key index */
1073                 rvalue = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1074                 current_index = r.u;
1075                 /* Verify that the key is not marked as invalid */
1076                 if (!(dwrq->flags & IW_ENCODE_NOKEY)) {
1077                         if (dwrq->length > KEY_SIZE_TKIP) {
1078                                 /* User-provided key data too big */
1079                                 return -EINVAL;
1080                         }
1081                         if (dwrq->length > KEY_SIZE_WEP104) {
1082                                 /* WPA-PSK TKIP */
1083                                 key.type = DOT11_PRIV_TKIP;
1084                                 key.length = KEY_SIZE_TKIP;
1085                         } else if (dwrq->length > KEY_SIZE_WEP40) {
1086                                 /* WEP 104/128 */
1087                                 key.length = KEY_SIZE_WEP104;
1088                         } else {
1089                                 /* WEP 40/64 */
1090                                 key.length = KEY_SIZE_WEP40;
1091                         }
1092                         memset(key.key, 0, sizeof (key.key));
1093                         memcpy(key.key, extra, dwrq->length);
1094
1095                         if ((index < 0) || (index > 3))
1096                                 /* no index provided use the current one */
1097                                 index = current_index;
1098
1099                         /* now send the key to the card  */
1100                         rvalue |=
1101                             mgt_set_request(priv, DOT11_OID_DEFKEYX, index,
1102                                             &key);
1103                 }
1104                 /*
1105                  * If a valid key is set, encryption should be enabled
1106                  * (user may turn it off later).
1107                  * This is also how "iwconfig ethX key on" works
1108                  */
1109                 if ((index == current_index) && (key.length > 0))
1110                         force = 1;
1111         } else {
1112                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1113                 if ((index >= 0) && (index <= 3)) {
1114                         /* we want to set the key index */
1115                         rvalue |=
1116                             mgt_set_request(priv, DOT11_OID_DEFKEYID, 0,
1117                                             &index);
1118                 } else {
1119                         if (!(dwrq->flags & IW_ENCODE_MODE)) {
1120                                 /* we cannot do anything. Complain. */
1121                                 return -EINVAL;
1122                         }
1123                 }
1124         }
1125         /* now read the flags */
1126         if (dwrq->flags & IW_ENCODE_DISABLED) {
1127                 /* Encoding disabled,
1128                  * authen = DOT11_AUTH_OS;
1129                  * invoke = 0;
1130                  * exunencrypt = 0; */
1131         }
1132         if (dwrq->flags & IW_ENCODE_OPEN)
1133                 /* Encode but accept non-encoded packets. No auth */
1134                 invoke = 1;
1135         if ((dwrq->flags & IW_ENCODE_RESTRICTED) || force) {
1136                 /* Refuse non-encoded packets. Auth */
1137                 authen = DOT11_AUTH_BOTH;
1138                 invoke = 1;
1139                 exunencrypt = 1;
1140         }
1141         /* do the change if requested  */
1142         if ((dwrq->flags & IW_ENCODE_MODE) || force) {
1143                 rvalue |=
1144                     mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
1145                 rvalue |=
1146                     mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &invoke);
1147                 rvalue |=
1148                     mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
1149                                     &exunencrypt);
1150         }
1151         return rvalue;
1152 }
1153
1154 static int
1155 prism54_get_encode(struct net_device *ndev, struct iw_request_info *info,
1156                    struct iw_point *dwrq, char *extra)
1157 {
1158         islpci_private *priv = netdev_priv(ndev);
1159         struct obj_key *key;
1160         u32 devindex, index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1161         u32 authen = 0, invoke = 0, exunencrypt = 0;
1162         int rvalue;
1163         union oid_res_t r;
1164
1165         /* first get the flags */
1166         rvalue = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1167         authen = r.u;
1168         rvalue |= mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1169         invoke = r.u;
1170         rvalue |= mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1171         exunencrypt = r.u;
1172
1173         if (invoke && (authen == DOT11_AUTH_BOTH) && exunencrypt)
1174                 dwrq->flags = IW_ENCODE_RESTRICTED;
1175         else if ((authen == DOT11_AUTH_OS) && !exunencrypt) {
1176                 if (invoke)
1177                         dwrq->flags = IW_ENCODE_OPEN;
1178                 else
1179                         dwrq->flags = IW_ENCODE_DISABLED;
1180         } else
1181                 /* The card should not work in this state */
1182                 dwrq->flags = 0;
1183
1184         /* get the current device key index */
1185         rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1186         devindex = r.u;
1187         /* Now get the key, return it */
1188         if (index == -1 || index > 3)
1189                 /* no index provided, use the current one */
1190                 index = devindex;
1191         rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYX, index, NULL, &r);
1192         key = r.ptr;
1193         dwrq->length = key->length;
1194         memcpy(extra, key->key, dwrq->length);
1195         kfree(key);
1196         /* return the used key index */
1197         dwrq->flags |= devindex + 1;
1198
1199         return rvalue;
1200 }
1201
1202 static int
1203 prism54_get_txpower(struct net_device *ndev, struct iw_request_info *info,
1204                     struct iw_param *vwrq, char *extra)
1205 {
1206         islpci_private *priv = netdev_priv(ndev);
1207         union oid_res_t r;
1208         int rvalue;
1209
1210         rvalue = mgt_get_request(priv, OID_INL_OUTPUTPOWER, 0, NULL, &r);
1211         /* intersil firmware operates in 0.25 dBm (1/4 dBm) */
1212         vwrq->value = (s32) r.u / 4;
1213         vwrq->fixed = 1;
1214         /* radio is not turned of
1215          * btw: how is possible to turn off only the radio
1216          */
1217         vwrq->disabled = 0;
1218
1219         return rvalue;
1220 }
1221
1222 static int
1223 prism54_set_txpower(struct net_device *ndev, struct iw_request_info *info,
1224                     struct iw_param *vwrq, char *extra)
1225 {
1226         islpci_private *priv = netdev_priv(ndev);
1227         s32 u = vwrq->value;
1228
1229         /* intersil firmware operates in 0.25 dBm (1/4) */
1230         u *= 4;
1231         if (vwrq->disabled) {
1232                 /* don't know how to disable radio */
1233                 printk(KERN_DEBUG
1234                        "%s: %s() disabling radio is not yet supported.\n",
1235                        priv->ndev->name, __func__);
1236                 return -ENOTSUPP;
1237         } else if (vwrq->fixed)
1238                 /* currently only fixed value is supported */
1239                 return mgt_set_request(priv, OID_INL_OUTPUTPOWER, 0, &u);
1240         else {
1241                 printk(KERN_DEBUG
1242                        "%s: %s() auto power will be implemented later.\n",
1243                        priv->ndev->name, __func__);
1244                 return -ENOTSUPP;
1245         }
1246 }
1247
1248 static int prism54_set_genie(struct net_device *ndev,
1249                              struct iw_request_info *info,
1250                              struct iw_point *data, char *extra)
1251 {
1252         islpci_private *priv = netdev_priv(ndev);
1253         int alen, ret = 0;
1254         struct obj_attachment *attach;
1255
1256         if (data->length > MAX_WPA_IE_LEN ||
1257             (data->length && extra == NULL))
1258                 return -EINVAL;
1259
1260         memcpy(priv->wpa_ie, extra, data->length);
1261         priv->wpa_ie_len = data->length;
1262
1263         alen = sizeof(*attach) + priv->wpa_ie_len;
1264         attach = kzalloc(alen, GFP_KERNEL);
1265         if (attach == NULL)
1266                 return -ENOMEM;
1267
1268 #define WLAN_FC_TYPE_MGMT 0
1269 #define WLAN_FC_STYPE_ASSOC_REQ 0
1270 #define WLAN_FC_STYPE_REASSOC_REQ 2
1271
1272         /* Note: endianness is covered by mgt_set_varlen */
1273         attach->type = (WLAN_FC_TYPE_MGMT << 2) |
1274                (WLAN_FC_STYPE_ASSOC_REQ << 4);
1275         attach->id = -1;
1276         attach->size = priv->wpa_ie_len;
1277         memcpy(attach->data, extra, priv->wpa_ie_len);
1278
1279         ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach,
1280                 priv->wpa_ie_len);
1281         if (ret == 0) {
1282                 attach->type = (WLAN_FC_TYPE_MGMT << 2) |
1283                         (WLAN_FC_STYPE_REASSOC_REQ << 4);
1284
1285                 ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach,
1286                         priv->wpa_ie_len);
1287                 if (ret == 0)
1288                         printk(KERN_DEBUG "%s: WPA IE Attachment was set\n",
1289                                 ndev->name);
1290         }
1291
1292         kfree(attach);
1293         return ret;
1294 }
1295
1296
1297 static int prism54_get_genie(struct net_device *ndev,
1298                              struct iw_request_info *info,
1299                              struct iw_point *data, char *extra)
1300 {
1301         islpci_private *priv = netdev_priv(ndev);
1302         int len = priv->wpa_ie_len;
1303
1304         if (len <= 0) {
1305                 data->length = 0;
1306                 return 0;
1307         }
1308
1309         if (data->length < len)
1310                 return -E2BIG;
1311
1312         data->length = len;
1313         memcpy(extra, priv->wpa_ie, len);
1314
1315         return 0;
1316 }
1317
1318 static int prism54_set_auth(struct net_device *ndev,
1319                                struct iw_request_info *info,
1320                                union iwreq_data *wrqu, char *extra)
1321 {
1322         islpci_private *priv = netdev_priv(ndev);
1323         struct iw_param *param = &wrqu->param;
1324         u32 mlmelevel = 0, authen = 0, dot1x = 0;
1325         u32 exunencrypt = 0, privinvoked = 0, wpa = 0;
1326         u32 old_wpa;
1327         int ret = 0;
1328         union oid_res_t r;
1329
1330         if (islpci_get_state(priv) < PRV_STATE_INIT)
1331                 return 0;
1332
1333         /* first get the flags */
1334         down_write(&priv->mib_sem);
1335         wpa = old_wpa = priv->wpa;
1336         up_write(&priv->mib_sem);
1337         ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1338         authen = r.u;
1339         ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1340         privinvoked = r.u;
1341         ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1342         exunencrypt = r.u;
1343         ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r);
1344         dot1x = r.u;
1345         ret = mgt_get_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, NULL, &r);
1346         mlmelevel = r.u;
1347
1348         if (ret < 0)
1349                 goto out;
1350
1351         switch (param->flags & IW_AUTH_INDEX) {
1352         case IW_AUTH_CIPHER_PAIRWISE:
1353         case IW_AUTH_CIPHER_GROUP:
1354         case IW_AUTH_KEY_MGMT:
1355                 break;
1356
1357         case IW_AUTH_WPA_ENABLED:
1358                 /* Do the same thing as IW_AUTH_WPA_VERSION */
1359                 if (param->value) {
1360                         wpa = 1;
1361                         privinvoked = 1; /* For privacy invoked */
1362                         exunencrypt = 1; /* Filter out all unencrypted frames */
1363                         dot1x = 0x01; /* To enable eap filter */
1364                         mlmelevel = DOT11_MLME_EXTENDED;
1365                         authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
1366                 } else {
1367                         wpa = 0;
1368                         privinvoked = 0;
1369                         exunencrypt = 0; /* Do not filter un-encrypted data */
1370                         dot1x = 0;
1371                         mlmelevel = DOT11_MLME_AUTO;
1372                 }
1373                 break;
1374
1375         case IW_AUTH_WPA_VERSION:
1376                 if (param->value & IW_AUTH_WPA_VERSION_DISABLED) {
1377                         wpa = 0;
1378                         privinvoked = 0;
1379                         exunencrypt = 0; /* Do not filter un-encrypted data */
1380                         dot1x = 0;
1381                         mlmelevel = DOT11_MLME_AUTO;
1382                 } else {
1383                         if (param->value & IW_AUTH_WPA_VERSION_WPA)
1384                                 wpa = 1;
1385                         else if (param->value & IW_AUTH_WPA_VERSION_WPA2)
1386                                 wpa = 2;
1387                         privinvoked = 1; /* For privacy invoked */
1388                         exunencrypt = 1; /* Filter out all unencrypted frames */
1389                         dot1x = 0x01; /* To enable eap filter */
1390                         mlmelevel = DOT11_MLME_EXTENDED;
1391                         authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
1392                 }
1393                 break;
1394
1395         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1396                 /* dot1x should be the opposite of RX_UNENCRYPTED_EAPOL;
1397                  * turn off dot1x when allowing receipt of unencrypted EAPOL
1398                  * frames, turn on dot1x when receipt should be disallowed
1399                  */
1400                 dot1x = param->value ? 0 : 0x01;
1401                 break;
1402
1403         case IW_AUTH_PRIVACY_INVOKED:
1404                 privinvoked = param->value ? 1 : 0;
1405                 break;
1406
1407         case IW_AUTH_DROP_UNENCRYPTED:
1408                 exunencrypt = param->value ? 1 : 0;
1409                 break;
1410
1411         case IW_AUTH_80211_AUTH_ALG:
1412                 if (param->value & IW_AUTH_ALG_SHARED_KEY) {
1413                         /* Only WEP uses _SK and _BOTH */
1414                         if (wpa > 0) {
1415                                 ret = -EINVAL;
1416                                 goto out;
1417                         }
1418                         authen = DOT11_AUTH_SK;
1419                 } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
1420                         authen = DOT11_AUTH_OS;
1421                 } else {
1422                         ret = -EINVAL;
1423                         goto out;
1424                 }
1425                 break;
1426
1427         default:
1428                 return -EOPNOTSUPP;
1429         }
1430
1431         /* Set all the values */
1432         down_write(&priv->mib_sem);
1433         priv->wpa = wpa;
1434         up_write(&priv->mib_sem);
1435         mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
1436         mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &privinvoked);
1437         mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &exunencrypt);
1438         mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x);
1439         mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlmelevel);
1440
1441 out:
1442         return ret;
1443 }
1444
1445 static int prism54_get_auth(struct net_device *ndev,
1446                             struct iw_request_info *info,
1447                             union iwreq_data *wrqu, char *extra)
1448 {
1449         islpci_private *priv = netdev_priv(ndev);
1450         struct iw_param *param = &wrqu->param;
1451         u32 wpa = 0;
1452         int ret = 0;
1453         union oid_res_t r;
1454
1455         if (islpci_get_state(priv) < PRV_STATE_INIT)
1456                 return 0;
1457
1458         /* first get the flags */
1459         down_write(&priv->mib_sem);
1460         wpa = priv->wpa;
1461         up_write(&priv->mib_sem);
1462
1463         switch (param->flags & IW_AUTH_INDEX) {
1464         case IW_AUTH_CIPHER_PAIRWISE:
1465         case IW_AUTH_CIPHER_GROUP:
1466         case IW_AUTH_KEY_MGMT:
1467                 /*
1468                  * wpa_supplicant will control these internally
1469                  */
1470                 ret = -EOPNOTSUPP;
1471                 break;
1472
1473         case IW_AUTH_WPA_VERSION:
1474                 switch (wpa) {
1475                 case 1:
1476                         param->value = IW_AUTH_WPA_VERSION_WPA;
1477                         break;
1478                 case 2:
1479                         param->value = IW_AUTH_WPA_VERSION_WPA2;
1480                         break;
1481                 case 0:
1482                 default:
1483                         param->value = IW_AUTH_WPA_VERSION_DISABLED;
1484                         break;
1485                 }
1486                 break;
1487
1488         case IW_AUTH_DROP_UNENCRYPTED:
1489                 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1490                 if (ret >= 0)
1491                         param->value = r.u > 0 ? 1 : 0;
1492                 break;
1493
1494         case IW_AUTH_80211_AUTH_ALG:
1495                 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1496                 if (ret >= 0) {
1497                         switch (r.u) {
1498                         case DOT11_AUTH_OS:
1499                                 param->value = IW_AUTH_ALG_OPEN_SYSTEM;
1500                                 break;
1501                         case DOT11_AUTH_BOTH:
1502                         case DOT11_AUTH_SK:
1503                                 param->value = IW_AUTH_ALG_SHARED_KEY;
1504                                 break;
1505                         case DOT11_AUTH_NONE:
1506                         default:
1507                                 param->value = 0;
1508                                 break;
1509                         }
1510                 }
1511                 break;
1512
1513         case IW_AUTH_WPA_ENABLED:
1514                 param->value = wpa > 0 ? 1 : 0;
1515                 break;
1516
1517         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1518                 ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r);
1519                 if (ret >= 0)
1520                         param->value = r.u > 0 ? 1 : 0;
1521                 break;
1522
1523         case IW_AUTH_PRIVACY_INVOKED:
1524                 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1525                 if (ret >= 0)
1526                         param->value = r.u > 0 ? 1 : 0;
1527                 break;
1528
1529         default:
1530                 return -EOPNOTSUPP;
1531         }
1532         return ret;
1533 }
1534
1535 static int prism54_set_encodeext(struct net_device *ndev,
1536                                  struct iw_request_info *info,
1537                                  union iwreq_data *wrqu,
1538                                  char *extra)
1539 {
1540         islpci_private *priv = netdev_priv(ndev);
1541         struct iw_point *encoding = &wrqu->encoding;
1542         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1543         int idx, alg = ext->alg, set_key = 1;
1544         union oid_res_t r;
1545         int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
1546         int ret = 0;
1547
1548         if (islpci_get_state(priv) < PRV_STATE_INIT)
1549                 return 0;
1550
1551         /* Determine and validate the key index */
1552         idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1553         if (idx) {
1554                 if (idx < 0 || idx > 3)
1555                         return -EINVAL;
1556         } else {
1557                 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1558                 if (ret < 0)
1559                         goto out;
1560                 idx = r.u;
1561         }
1562
1563         if (encoding->flags & IW_ENCODE_DISABLED)
1564                 alg = IW_ENCODE_ALG_NONE;
1565
1566         if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
1567                 /* Only set transmit key index here, actual
1568                  * key is set below if needed.
1569                  */
1570                 ret = mgt_set_request(priv, DOT11_OID_DEFKEYID, 0, &idx);
1571                 set_key = ext->key_len > 0 ? 1 : 0;
1572         }
1573
1574         if (set_key) {
1575                 struct obj_key key = { DOT11_PRIV_WEP, 0, "" };
1576                 switch (alg) {
1577                 case IW_ENCODE_ALG_NONE:
1578                         break;
1579                 case IW_ENCODE_ALG_WEP:
1580                         if (ext->key_len > KEY_SIZE_WEP104) {
1581                                 ret = -EINVAL;
1582                                 goto out;
1583                         }
1584                         if (ext->key_len > KEY_SIZE_WEP40)
1585                                 key.length = KEY_SIZE_WEP104;
1586                         else
1587                                 key.length = KEY_SIZE_WEP40;
1588                         break;
1589                 case IW_ENCODE_ALG_TKIP:
1590                         if (ext->key_len > KEY_SIZE_TKIP) {
1591                                 ret = -EINVAL;
1592                                 goto out;
1593                         }
1594                         key.type = DOT11_PRIV_TKIP;
1595                         key.length = KEY_SIZE_TKIP;
1596                         break;
1597                 default:
1598                         return -EINVAL;
1599                 }
1600
1601                 if (key.length) {
1602                         memset(key.key, 0, sizeof(key.key));
1603                         memcpy(key.key, ext->key, ext->key_len);
1604                         ret = mgt_set_request(priv, DOT11_OID_DEFKEYX, idx,
1605                                             &key);
1606                         if (ret < 0)
1607                                 goto out;
1608                 }
1609         }
1610
1611         /* Read the flags */
1612         if (encoding->flags & IW_ENCODE_DISABLED) {
1613                 /* Encoding disabled,
1614                  * authen = DOT11_AUTH_OS;
1615                  * invoke = 0;
1616                  * exunencrypt = 0; */
1617         }
1618         if (encoding->flags & IW_ENCODE_OPEN) {
1619                 /* Encode but accept non-encoded packets. No auth */
1620                 invoke = 1;
1621         }
1622         if (encoding->flags & IW_ENCODE_RESTRICTED) {
1623                 /* Refuse non-encoded packets. Auth */
1624                 authen = DOT11_AUTH_BOTH;
1625                 invoke = 1;
1626                 exunencrypt = 1;
1627         }
1628
1629         /* do the change if requested  */
1630         if (encoding->flags & IW_ENCODE_MODE) {
1631                 ret = mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0,
1632                                       &authen);
1633                 ret = mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0,
1634                                       &invoke);
1635                 ret = mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
1636                                       &exunencrypt);
1637         }
1638
1639 out:
1640         return ret;
1641 }
1642
1643
1644 static int prism54_get_encodeext(struct net_device *ndev,
1645                                  struct iw_request_info *info,
1646                                  union iwreq_data *wrqu,
1647                                  char *extra)
1648 {
1649         islpci_private *priv = netdev_priv(ndev);
1650         struct iw_point *encoding = &wrqu->encoding;
1651         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1652         int idx, max_key_len;
1653         union oid_res_t r;
1654         int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0, wpa = 0;
1655         int ret = 0;
1656
1657         if (islpci_get_state(priv) < PRV_STATE_INIT)
1658                 return 0;
1659
1660         /* first get the flags */
1661         ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1662         authen = r.u;
1663         ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1664         invoke = r.u;
1665         ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1666         exunencrypt = r.u;
1667         if (ret < 0)
1668                 goto out;
1669
1670         max_key_len = encoding->length - sizeof(*ext);
1671         if (max_key_len < 0)
1672                 return -EINVAL;
1673
1674         idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1675         if (idx) {
1676                 if (idx < 0 || idx > 3)
1677                         return -EINVAL;
1678         } else {
1679                 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1680                 if (ret < 0)
1681                         goto out;
1682                 idx = r.u;
1683         }
1684
1685         encoding->flags = idx + 1;
1686         memset(ext, 0, sizeof(*ext));
1687
1688         switch (authen) {
1689         case DOT11_AUTH_BOTH:
1690         case DOT11_AUTH_SK:
1691                 wrqu->encoding.flags |= IW_ENCODE_RESTRICTED;
1692                 fallthrough;
1693         case DOT11_AUTH_OS:
1694         default:
1695                 wrqu->encoding.flags |= IW_ENCODE_OPEN;
1696                 break;
1697         }
1698
1699         down_write(&priv->mib_sem);
1700         wpa = priv->wpa;
1701         up_write(&priv->mib_sem);
1702
1703         if (authen == DOT11_AUTH_OS && !exunencrypt && !invoke && !wpa) {
1704                 /* No encryption */
1705                 ext->alg = IW_ENCODE_ALG_NONE;
1706                 ext->key_len = 0;
1707                 wrqu->encoding.flags |= IW_ENCODE_DISABLED;
1708         } else {
1709                 struct obj_key *key;
1710
1711                 ret = mgt_get_request(priv, DOT11_OID_DEFKEYX, idx, NULL, &r);
1712                 if (ret < 0)
1713                         goto out;
1714                 key = r.ptr;
1715                 if (max_key_len < key->length) {
1716                         ret = -E2BIG;
1717                         goto out;
1718                 }
1719                 memcpy(ext->key, key->key, key->length);
1720                 ext->key_len = key->length;
1721
1722                 switch (key->type) {
1723                 case DOT11_PRIV_TKIP:
1724                         ext->alg = IW_ENCODE_ALG_TKIP;
1725                         break;
1726                 default:
1727                 case DOT11_PRIV_WEP:
1728                         ext->alg = IW_ENCODE_ALG_WEP;
1729                         break;
1730                 }
1731                 wrqu->encoding.flags |= IW_ENCODE_ENABLED;
1732         }
1733
1734 out:
1735         return ret;
1736 }
1737
1738
1739 static int
1740 prism54_reset(struct net_device *ndev, struct iw_request_info *info,
1741               __u32 * uwrq, char *extra)
1742 {
1743         islpci_reset(netdev_priv(ndev), 0);
1744
1745         return 0;
1746 }
1747
1748 static int
1749 prism54_get_oid(struct net_device *ndev, struct iw_request_info *info,
1750                 struct iw_point *dwrq, char *extra)
1751 {
1752         union oid_res_t r;
1753         int rvalue;
1754         enum oid_num_t n = dwrq->flags;
1755
1756         rvalue = mgt_get_request(netdev_priv(ndev), n, 0, NULL, &r);
1757         dwrq->length = mgt_response_to_str(n, &r, extra);
1758         if ((isl_oid[n].flags & OID_FLAG_TYPE) != OID_TYPE_U32)
1759                 kfree(r.ptr);
1760         return rvalue;
1761 }
1762
1763 static int
1764 prism54_set_u32(struct net_device *ndev, struct iw_request_info *info,
1765                 __u32 * uwrq, char *extra)
1766 {
1767         u32 oid = uwrq[0], u = uwrq[1];
1768
1769         return mgt_set_request(netdev_priv(ndev), oid, 0, &u);
1770 }
1771
1772 static int
1773 prism54_set_raw(struct net_device *ndev, struct iw_request_info *info,
1774                 struct iw_point *dwrq, char *extra)
1775 {
1776         u32 oid = dwrq->flags;
1777
1778         return mgt_set_request(netdev_priv(ndev), oid, 0, extra);
1779 }
1780
1781 void
1782 prism54_acl_init(struct islpci_acl *acl)
1783 {
1784         mutex_init(&acl->lock);
1785         INIT_LIST_HEAD(&acl->mac_list);
1786         acl->size = 0;
1787         acl->policy = MAC_POLICY_OPEN;
1788 }
1789
1790 static void
1791 prism54_clear_mac(struct islpci_acl *acl)
1792 {
1793         struct list_head *ptr, *next;
1794         struct mac_entry *entry;
1795
1796         mutex_lock(&acl->lock);
1797
1798         if (acl->size == 0) {
1799                 mutex_unlock(&acl->lock);
1800                 return;
1801         }
1802
1803         for (ptr = acl->mac_list.next, next = ptr->next;
1804              ptr != &acl->mac_list; ptr = next, next = ptr->next) {
1805                 entry = list_entry(ptr, struct mac_entry, _list);
1806                 list_del(ptr);
1807                 kfree(entry);
1808         }
1809         acl->size = 0;
1810         mutex_unlock(&acl->lock);
1811 }
1812
1813 void
1814 prism54_acl_clean(struct islpci_acl *acl)
1815 {
1816         prism54_clear_mac(acl);
1817 }
1818
1819 static int
1820 prism54_add_mac(struct net_device *ndev, struct iw_request_info *info,
1821                 struct sockaddr *awrq, char *extra)
1822 {
1823         islpci_private *priv = netdev_priv(ndev);
1824         struct islpci_acl *acl = &priv->acl;
1825         struct mac_entry *entry;
1826         struct sockaddr *addr = (struct sockaddr *) extra;
1827
1828         if (addr->sa_family != ARPHRD_ETHER)
1829                 return -EOPNOTSUPP;
1830
1831         entry = kmalloc(sizeof (struct mac_entry), GFP_KERNEL);
1832         if (entry == NULL)
1833                 return -ENOMEM;
1834
1835         memcpy(entry->addr, addr->sa_data, ETH_ALEN);
1836
1837         if (mutex_lock_interruptible(&acl->lock)) {
1838                 kfree(entry);
1839                 return -ERESTARTSYS;
1840         }
1841         list_add_tail(&entry->_list, &acl->mac_list);
1842         acl->size++;
1843         mutex_unlock(&acl->lock);
1844
1845         return 0;
1846 }
1847
1848 static int
1849 prism54_del_mac(struct net_device *ndev, struct iw_request_info *info,
1850                 struct sockaddr *awrq, char *extra)
1851 {
1852         islpci_private *priv = netdev_priv(ndev);
1853         struct islpci_acl *acl = &priv->acl;
1854         struct mac_entry *entry;
1855         struct sockaddr *addr = (struct sockaddr *) extra;
1856
1857         if (addr->sa_family != ARPHRD_ETHER)
1858                 return -EOPNOTSUPP;
1859
1860         if (mutex_lock_interruptible(&acl->lock))
1861                 return -ERESTARTSYS;
1862         list_for_each_entry(entry, &acl->mac_list, _list) {
1863                 if (ether_addr_equal(entry->addr, addr->sa_data)) {
1864                         list_del(&entry->_list);
1865                         acl->size--;
1866                         kfree(entry);
1867                         mutex_unlock(&acl->lock);
1868                         return 0;
1869                 }
1870         }
1871         mutex_unlock(&acl->lock);
1872         return -EINVAL;
1873 }
1874
1875 static int
1876 prism54_get_mac(struct net_device *ndev, struct iw_request_info *info,
1877                 struct iw_point *dwrq, char *extra)
1878 {
1879         islpci_private *priv = netdev_priv(ndev);
1880         struct islpci_acl *acl = &priv->acl;
1881         struct mac_entry *entry;
1882         struct sockaddr *dst = (struct sockaddr *) extra;
1883
1884         dwrq->length = 0;
1885
1886         if (mutex_lock_interruptible(&acl->lock))
1887                 return -ERESTARTSYS;
1888
1889         list_for_each_entry(entry, &acl->mac_list, _list) {
1890                 memcpy(dst->sa_data, entry->addr, ETH_ALEN);
1891                 dst->sa_family = ARPHRD_ETHER;
1892                 dwrq->length++;
1893                 dst++;
1894         }
1895         mutex_unlock(&acl->lock);
1896         return 0;
1897 }
1898
1899 /* Setting policy also clears the MAC acl, even if we don't change the default
1900  * policy
1901  */
1902
1903 static int
1904 prism54_set_policy(struct net_device *ndev, struct iw_request_info *info,
1905                    __u32 * uwrq, char *extra)
1906 {
1907         islpci_private *priv = netdev_priv(ndev);
1908         struct islpci_acl *acl = &priv->acl;
1909         u32 mlmeautolevel;
1910
1911         prism54_clear_mac(acl);
1912
1913         if ((*uwrq < MAC_POLICY_OPEN) || (*uwrq > MAC_POLICY_REJECT))
1914                 return -EINVAL;
1915
1916         down_write(&priv->mib_sem);
1917
1918         acl->policy = *uwrq;
1919
1920         /* the ACL code needs an intermediate mlmeautolevel */
1921         if ((priv->iw_mode == IW_MODE_MASTER) &&
1922             (acl->policy != MAC_POLICY_OPEN))
1923                 mlmeautolevel = DOT11_MLME_INTERMEDIATE;
1924         else
1925                 mlmeautolevel = CARD_DEFAULT_MLME_MODE;
1926         if (priv->wpa)
1927                 mlmeautolevel = DOT11_MLME_EXTENDED;
1928         mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
1929         /* restart the card with our new policy */
1930         if (mgt_commit(priv)) {
1931                 up_write(&priv->mib_sem);
1932                 return -EIO;
1933         }
1934         up_write(&priv->mib_sem);
1935
1936         return 0;
1937 }
1938
1939 static int
1940 prism54_get_policy(struct net_device *ndev, struct iw_request_info *info,
1941                    __u32 * uwrq, char *extra)
1942 {
1943         islpci_private *priv = netdev_priv(ndev);
1944         struct islpci_acl *acl = &priv->acl;
1945
1946         *uwrq = acl->policy;
1947
1948         return 0;
1949 }
1950
1951 /* Return 1 only if client should be accepted. */
1952
1953 static int
1954 prism54_mac_accept(struct islpci_acl *acl, char *mac)
1955 {
1956         struct mac_entry *entry;
1957         int res = 0;
1958
1959         if (mutex_lock_interruptible(&acl->lock))
1960                 return -ERESTARTSYS;
1961
1962         if (acl->policy == MAC_POLICY_OPEN) {
1963                 mutex_unlock(&acl->lock);
1964                 return 1;
1965         }
1966
1967         list_for_each_entry(entry, &acl->mac_list, _list) {
1968                 if (memcmp(entry->addr, mac, ETH_ALEN) == 0) {
1969                         res = 1;
1970                         break;
1971                 }
1972         }
1973         res = (acl->policy == MAC_POLICY_ACCEPT) ? !res : res;
1974         mutex_unlock(&acl->lock);
1975
1976         return res;
1977 }
1978
1979 static int
1980 prism54_kick_all(struct net_device *ndev, struct iw_request_info *info,
1981                  struct iw_point *dwrq, char *extra)
1982 {
1983         struct obj_mlme *mlme;
1984         int rvalue;
1985
1986         mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
1987         if (mlme == NULL)
1988                 return -ENOMEM;
1989
1990         /* Tell the card to kick every client */
1991         mlme->id = 0;
1992         rvalue =
1993             mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
1994         kfree(mlme);
1995
1996         return rvalue;
1997 }
1998
1999 static int
2000 prism54_kick_mac(struct net_device *ndev, struct iw_request_info *info,
2001                  struct sockaddr *awrq, char *extra)
2002 {
2003         struct obj_mlme *mlme;
2004         struct sockaddr *addr = (struct sockaddr *) extra;
2005         int rvalue;
2006
2007         if (addr->sa_family != ARPHRD_ETHER)
2008                 return -EOPNOTSUPP;
2009
2010         mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
2011         if (mlme == NULL)
2012                 return -ENOMEM;
2013
2014         /* Tell the card to only kick the corresponding bastard */
2015         memcpy(mlme->address, addr->sa_data, ETH_ALEN);
2016         mlme->id = -1;
2017         rvalue =
2018             mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
2019
2020         kfree(mlme);
2021
2022         return rvalue;
2023 }
2024
2025 /* Translate a TRAP oid into a wireless event. Called in islpci_mgt_receive. */
2026
2027 static void
2028 format_event(islpci_private *priv, char *dest, const char *str,
2029              const struct obj_mlme *mlme, u16 *length, int error)
2030 {
2031         int n = snprintf(dest, IW_CUSTOM_MAX,
2032                          "%s %s %pM %s (%2.2X)",
2033                          str,
2034                          ((priv->iw_mode == IW_MODE_MASTER) ? "from" : "to"),
2035                          mlme->address,
2036                          (error ? (mlme->code ? " : REJECTED " : " : ACCEPTED ")
2037                           : ""), mlme->code);
2038         WARN_ON(n >= IW_CUSTOM_MAX);
2039         *length = n;
2040 }
2041
2042 static void
2043 send_formatted_event(islpci_private *priv, const char *str,
2044                      const struct obj_mlme *mlme, int error)
2045 {
2046         union iwreq_data wrqu;
2047         char *memptr;
2048
2049         memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2050         if (!memptr)
2051                 return;
2052         wrqu.data.pointer = memptr;
2053         wrqu.data.length = 0;
2054         format_event(priv, memptr, str, mlme, &wrqu.data.length,
2055                      error);
2056         wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2057         kfree(memptr);
2058 }
2059
2060 static void
2061 send_simple_event(islpci_private *priv, const char *str)
2062 {
2063         union iwreq_data wrqu;
2064         char *memptr;
2065         int n = strlen(str);
2066
2067         memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2068         if (!memptr)
2069                 return;
2070         BUG_ON(n >= IW_CUSTOM_MAX);
2071         wrqu.data.pointer = memptr;
2072         wrqu.data.length = n;
2073         strcpy(memptr, str);
2074         wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2075         kfree(memptr);
2076 }
2077
2078 static void
2079 link_changed(struct net_device *ndev, u32 bitrate)
2080 {
2081         islpci_private *priv = netdev_priv(ndev);
2082
2083         if (bitrate) {
2084                 netif_carrier_on(ndev);
2085                 if (priv->iw_mode == IW_MODE_INFRA) {
2086                         union iwreq_data uwrq;
2087                         prism54_get_wap(ndev, NULL, (struct sockaddr *) &uwrq,
2088                                         NULL);
2089                         wireless_send_event(ndev, SIOCGIWAP, &uwrq, NULL);
2090                 } else
2091                         send_simple_event(netdev_priv(ndev),
2092                                           "Link established");
2093         } else {
2094                 netif_carrier_off(ndev);
2095                 send_simple_event(netdev_priv(ndev), "Link lost");
2096         }
2097 }
2098
2099 /* Beacon/ProbeResp payload header */
2100 struct ieee80211_beacon_phdr {
2101         u8 timestamp[8];
2102         u16 beacon_int;
2103         u16 capab_info;
2104 } __packed;
2105
2106 #define WLAN_EID_GENERIC 0xdd
2107 static u8 wpa_oid[4] = { 0x00, 0x50, 0xf2, 1 };
2108
2109 static void
2110 prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
2111                        u8 *wpa_ie, size_t wpa_ie_len)
2112 {
2113         struct list_head *ptr;
2114         struct islpci_bss_wpa_ie *bss = NULL;
2115
2116         if (wpa_ie_len > MAX_WPA_IE_LEN)
2117                 wpa_ie_len = MAX_WPA_IE_LEN;
2118
2119         mutex_lock(&priv->wpa_lock);
2120
2121         /* try to use existing entry */
2122         list_for_each(ptr, &priv->bss_wpa_list) {
2123                 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2124                 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0) {
2125                         list_move(&bss->list, &priv->bss_wpa_list);
2126                         break;
2127                 }
2128                 bss = NULL;
2129         }
2130
2131         if (bss == NULL) {
2132                 /* add a new BSS entry; if max number of entries is already
2133                  * reached, replace the least recently updated */
2134                 if (priv->num_bss_wpa >= MAX_BSS_WPA_IE_COUNT) {
2135                         bss = list_entry(priv->bss_wpa_list.prev,
2136                                          struct islpci_bss_wpa_ie, list);
2137                         list_del(&bss->list);
2138                 } else {
2139                         bss = kzalloc(sizeof (*bss), GFP_ATOMIC);
2140                         if (bss != NULL)
2141                                 priv->num_bss_wpa++;
2142                 }
2143                 if (bss != NULL) {
2144                         memcpy(bss->bssid, bssid, ETH_ALEN);
2145                         list_add(&bss->list, &priv->bss_wpa_list);
2146                 }
2147         }
2148
2149         if (bss != NULL) {
2150                 memcpy(bss->wpa_ie, wpa_ie, wpa_ie_len);
2151                 bss->wpa_ie_len = wpa_ie_len;
2152                 bss->last_update = jiffies;
2153         } else {
2154                 printk(KERN_DEBUG "Failed to add BSS WPA entry for "
2155                        "%pM\n", bssid);
2156         }
2157
2158         /* expire old entries from WPA list */
2159         while (priv->num_bss_wpa > 0) {
2160                 bss = list_entry(priv->bss_wpa_list.prev,
2161                                  struct islpci_bss_wpa_ie, list);
2162                 if (!time_after(jiffies, bss->last_update + 60 * HZ))
2163                         break;
2164
2165                 list_del(&bss->list);
2166                 priv->num_bss_wpa--;
2167                 kfree(bss);
2168         }
2169
2170         mutex_unlock(&priv->wpa_lock);
2171 }
2172
2173 static size_t
2174 prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie)
2175 {
2176         struct list_head *ptr;
2177         struct islpci_bss_wpa_ie *bss = NULL;
2178         size_t len = 0;
2179
2180         mutex_lock(&priv->wpa_lock);
2181
2182         list_for_each(ptr, &priv->bss_wpa_list) {
2183                 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2184                 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0)
2185                         break;
2186                 bss = NULL;
2187         }
2188         if (bss) {
2189                 len = bss->wpa_ie_len;
2190                 memcpy(wpa_ie, bss->wpa_ie, len);
2191         }
2192         mutex_unlock(&priv->wpa_lock);
2193
2194         return len;
2195 }
2196
2197 void
2198 prism54_wpa_bss_ie_init(islpci_private *priv)
2199 {
2200         INIT_LIST_HEAD(&priv->bss_wpa_list);
2201         mutex_init(&priv->wpa_lock);
2202 }
2203
2204 void
2205 prism54_wpa_bss_ie_clean(islpci_private *priv)
2206 {
2207         struct islpci_bss_wpa_ie *bss, *n;
2208
2209         list_for_each_entry_safe(bss, n, &priv->bss_wpa_list, list) {
2210                 kfree(bss);
2211         }
2212 }
2213
2214 static void
2215 prism54_process_bss_data(islpci_private *priv, u32 oid, u8 *addr,
2216                          u8 *payload, size_t len)
2217 {
2218         struct ieee80211_beacon_phdr *hdr;
2219         u8 *pos, *end;
2220
2221         if (!priv->wpa)
2222                 return;
2223
2224         hdr = (struct ieee80211_beacon_phdr *) payload;
2225         pos = (u8 *) (hdr + 1);
2226         end = payload + len;
2227         while (pos < end) {
2228                 if (pos + 2 + pos[1] > end) {
2229                         printk(KERN_DEBUG "Parsing Beacon/ProbeResp failed "
2230                                "for %pM\n", addr);
2231                         return;
2232                 }
2233                 if (pos[0] == WLAN_EID_GENERIC && pos[1] >= 4 &&
2234                     memcmp(pos + 2, wpa_oid, 4) == 0) {
2235                         prism54_wpa_bss_ie_add(priv, addr, pos, pos[1] + 2);
2236                         return;
2237                 }
2238                 pos += 2 + pos[1];
2239         }
2240 }
2241
2242 static void
2243 handle_request(islpci_private *priv, struct obj_mlme *mlme, enum oid_num_t oid)
2244 {
2245         if (((mlme->state == DOT11_STATE_AUTHING) ||
2246              (mlme->state == DOT11_STATE_ASSOCING))
2247             && mgt_mlme_answer(priv)) {
2248                 /* Someone is requesting auth and we must respond. Just send back
2249                  * the trap with error code set accordingly.
2250                  */
2251                 mlme->code = prism54_mac_accept(&priv->acl,
2252                                                 mlme->address) ? 0 : 1;
2253                 mgt_set_request(priv, oid, 0, mlme);
2254         }
2255 }
2256
2257 static int
2258 prism54_process_trap_helper(islpci_private *priv, enum oid_num_t oid,
2259                             char *data)
2260 {
2261         struct obj_mlme *mlme = (struct obj_mlme *) data;
2262         struct obj_mlmeex *mlmeex = (struct obj_mlmeex *) data;
2263         struct obj_mlmeex *confirm;
2264         u8 wpa_ie[MAX_WPA_IE_LEN];
2265         int wpa_ie_len;
2266         size_t len = 0; /* u16, better? */
2267         u8 *payload = NULL, *pos = NULL;
2268         int ret;
2269
2270         /* I think all trapable objects are listed here.
2271          * Some oids have a EX version. The difference is that they are emitted
2272          * in DOT11_MLME_EXTENDED mode (set with DOT11_OID_MLMEAUTOLEVEL)
2273          * with more info.
2274          * The few events already defined by the wireless tools are not really
2275          * suited. We use the more flexible custom event facility.
2276          */
2277
2278         if (oid >= DOT11_OID_BEACON) {
2279                 len = mlmeex->size;
2280                 payload = pos = mlmeex->data;
2281         }
2282
2283         /* I fear prism54_process_bss_data won't work with big endian data */
2284         if ((oid == DOT11_OID_BEACON) || (oid == DOT11_OID_PROBE))
2285                 prism54_process_bss_data(priv, oid, mlmeex->address,
2286                                          payload, len);
2287
2288         mgt_le_to_cpu(isl_oid[oid].flags & OID_FLAG_TYPE, (void *) mlme);
2289
2290         switch (oid) {
2291
2292         case GEN_OID_LINKSTATE:
2293                 link_changed(priv->ndev, (u32) *data);
2294                 break;
2295
2296         case DOT11_OID_MICFAILURE:
2297                 send_simple_event(priv, "Mic failure");
2298                 break;
2299
2300         case DOT11_OID_DEAUTHENTICATE:
2301                 send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2302                 break;
2303
2304         case DOT11_OID_AUTHENTICATE:
2305                 handle_request(priv, mlme, oid);
2306                 send_formatted_event(priv, "Authenticate request", mlme, 1);
2307                 break;
2308
2309         case DOT11_OID_DISASSOCIATE:
2310                 send_formatted_event(priv, "Disassociate request", mlme, 0);
2311                 break;
2312
2313         case DOT11_OID_ASSOCIATE:
2314                 handle_request(priv, mlme, oid);
2315                 send_formatted_event(priv, "Associate request", mlme, 1);
2316                 break;
2317
2318         case DOT11_OID_REASSOCIATE:
2319                 handle_request(priv, mlme, oid);
2320                 send_formatted_event(priv, "ReAssociate request", mlme, 1);
2321                 break;
2322
2323         case DOT11_OID_BEACON:
2324                 send_formatted_event(priv,
2325                                      "Received a beacon from an unknown AP",
2326                                      mlme, 0);
2327                 break;
2328
2329         case DOT11_OID_PROBE:
2330                 /* we received a probe from a client. */
2331                 send_formatted_event(priv, "Received a probe from client", mlme,
2332                                      0);
2333                 break;
2334
2335                 /* Note : "mlme" is actually a "struct obj_mlmeex *" here, but this
2336                  * is backward compatible layout-wise with "struct obj_mlme".
2337                  */
2338
2339         case DOT11_OID_DEAUTHENTICATEEX:
2340                 send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2341                 break;
2342
2343         case DOT11_OID_AUTHENTICATEEX:
2344                 handle_request(priv, mlme, oid);
2345                 send_formatted_event(priv, "Authenticate request (ex)", mlme, 1);
2346
2347                 if (priv->iw_mode != IW_MODE_MASTER
2348                                 && mlmeex->state != DOT11_STATE_AUTHING)
2349                         break;
2350
2351                 confirm = kmalloc(sizeof(struct obj_mlmeex) + 6, GFP_ATOMIC);
2352
2353                 if (!confirm)
2354                         break;
2355
2356                 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2357                 printk(KERN_DEBUG "Authenticate from: address:\t%pM\n",
2358                        mlmeex->address);
2359                 confirm->id = -1; /* or mlmeex->id ? */
2360                 confirm->state = 0; /* not used */
2361                 confirm->code = 0;
2362                 confirm->size = 6;
2363                 confirm->data[0] = 0x00;
2364                 confirm->data[1] = 0x00;
2365                 confirm->data[2] = 0x02;
2366                 confirm->data[3] = 0x00;
2367                 confirm->data[4] = 0x00;
2368                 confirm->data[5] = 0x00;
2369
2370                 ret = mgt_set_varlen(priv, DOT11_OID_ASSOCIATEEX, confirm, 6);
2371
2372                 kfree(confirm);
2373                 if (ret)
2374                         return ret;
2375                 break;
2376
2377         case DOT11_OID_DISASSOCIATEEX:
2378                 send_formatted_event(priv, "Disassociate request (ex)", mlme, 0);
2379                 break;
2380
2381         case DOT11_OID_ASSOCIATEEX:
2382                 handle_request(priv, mlme, oid);
2383                 send_formatted_event(priv, "Associate request (ex)", mlme, 1);
2384
2385                 if (priv->iw_mode != IW_MODE_MASTER
2386                                 && mlmeex->state != DOT11_STATE_ASSOCING)
2387                         break;
2388
2389                 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2390
2391                 if (!confirm)
2392                         break;
2393
2394                 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2395
2396                 confirm->id = ((struct obj_mlmeex *)mlme)->id;
2397                 confirm->state = 0; /* not used */
2398                 confirm->code = 0;
2399
2400                 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2401
2402                 if (!wpa_ie_len) {
2403                         printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n",
2404                                mlmeex->address);
2405                         kfree(confirm);
2406                         break;
2407                 }
2408
2409                 confirm->size = wpa_ie_len;
2410                 memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2411
2412                 mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2413
2414                 kfree(confirm);
2415
2416                 break;
2417
2418         case DOT11_OID_REASSOCIATEEX:
2419                 handle_request(priv, mlme, oid);
2420                 send_formatted_event(priv, "Reassociate request (ex)", mlme, 1);
2421
2422                 if (priv->iw_mode != IW_MODE_MASTER
2423                                 && mlmeex->state != DOT11_STATE_ASSOCING)
2424                         break;
2425
2426                 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2427
2428                 if (!confirm)
2429                         break;
2430
2431                 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2432
2433                 confirm->id = mlmeex->id;
2434                 confirm->state = 0; /* not used */
2435                 confirm->code = 0;
2436
2437                 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2438
2439                 if (!wpa_ie_len) {
2440                         printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n",
2441                                mlmeex->address);
2442                         kfree(confirm);
2443                         break;
2444                 }
2445
2446                 confirm->size = wpa_ie_len;
2447                 memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2448
2449                 mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2450
2451                 kfree(confirm);
2452
2453                 break;
2454
2455         default:
2456                 return -EINVAL;
2457         }
2458
2459         return 0;
2460 }
2461
2462 /*
2463  * Process a device trap.  This is called via schedule_work(), outside of
2464  * interrupt context, no locks held.
2465  */
2466 void
2467 prism54_process_trap(struct work_struct *work)
2468 {
2469         struct islpci_mgmtframe *frame =
2470                 container_of(work, struct islpci_mgmtframe, ws);
2471         struct net_device *ndev = frame->ndev;
2472         enum oid_num_t n = mgt_oidtonum(frame->header->oid);
2473
2474         if (n != OID_NUM_LAST)
2475                 prism54_process_trap_helper(netdev_priv(ndev), n, frame->data);
2476         islpci_mgt_release(frame);
2477 }
2478
2479 int
2480 prism54_set_mac_address(struct net_device *ndev, void *addr)
2481 {
2482         islpci_private *priv = netdev_priv(ndev);
2483         int ret;
2484
2485         if (ndev->addr_len != 6)
2486                 return -EINVAL;
2487         ret = mgt_set_request(priv, GEN_OID_MACADDRESS, 0,
2488                               &((struct sockaddr *) addr)->sa_data);
2489         if (!ret)
2490                 memcpy(priv->ndev->dev_addr,
2491                        &((struct sockaddr *) addr)->sa_data, ETH_ALEN);
2492
2493         return ret;
2494 }
2495
2496 #define PRISM54_SET_WPA                 SIOCIWFIRSTPRIV+12
2497
2498 static int
2499 prism54_set_wpa(struct net_device *ndev, struct iw_request_info *info,
2500                 __u32 * uwrq, char *extra)
2501 {
2502         islpci_private *priv = netdev_priv(ndev);
2503         u32 mlme, authen, dot1x, filter, wep;
2504
2505         if (islpci_get_state(priv) < PRV_STATE_INIT)
2506                 return 0;
2507
2508         wep = 1; /* For privacy invoked */
2509         filter = 1; /* Filter out all unencrypted frames */
2510         dot1x = 0x01; /* To enable eap filter */
2511         mlme = DOT11_MLME_EXTENDED;
2512         authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
2513
2514         down_write(&priv->mib_sem);
2515         priv->wpa = *uwrq;
2516
2517         switch (priv->wpa) {
2518                 default:
2519                 case 0: /* Clears/disables WPA and friends */
2520                         wep = 0;
2521                         filter = 0; /* Do not filter un-encrypted data */
2522                         dot1x = 0;
2523                         mlme = DOT11_MLME_AUTO;
2524                         printk("%s: Disabling WPA\n", ndev->name);
2525                         break;
2526                 case 2:
2527                 case 1: /* WPA */
2528                         printk("%s: Enabling WPA\n", ndev->name);
2529                         break;
2530         }
2531         up_write(&priv->mib_sem);
2532
2533         mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
2534         mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &wep);
2535         mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &filter);
2536         mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x);
2537         mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlme);
2538
2539         return 0;
2540 }
2541
2542 static int
2543 prism54_get_wpa(struct net_device *ndev, struct iw_request_info *info,
2544                 __u32 * uwrq, char *extra)
2545 {
2546         islpci_private *priv = netdev_priv(ndev);
2547         *uwrq = priv->wpa;
2548         return 0;
2549 }
2550
2551 static int
2552 prism54_set_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2553                      __u32 * uwrq, char *extra)
2554 {
2555         islpci_private *priv = netdev_priv(ndev);
2556         priv->monitor_type =
2557             (*uwrq ? ARPHRD_IEEE80211_PRISM : ARPHRD_IEEE80211);
2558         if (priv->iw_mode == IW_MODE_MONITOR)
2559                 priv->ndev->type = priv->monitor_type;
2560
2561         return 0;
2562 }
2563
2564 static int
2565 prism54_get_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2566                      __u32 * uwrq, char *extra)
2567 {
2568         islpci_private *priv = netdev_priv(ndev);
2569         *uwrq = (priv->monitor_type == ARPHRD_IEEE80211_PRISM);
2570         return 0;
2571 }
2572
2573 static int
2574 prism54_debug_oid(struct net_device *ndev, struct iw_request_info *info,
2575                   __u32 * uwrq, char *extra)
2576 {
2577         islpci_private *priv = netdev_priv(ndev);
2578
2579         priv->priv_oid = *uwrq;
2580         printk("%s: oid 0x%08X\n", ndev->name, *uwrq);
2581
2582         return 0;
2583 }
2584
2585 static int
2586 prism54_debug_get_oid(struct net_device *ndev, struct iw_request_info *info,
2587                       struct iw_point *data, char *extra)
2588 {
2589         islpci_private *priv = netdev_priv(ndev);
2590         struct islpci_mgmtframe *response;
2591         int ret = -EIO;
2592
2593         printk("%s: get_oid 0x%08X\n", ndev->name, priv->priv_oid);
2594         data->length = 0;
2595
2596         if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2597                 ret =
2598                     islpci_mgt_transaction(priv->ndev, PIMFOR_OP_GET,
2599                                            priv->priv_oid, extra, 256,
2600                                            &response);
2601                 printk("%s: ret: %i\n", ndev->name, ret);
2602                 if (ret || !response
2603                     || response->header->operation == PIMFOR_OP_ERROR) {
2604                         if (response) {
2605                                 islpci_mgt_release(response);
2606                         }
2607                         printk("%s: EIO\n", ndev->name);
2608                         ret = -EIO;
2609                 }
2610                 if (!ret) {
2611                         data->length = response->header->length;
2612                         memcpy(extra, response->data, data->length);
2613                         islpci_mgt_release(response);
2614                         printk("%s: len: %i\n", ndev->name, data->length);
2615                 }
2616         }
2617
2618         return ret;
2619 }
2620
2621 static int
2622 prism54_debug_set_oid(struct net_device *ndev, struct iw_request_info *info,
2623                       struct iw_point *data, char *extra)
2624 {
2625         islpci_private *priv = netdev_priv(ndev);
2626         struct islpci_mgmtframe *response;
2627         int ret = 0, response_op = PIMFOR_OP_ERROR;
2628
2629         printk("%s: set_oid 0x%08X\tlen: %d\n", ndev->name, priv->priv_oid,
2630                data->length);
2631
2632         if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2633                 ret =
2634                     islpci_mgt_transaction(priv->ndev, PIMFOR_OP_SET,
2635                                            priv->priv_oid, extra, data->length,
2636                                            &response);
2637                 printk("%s: ret: %i\n", ndev->name, ret);
2638                 if (ret || !response
2639                     || response->header->operation == PIMFOR_OP_ERROR) {
2640                         if (response) {
2641                                 islpci_mgt_release(response);
2642                         }
2643                         printk("%s: EIO\n", ndev->name);
2644                         ret = -EIO;
2645                 }
2646                 if (!ret) {
2647                         response_op = response->header->operation;
2648                         printk("%s: response_op: %i\n", ndev->name,
2649                                response_op);
2650                         islpci_mgt_release(response);
2651                 }
2652         }
2653
2654         return (ret ? ret : -EINPROGRESS);
2655 }
2656
2657 static int
2658 prism54_set_spy(struct net_device *ndev,
2659                 struct iw_request_info *info,
2660                 union iwreq_data *uwrq, char *extra)
2661 {
2662         islpci_private *priv = netdev_priv(ndev);
2663         u32 u;
2664         enum oid_num_t oid = OID_INL_CONFIG;
2665
2666         down_write(&priv->mib_sem);
2667         mgt_get(priv, OID_INL_CONFIG, &u);
2668
2669         if ((uwrq->data.length == 0) && (priv->spy_data.spy_number > 0))
2670                 /* disable spy */
2671                 u &= ~INL_CONFIG_RXANNEX;
2672         else if ((uwrq->data.length > 0) && (priv->spy_data.spy_number == 0))
2673                 /* enable spy */
2674                 u |= INL_CONFIG_RXANNEX;
2675
2676         mgt_set(priv, OID_INL_CONFIG, &u);
2677         mgt_commit_list(priv, &oid, 1);
2678         up_write(&priv->mib_sem);
2679
2680         return iw_handler_set_spy(ndev, info, uwrq, extra);
2681 }
2682
2683 static const iw_handler prism54_handler[] = {
2684         (iw_handler) prism54_commit,    /* SIOCSIWCOMMIT */
2685         (iw_handler) prism54_get_name,  /* SIOCGIWNAME */
2686         (iw_handler) NULL,      /* SIOCSIWNWID */
2687         (iw_handler) NULL,      /* SIOCGIWNWID */
2688         (iw_handler) prism54_set_freq,  /* SIOCSIWFREQ */
2689         (iw_handler) prism54_get_freq,  /* SIOCGIWFREQ */
2690         (iw_handler) prism54_set_mode,  /* SIOCSIWMODE */
2691         (iw_handler) prism54_get_mode,  /* SIOCGIWMODE */
2692         (iw_handler) prism54_set_sens,  /* SIOCSIWSENS */
2693         (iw_handler) prism54_get_sens,  /* SIOCGIWSENS */
2694         (iw_handler) NULL,      /* SIOCSIWRANGE */
2695         (iw_handler) prism54_get_range, /* SIOCGIWRANGE */
2696         (iw_handler) NULL,      /* SIOCSIWPRIV */
2697         (iw_handler) NULL,      /* SIOCGIWPRIV */
2698         (iw_handler) NULL,      /* SIOCSIWSTATS */
2699         (iw_handler) NULL,      /* SIOCGIWSTATS */
2700         prism54_set_spy,        /* SIOCSIWSPY */
2701         iw_handler_get_spy,     /* SIOCGIWSPY */
2702         iw_handler_set_thrspy,  /* SIOCSIWTHRSPY */
2703         iw_handler_get_thrspy,  /* SIOCGIWTHRSPY */
2704         (iw_handler) prism54_set_wap,   /* SIOCSIWAP */
2705         (iw_handler) prism54_get_wap,   /* SIOCGIWAP */
2706         (iw_handler) NULL,      /* -- hole -- */
2707         (iw_handler) NULL,      /* SIOCGIWAPLIST deprecated */
2708         (iw_handler) prism54_set_scan,  /* SIOCSIWSCAN */
2709         (iw_handler) prism54_get_scan,  /* SIOCGIWSCAN */
2710         (iw_handler) prism54_set_essid, /* SIOCSIWESSID */
2711         (iw_handler) prism54_get_essid, /* SIOCGIWESSID */
2712         (iw_handler) prism54_set_nick,  /* SIOCSIWNICKN */
2713         (iw_handler) prism54_get_nick,  /* SIOCGIWNICKN */
2714         (iw_handler) NULL,      /* -- hole -- */
2715         (iw_handler) NULL,      /* -- hole -- */
2716         (iw_handler) prism54_set_rate,  /* SIOCSIWRATE */
2717         (iw_handler) prism54_get_rate,  /* SIOCGIWRATE */
2718         (iw_handler) prism54_set_rts,   /* SIOCSIWRTS */
2719         (iw_handler) prism54_get_rts,   /* SIOCGIWRTS */
2720         (iw_handler) prism54_set_frag,  /* SIOCSIWFRAG */
2721         (iw_handler) prism54_get_frag,  /* SIOCGIWFRAG */
2722         (iw_handler) prism54_set_txpower,       /* SIOCSIWTXPOW */
2723         (iw_handler) prism54_get_txpower,       /* SIOCGIWTXPOW */
2724         (iw_handler) prism54_set_retry, /* SIOCSIWRETRY */
2725         (iw_handler) prism54_get_retry, /* SIOCGIWRETRY */
2726         (iw_handler) prism54_set_encode,        /* SIOCSIWENCODE */
2727         (iw_handler) prism54_get_encode,        /* SIOCGIWENCODE */
2728         (iw_handler) NULL,      /* SIOCSIWPOWER */
2729         (iw_handler) NULL,      /* SIOCGIWPOWER */
2730         NULL,                   /* -- hole -- */
2731         NULL,                   /* -- hole -- */
2732         (iw_handler) prism54_set_genie, /* SIOCSIWGENIE */
2733         (iw_handler) prism54_get_genie, /* SIOCGIWGENIE */
2734         (iw_handler) prism54_set_auth,  /* SIOCSIWAUTH */
2735         (iw_handler) prism54_get_auth,  /* SIOCGIWAUTH */
2736         (iw_handler) prism54_set_encodeext, /* SIOCSIWENCODEEXT */
2737         (iw_handler) prism54_get_encodeext, /* SIOCGIWENCODEEXT */
2738         NULL,                   /* SIOCSIWPMKSA */
2739 };
2740
2741 /* The low order bit identify a SET (0) or a GET (1) ioctl.  */
2742
2743 #define PRISM54_RESET           SIOCIWFIRSTPRIV
2744 #define PRISM54_GET_POLICY      SIOCIWFIRSTPRIV+1
2745 #define PRISM54_SET_POLICY      SIOCIWFIRSTPRIV+2
2746 #define PRISM54_GET_MAC         SIOCIWFIRSTPRIV+3
2747 #define PRISM54_ADD_MAC         SIOCIWFIRSTPRIV+4
2748
2749 #define PRISM54_DEL_MAC         SIOCIWFIRSTPRIV+6
2750
2751 #define PRISM54_KICK_MAC        SIOCIWFIRSTPRIV+8
2752
2753 #define PRISM54_KICK_ALL        SIOCIWFIRSTPRIV+10
2754
2755 #define PRISM54_GET_WPA         SIOCIWFIRSTPRIV+11
2756 #define PRISM54_SET_WPA         SIOCIWFIRSTPRIV+12
2757
2758 #define PRISM54_DBG_OID         SIOCIWFIRSTPRIV+14
2759 #define PRISM54_DBG_GET_OID     SIOCIWFIRSTPRIV+15
2760 #define PRISM54_DBG_SET_OID     SIOCIWFIRSTPRIV+16
2761
2762 #define PRISM54_GET_OID         SIOCIWFIRSTPRIV+17
2763 #define PRISM54_SET_OID_U32     SIOCIWFIRSTPRIV+18
2764 #define PRISM54_SET_OID_STR     SIOCIWFIRSTPRIV+20
2765 #define PRISM54_SET_OID_ADDR    SIOCIWFIRSTPRIV+22
2766
2767 #define PRISM54_GET_PRISMHDR    SIOCIWFIRSTPRIV+23
2768 #define PRISM54_SET_PRISMHDR    SIOCIWFIRSTPRIV+24
2769
2770 #define IWPRIV_SET_U32(n,x)     { n, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2771 #define IWPRIV_SET_SSID(n,x)    { n, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2772 #define IWPRIV_SET_ADDR(n,x)    { n, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2773 #define IWPRIV_GET(n,x) { n, 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, "g_"x }
2774
2775 #define IWPRIV_U32(n,x)         IWPRIV_SET_U32(n,x), IWPRIV_GET(n,x)
2776 #define IWPRIV_SSID(n,x)        IWPRIV_SET_SSID(n,x), IWPRIV_GET(n,x)
2777 #define IWPRIV_ADDR(n,x)        IWPRIV_SET_ADDR(n,x), IWPRIV_GET(n,x)
2778
2779 /* Note : limited to 128 private ioctls (wireless tools 26) */
2780
2781 static const struct iw_priv_args prism54_private_args[] = {
2782 /*{ cmd, set_args, get_args, name } */
2783         {PRISM54_RESET, 0, 0, "reset"},
2784         {PRISM54_GET_PRISMHDR, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2785          "get_prismhdr"},
2786         {PRISM54_SET_PRISMHDR, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2787          "set_prismhdr"},
2788         {PRISM54_GET_POLICY, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2789          "getPolicy"},
2790         {PRISM54_SET_POLICY, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2791          "setPolicy"},
2792         {PRISM54_GET_MAC, 0, IW_PRIV_TYPE_ADDR | 64, "getMac"},
2793         {PRISM54_ADD_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2794          "addMac"},
2795         {PRISM54_DEL_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2796          "delMac"},
2797         {PRISM54_KICK_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2798          "kickMac"},
2799         {PRISM54_KICK_ALL, 0, 0, "kickAll"},
2800         {PRISM54_GET_WPA, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2801          "get_wpa"},
2802         {PRISM54_SET_WPA, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2803          "set_wpa"},
2804         {PRISM54_DBG_OID, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2805          "dbg_oid"},
2806         {PRISM54_DBG_GET_OID, 0, IW_PRIV_TYPE_BYTE | 256, "dbg_get_oid"},
2807         {PRISM54_DBG_SET_OID, IW_PRIV_TYPE_BYTE | 256, 0, "dbg_set_oid"},
2808         /* --- sub-ioctls handlers --- */
2809         {PRISM54_GET_OID,
2810          0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, ""},
2811         {PRISM54_SET_OID_U32,
2812          IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2813         {PRISM54_SET_OID_STR,
2814          IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2815         {PRISM54_SET_OID_ADDR,
2816          IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2817         /* --- sub-ioctls definitions --- */
2818         IWPRIV_ADDR(GEN_OID_MACADDRESS, "addr"),
2819         IWPRIV_GET(GEN_OID_LINKSTATE, "linkstate"),
2820         IWPRIV_U32(DOT11_OID_BSSTYPE, "bsstype"),
2821         IWPRIV_ADDR(DOT11_OID_BSSID, "bssid"),
2822         IWPRIV_U32(DOT11_OID_STATE, "state"),
2823         IWPRIV_U32(DOT11_OID_AID, "aid"),
2824
2825         IWPRIV_SSID(DOT11_OID_SSIDOVERRIDE, "ssidoverride"),
2826
2827         IWPRIV_U32(DOT11_OID_MEDIUMLIMIT, "medlimit"),
2828         IWPRIV_U32(DOT11_OID_BEACONPERIOD, "beacon"),
2829         IWPRIV_U32(DOT11_OID_DTIMPERIOD, "dtimperiod"),
2830
2831         IWPRIV_U32(DOT11_OID_AUTHENABLE, "authenable"),
2832         IWPRIV_U32(DOT11_OID_PRIVACYINVOKED, "privinvok"),
2833         IWPRIV_U32(DOT11_OID_EXUNENCRYPTED, "exunencrypt"),
2834
2835         IWPRIV_U32(DOT11_OID_REKEYTHRESHOLD, "rekeythresh"),
2836
2837         IWPRIV_U32(DOT11_OID_MAXTXLIFETIME, "maxtxlife"),
2838         IWPRIV_U32(DOT11_OID_MAXRXLIFETIME, "maxrxlife"),
2839         IWPRIV_U32(DOT11_OID_ALOFT_FIXEDRATE, "fixedrate"),
2840         IWPRIV_U32(DOT11_OID_MAXFRAMEBURST, "frameburst"),
2841         IWPRIV_U32(DOT11_OID_PSM, "psm"),
2842
2843         IWPRIV_U32(DOT11_OID_BRIDGELOCAL, "bridge"),
2844         IWPRIV_U32(DOT11_OID_CLIENTS, "clients"),
2845         IWPRIV_U32(DOT11_OID_CLIENTSASSOCIATED, "clientassoc"),
2846         IWPRIV_U32(DOT11_OID_DOT1XENABLE, "dot1xenable"),
2847         IWPRIV_U32(DOT11_OID_ANTENNARX, "rxant"),
2848         IWPRIV_U32(DOT11_OID_ANTENNATX, "txant"),
2849         IWPRIV_U32(DOT11_OID_ANTENNADIVERSITY, "antdivers"),
2850         IWPRIV_U32(DOT11_OID_EDTHRESHOLD, "edthresh"),
2851         IWPRIV_U32(DOT11_OID_PREAMBLESETTINGS, "preamble"),
2852         IWPRIV_GET(DOT11_OID_RATES, "rates"),
2853         IWPRIV_U32(DOT11_OID_OUTPUTPOWER, ".11outpower"),
2854         IWPRIV_GET(DOT11_OID_SUPPORTEDRATES, "supprates"),
2855         IWPRIV_GET(DOT11_OID_SUPPORTEDFREQUENCIES, "suppfreq"),
2856
2857         IWPRIV_U32(DOT11_OID_NOISEFLOOR, "noisefloor"),
2858         IWPRIV_GET(DOT11_OID_FREQUENCYACTIVITY, "freqactivity"),
2859         IWPRIV_U32(DOT11_OID_NONERPPROTECTION, "nonerpprotec"),
2860         IWPRIV_U32(DOT11_OID_PROFILES, "profile"),
2861         IWPRIV_GET(DOT11_OID_EXTENDEDRATES, "extrates"),
2862         IWPRIV_U32(DOT11_OID_MLMEAUTOLEVEL, "mlmelevel"),
2863
2864         IWPRIV_GET(DOT11_OID_BSSS, "bsss"),
2865         IWPRIV_GET(DOT11_OID_BSSLIST, "bsslist"),
2866         IWPRIV_U32(OID_INL_MODE, "mode"),
2867         IWPRIV_U32(OID_INL_CONFIG, "config"),
2868         IWPRIV_U32(OID_INL_DOT11D_CONFORMANCE, ".11dconform"),
2869         IWPRIV_GET(OID_INL_PHYCAPABILITIES, "phycapa"),
2870         IWPRIV_U32(OID_INL_OUTPUTPOWER, "outpower"),
2871 };
2872
2873 static const iw_handler prism54_private_handler[] = {
2874         (iw_handler) prism54_reset,
2875         (iw_handler) prism54_get_policy,
2876         (iw_handler) prism54_set_policy,
2877         (iw_handler) prism54_get_mac,
2878         (iw_handler) prism54_add_mac,
2879         (iw_handler) NULL,
2880         (iw_handler) prism54_del_mac,
2881         (iw_handler) NULL,
2882         (iw_handler) prism54_kick_mac,
2883         (iw_handler) NULL,
2884         (iw_handler) prism54_kick_all,
2885         (iw_handler) prism54_get_wpa,
2886         (iw_handler) prism54_set_wpa,
2887         (iw_handler) NULL,
2888         (iw_handler) prism54_debug_oid,
2889         (iw_handler) prism54_debug_get_oid,
2890         (iw_handler) prism54_debug_set_oid,
2891         (iw_handler) prism54_get_oid,
2892         (iw_handler) prism54_set_u32,
2893         (iw_handler) NULL,
2894         (iw_handler) prism54_set_raw,
2895         (iw_handler) NULL,
2896         (iw_handler) prism54_set_raw,
2897         (iw_handler) prism54_get_prismhdr,
2898         (iw_handler) prism54_set_prismhdr,
2899 };
2900
2901 const struct iw_handler_def prism54_handler_def = {
2902         .num_standard = ARRAY_SIZE(prism54_handler),
2903         .num_private = ARRAY_SIZE(prism54_private_handler),
2904         .num_private_args = ARRAY_SIZE(prism54_private_args),
2905         .standard = (iw_handler *) prism54_handler,
2906         .private = (iw_handler *) prism54_private_handler,
2907         .private_args = (struct iw_priv_args *) prism54_private_args,
2908         .get_wireless_stats = prism54_get_wireless_stats,
2909 };