git.oblomov.eu Git - linux-2.6/blob - drivers/net/wireless/prism54/isl_ioctl.c

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