drivers/net/wireless/cisco/airo.c

   1 /*======================================================================
   2
   3     Aironet driver for 4500 and 4800 series cards
   4
   5     This code is released under both the GPL version 2 and BSD licenses.
   6     Either license may be used.  The respective licenses are found at
   7     the end of this file.
   8
   9     This code was developed by Benjamin Reed <breed@users.sourceforge.net>
  10     including portions of which come from the Aironet PC4500
  11     Developer's Reference Manual and used with permission.  Copyright
  12     (C) 1999 Benjamin Reed.  All Rights Reserved.  Permission to use
  13     code in the Developer's manual was granted for this driver by
  14     Aironet.  Major code contributions were received from Javier Achirica
  15     <achirica@users.sourceforge.net> and Jean Tourrilhes <jt@hpl.hp.com>.
  16     Code was also integrated from the Cisco Aironet driver for Linux.
  17     Support for MPI350 cards was added by Fabrice Bellet
  18     <fabrice@bellet.info>.
  19
  20 ======================================================================*/
  21
  22 #include <linux/err.h>
  23 #include <linux/init.h>
  24
  25 #include <linux/kernel.h>
  26 #include <linux/module.h>
  27 #include <linux/proc_fs.h>
  28
  29 #include <linux/sched.h>
  30 #include <linux/ptrace.h>
  31 #include <linux/slab.h>
  32 #include <linux/string.h>
  33 #include <linux/timer.h>
  34 #include <linux/interrupt.h>
  35 #include <linux/in.h>
  36 #include <linux/bitops.h>
  37 #include <linux/scatterlist.h>
  38 #include <linux/crypto.h>
  39 #include <linux/io.h>
  40 #include <asm/unaligned.h>
  41
  42 #include <linux/netdevice.h>
  43 #include <linux/etherdevice.h>
  44 #include <linux/skbuff.h>
  45 #include <linux/if_arp.h>
  46 #include <linux/ioport.h>
  47 #include <linux/pci.h>
  48 #include <linux/uaccess.h>
  49 #include <linux/kthread.h>
  50 #include <linux/freezer.h>
  51
  52 #include <net/cfg80211.h>
  53 #include <net/iw_handler.h>
  54
  55 #include "airo.h"
  56
  57 #define DRV_NAME "airo"
  58
  59 #ifdef CONFIG_PCI
  60 static const struct pci_device_id card_ids[] = {
  61         { 0x14b9, 1, PCI_ANY_ID, PCI_ANY_ID, },
  62         { 0x14b9, 0x4500, PCI_ANY_ID, PCI_ANY_ID },
  63         { 0x14b9, 0x4800, PCI_ANY_ID, PCI_ANY_ID, },
  64         { 0x14b9, 0x0340, PCI_ANY_ID, PCI_ANY_ID, },
  65         { 0x14b9, 0x0350, PCI_ANY_ID, PCI_ANY_ID, },
  66         { 0x14b9, 0x5000, PCI_ANY_ID, PCI_ANY_ID, },
  67         { 0x14b9, 0xa504, PCI_ANY_ID, PCI_ANY_ID, },
  68         { 0, }
  69 };
  70 MODULE_DEVICE_TABLE(pci, card_ids);
  71
  72 static int airo_pci_probe(struct pci_dev *, const struct pci_device_id *);
  73 static void airo_pci_remove(struct pci_dev *);
  74 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state);
  75 static int airo_pci_resume(struct pci_dev *pdev);
  76
  77 static struct pci_driver airo_driver = {
  78         .name     = DRV_NAME,
  79         .id_table = card_ids,
  80         .probe    = airo_pci_probe,
  81         .remove   = airo_pci_remove,
  82         .suspend  = airo_pci_suspend,
  83         .resume   = airo_pci_resume,
  84 };
  85 #endif /* CONFIG_PCI */
  86
  87 /* Include Wireless Extension definition and check version - Jean II */
  88 #include <linux/wireless.h>
  89 #define WIRELESS_SPY            /* enable iwspy support */
  90
  91 #define CISCO_EXT               /* enable Cisco extensions */
  92 #ifdef CISCO_EXT
  93 #include <linux/delay.h>
  94 #endif
  95
  96 /* Hack to do some power saving */
  97 #define POWER_ON_DOWN
  98
  99 /* As you can see this list is HUGH!
 100    I really don't know what a lot of these counts are about, but they
 101    are all here for completeness.  If the IGNLABEL macro is put in
 102    infront of the label, that statistic will not be included in the list
 103    of statistics in the /proc filesystem */
 104
 105 #define IGNLABEL(comment) NULL
 106 static const char *statsLabels[] = {
 107         "RxOverrun",
 108         IGNLABEL("RxPlcpCrcErr"),
 109         IGNLABEL("RxPlcpFormatErr"),
 110         IGNLABEL("RxPlcpLengthErr"),
 111         "RxMacCrcErr",
 112         "RxMacCrcOk",
 113         "RxWepErr",
 114         "RxWepOk",
 115         "RetryLong",
 116         "RetryShort",
 117         "MaxRetries",
 118         "NoAck",
 119         "NoCts",
 120         "RxAck",
 121         "RxCts",
 122         "TxAck",
 123         "TxRts",
 124         "TxCts",
 125         "TxMc",
 126         "TxBc",
 127         "TxUcFrags",
 128         "TxUcPackets",
 129         "TxBeacon",
 130         "RxBeacon",
 131         "TxSinColl",
 132         "TxMulColl",
 133         "DefersNo",
 134         "DefersProt",
 135         "DefersEngy",
 136         "DupFram",
 137         "RxFragDisc",
 138         "TxAged",
 139         "RxAged",
 140         "LostSync-MaxRetry",
 141         "LostSync-MissedBeacons",
 142         "LostSync-ArlExceeded",
 143         "LostSync-Deauth",
 144         "LostSync-Disassoced",
 145         "LostSync-TsfTiming",
 146         "HostTxMc",
 147         "HostTxBc",
 148         "HostTxUc",
 149         "HostTxFail",
 150         "HostRxMc",
 151         "HostRxBc",
 152         "HostRxUc",
 153         "HostRxDiscard",
 154         IGNLABEL("HmacTxMc"),
 155         IGNLABEL("HmacTxBc"),
 156         IGNLABEL("HmacTxUc"),
 157         IGNLABEL("HmacTxFail"),
 158         IGNLABEL("HmacRxMc"),
 159         IGNLABEL("HmacRxBc"),
 160         IGNLABEL("HmacRxUc"),
 161         IGNLABEL("HmacRxDiscard"),
 162         IGNLABEL("HmacRxAccepted"),
 163         "SsidMismatch",
 164         "ApMismatch",
 165         "RatesMismatch",
 166         "AuthReject",
 167         "AuthTimeout",
 168         "AssocReject",
 169         "AssocTimeout",
 170         IGNLABEL("ReasonOutsideTable"),
 171         IGNLABEL("ReasonStatus1"),
 172         IGNLABEL("ReasonStatus2"),
 173         IGNLABEL("ReasonStatus3"),
 174         IGNLABEL("ReasonStatus4"),
 175         IGNLABEL("ReasonStatus5"),
 176         IGNLABEL("ReasonStatus6"),
 177         IGNLABEL("ReasonStatus7"),
 178         IGNLABEL("ReasonStatus8"),
 179         IGNLABEL("ReasonStatus9"),
 180         IGNLABEL("ReasonStatus10"),
 181         IGNLABEL("ReasonStatus11"),
 182         IGNLABEL("ReasonStatus12"),
 183         IGNLABEL("ReasonStatus13"),
 184         IGNLABEL("ReasonStatus14"),
 185         IGNLABEL("ReasonStatus15"),
 186         IGNLABEL("ReasonStatus16"),
 187         IGNLABEL("ReasonStatus17"),
 188         IGNLABEL("ReasonStatus18"),
 189         IGNLABEL("ReasonStatus19"),
 190         "RxMan",
 191         "TxMan",
 192         "RxRefresh",
 193         "TxRefresh",
 194         "RxPoll",
 195         "TxPoll",
 196         "HostRetries",
 197         "LostSync-HostReq",
 198         "HostTxBytes",
 199         "HostRxBytes",
 200         "ElapsedUsec",
 201         "ElapsedSec",
 202         "LostSyncBetterAP",
 203         "PrivacyMismatch",
 204         "Jammed",
 205         "DiscRxNotWepped",
 206         "PhyEleMismatch",
 207         (char*)-1 };
 208 #ifndef RUN_AT
 209 #define RUN_AT(x) (jiffies+(x))
 210 #endif
 211
 212
 213 /* These variables are for insmod, since it seems that the rates
 214    can only be set in setup_card.  Rates should be a comma separated
 215    (no spaces) list of rates (up to 8). */
 216
 217 static int rates[8];
 218 static char *ssids[3];
 219
 220 static int io[4];
 221 static int irq[4];
 222
 223 static
 224 int maxencrypt /* = 0 */; /* The highest rate that the card can encrypt at.
 225                        0 means no limit.  For old cards this was 4 */
 226
 227 static int auto_wep /* = 0 */; /* If set, it tries to figure out the wep mode */
 228 static int aux_bap /* = 0 */; /* Checks to see if the aux ports are needed to read
 229                     the bap, needed on some older cards and buses. */
 230 static int adhoc;
 231
 232 static int probe = 1;
 233
 234 static kuid_t proc_kuid;
 235 static int proc_uid /* = 0 */;
 236
 237 static kgid_t proc_kgid;
 238 static int proc_gid /* = 0 */;
 239
 240 static int airo_perm = 0555;
 241
 242 static int proc_perm = 0644;
 243
 244 MODULE_AUTHOR("Benjamin Reed");
 245 MODULE_DESCRIPTION("Support for Cisco/Aironet 802.11 wireless ethernet cards.  "
 246                    "Direct support for ISA/PCI/MPI cards and support for PCMCIA when used with airo_cs.");
 247 MODULE_LICENSE("Dual BSD/GPL");
 248 MODULE_SUPPORTED_DEVICE("Aironet 4500, 4800 and Cisco 340/350");
 249 module_param_hw_array(io, int, ioport, NULL, 0);
 250 module_param_hw_array(irq, int, irq, NULL, 0);
 251 module_param_array(rates, int, NULL, 0);
 252 module_param_array(ssids, charp, NULL, 0);
 253 module_param(auto_wep, int, 0);
 254 MODULE_PARM_DESC(auto_wep,
 255                  "If non-zero, the driver will keep looping through the authentication options until an association is made.  "
 256                  "The value of auto_wep is number of the wep keys to check.  "
 257                  "A value of 2 will try using the key at index 0 and index 1.");
 258 module_param(aux_bap, int, 0);
 259 MODULE_PARM_DESC(aux_bap,
 260                  "If non-zero, the driver will switch into a mode that seems to work better for older cards with some older buses.  "
 261                  "Before switching it checks that the switch is needed.");
 262 module_param(maxencrypt, int, 0);
 263 MODULE_PARM_DESC(maxencrypt,
 264                  "The maximum speed that the card can do encryption.  "
 265                  "Units are in 512kbs.  "
 266                  "Zero (default) means there is no limit.  "
 267                  "Older cards used to be limited to 2mbs (4).");
 268 module_param(adhoc, int, 0);
 269 MODULE_PARM_DESC(adhoc, "If non-zero, the card will start in adhoc mode.");
 270 module_param(probe, int, 0);
 271 MODULE_PARM_DESC(probe, "If zero, the driver won't start the card.");
 272
 273 module_param(proc_uid, int, 0);
 274 MODULE_PARM_DESC(proc_uid, "The uid that the /proc files will belong to.");
 275 module_param(proc_gid, int, 0);
 276 MODULE_PARM_DESC(proc_gid, "The gid that the /proc files will belong to.");
 277 module_param(airo_perm, int, 0);
 278 MODULE_PARM_DESC(airo_perm, "The permission bits of /proc/[driver/]aironet.");
 279 module_param(proc_perm, int, 0);
 280 MODULE_PARM_DESC(proc_perm, "The permission bits of the files in /proc");
 281
 282 /* This is a kind of sloppy hack to get this information to OUT4500 and
 283    IN4500.  I would be extremely interested in the situation where this
 284    doesn't work though!!! */
 285 static int do8bitIO /* = 0 */;
 286
 287 /* Return codes */
 288 #define SUCCESS 0
 289 #define ERROR -1
 290 #define NO_PACKET -2
 291
 292 /* Commands */
 293 #define NOP2            0x0000
 294 #define MAC_ENABLE      0x0001
 295 #define MAC_DISABLE     0x0002
 296 #define CMD_LOSE_SYNC   0x0003 /* Not sure what this does... */
 297 #define CMD_SOFTRESET   0x0004
 298 #define HOSTSLEEP       0x0005
 299 #define CMD_MAGIC_PKT   0x0006
 300 #define CMD_SETWAKEMASK 0x0007
 301 #define CMD_READCFG     0x0008
 302 #define CMD_SETMODE     0x0009
 303 #define CMD_ALLOCATETX  0x000a
 304 #define CMD_TRANSMIT    0x000b
 305 #define CMD_DEALLOCATETX 0x000c
 306 #define NOP             0x0010
 307 #define CMD_WORKAROUND  0x0011
 308 #define CMD_ALLOCATEAUX 0x0020
 309 #define CMD_ACCESS      0x0021
 310 #define CMD_PCIBAP      0x0022
 311 #define CMD_PCIAUX      0x0023
 312 #define CMD_ALLOCBUF    0x0028
 313 #define CMD_GETTLV      0x0029
 314 #define CMD_PUTTLV      0x002a
 315 #define CMD_DELTLV      0x002b
 316 #define CMD_FINDNEXTTLV 0x002c
 317 #define CMD_PSPNODES    0x0030
 318 #define CMD_SETCW       0x0031
 319 #define CMD_SETPCF      0x0032
 320 #define CMD_SETPHYREG   0x003e
 321 #define CMD_TXTEST      0x003f
 322 #define MAC_ENABLETX    0x0101
 323 #define CMD_LISTBSS     0x0103
 324 #define CMD_SAVECFG     0x0108
 325 #define CMD_ENABLEAUX   0x0111
 326 #define CMD_WRITERID    0x0121
 327 #define CMD_USEPSPNODES 0x0130
 328 #define MAC_ENABLERX    0x0201
 329
 330 /* Command errors */
 331 #define ERROR_QUALIF 0x00
 332 #define ERROR_ILLCMD 0x01
 333 #define ERROR_ILLFMT 0x02
 334 #define ERROR_INVFID 0x03
 335 #define ERROR_INVRID 0x04
 336 #define ERROR_LARGE 0x05
 337 #define ERROR_NDISABL 0x06
 338 #define ERROR_ALLOCBSY 0x07
 339 #define ERROR_NORD 0x0B
 340 #define ERROR_NOWR 0x0C
 341 #define ERROR_INVFIDTX 0x0D
 342 #define ERROR_TESTACT 0x0E
 343 #define ERROR_TAGNFND 0x12
 344 #define ERROR_DECODE 0x20
 345 #define ERROR_DESCUNAV 0x21
 346 #define ERROR_BADLEN 0x22
 347 #define ERROR_MODE 0x80
 348 #define ERROR_HOP 0x81
 349 #define ERROR_BINTER 0x82
 350 #define ERROR_RXMODE 0x83
 351 #define ERROR_MACADDR 0x84
 352 #define ERROR_RATES 0x85
 353 #define ERROR_ORDER 0x86
 354 #define ERROR_SCAN 0x87
 355 #define ERROR_AUTH 0x88
 356 #define ERROR_PSMODE 0x89
 357 #define ERROR_RTYPE 0x8A
 358 #define ERROR_DIVER 0x8B
 359 #define ERROR_SSID 0x8C
 360 #define ERROR_APLIST 0x8D
 361 #define ERROR_AUTOWAKE 0x8E
 362 #define ERROR_LEAP 0x8F
 363
 364 /* Registers */
 365 #define COMMAND 0x00
 366 #define PARAM0 0x02
 367 #define PARAM1 0x04
 368 #define PARAM2 0x06
 369 #define STATUS 0x08
 370 #define RESP0 0x0a
 371 #define RESP1 0x0c
 372 #define RESP2 0x0e
 373 #define LINKSTAT 0x10
 374 #define SELECT0 0x18
 375 #define OFFSET0 0x1c
 376 #define RXFID 0x20
 377 #define TXALLOCFID 0x22
 378 #define TXCOMPLFID 0x24
 379 #define DATA0 0x36
 380 #define EVSTAT 0x30
 381 #define EVINTEN 0x32
 382 #define EVACK 0x34
 383 #define SWS0 0x28
 384 #define SWS1 0x2a
 385 #define SWS2 0x2c
 386 #define SWS3 0x2e
 387 #define AUXPAGE 0x3A
 388 #define AUXOFF 0x3C
 389 #define AUXDATA 0x3E
 390
 391 #define FID_TX 1
 392 #define FID_RX 2
 393 /* Offset into aux memory for descriptors */
 394 #define AUX_OFFSET 0x800
 395 /* Size of allocated packets */
 396 #define PKTSIZE 1840
 397 #define RIDSIZE 2048
 398 /* Size of the transmit queue */
 399 #define MAXTXQ 64
 400
 401 /* BAP selectors */
 402 #define BAP0 0 /* Used for receiving packets */
 403 #define BAP1 2 /* Used for xmiting packets and working with RIDS */
 404
 405 /* Flags */
 406 #define COMMAND_BUSY 0x8000
 407
 408 #define BAP_BUSY 0x8000
 409 #define BAP_ERR 0x4000
 410 #define BAP_DONE 0x2000
 411
 412 #define PROMISC 0xffff
 413 #define NOPROMISC 0x0000
 414
 415 #define EV_CMD 0x10
 416 #define EV_CLEARCOMMANDBUSY 0x4000
 417 #define EV_RX 0x01
 418 #define EV_TX 0x02
 419 #define EV_TXEXC 0x04
 420 #define EV_ALLOC 0x08
 421 #define EV_LINK 0x80
 422 #define EV_AWAKE 0x100
 423 #define EV_TXCPY 0x400
 424 #define EV_UNKNOWN 0x800
 425 #define EV_MIC 0x1000 /* Message Integrity Check Interrupt */
 426 #define EV_AWAKEN 0x2000
 427 #define STATUS_INTS (EV_AWAKE|EV_LINK|EV_TXEXC|EV_TX|EV_TXCPY|EV_RX|EV_MIC)
 428
 429 #ifdef CHECK_UNKNOWN_INTS
 430 #define IGNORE_INTS ( EV_CMD | EV_UNKNOWN)
 431 #else
 432 #define IGNORE_INTS (~STATUS_INTS)
 433 #endif
 434
 435 /* RID TYPES */
 436 #define RID_RW 0x20
 437
 438 /* The RIDs */
 439 #define RID_CAPABILITIES 0xFF00
 440 #define RID_APINFO     0xFF01
 441 #define RID_RADIOINFO  0xFF02
 442 #define RID_UNKNOWN3   0xFF03
 443 #define RID_RSSI       0xFF04
 444 #define RID_CONFIG     0xFF10
 445 #define RID_SSID       0xFF11
 446 #define RID_APLIST     0xFF12
 447 #define RID_DRVNAME    0xFF13
 448 #define RID_ETHERENCAP 0xFF14
 449 #define RID_WEP_TEMP   0xFF15
 450 #define RID_WEP_PERM   0xFF16
 451 #define RID_MODULATION 0xFF17
 452 #define RID_OPTIONS    0xFF18
 453 #define RID_ACTUALCONFIG 0xFF20 /*readonly*/
 454 #define RID_FACTORYCONFIG 0xFF21
 455 #define RID_UNKNOWN22  0xFF22
 456 #define RID_LEAPUSERNAME 0xFF23
 457 #define RID_LEAPPASSWORD 0xFF24
 458 #define RID_STATUS     0xFF50
 459 #define RID_BEACON_HST 0xFF51
 460 #define RID_BUSY_HST   0xFF52
 461 #define RID_RETRIES_HST 0xFF53
 462 #define RID_UNKNOWN54  0xFF54
 463 #define RID_UNKNOWN55  0xFF55
 464 #define RID_UNKNOWN56  0xFF56
 465 #define RID_MIC        0xFF57
 466 #define RID_STATS16    0xFF60
 467 #define RID_STATS16DELTA 0xFF61
 468 #define RID_STATS16DELTACLEAR 0xFF62
 469 #define RID_STATS      0xFF68
 470 #define RID_STATSDELTA 0xFF69
 471 #define RID_STATSDELTACLEAR 0xFF6A
 472 #define RID_ECHOTEST_RID 0xFF70
 473 #define RID_ECHOTEST_RESULTS 0xFF71
 474 #define RID_BSSLISTFIRST 0xFF72
 475 #define RID_BSSLISTNEXT  0xFF73
 476 #define RID_WPA_BSSLISTFIRST 0xFF74
 477 #define RID_WPA_BSSLISTNEXT  0xFF75
 478
 479 typedef struct {
 480         u16 cmd;
 481         u16 parm0;
 482         u16 parm1;
 483         u16 parm2;
 484 } Cmd;
 485
 486 typedef struct {
 487         u16 status;
 488         u16 rsp0;
 489         u16 rsp1;
 490         u16 rsp2;
 491 } Resp;
 492
 493 /*
 494  * Rids and endian-ness:  The Rids will always be in cpu endian, since
 495  * this all the patches from the big-endian guys end up doing that.
 496  * so all rid access should use the read/writeXXXRid routines.
 497  */
 498
 499 /* This structure came from an email sent to me from an engineer at
 500    aironet for inclusion into this driver */
 501 typedef struct WepKeyRid WepKeyRid;
 502 struct WepKeyRid {
 503         __le16 len;
 504         __le16 kindex;
 505         u8 mac[ETH_ALEN];
 506         __le16 klen;
 507         u8 key[16];
 508 } __packed;
 509
 510 /* These structures are from the Aironet's PC4500 Developers Manual */
 511 typedef struct Ssid Ssid;
 512 struct Ssid {
 513         __le16 len;
 514         u8 ssid[32];
 515 } __packed;
 516
 517 typedef struct SsidRid SsidRid;
 518 struct SsidRid {
 519         __le16 len;
 520         Ssid ssids[3];
 521 } __packed;
 522
 523 typedef struct ModulationRid ModulationRid;
 524 struct ModulationRid {
 525         __le16 len;
 526         __le16 modulation;
 527 #define MOD_DEFAULT cpu_to_le16(0)
 528 #define MOD_CCK cpu_to_le16(1)
 529 #define MOD_MOK cpu_to_le16(2)
 530 } __packed;
 531
 532 typedef struct ConfigRid ConfigRid;
 533 struct ConfigRid {
 534         __le16 len; /* sizeof(ConfigRid) */
 535         __le16 opmode; /* operating mode */
 536 #define MODE_STA_IBSS cpu_to_le16(0)
 537 #define MODE_STA_ESS cpu_to_le16(1)
 538 #define MODE_AP cpu_to_le16(2)
 539 #define MODE_AP_RPTR cpu_to_le16(3)
 540 #define MODE_CFG_MASK cpu_to_le16(0xff)
 541 #define MODE_ETHERNET_HOST cpu_to_le16(0<<8) /* rx payloads converted */
 542 #define MODE_LLC_HOST cpu_to_le16(1<<8) /* rx payloads left as is */
 543 #define MODE_AIRONET_EXTEND cpu_to_le16(1<<9) /* enable Aironet extenstions */
 544 #define MODE_AP_INTERFACE cpu_to_le16(1<<10) /* enable ap interface extensions */
 545 #define MODE_ANTENNA_ALIGN cpu_to_le16(1<<11) /* enable antenna alignment */
 546 #define MODE_ETHER_LLC cpu_to_le16(1<<12) /* enable ethernet LLC */
 547 #define MODE_LEAF_NODE cpu_to_le16(1<<13) /* enable leaf node bridge */
 548 #define MODE_CF_POLLABLE cpu_to_le16(1<<14) /* enable CF pollable */
 549 #define MODE_MIC cpu_to_le16(1<<15) /* enable MIC */
 550         __le16 rmode; /* receive mode */
 551 #define RXMODE_BC_MC_ADDR cpu_to_le16(0)
 552 #define RXMODE_BC_ADDR cpu_to_le16(1) /* ignore multicasts */
 553 #define RXMODE_ADDR cpu_to_le16(2) /* ignore multicast and broadcast */
 554 #define RXMODE_RFMON cpu_to_le16(3) /* wireless monitor mode */
 555 #define RXMODE_RFMON_ANYBSS cpu_to_le16(4)
 556 #define RXMODE_LANMON cpu_to_le16(5) /* lan style monitor -- data packets only */
 557 #define RXMODE_MASK cpu_to_le16(255)
 558 #define RXMODE_DISABLE_802_3_HEADER cpu_to_le16(1<<8) /* disables 802.3 header on rx */
 559 #define RXMODE_FULL_MASK (RXMODE_MASK | RXMODE_DISABLE_802_3_HEADER)
 560 #define RXMODE_NORMALIZED_RSSI cpu_to_le16(1<<9) /* return normalized RSSI */
 561         __le16 fragThresh;
 562         __le16 rtsThres;
 563         u8 macAddr[ETH_ALEN];
 564         u8 rates[8];
 565         __le16 shortRetryLimit;
 566         __le16 longRetryLimit;
 567         __le16 txLifetime; /* in kusec */
 568         __le16 rxLifetime; /* in kusec */
 569         __le16 stationary;
 570         __le16 ordering;
 571         __le16 u16deviceType; /* for overriding device type */
 572         __le16 cfpRate;
 573         __le16 cfpDuration;
 574         __le16 _reserved1[3];
 575         /*---------- Scanning/Associating ----------*/
 576         __le16 scanMode;
 577 #define SCANMODE_ACTIVE cpu_to_le16(0)
 578 #define SCANMODE_PASSIVE cpu_to_le16(1)
 579 #define SCANMODE_AIROSCAN cpu_to_le16(2)
 580         __le16 probeDelay; /* in kusec */
 581         __le16 probeEnergyTimeout; /* in kusec */
 582         __le16 probeResponseTimeout;
 583         __le16 beaconListenTimeout;
 584         __le16 joinNetTimeout;
 585         __le16 authTimeout;
 586         __le16 authType;
 587 #define AUTH_OPEN cpu_to_le16(0x1)
 588 #define AUTH_ENCRYPT cpu_to_le16(0x101)
 589 #define AUTH_SHAREDKEY cpu_to_le16(0x102)
 590 #define AUTH_ALLOW_UNENCRYPTED cpu_to_le16(0x200)
 591         __le16 associationTimeout;
 592         __le16 specifiedApTimeout;
 593         __le16 offlineScanInterval;
 594         __le16 offlineScanDuration;
 595         __le16 linkLossDelay;
 596         __le16 maxBeaconLostTime;
 597         __le16 refreshInterval;
 598 #define DISABLE_REFRESH cpu_to_le16(0xFFFF)
 599         __le16 _reserved1a[1];
 600         /*---------- Power save operation ----------*/
 601         __le16 powerSaveMode;
 602 #define POWERSAVE_CAM cpu_to_le16(0)
 603 #define POWERSAVE_PSP cpu_to_le16(1)
 604 #define POWERSAVE_PSPCAM cpu_to_le16(2)
 605         __le16 sleepForDtims;
 606         __le16 listenInterval;
 607         __le16 fastListenInterval;
 608         __le16 listenDecay;
 609         __le16 fastListenDelay;
 610         __le16 _reserved2[2];
 611         /*---------- Ap/Ibss config items ----------*/
 612         __le16 beaconPeriod;
 613         __le16 atimDuration;
 614         __le16 hopPeriod;
 615         __le16 channelSet;
 616         __le16 channel;
 617         __le16 dtimPeriod;
 618         __le16 bridgeDistance;
 619         __le16 radioID;
 620         /*---------- Radio configuration ----------*/
 621         __le16 radioType;
 622 #define RADIOTYPE_DEFAULT cpu_to_le16(0)
 623 #define RADIOTYPE_802_11 cpu_to_le16(1)
 624 #define RADIOTYPE_LEGACY cpu_to_le16(2)
 625         u8 rxDiversity;
 626         u8 txDiversity;
 627         __le16 txPower;
 628 #define TXPOWER_DEFAULT 0
 629         __le16 rssiThreshold;
 630 #define RSSI_DEFAULT 0
 631         __le16 modulation;
 632 #define PREAMBLE_AUTO cpu_to_le16(0)
 633 #define PREAMBLE_LONG cpu_to_le16(1)
 634 #define PREAMBLE_SHORT cpu_to_le16(2)
 635         __le16 preamble;
 636         __le16 homeProduct;
 637         __le16 radioSpecific;
 638         /*---------- Aironet Extensions ----------*/
 639         u8 nodeName[16];
 640         __le16 arlThreshold;
 641         __le16 arlDecay;
 642         __le16 arlDelay;
 643         __le16 _reserved4[1];
 644         /*---------- Aironet Extensions ----------*/
 645         u8 magicAction;
 646 #define MAGIC_ACTION_STSCHG 1
 647 #define MAGIC_ACTION_RESUME 2
 648 #define MAGIC_IGNORE_MCAST (1<<8)
 649 #define MAGIC_IGNORE_BCAST (1<<9)
 650 #define MAGIC_SWITCH_TO_PSP (0<<10)
 651 #define MAGIC_STAY_IN_CAM (1<<10)
 652         u8 magicControl;
 653         __le16 autoWake;
 654 } __packed;
 655
 656 typedef struct StatusRid StatusRid;
 657 struct StatusRid {
 658         __le16 len;
 659         u8 mac[ETH_ALEN];
 660         __le16 mode;
 661         __le16 errorCode;
 662         __le16 sigQuality;
 663         __le16 SSIDlen;
 664         char SSID[32];
 665         char apName[16];
 666         u8 bssid[4][ETH_ALEN];
 667         __le16 beaconPeriod;
 668         __le16 dimPeriod;
 669         __le16 atimDuration;
 670         __le16 hopPeriod;
 671         __le16 channelSet;
 672         __le16 channel;
 673         __le16 hopsToBackbone;
 674         __le16 apTotalLoad;
 675         __le16 generatedLoad;
 676         __le16 accumulatedArl;
 677         __le16 signalQuality;
 678         __le16 currentXmitRate;
 679         __le16 apDevExtensions;
 680         __le16 normalizedSignalStrength;
 681         __le16 shortPreamble;
 682         u8 apIP[4];
 683         u8 noisePercent; /* Noise percent in last second */
 684         u8 noisedBm; /* Noise dBm in last second */
 685         u8 noiseAvePercent; /* Noise percent in last minute */
 686         u8 noiseAvedBm; /* Noise dBm in last minute */
 687         u8 noiseMaxPercent; /* Highest noise percent in last minute */
 688         u8 noiseMaxdBm; /* Highest noise dbm in last minute */
 689         __le16 load;
 690         u8 carrier[4];
 691         __le16 assocStatus;
 692 #define STAT_NOPACKETS 0
 693 #define STAT_NOCARRIERSET 10
 694 #define STAT_GOTCARRIERSET 11
 695 #define STAT_WRONGSSID 20
 696 #define STAT_BADCHANNEL 25
 697 #define STAT_BADBITRATES 30
 698 #define STAT_BADPRIVACY 35
 699 #define STAT_APFOUND 40
 700 #define STAT_APREJECTED 50
 701 #define STAT_AUTHENTICATING 60
 702 #define STAT_DEAUTHENTICATED 61
 703 #define STAT_AUTHTIMEOUT 62
 704 #define STAT_ASSOCIATING 70
 705 #define STAT_DEASSOCIATED 71
 706 #define STAT_ASSOCTIMEOUT 72
 707 #define STAT_NOTAIROAP 73
 708 #define STAT_ASSOCIATED 80
 709 #define STAT_LEAPING 90
 710 #define STAT_LEAPFAILED 91
 711 #define STAT_LEAPTIMEDOUT 92
 712 #define STAT_LEAPCOMPLETE 93
 713 } __packed;
 714
 715 typedef struct StatsRid StatsRid;
 716 struct StatsRid {
 717         __le16 len;
 718         __le16 spacer;
 719         __le32 vals[100];
 720 } __packed;
 721
 722 typedef struct APListRid APListRid;
 723 struct APListRid {
 724         __le16 len;
 725         u8 ap[4][ETH_ALEN];
 726 } __packed;
 727
 728 typedef struct CapabilityRid CapabilityRid;
 729 struct CapabilityRid {
 730         __le16 len;
 731         char oui[3];
 732         char zero;
 733         __le16 prodNum;
 734         char manName[32];
 735         char prodName[16];
 736         char prodVer[8];
 737         char factoryAddr[ETH_ALEN];
 738         char aironetAddr[ETH_ALEN];
 739         __le16 radioType;
 740         __le16 country;
 741         char callid[ETH_ALEN];
 742         char supportedRates[8];
 743         char rxDiversity;
 744         char txDiversity;
 745         __le16 txPowerLevels[8];
 746         __le16 hardVer;
 747         __le16 hardCap;
 748         __le16 tempRange;
 749         __le16 softVer;
 750         __le16 softSubVer;
 751         __le16 interfaceVer;
 752         __le16 softCap;
 753         __le16 bootBlockVer;
 754         __le16 requiredHard;
 755         __le16 extSoftCap;
 756 } __packed;
 757
 758 /* Only present on firmware >= 5.30.17 */
 759 typedef struct BSSListRidExtra BSSListRidExtra;
 760 struct BSSListRidExtra {
 761   __le16 unknown[4];
 762   u8 fixed[12]; /* WLAN management frame */
 763   u8 iep[624];
 764 } __packed;
 765
 766 typedef struct BSSListRid BSSListRid;
 767 struct BSSListRid {
 768   __le16 len;
 769   __le16 index; /* First is 0 and 0xffff means end of list */
 770 #define RADIO_FH 1 /* Frequency hopping radio type */
 771 #define RADIO_DS 2 /* Direct sequence radio type */
 772 #define RADIO_TMA 4 /* Proprietary radio used in old cards (2500) */
 773   __le16 radioType;
 774   u8 bssid[ETH_ALEN]; /* Mac address of the BSS */
 775   u8 zero;
 776   u8 ssidLen;
 777   u8 ssid[32];
 778   __le16 dBm;
 779 #define CAP_ESS cpu_to_le16(1<<0)
 780 #define CAP_IBSS cpu_to_le16(1<<1)
 781 #define CAP_PRIVACY cpu_to_le16(1<<4)
 782 #define CAP_SHORTHDR cpu_to_le16(1<<5)
 783   __le16 cap;
 784   __le16 beaconInterval;
 785   u8 rates[8]; /* Same as rates for config rid */
 786   struct { /* For frequency hopping only */
 787     __le16 dwell;
 788     u8 hopSet;
 789     u8 hopPattern;
 790     u8 hopIndex;
 791     u8 fill;
 792   } fh;
 793   __le16 dsChannel;
 794   __le16 atimWindow;
 795
 796   /* Only present on firmware >= 5.30.17 */
 797   BSSListRidExtra extra;
 798 } __packed;
 799
 800 typedef struct {
 801   BSSListRid bss;
 802   struct list_head list;
 803 } BSSListElement;
 804
 805 typedef struct tdsRssiEntry tdsRssiEntry;
 806 struct tdsRssiEntry {
 807   u8 rssipct;
 808   u8 rssidBm;
 809 } __packed;
 810
 811 typedef struct tdsRssiRid tdsRssiRid;
 812 struct tdsRssiRid {
 813   u16 len;
 814   tdsRssiEntry x[256];
 815 } __packed;
 816
 817 typedef struct MICRid MICRid;
 818 struct MICRid {
 819         __le16 len;
 820         __le16 state;
 821         __le16 multicastValid;
 822         u8  multicast[16];
 823         __le16 unicastValid;
 824         u8  unicast[16];
 825 } __packed;
 826
 827 typedef struct MICBuffer MICBuffer;
 828 struct MICBuffer {
 829         __be16 typelen;
 830
 831         union {
 832             u8 snap[8];
 833             struct {
 834                 u8 dsap;
 835                 u8 ssap;
 836                 u8 control;
 837                 u8 orgcode[3];
 838                 u8 fieldtype[2];
 839             } llc;
 840         } u;
 841         __be32 mic;
 842         __be32 seq;
 843 } __packed;
 844
 845 typedef struct {
 846         u8 da[ETH_ALEN];
 847         u8 sa[ETH_ALEN];
 848 } etherHead;
 849
 850 #define TXCTL_TXOK (1<<1) /* report if tx is ok */
 851 #define TXCTL_TXEX (1<<2) /* report if tx fails */
 852 #define TXCTL_802_3 (0<<3) /* 802.3 packet */
 853 #define TXCTL_802_11 (1<<3) /* 802.11 mac packet */
 854 #define TXCTL_ETHERNET (0<<4) /* payload has ethertype */
 855 #define TXCTL_LLC (1<<4) /* payload is llc */
 856 #define TXCTL_RELEASE (0<<5) /* release after completion */
 857 #define TXCTL_NORELEASE (1<<5) /* on completion returns to host */
 858
 859 #define BUSY_FID 0x10000
 860
 861 #ifdef CISCO_EXT
 862 #define AIROMAGIC       0xa55a
 863 /* Warning : SIOCDEVPRIVATE may disapear during 2.5.X - Jean II */
 864 #ifdef SIOCIWFIRSTPRIV
 865 #ifdef SIOCDEVPRIVATE
 866 #define AIROOLDIOCTL    SIOCDEVPRIVATE
 867 #define AIROOLDIDIFC    AIROOLDIOCTL + 1
 868 #endif /* SIOCDEVPRIVATE */
 869 #else /* SIOCIWFIRSTPRIV */
 870 #define SIOCIWFIRSTPRIV SIOCDEVPRIVATE
 871 #endif /* SIOCIWFIRSTPRIV */
 872 /* This may be wrong. When using the new SIOCIWFIRSTPRIV range, we probably
 873  * should use only "GET" ioctls (last bit set to 1). "SET" ioctls are root
 874  * only and don't return the modified struct ifreq to the application which
 875  * is usually a problem. - Jean II */
 876 #define AIROIOCTL       SIOCIWFIRSTPRIV
 877 #define AIROIDIFC       AIROIOCTL + 1
 878
 879 /* Ioctl constants to be used in airo_ioctl.command */
 880
 881 #define AIROGCAP                0       // Capability rid
 882 #define AIROGCFG                1       // USED A LOT
 883 #define AIROGSLIST              2       // System ID list
 884 #define AIROGVLIST              3       // List of specified AP's
 885 #define AIROGDRVNAM             4       //  NOTUSED
 886 #define AIROGEHTENC             5       // NOTUSED
 887 #define AIROGWEPKTMP            6
 888 #define AIROGWEPKNV             7
 889 #define AIROGSTAT               8
 890 #define AIROGSTATSC32           9
 891 #define AIROGSTATSD32           10
 892 #define AIROGMICRID             11
 893 #define AIROGMICSTATS           12
 894 #define AIROGFLAGS              13
 895 #define AIROGID                 14
 896 #define AIRORRID                15
 897 #define AIRORSWVERSION          17
 898
 899 /* Leave gap of 40 commands after AIROGSTATSD32 for future */
 900
 901 #define AIROPCAP                AIROGSTATSD32 + 40
 902 #define AIROPVLIST              AIROPCAP      + 1
 903 #define AIROPSLIST              AIROPVLIST    + 1
 904 #define AIROPCFG                AIROPSLIST    + 1
 905 #define AIROPSIDS               AIROPCFG      + 1
 906 #define AIROPAPLIST             AIROPSIDS     + 1
 907 #define AIROPMACON              AIROPAPLIST   + 1       /* Enable mac  */
 908 #define AIROPMACOFF             AIROPMACON    + 1       /* Disable mac */
 909 #define AIROPSTCLR              AIROPMACOFF   + 1
 910 #define AIROPWEPKEY             AIROPSTCLR    + 1
 911 #define AIROPWEPKEYNV           AIROPWEPKEY   + 1
 912 #define AIROPLEAPPWD            AIROPWEPKEYNV + 1
 913 #define AIROPLEAPUSR            AIROPLEAPPWD  + 1
 914
 915 /* Flash codes */
 916
 917 #define AIROFLSHRST            AIROPWEPKEYNV  + 40
 918 #define AIROFLSHGCHR           AIROFLSHRST    + 1
 919 #define AIROFLSHSTFL           AIROFLSHGCHR   + 1
 920 #define AIROFLSHPCHR           AIROFLSHSTFL   + 1
 921 #define AIROFLPUTBUF           AIROFLSHPCHR   + 1
 922 #define AIRORESTART            AIROFLPUTBUF   + 1
 923
 924 #define FLASHSIZE       32768
 925 #define AUXMEMSIZE      (256 * 1024)
 926
 927 typedef struct aironet_ioctl {
 928         unsigned short command;         // What to do
 929         unsigned short len;             // Len of data
 930         unsigned short ridnum;          // rid number
 931         unsigned char __user *data;     // d-data
 932 } aironet_ioctl;
 933
 934 static const char swversion[] = "2.1";
 935 #endif /* CISCO_EXT */
 936
 937 #define NUM_MODULES       2
 938 #define MIC_MSGLEN_MAX    2400
 939 #define EMMH32_MSGLEN_MAX MIC_MSGLEN_MAX
 940 #define AIRO_DEF_MTU      2312
 941
 942 typedef struct {
 943         u32   size;            // size
 944         u8    enabled;         // MIC enabled or not
 945         u32   rxSuccess;       // successful packets received
 946         u32   rxIncorrectMIC;  // pkts dropped due to incorrect MIC comparison
 947         u32   rxNotMICed;      // pkts dropped due to not being MIC'd
 948         u32   rxMICPlummed;    // pkts dropped due to not having a MIC plummed
 949         u32   rxWrongSequence; // pkts dropped due to sequence number violation
 950         u32   reserve[32];
 951 } mic_statistics;
 952
 953 typedef struct {
 954         u32 coeff[((EMMH32_MSGLEN_MAX)+3)>>2];
 955         u64 accum;      // accumulated mic, reduced to u32 in final()
 956         int position;   // current position (byte offset) in message
 957         union {
 958                 u8  d8[4];
 959                 __be32 d32;
 960         } part; // saves partial message word across update() calls
 961 } emmh32_context;
 962
 963 typedef struct {
 964         emmh32_context seed;        // Context - the seed
 965         u32              rx;        // Received sequence number
 966         u32              tx;        // Tx sequence number
 967         u32              window;    // Start of window
 968         u8               valid;     // Flag to say if context is valid or not
 969         u8               key[16];
 970 } miccntx;
 971
 972 typedef struct {
 973         miccntx mCtx;           // Multicast context
 974         miccntx uCtx;           // Unicast context
 975 } mic_module;
 976
 977 typedef struct {
 978         unsigned int  rid: 16;
 979         unsigned int  len: 15;
 980         unsigned int  valid: 1;
 981         dma_addr_t host_addr;
 982 } Rid;
 983
 984 typedef struct {
 985         unsigned int  offset: 15;
 986         unsigned int  eoc: 1;
 987         unsigned int  len: 15;
 988         unsigned int  valid: 1;
 989         dma_addr_t host_addr;
 990 } TxFid;
 991
 992 struct rx_hdr {
 993         __le16 status, len;
 994         u8 rssi[2];
 995         u8 rate;
 996         u8 freq;
 997         __le16 tmp[4];
 998 } __packed;
 999
1000 typedef struct {
1001         unsigned int  ctl: 15;
1002         unsigned int  rdy: 1;
1003         unsigned int  len: 15;
1004         unsigned int  valid: 1;
1005         dma_addr_t host_addr;
1006 } RxFid;
1007
1008 /*
1009  * Host receive descriptor
1010  */
1011 typedef struct {
1012         unsigned char __iomem *card_ram_off; /* offset into card memory of the
1013                                                 desc */
1014         RxFid         rx_desc;               /* card receive descriptor */
1015         char          *virtual_host_addr;    /* virtual address of host receive
1016                                                 buffer */
1017         int           pending;
1018 } HostRxDesc;
1019
1020 /*
1021  * Host transmit descriptor
1022  */
1023 typedef struct {
1024         unsigned char __iomem *card_ram_off;         /* offset into card memory of the
1025                                                 desc */
1026         TxFid         tx_desc;               /* card transmit descriptor */
1027         char          *virtual_host_addr;    /* virtual address of host receive
1028                                                 buffer */
1029         int           pending;
1030 } HostTxDesc;
1031
1032 /*
1033  * Host RID descriptor
1034  */
1035 typedef struct {
1036         unsigned char __iomem *card_ram_off;      /* offset into card memory of the
1037                                              descriptor */
1038         Rid           rid_desc;           /* card RID descriptor */
1039         char          *virtual_host_addr; /* virtual address of host receive
1040                                              buffer */
1041 } HostRidDesc;
1042
1043 typedef struct {
1044         u16 sw0;
1045         u16 sw1;
1046         u16 status;
1047         u16 len;
1048 #define HOST_SET (1 << 0)
1049 #define HOST_INT_TX (1 << 1) /* Interrupt on successful TX */
1050 #define HOST_INT_TXERR (1 << 2) /* Interrupt on unseccessful TX */
1051 #define HOST_LCC_PAYLOAD (1 << 4) /* LLC payload, 0 = Ethertype */
1052 #define HOST_DONT_RLSE (1 << 5) /* Don't release buffer when done */
1053 #define HOST_DONT_RETRY (1 << 6) /* Don't retry trasmit */
1054 #define HOST_CLR_AID (1 << 7) /* clear AID failure */
1055 #define HOST_RTS (1 << 9) /* Force RTS use */
1056 #define HOST_SHORT (1 << 10) /* Do short preamble */
1057         u16 ctl;
1058         u16 aid;
1059         u16 retries;
1060         u16 fill;
1061 } TxCtlHdr;
1062
1063 typedef struct {
1064         u16 ctl;
1065         u16 duration;
1066         char addr1[6];
1067         char addr2[6];
1068         char addr3[6];
1069         u16 seq;
1070         char addr4[6];
1071 } WifiHdr;
1072
1073
1074 typedef struct {
1075         TxCtlHdr ctlhdr;
1076         u16 fill1;
1077         u16 fill2;
1078         WifiHdr wifihdr;
1079         u16 gaplen;
1080         u16 status;
1081 } WifiCtlHdr;
1082
1083 static WifiCtlHdr wifictlhdr8023 = {
1084         .ctlhdr = {
1085                 .ctl    = HOST_DONT_RLSE,
1086         }
1087 };
1088
1089 // A few details needed for WEP (Wireless Equivalent Privacy)
1090 #define MAX_KEY_SIZE 13                 // 128 (?) bits
1091 #define MIN_KEY_SIZE  5                 // 40 bits RC4 - WEP
1092 typedef struct wep_key_t {
1093         u16     len;
1094         u8      key[16];        /* 40-bit and 104-bit keys */
1095 } wep_key_t;
1096
1097 /* List of Wireless Handlers (new API) */
1098 static const struct iw_handler_def      airo_handler_def;
1099
1100 static const char version[] = "airo.c 0.6 (Ben Reed & Javier Achirica)";
1101
1102 struct airo_info;
1103
1104 static int get_dec_u16( char *buffer, int *start, int limit );
1105 static void OUT4500( struct airo_info *, u16 reg, u16 value );
1106 static unsigned short IN4500( struct airo_info *, u16 reg );
1107 static u16 setup_card(struct airo_info*, u8 *mac, int lock);
1108 static int enable_MAC(struct airo_info *ai, int lock);
1109 static void disable_MAC(struct airo_info *ai, int lock);
1110 static void enable_interrupts(struct airo_info*);
1111 static void disable_interrupts(struct airo_info*);
1112 static u16 issuecommand(struct airo_info*, Cmd *pCmd, Resp *pRsp);
1113 static int bap_setup(struct airo_info*, u16 rid, u16 offset, int whichbap);
1114 static int aux_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
1115                         int whichbap);
1116 static int fast_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
1117                          int whichbap);
1118 static int bap_write(struct airo_info*, const __le16 *pu16Src, int bytelen,
1119                      int whichbap);
1120 static int PC4500_accessrid(struct airo_info*, u16 rid, u16 accmd);
1121 static int PC4500_readrid(struct airo_info*, u16 rid, void *pBuf, int len, int lock);
1122 static int PC4500_writerid(struct airo_info*, u16 rid, const void
1123                            *pBuf, int len, int lock);
1124 static int do_writerid( struct airo_info*, u16 rid, const void *rid_data,
1125                         int len, int dummy );
1126 static u16 transmit_allocate(struct airo_info*, int lenPayload, int raw);
1127 static int transmit_802_3_packet(struct airo_info*, int len, char *pPacket);
1128 static int transmit_802_11_packet(struct airo_info*, int len, char *pPacket);
1129
1130 static int mpi_send_packet (struct net_device *dev);
1131 static void mpi_unmap_card(struct pci_dev *pci);
1132 static void mpi_receive_802_3(struct airo_info *ai);
1133 static void mpi_receive_802_11(struct airo_info *ai);
1134 static int waitbusy (struct airo_info *ai);
1135
1136 static irqreturn_t airo_interrupt( int irq, void* dev_id);
1137 static int airo_thread(void *data);
1138 static void timer_func( struct net_device *dev );
1139 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
1140 static struct iw_statistics *airo_get_wireless_stats (struct net_device *dev);
1141 static void airo_read_wireless_stats (struct airo_info *local);
1142 #ifdef CISCO_EXT
1143 static int readrids(struct net_device *dev, aironet_ioctl *comp);
1144 static int writerids(struct net_device *dev, aironet_ioctl *comp);
1145 static int flashcard(struct net_device *dev, aironet_ioctl *comp);
1146 #endif /* CISCO_EXT */
1147 static void micinit(struct airo_info *ai);
1148 static int micsetup(struct airo_info *ai);
1149 static int encapsulate(struct airo_info *ai, etherHead *pPacket, MICBuffer *buffer, int len);
1150 static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *pPacket, u16 payLen);
1151
1152 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi);
1153 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm);
1154
1155 static void airo_networks_free(struct airo_info *ai);
1156
1157 struct airo_info {
1158         struct net_device             *dev;
1159         struct list_head              dev_list;
1160         /* Note, we can have MAX_FIDS outstanding.  FIDs are 16-bits, so we
1161            use the high bit to mark whether it is in use. */
1162 #define MAX_FIDS 6
1163 #define MPI_MAX_FIDS 1
1164         u32                           fids[MAX_FIDS];
1165         ConfigRid config;
1166         char keyindex; // Used with auto wep
1167         char defindex; // Used with auto wep
1168         struct proc_dir_entry *proc_entry;
1169         spinlock_t aux_lock;
1170 #define FLAG_RADIO_OFF  0       /* User disabling of MAC */
1171 #define FLAG_RADIO_DOWN 1       /* ifup/ifdown disabling of MAC */
1172 #define FLAG_RADIO_MASK 0x03
1173 #define FLAG_ENABLED    2
1174 #define FLAG_ADHOC      3       /* Needed by MIC */
1175 #define FLAG_MIC_CAPABLE 4
1176 #define FLAG_UPDATE_MULTI 5
1177 #define FLAG_UPDATE_UNI 6
1178 #define FLAG_802_11     7
1179 #define FLAG_PROMISC    8       /* IFF_PROMISC 0x100 - include/linux/if.h */
1180 #define FLAG_PENDING_XMIT 9
1181 #define FLAG_PENDING_XMIT11 10
1182 #define FLAG_MPI        11
1183 #define FLAG_REGISTERED 12
1184 #define FLAG_COMMIT     13
1185 #define FLAG_RESET      14
1186 #define FLAG_FLASHING   15
1187 #define FLAG_WPA_CAPABLE        16
1188         unsigned long flags;
1189 #define JOB_DIE 0
1190 #define JOB_XMIT        1
1191 #define JOB_XMIT11      2
1192 #define JOB_STATS       3
1193 #define JOB_PROMISC     4
1194 #define JOB_MIC 5
1195 #define JOB_EVENT       6
1196 #define JOB_AUTOWEP     7
1197 #define JOB_WSTATS      8
1198 #define JOB_SCAN_RESULTS  9
1199         unsigned long jobs;
1200         int (*bap_read)(struct airo_info*, __le16 *pu16Dst, int bytelen,
1201                         int whichbap);
1202         unsigned short *flash;
1203         tdsRssiEntry *rssi;
1204         struct task_struct *list_bss_task;
1205         struct task_struct *airo_thread_task;
1206         struct semaphore sem;
1207         wait_queue_head_t thr_wait;
1208         unsigned long expires;
1209         struct {
1210                 struct sk_buff *skb;
1211                 int fid;
1212         } xmit, xmit11;
1213         struct net_device *wifidev;
1214         struct iw_statistics    wstats;         // wireless stats
1215         unsigned long           scan_timeout;   /* Time scan should be read */
1216         struct iw_spy_data      spy_data;
1217         struct iw_public_data   wireless_data;
1218         /* MIC stuff */
1219         struct crypto_cipher    *tfm;
1220         mic_module              mod[2];
1221         mic_statistics          micstats;
1222         HostRxDesc rxfids[MPI_MAX_FIDS]; // rx/tx/config MPI350 descriptors
1223         HostTxDesc txfids[MPI_MAX_FIDS];
1224         HostRidDesc config_desc;
1225         unsigned long ridbus; // phys addr of config_desc
1226         struct sk_buff_head txq;// tx queue used by mpi350 code
1227         struct pci_dev          *pci;
1228         unsigned char           __iomem *pcimem;
1229         unsigned char           __iomem *pciaux;
1230         unsigned char           *shared;
1231         dma_addr_t              shared_dma;
1232         pm_message_t            power;
1233         SsidRid                 *SSID;
1234         APListRid               APList;
1235 #define PCI_SHARED_LEN          2*MPI_MAX_FIDS*PKTSIZE+RIDSIZE
1236         char                    proc_name[IFNAMSIZ];
1237
1238         int                     wep_capable;
1239         int                     max_wep_idx;
1240         int                     last_auth;
1241
1242         /* WPA-related stuff */
1243         unsigned int bssListFirst;
1244         unsigned int bssListNext;
1245         unsigned int bssListRidLen;
1246
1247         struct list_head network_list;
1248         struct list_head network_free_list;
1249         BSSListElement *networks;
1250 };
1251
1252 static inline int bap_read(struct airo_info *ai, __le16 *pu16Dst, int bytelen,
1253                            int whichbap)
1254 {
1255         return ai->bap_read(ai, pu16Dst, bytelen, whichbap);
1256 }
1257
1258 static int setup_proc_entry( struct net_device *dev,
1259                              struct airo_info *apriv );
1260 static int takedown_proc_entry( struct net_device *dev,
1261                                 struct airo_info *apriv );
1262
1263 static int cmdreset(struct airo_info *ai);
1264 static int setflashmode (struct airo_info *ai);
1265 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime);
1266 static int flashputbuf(struct airo_info *ai);
1267 static int flashrestart(struct airo_info *ai,struct net_device *dev);
1268
1269 #define airo_print(type, name, fmt, args...) \
1270         printk(type DRV_NAME "(%s): " fmt "\n", name, ##args)
1271
1272 #define airo_print_info(name, fmt, args...) \
1273         airo_print(KERN_INFO, name, fmt, ##args)
1274
1275 #define airo_print_dbg(name, fmt, args...) \
1276         airo_print(KERN_DEBUG, name, fmt, ##args)
1277
1278 #define airo_print_warn(name, fmt, args...) \
1279         airo_print(KERN_WARNING, name, fmt, ##args)
1280
1281 #define airo_print_err(name, fmt, args...) \
1282         airo_print(KERN_ERR, name, fmt, ##args)
1283
1284 #define AIRO_FLASH(dev) (((struct airo_info *)dev->ml_priv)->flash)
1285
1286 /***********************************************************************
1287  *                              MIC ROUTINES                           *
1288  ***********************************************************************
1289  */
1290
1291 static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq);
1292 static void MoveWindow(miccntx *context, u32 micSeq);
1293 static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1294                            struct crypto_cipher *tfm);
1295 static void emmh32_init(emmh32_context *context);
1296 static void emmh32_update(emmh32_context *context, u8 *pOctets, int len);
1297 static void emmh32_final(emmh32_context *context, u8 digest[4]);
1298 static int flashpchar(struct airo_info *ai,int byte,int dwelltime);
1299
1300 static void age_mic_context(miccntx *cur, miccntx *old, u8 *key, int key_len,
1301                             struct crypto_cipher *tfm)
1302 {
1303         /* If the current MIC context is valid and its key is the same as
1304          * the MIC register, there's nothing to do.
1305          */
1306         if (cur->valid && (memcmp(cur->key, key, key_len) == 0))
1307                 return;
1308
1309         /* Age current mic Context */
1310         memcpy(old, cur, sizeof(*cur));
1311
1312         /* Initialize new context */
1313         memcpy(cur->key, key, key_len);
1314         cur->window  = 33; /* Window always points to the middle */
1315         cur->rx      = 0;  /* Rx Sequence numbers */
1316         cur->tx      = 0;  /* Tx sequence numbers */
1317         cur->valid   = 1;  /* Key is now valid */
1318
1319         /* Give key to mic seed */
1320         emmh32_setseed(&cur->seed, key, key_len, tfm);
1321 }
1322
1323 /* micinit - Initialize mic seed */
1324
1325 static void micinit(struct airo_info *ai)
1326 {
1327         MICRid mic_rid;
1328
1329         clear_bit(JOB_MIC, &ai->jobs);
1330         PC4500_readrid(ai, RID_MIC, &mic_rid, sizeof(mic_rid), 0);
1331         up(&ai->sem);
1332
1333         ai->micstats.enabled = (le16_to_cpu(mic_rid.state) & 0x00FF) ? 1 : 0;
1334         if (!ai->micstats.enabled) {
1335                 /* So next time we have a valid key and mic is enabled, we will
1336                  * update the sequence number if the key is the same as before.
1337                  */
1338                 ai->mod[0].uCtx.valid = 0;
1339                 ai->mod[0].mCtx.valid = 0;
1340                 return;
1341         }
1342
1343         if (mic_rid.multicastValid) {
1344                 age_mic_context(&ai->mod[0].mCtx, &ai->mod[1].mCtx,
1345                                 mic_rid.multicast, sizeof(mic_rid.multicast),
1346                                 ai->tfm);
1347         }
1348
1349         if (mic_rid.unicastValid) {
1350                 age_mic_context(&ai->mod[0].uCtx, &ai->mod[1].uCtx,
1351                                 mic_rid.unicast, sizeof(mic_rid.unicast),
1352                                 ai->tfm);
1353         }
1354 }
1355
1356 /* micsetup - Get ready for business */
1357
1358 static int micsetup(struct airo_info *ai) {
1359         int i;
1360
1361         if (ai->tfm == NULL)
1362                 ai->tfm = crypto_alloc_cipher("aes", 0, CRYPTO_ALG_ASYNC);
1363
1364         if (IS_ERR(ai->tfm)) {
1365                 airo_print_err(ai->dev->name, "failed to load transform for AES");
1366                 ai->tfm = NULL;
1367                 return ERROR;
1368         }
1369
1370         for (i=0; i < NUM_MODULES; i++) {
1371                 memset(&ai->mod[i].mCtx,0,sizeof(miccntx));
1372                 memset(&ai->mod[i].uCtx,0,sizeof(miccntx));
1373         }
1374         return SUCCESS;
1375 }
1376
1377 static const u8 micsnap[] = {0xAA,0xAA,0x03,0x00,0x40,0x96,0x00,0x02};
1378
1379 /*===========================================================================
1380  * Description: Mic a packet
1381  *
1382  *      Inputs: etherHead * pointer to an 802.3 frame
1383  *
1384  *     Returns: BOOLEAN if successful, otherwise false.
1385  *             PacketTxLen will be updated with the mic'd packets size.
1386  *
1387  *    Caveats: It is assumed that the frame buffer will already
1388  *             be big enough to hold the largets mic message possible.
1389  *            (No memory allocation is done here).
1390  *
1391  *    Author: sbraneky (10/15/01)
1392  *    Merciless hacks by rwilcher (1/14/02)
1393  */
1394
1395 static int encapsulate(struct airo_info *ai ,etherHead *frame, MICBuffer *mic, int payLen)
1396 {
1397         miccntx   *context;
1398
1399         // Determine correct context
1400         // If not adhoc, always use unicast key
1401
1402         if (test_bit(FLAG_ADHOC, &ai->flags) && (frame->da[0] & 0x1))
1403                 context = &ai->mod[0].mCtx;
1404         else
1405                 context = &ai->mod[0].uCtx;
1406
1407         if (!context->valid)
1408                 return ERROR;
1409
1410         mic->typelen = htons(payLen + 16); //Length of Mic'd packet
1411
1412         memcpy(&mic->u.snap, micsnap, sizeof(micsnap)); // Add Snap
1413
1414         // Add Tx sequence
1415         mic->seq = htonl(context->tx);
1416         context->tx += 2;
1417
1418         emmh32_init(&context->seed); // Mic the packet
1419         emmh32_update(&context->seed,frame->da,ETH_ALEN * 2); // DA,SA
1420         emmh32_update(&context->seed,(u8*)&mic->typelen,10); // Type/Length and Snap
1421         emmh32_update(&context->seed,(u8*)&mic->seq,sizeof(mic->seq)); //SEQ
1422         emmh32_update(&context->seed,(u8*)(frame + 1),payLen); //payload
1423         emmh32_final(&context->seed, (u8*)&mic->mic);
1424
1425         /*    New Type/length ?????????? */
1426         mic->typelen = 0; //Let NIC know it could be an oversized packet
1427         return SUCCESS;
1428 }
1429
1430 typedef enum {
1431     NONE,
1432     NOMIC,
1433     NOMICPLUMMED,
1434     SEQUENCE,
1435     INCORRECTMIC,
1436 } mic_error;
1437
1438 /*===========================================================================
1439  *  Description: Decapsulates a MIC'd packet and returns the 802.3 packet
1440  *               (removes the MIC stuff) if packet is a valid packet.
1441  *
1442  *       Inputs: etherHead  pointer to the 802.3 packet
1443  *
1444  *      Returns: BOOLEAN - TRUE if packet should be dropped otherwise FALSE
1445  *
1446  *      Author: sbraneky (10/15/01)
1447  *    Merciless hacks by rwilcher (1/14/02)
1448  *---------------------------------------------------------------------------
1449  */
1450
1451 static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *eth, u16 payLen)
1452 {
1453         int      i;
1454         u32      micSEQ;
1455         miccntx  *context;
1456         u8       digest[4];
1457         mic_error micError = NONE;
1458
1459         // Check if the packet is a Mic'd packet
1460
1461         if (!ai->micstats.enabled) {
1462                 //No Mic set or Mic OFF but we received a MIC'd packet.
1463                 if (memcmp ((u8*)eth + 14, micsnap, sizeof(micsnap)) == 0) {
1464                         ai->micstats.rxMICPlummed++;
1465                         return ERROR;
1466                 }
1467                 return SUCCESS;
1468         }
1469
1470         if (ntohs(mic->typelen) == 0x888E)
1471                 return SUCCESS;
1472
1473         if (memcmp (mic->u.snap, micsnap, sizeof(micsnap)) != 0) {
1474             // Mic enabled but packet isn't Mic'd
1475                 ai->micstats.rxMICPlummed++;
1476                 return ERROR;
1477         }
1478
1479         micSEQ = ntohl(mic->seq);            //store SEQ as CPU order
1480
1481         //At this point we a have a mic'd packet and mic is enabled
1482         //Now do the mic error checking.
1483
1484         //Receive seq must be odd
1485         if ( (micSEQ & 1) == 0 ) {
1486                 ai->micstats.rxWrongSequence++;
1487                 return ERROR;
1488         }
1489
1490         for (i = 0; i < NUM_MODULES; i++) {
1491                 int mcast = eth->da[0] & 1;
1492                 //Determine proper context
1493                 context = mcast ? &ai->mod[i].mCtx : &ai->mod[i].uCtx;
1494
1495                 //Make sure context is valid
1496                 if (!context->valid) {
1497                         if (i == 0)
1498                                 micError = NOMICPLUMMED;
1499                         continue;
1500                 }
1501                 //DeMic it
1502
1503                 if (!mic->typelen)
1504                         mic->typelen = htons(payLen + sizeof(MICBuffer) - 2);
1505
1506                 emmh32_init(&context->seed);
1507                 emmh32_update(&context->seed, eth->da, ETH_ALEN*2);
1508                 emmh32_update(&context->seed, (u8 *)&mic->typelen, sizeof(mic->typelen)+sizeof(mic->u.snap));
1509                 emmh32_update(&context->seed, (u8 *)&mic->seq,sizeof(mic->seq));
1510                 emmh32_update(&context->seed, (u8 *)(eth + 1),payLen);
1511                 //Calculate MIC
1512                 emmh32_final(&context->seed, digest);
1513
1514                 if (memcmp(digest, &mic->mic, 4)) { //Make sure the mics match
1515                   //Invalid Mic
1516                         if (i == 0)
1517                                 micError = INCORRECTMIC;
1518                         continue;
1519                 }
1520
1521                 //Check Sequence number if mics pass
1522                 if (RxSeqValid(ai, context, mcast, micSEQ) == SUCCESS) {
1523                         ai->micstats.rxSuccess++;
1524                         return SUCCESS;
1525                 }
1526                 if (i == 0)
1527                         micError = SEQUENCE;
1528         }
1529
1530         // Update statistics
1531         switch (micError) {
1532                 case NOMICPLUMMED: ai->micstats.rxMICPlummed++;   break;
1533                 case SEQUENCE:    ai->micstats.rxWrongSequence++; break;
1534                 case INCORRECTMIC: ai->micstats.rxIncorrectMIC++; break;
1535                 case NONE:  break;
1536                 case NOMIC: break;
1537         }
1538         return ERROR;
1539 }
1540
1541 /*===========================================================================
1542  * Description:  Checks the Rx Seq number to make sure it is valid
1543  *               and hasn't already been received
1544  *
1545  *     Inputs: miccntx - mic context to check seq against
1546  *             micSeq  - the Mic seq number
1547  *
1548  *    Returns: TRUE if valid otherwise FALSE.
1549  *
1550  *    Author: sbraneky (10/15/01)
1551  *    Merciless hacks by rwilcher (1/14/02)
1552  *---------------------------------------------------------------------------
1553  */
1554
1555 static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq)
1556 {
1557         u32 seq,index;
1558
1559         //Allow for the ap being rebooted - if it is then use the next
1560         //sequence number of the current sequence number - might go backwards
1561
1562         if (mcast) {
1563                 if (test_bit(FLAG_UPDATE_MULTI, &ai->flags)) {
1564                         clear_bit (FLAG_UPDATE_MULTI, &ai->flags);
1565                         context->window = (micSeq > 33) ? micSeq : 33;
1566                         context->rx     = 0;        // Reset rx
1567                 }
1568         } else if (test_bit(FLAG_UPDATE_UNI, &ai->flags)) {
1569                 clear_bit (FLAG_UPDATE_UNI, &ai->flags);
1570                 context->window = (micSeq > 33) ? micSeq : 33; // Move window
1571                 context->rx     = 0;        // Reset rx
1572         }
1573
1574         //Make sequence number relative to START of window
1575         seq = micSeq - (context->window - 33);
1576
1577         //Too old of a SEQ number to check.
1578         if ((s32)seq < 0)
1579                 return ERROR;
1580
1581         if ( seq > 64 ) {
1582                 //Window is infinite forward
1583                 MoveWindow(context,micSeq);
1584                 return SUCCESS;
1585         }
1586
1587         // We are in the window. Now check the context rx bit to see if it was already sent
1588         seq >>= 1;         //divide by 2 because we only have odd numbers
1589         index = 1 << seq;  //Get an index number
1590
1591         if (!(context->rx & index)) {
1592                 //micSEQ falls inside the window.
1593                 //Add seqence number to the list of received numbers.
1594                 context->rx |= index;
1595
1596                 MoveWindow(context,micSeq);
1597
1598                 return SUCCESS;
1599         }
1600         return ERROR;
1601 }
1602
1603 static void MoveWindow(miccntx *context, u32 micSeq)
1604 {
1605         u32 shift;
1606
1607         //Move window if seq greater than the middle of the window
1608         if (micSeq > context->window) {
1609                 shift = (micSeq - context->window) >> 1;
1610
1611                     //Shift out old
1612                 if (shift < 32)
1613                         context->rx >>= shift;
1614                 else
1615                         context->rx = 0;
1616
1617                 context->window = micSeq;      //Move window
1618         }
1619 }
1620
1621 /*==============================================*/
1622 /*========== EMMH ROUTINES  ====================*/
1623 /*==============================================*/
1624
1625 /* mic accumulate */
1626 #define MIC_ACCUM(val)  \
1627         context->accum += (u64)(val) * context->coeff[coeff_position++];
1628
1629 static unsigned char aes_counter[16];
1630
1631 /* expand the key to fill the MMH coefficient array */
1632 static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1633                            struct crypto_cipher *tfm)
1634 {
1635   /* take the keying material, expand if necessary, truncate at 16-bytes */
1636   /* run through AES counter mode to generate context->coeff[] */
1637
1638         int i,j;
1639         u32 counter;
1640         u8 *cipher, plain[16];
1641
1642         crypto_cipher_setkey(tfm, pkey, 16);
1643         counter = 0;
1644         for (i = 0; i < ARRAY_SIZE(context->coeff); ) {
1645                 aes_counter[15] = (u8)(counter >> 0);
1646                 aes_counter[14] = (u8)(counter >> 8);
1647                 aes_counter[13] = (u8)(counter >> 16);
1648                 aes_counter[12] = (u8)(counter >> 24);
1649                 counter++;
1650                 memcpy (plain, aes_counter, 16);
1651                 crypto_cipher_encrypt_one(tfm, plain, plain);
1652                 cipher = plain;
1653                 for (j = 0; (j < 16) && (i < ARRAY_SIZE(context->coeff)); ) {
1654                         context->coeff[i++] = ntohl(*(__be32 *)&cipher[j]);
1655                         j += 4;
1656                 }
1657         }
1658 }
1659
1660 /* prepare for calculation of a new mic */
1661 static void emmh32_init(emmh32_context *context)
1662 {
1663         /* prepare for new mic calculation */
1664         context->accum = 0;
1665         context->position = 0;
1666 }
1667
1668 /* add some bytes to the mic calculation */
1669 static void emmh32_update(emmh32_context *context, u8 *pOctets, int len)
1670 {
1671         int     coeff_position, byte_position;
1672
1673         if (len == 0) return;
1674
1675         coeff_position = context->position >> 2;
1676
1677         /* deal with partial 32-bit word left over from last update */
1678         byte_position = context->position & 3;
1679         if (byte_position) {
1680                 /* have a partial word in part to deal with */
1681                 do {
1682                         if (len == 0) return;
1683                         context->part.d8[byte_position++] = *pOctets++;
1684                         context->position++;
1685                         len--;
1686                 } while (byte_position < 4);
1687                 MIC_ACCUM(ntohl(context->part.d32));
1688         }
1689
1690         /* deal with full 32-bit words */
1691         while (len >= 4) {
1692                 MIC_ACCUM(ntohl(*(__be32 *)pOctets));
1693                 context->position += 4;
1694                 pOctets += 4;
1695                 len -= 4;
1696         }
1697
1698         /* deal with partial 32-bit word that will be left over from this update */
1699         byte_position = 0;
1700         while (len > 0) {
1701                 context->part.d8[byte_position++] = *pOctets++;
1702                 context->position++;
1703                 len--;
1704         }
1705 }
1706
1707 /* mask used to zero empty bytes for final partial word */
1708 static u32 mask32[4] = { 0x00000000L, 0xFF000000L, 0xFFFF0000L, 0xFFFFFF00L };
1709
1710 /* calculate the mic */
1711 static void emmh32_final(emmh32_context *context, u8 digest[4])
1712 {
1713         int     coeff_position, byte_position;
1714         u32     val;
1715
1716         u64 sum, utmp;
1717         s64 stmp;
1718
1719         coeff_position = context->position >> 2;
1720
1721         /* deal with partial 32-bit word left over from last update */
1722         byte_position = context->position & 3;
1723         if (byte_position) {
1724                 /* have a partial word in part to deal with */
1725                 val = ntohl(context->part.d32);
1726                 MIC_ACCUM(val & mask32[byte_position]); /* zero empty bytes */
1727         }
1728
1729         /* reduce the accumulated u64 to a 32-bit MIC */
1730         sum = context->accum;
1731         stmp = (sum  & 0xffffffffLL) - ((sum >> 32)  * 15);
1732         utmp = (stmp & 0xffffffffLL) - ((stmp >> 32) * 15);
1733         sum = utmp & 0xffffffffLL;
1734         if (utmp > 0x10000000fLL)
1735                 sum -= 15;
1736
1737         val = (u32)sum;
1738         digest[0] = (val>>24) & 0xFF;
1739         digest[1] = (val>>16) & 0xFF;
1740         digest[2] = (val>>8) & 0xFF;
1741         digest[3] = val & 0xFF;
1742 }
1743
1744 static int readBSSListRid(struct airo_info *ai, int first,
1745                       BSSListRid *list)
1746 {
1747         Cmd cmd;
1748         Resp rsp;
1749
1750         if (first == 1) {
1751                 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
1752                 memset(&cmd, 0, sizeof(cmd));
1753                 cmd.cmd=CMD_LISTBSS;
1754                 if (down_interruptible(&ai->sem))
1755                         return -ERESTARTSYS;
1756                 ai->list_bss_task = current;
1757                 issuecommand(ai, &cmd, &rsp);
1758                 up(&ai->sem);
1759                 /* Let the command take effect */
1760                 schedule_timeout_uninterruptible(3 * HZ);
1761                 ai->list_bss_task = NULL;
1762         }
1763         return PC4500_readrid(ai, first ? ai->bssListFirst : ai->bssListNext,
1764                             list, ai->bssListRidLen, 1);
1765 }
1766
1767 static int readWepKeyRid(struct airo_info *ai, WepKeyRid *wkr, int temp, int lock)
1768 {
1769         return PC4500_readrid(ai, temp ? RID_WEP_TEMP : RID_WEP_PERM,
1770                                 wkr, sizeof(*wkr), lock);
1771 }
1772
1773 static int writeWepKeyRid(struct airo_info *ai, WepKeyRid *wkr, int perm, int lock)
1774 {
1775         int rc;
1776         rc = PC4500_writerid(ai, RID_WEP_TEMP, wkr, sizeof(*wkr), lock);
1777         if (rc!=SUCCESS)
1778                 airo_print_err(ai->dev->name, "WEP_TEMP set %x", rc);
1779         if (perm) {
1780                 rc = PC4500_writerid(ai, RID_WEP_PERM, wkr, sizeof(*wkr), lock);
1781                 if (rc!=SUCCESS)
1782                         airo_print_err(ai->dev->name, "WEP_PERM set %x", rc);
1783         }
1784         return rc;
1785 }
1786
1787 static int readSsidRid(struct airo_info*ai, SsidRid *ssidr)
1788 {
1789         return PC4500_readrid(ai, RID_SSID, ssidr, sizeof(*ssidr), 1);
1790 }
1791
1792 static int writeSsidRid(struct airo_info*ai, SsidRid *pssidr, int lock)
1793 {
1794         return PC4500_writerid(ai, RID_SSID, pssidr, sizeof(*pssidr), lock);
1795 }
1796
1797 static int readConfigRid(struct airo_info *ai, int lock)
1798 {
1799         int rc;
1800         ConfigRid cfg;
1801
1802         if (ai->config.len)
1803                 return SUCCESS;
1804
1805         rc = PC4500_readrid(ai, RID_ACTUALCONFIG, &cfg, sizeof(cfg), lock);
1806         if (rc != SUCCESS)
1807                 return rc;
1808
1809         ai->config = cfg;
1810         return SUCCESS;
1811 }
1812
1813 static inline void checkThrottle(struct airo_info *ai)
1814 {
1815         int i;
1816 /* Old hardware had a limit on encryption speed */
1817         if (ai->config.authType != AUTH_OPEN && maxencrypt) {
1818                 for(i=0; i<8; i++) {
1819                         if (ai->config.rates[i] > maxencrypt) {
1820                                 ai->config.rates[i] = 0;
1821                         }
1822                 }
1823         }
1824 }
1825
1826 static int writeConfigRid(struct airo_info *ai, int lock)
1827 {
1828         ConfigRid cfgr;
1829
1830         if (!test_bit (FLAG_COMMIT, &ai->flags))
1831                 return SUCCESS;
1832
1833         clear_bit (FLAG_COMMIT, &ai->flags);
1834         clear_bit (FLAG_RESET, &ai->flags);
1835         checkThrottle(ai);
1836         cfgr = ai->config;
1837
1838         if ((cfgr.opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
1839                 set_bit(FLAG_ADHOC, &ai->flags);
1840         else
1841                 clear_bit(FLAG_ADHOC, &ai->flags);
1842
1843         return PC4500_writerid( ai, RID_CONFIG, &cfgr, sizeof(cfgr), lock);
1844 }
1845
1846 static int readStatusRid(struct airo_info *ai, StatusRid *statr, int lock)
1847 {
1848         return PC4500_readrid(ai, RID_STATUS, statr, sizeof(*statr), lock);
1849 }
1850
1851 static int writeAPListRid(struct airo_info *ai, APListRid *aplr, int lock)
1852 {
1853         return PC4500_writerid(ai, RID_APLIST, aplr, sizeof(*aplr), lock);
1854 }
1855
1856 static int readCapabilityRid(struct airo_info *ai, CapabilityRid *capr, int lock)
1857 {
1858         return PC4500_readrid(ai, RID_CAPABILITIES, capr, sizeof(*capr), lock);
1859 }
1860
1861 static int readStatsRid(struct airo_info*ai, StatsRid *sr, int rid, int lock)
1862 {
1863         return PC4500_readrid(ai, rid, sr, sizeof(*sr), lock);
1864 }
1865
1866 static void try_auto_wep(struct airo_info *ai)
1867 {
1868         if (auto_wep && !test_bit(FLAG_RADIO_DOWN, &ai->flags)) {
1869                 ai->expires = RUN_AT(3*HZ);
1870                 wake_up_interruptible(&ai->thr_wait);
1871         }
1872 }
1873
1874 static int airo_open(struct net_device *dev) {
1875         struct airo_info *ai = dev->ml_priv;
1876         int rc = 0;
1877
1878         if (test_bit(FLAG_FLASHING, &ai->flags))
1879                 return -EIO;
1880
1881         /* Make sure the card is configured.
1882          * Wireless Extensions may postpone config changes until the card
1883          * is open (to pipeline changes and speed-up card setup). If
1884          * those changes are not yet committed, do it now - Jean II */
1885         if (test_bit(FLAG_COMMIT, &ai->flags)) {
1886                 disable_MAC(ai, 1);
1887                 writeConfigRid(ai, 1);
1888         }
1889
1890         if (ai->wifidev != dev) {
1891                 clear_bit(JOB_DIE, &ai->jobs);
1892                 ai->airo_thread_task = kthread_run(airo_thread, dev, "%s",
1893                                                    dev->name);
1894                 if (IS_ERR(ai->airo_thread_task))
1895                         return (int)PTR_ERR(ai->airo_thread_task);
1896
1897                 rc = request_irq(dev->irq, airo_interrupt, IRQF_SHARED,
1898                         dev->name, dev);
1899                 if (rc) {
1900                         airo_print_err(dev->name,
1901                                 "register interrupt %d failed, rc %d",
1902                                 dev->irq, rc);
1903                         set_bit(JOB_DIE, &ai->jobs);
1904                         kthread_stop(ai->airo_thread_task);
1905                         return rc;
1906                 }
1907
1908                 /* Power on the MAC controller (which may have been disabled) */
1909                 clear_bit(FLAG_RADIO_DOWN, &ai->flags);
1910                 enable_interrupts(ai);
1911
1912                 try_auto_wep(ai);
1913         }
1914         enable_MAC(ai, 1);
1915
1916         netif_start_queue(dev);
1917         return 0;
1918 }
1919
1920 static netdev_tx_t mpi_start_xmit(struct sk_buff *skb,
1921                                         struct net_device *dev)
1922 {
1923         int npacks, pending;
1924         unsigned long flags;
1925         struct airo_info *ai = dev->ml_priv;
1926
1927         if (!skb) {
1928                 airo_print_err(dev->name, "%s: skb == NULL!",__func__);
1929                 return NETDEV_TX_OK;
1930         }
1931         if (skb_padto(skb, ETH_ZLEN)) {
1932                 dev->stats.tx_dropped++;
1933                 return NETDEV_TX_OK;
1934         }
1935         npacks = skb_queue_len (&ai->txq);
1936
1937         if (npacks >= MAXTXQ - 1) {
1938                 netif_stop_queue (dev);
1939                 if (npacks > MAXTXQ) {
1940                         dev->stats.tx_fifo_errors++;
1941                         return NETDEV_TX_BUSY;
1942                 }
1943                 skb_queue_tail (&ai->txq, skb);
1944                 return NETDEV_TX_OK;
1945         }
1946
1947         spin_lock_irqsave(&ai->aux_lock, flags);
1948         skb_queue_tail (&ai->txq, skb);
1949         pending = test_bit(FLAG_PENDING_XMIT, &ai->flags);
1950         spin_unlock_irqrestore(&ai->aux_lock,flags);
1951         netif_wake_queue (dev);
1952
1953         if (pending == 0) {
1954                 set_bit(FLAG_PENDING_XMIT, &ai->flags);
1955                 mpi_send_packet (dev);
1956         }
1957         return NETDEV_TX_OK;
1958 }
1959
1960 /*
1961  * @mpi_send_packet
1962  *
1963  * Attempt to transmit a packet. Can be called from interrupt
1964  * or transmit . return number of packets we tried to send
1965  */
1966
1967 static int mpi_send_packet (struct net_device *dev)
1968 {
1969         struct sk_buff *skb;
1970         unsigned char *buffer;
1971         s16 len;
1972         __le16 *payloadLen;
1973         struct airo_info *ai = dev->ml_priv;
1974         u8 *sendbuf;
1975
1976         /* get a packet to send */
1977
1978         if ((skb = skb_dequeue(&ai->txq)) == NULL) {
1979                 airo_print_err(dev->name,
1980                         "%s: Dequeue'd zero in send_packet()",
1981                         __func__);
1982                 return 0;
1983         }
1984
1985         /* check min length*/
1986         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
1987         buffer = skb->data;
1988
1989         ai->txfids[0].tx_desc.offset = 0;
1990         ai->txfids[0].tx_desc.valid = 1;
1991         ai->txfids[0].tx_desc.eoc = 1;
1992         ai->txfids[0].tx_desc.len =len+sizeof(WifiHdr);
1993
1994 /*
1995  * Magic, the cards firmware needs a length count (2 bytes) in the host buffer
1996  * right after  TXFID_HDR.The TXFID_HDR contains the status short so payloadlen
1997  * is immediately after it. ------------------------------------------------
1998  *                         |TXFIDHDR+STATUS|PAYLOADLEN|802.3HDR|PACKETDATA|
1999  *                         ------------------------------------------------
2000  */
2001
2002         memcpy(ai->txfids[0].virtual_host_addr,
2003                 (char *)&wifictlhdr8023, sizeof(wifictlhdr8023));
2004
2005         payloadLen = (__le16 *)(ai->txfids[0].virtual_host_addr +
2006                 sizeof(wifictlhdr8023));
2007         sendbuf = ai->txfids[0].virtual_host_addr +
2008                 sizeof(wifictlhdr8023) + 2 ;
2009
2010         /*
2011          * Firmware automatically puts 802 header on so
2012          * we don't need to account for it in the length
2013          */
2014         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
2015                 (ntohs(((__be16 *)buffer)[6]) != 0x888E)) {
2016                 MICBuffer pMic;
2017
2018                 if (encapsulate(ai, (etherHead *)buffer, &pMic, len - sizeof(etherHead)) != SUCCESS)
2019                         return ERROR;
2020
2021                 *payloadLen = cpu_to_le16(len-sizeof(etherHead)+sizeof(pMic));
2022                 ai->txfids[0].tx_desc.len += sizeof(pMic);
2023                 /* copy data into airo dma buffer */
2024                 memcpy (sendbuf, buffer, sizeof(etherHead));
2025                 buffer += sizeof(etherHead);
2026                 sendbuf += sizeof(etherHead);
2027                 memcpy (sendbuf, &pMic, sizeof(pMic));
2028                 sendbuf += sizeof(pMic);
2029                 memcpy (sendbuf, buffer, len - sizeof(etherHead));
2030         } else {
2031                 *payloadLen = cpu_to_le16(len - sizeof(etherHead));
2032
2033                 netif_trans_update(dev);
2034
2035                 /* copy data into airo dma buffer */
2036                 memcpy(sendbuf, buffer, len);
2037         }
2038
2039         memcpy_toio(ai->txfids[0].card_ram_off,
2040                 &ai->txfids[0].tx_desc, sizeof(TxFid));
2041
2042         OUT4500(ai, EVACK, 8);
2043
2044         dev_kfree_skb_any(skb);
2045         return 1;
2046 }
2047
2048 static void get_tx_error(struct airo_info *ai, s32 fid)
2049 {
2050         __le16 status;
2051
2052         if (fid < 0)
2053                 status = ((WifiCtlHdr *)ai->txfids[0].virtual_host_addr)->ctlhdr.status;
2054         else {
2055                 if (bap_setup(ai, ai->fids[fid] & 0xffff, 4, BAP0) != SUCCESS)
2056                         return;
2057                 bap_read(ai, &status, 2, BAP0);
2058         }
2059         if (le16_to_cpu(status) & 2) /* Too many retries */
2060                 ai->dev->stats.tx_aborted_errors++;
2061         if (le16_to_cpu(status) & 4) /* Transmit lifetime exceeded */
2062                 ai->dev->stats.tx_heartbeat_errors++;
2063         if (le16_to_cpu(status) & 8) /* Aid fail */
2064                 { }
2065         if (le16_to_cpu(status) & 0x10) /* MAC disabled */
2066                 ai->dev->stats.tx_carrier_errors++;
2067         if (le16_to_cpu(status) & 0x20) /* Association lost */
2068                 { }
2069         /* We produce a TXDROP event only for retry or lifetime
2070          * exceeded, because that's the only status that really mean
2071          * that this particular node went away.
2072          * Other errors means that *we* screwed up. - Jean II */
2073         if ((le16_to_cpu(status) & 2) ||
2074              (le16_to_cpu(status) & 4)) {
2075                 union iwreq_data        wrqu;
2076                 char junk[0x18];
2077
2078                 /* Faster to skip over useless data than to do
2079                  * another bap_setup(). We are at offset 0x6 and
2080                  * need to go to 0x18 and read 6 bytes - Jean II */
2081                 bap_read(ai, (__le16 *) junk, 0x18, BAP0);
2082
2083                 /* Copy 802.11 dest address.
2084                  * We use the 802.11 header because the frame may
2085                  * not be 802.3 or may be mangled...
2086                  * In Ad-Hoc mode, it will be the node address.
2087                  * In managed mode, it will be most likely the AP addr
2088                  * User space will figure out how to convert it to
2089                  * whatever it needs (IP address or else).
2090                  * - Jean II */
2091                 memcpy(wrqu.addr.sa_data, junk + 0x12, ETH_ALEN);
2092                 wrqu.addr.sa_family = ARPHRD_ETHER;
2093
2094                 /* Send event to user space */
2095                 wireless_send_event(ai->dev, IWEVTXDROP, &wrqu, NULL);
2096         }
2097 }
2098
2099 static void airo_end_xmit(struct net_device *dev) {
2100         u16 status;
2101         int i;
2102         struct airo_info *priv = dev->ml_priv;
2103         struct sk_buff *skb = priv->xmit.skb;
2104         int fid = priv->xmit.fid;
2105         u32 *fids = priv->fids;
2106
2107         clear_bit(JOB_XMIT, &priv->jobs);
2108         clear_bit(FLAG_PENDING_XMIT, &priv->flags);
2109         status = transmit_802_3_packet (priv, fids[fid], skb->data);
2110         up(&priv->sem);
2111
2112         i = 0;
2113         if ( status == SUCCESS ) {
2114                 netif_trans_update(dev);
2115                 for (; i < MAX_FIDS / 2 && (priv->fids[i] & 0xffff0000); i++);
2116         } else {
2117                 priv->fids[fid] &= 0xffff;
2118                 dev->stats.tx_window_errors++;
2119         }
2120         if (i < MAX_FIDS / 2)
2121                 netif_wake_queue(dev);
2122         dev_kfree_skb(skb);
2123 }
2124
2125 static netdev_tx_t airo_start_xmit(struct sk_buff *skb,
2126                                          struct net_device *dev)
2127 {
2128         s16 len;
2129         int i, j;
2130         struct airo_info *priv = dev->ml_priv;
2131         u32 *fids = priv->fids;
2132
2133         if ( skb == NULL ) {
2134                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2135                 return NETDEV_TX_OK;
2136         }
2137         if (skb_padto(skb, ETH_ZLEN)) {
2138                 dev->stats.tx_dropped++;
2139                 return NETDEV_TX_OK;
2140         }
2141
2142         /* Find a vacant FID */
2143         for( i = 0; i < MAX_FIDS / 2 && (fids[i] & 0xffff0000); i++ );
2144         for( j = i + 1; j < MAX_FIDS / 2 && (fids[j] & 0xffff0000); j++ );
2145
2146         if ( j >= MAX_FIDS / 2 ) {
2147                 netif_stop_queue(dev);
2148
2149                 if (i == MAX_FIDS / 2) {
2150                         dev->stats.tx_fifo_errors++;
2151                         return NETDEV_TX_BUSY;
2152                 }
2153         }
2154         /* check min length*/
2155         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2156         /* Mark fid as used & save length for later */
2157         fids[i] |= (len << 16);
2158         priv->xmit.skb = skb;
2159         priv->xmit.fid = i;
2160         if (down_trylock(&priv->sem) != 0) {
2161                 set_bit(FLAG_PENDING_XMIT, &priv->flags);
2162                 netif_stop_queue(dev);
2163                 set_bit(JOB_XMIT, &priv->jobs);
2164                 wake_up_interruptible(&priv->thr_wait);
2165         } else
2166                 airo_end_xmit(dev);
2167         return NETDEV_TX_OK;
2168 }
2169
2170 static void airo_end_xmit11(struct net_device *dev) {
2171         u16 status;
2172         int i;
2173         struct airo_info *priv = dev->ml_priv;
2174         struct sk_buff *skb = priv->xmit11.skb;
2175         int fid = priv->xmit11.fid;
2176         u32 *fids = priv->fids;
2177
2178         clear_bit(JOB_XMIT11, &priv->jobs);
2179         clear_bit(FLAG_PENDING_XMIT11, &priv->flags);
2180         status = transmit_802_11_packet (priv, fids[fid], skb->data);
2181         up(&priv->sem);
2182
2183         i = MAX_FIDS / 2;
2184         if ( status == SUCCESS ) {
2185                 netif_trans_update(dev);
2186                 for (; i < MAX_FIDS && (priv->fids[i] & 0xffff0000); i++);
2187         } else {
2188                 priv->fids[fid] &= 0xffff;
2189                 dev->stats.tx_window_errors++;
2190         }
2191         if (i < MAX_FIDS)
2192                 netif_wake_queue(dev);
2193         dev_kfree_skb(skb);
2194 }
2195
2196 static netdev_tx_t airo_start_xmit11(struct sk_buff *skb,
2197                                            struct net_device *dev)
2198 {
2199         s16 len;
2200         int i, j;
2201         struct airo_info *priv = dev->ml_priv;
2202         u32 *fids = priv->fids;
2203
2204         if (test_bit(FLAG_MPI, &priv->flags)) {
2205                 /* Not implemented yet for MPI350 */
2206                 netif_stop_queue(dev);
2207                 dev_kfree_skb_any(skb);
2208                 return NETDEV_TX_OK;
2209         }
2210
2211         if ( skb == NULL ) {
2212                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2213                 return NETDEV_TX_OK;
2214         }
2215         if (skb_padto(skb, ETH_ZLEN)) {
2216                 dev->stats.tx_dropped++;
2217                 return NETDEV_TX_OK;
2218         }
2219
2220         /* Find a vacant FID */
2221         for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2222         for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2223
2224         if ( j >= MAX_FIDS ) {
2225                 netif_stop_queue(dev);
2226
2227                 if (i == MAX_FIDS) {
2228                         dev->stats.tx_fifo_errors++;
2229                         return NETDEV_TX_BUSY;
2230                 }
2231         }
2232         /* check min length*/
2233         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2234         /* Mark fid as used & save length for later */
2235         fids[i] |= (len << 16);
2236         priv->xmit11.skb = skb;
2237         priv->xmit11.fid = i;
2238         if (down_trylock(&priv->sem) != 0) {
2239                 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2240                 netif_stop_queue(dev);
2241                 set_bit(JOB_XMIT11, &priv->jobs);
2242                 wake_up_interruptible(&priv->thr_wait);
2243         } else
2244                 airo_end_xmit11(dev);
2245         return NETDEV_TX_OK;
2246 }
2247
2248 static void airo_read_stats(struct net_device *dev)
2249 {
2250         struct airo_info *ai = dev->ml_priv;
2251         StatsRid stats_rid;
2252         __le32 *vals = stats_rid.vals;
2253
2254         clear_bit(JOB_STATS, &ai->jobs);
2255         if (ai->power.event) {
2256                 up(&ai->sem);
2257                 return;
2258         }
2259         readStatsRid(ai, &stats_rid, RID_STATS, 0);
2260         up(&ai->sem);
2261
2262         dev->stats.rx_packets = le32_to_cpu(vals[43]) + le32_to_cpu(vals[44]) +
2263                                le32_to_cpu(vals[45]);
2264         dev->stats.tx_packets = le32_to_cpu(vals[39]) + le32_to_cpu(vals[40]) +
2265                                le32_to_cpu(vals[41]);
2266         dev->stats.rx_bytes = le32_to_cpu(vals[92]);
2267         dev->stats.tx_bytes = le32_to_cpu(vals[91]);
2268         dev->stats.rx_errors = le32_to_cpu(vals[0]) + le32_to_cpu(vals[2]) +
2269                               le32_to_cpu(vals[3]) + le32_to_cpu(vals[4]);
2270         dev->stats.tx_errors = le32_to_cpu(vals[42]) +
2271                               dev->stats.tx_fifo_errors;
2272         dev->stats.multicast = le32_to_cpu(vals[43]);
2273         dev->stats.collisions = le32_to_cpu(vals[89]);
2274
2275         /* detailed rx_errors: */
2276         dev->stats.rx_length_errors = le32_to_cpu(vals[3]);
2277         dev->stats.rx_crc_errors = le32_to_cpu(vals[4]);
2278         dev->stats.rx_frame_errors = le32_to_cpu(vals[2]);
2279         dev->stats.rx_fifo_errors = le32_to_cpu(vals[0]);
2280 }
2281
2282 static struct net_device_stats *airo_get_stats(struct net_device *dev)
2283 {
2284         struct airo_info *local =  dev->ml_priv;
2285
2286         if (!test_bit(JOB_STATS, &local->jobs)) {
2287                 /* Get stats out of the card if available */
2288                 if (down_trylock(&local->sem) != 0) {
2289                         set_bit(JOB_STATS, &local->jobs);
2290                         wake_up_interruptible(&local->thr_wait);
2291                 } else
2292                         airo_read_stats(dev);
2293         }
2294
2295         return &dev->stats;
2296 }
2297
2298 static void airo_set_promisc(struct airo_info *ai) {
2299         Cmd cmd;
2300         Resp rsp;
2301
2302         memset(&cmd, 0, sizeof(cmd));
2303         cmd.cmd=CMD_SETMODE;
2304         clear_bit(JOB_PROMISC, &ai->jobs);
2305         cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2306         issuecommand(ai, &cmd, &rsp);
2307         up(&ai->sem);
2308 }
2309
2310 static void airo_set_multicast_list(struct net_device *dev) {
2311         struct airo_info *ai = dev->ml_priv;
2312
2313         if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2314                 change_bit(FLAG_PROMISC, &ai->flags);
2315                 if (down_trylock(&ai->sem) != 0) {
2316                         set_bit(JOB_PROMISC, &ai->jobs);
2317                         wake_up_interruptible(&ai->thr_wait);
2318                 } else
2319                         airo_set_promisc(ai);
2320         }
2321
2322         if ((dev->flags&IFF_ALLMULTI) || !netdev_mc_empty(dev)) {
2323                 /* Turn on multicast.  (Should be already setup...) */
2324         }
2325 }
2326
2327 static int airo_set_mac_address(struct net_device *dev, void *p)
2328 {
2329         struct airo_info *ai = dev->ml_priv;
2330         struct sockaddr *addr = p;
2331
2332         readConfigRid(ai, 1);
2333         memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2334         set_bit (FLAG_COMMIT, &ai->flags);
2335         disable_MAC(ai, 1);
2336         writeConfigRid (ai, 1);
2337         enable_MAC(ai, 1);
2338         memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2339         if (ai->wifidev)
2340                 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2341         return 0;
2342 }
2343
2344 static LIST_HEAD(airo_devices);
2345
2346 static void add_airo_dev(struct airo_info *ai)
2347 {
2348         /* Upper layers already keep track of PCI devices,
2349          * so we only need to remember our non-PCI cards. */
2350         if (!ai->pci)
2351                 list_add_tail(&ai->dev_list, &airo_devices);
2352 }
2353
2354 static void del_airo_dev(struct airo_info *ai)
2355 {
2356         if (!ai->pci)
2357                 list_del(&ai->dev_list);
2358 }
2359
2360 static int airo_close(struct net_device *dev) {
2361         struct airo_info *ai = dev->ml_priv;
2362
2363         netif_stop_queue(dev);
2364
2365         if (ai->wifidev != dev) {
2366 #ifdef POWER_ON_DOWN
2367                 /* Shut power to the card. The idea is that the user can save
2368                  * power when he doesn't need the card with "ifconfig down".
2369                  * That's the method that is most friendly towards the network
2370                  * stack (i.e. the network stack won't try to broadcast
2371                  * anything on the interface and routes are gone. Jean II */
2372                 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2373                 disable_MAC(ai, 1);
2374 #endif
2375                 disable_interrupts( ai );
2376
2377                 free_irq(dev->irq, dev);
2378
2379                 set_bit(JOB_DIE, &ai->jobs);
2380                 kthread_stop(ai->airo_thread_task);
2381         }
2382         return 0;
2383 }
2384
2385 void stop_airo_card( struct net_device *dev, int freeres )
2386 {
2387         struct airo_info *ai = dev->ml_priv;
2388
2389         set_bit(FLAG_RADIO_DOWN, &ai->flags);
2390         disable_MAC(ai, 1);
2391         disable_interrupts(ai);
2392         takedown_proc_entry( dev, ai );
2393         if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2394                 unregister_netdev( dev );
2395                 if (ai->wifidev) {
2396                         unregister_netdev(ai->wifidev);
2397                         free_netdev(ai->wifidev);
2398                         ai->wifidev = NULL;
2399                 }
2400                 clear_bit(FLAG_REGISTERED, &ai->flags);
2401         }
2402         /*
2403          * Clean out tx queue
2404          */
2405         if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
2406                 struct sk_buff *skb = NULL;
2407                 for (;(skb = skb_dequeue(&ai->txq));)
2408                         dev_kfree_skb(skb);
2409         }
2410
2411         airo_networks_free (ai);
2412
2413         kfree(ai->flash);
2414         kfree(ai->rssi);
2415         kfree(ai->SSID);
2416         if (freeres) {
2417                 /* PCMCIA frees this stuff, so only for PCI and ISA */
2418                 release_region( dev->base_addr, 64 );
2419                 if (test_bit(FLAG_MPI, &ai->flags)) {
2420                         if (ai->pci)
2421                                 mpi_unmap_card(ai->pci);
2422                         if (ai->pcimem)
2423                                 iounmap(ai->pcimem);
2424                         if (ai->pciaux)
2425                                 iounmap(ai->pciaux);
2426                         pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2427                                 ai->shared, ai->shared_dma);
2428                 }
2429         }
2430         crypto_free_cipher(ai->tfm);
2431         del_airo_dev(ai);
2432         free_netdev( dev );
2433 }
2434
2435 EXPORT_SYMBOL(stop_airo_card);
2436
2437 static int wll_header_parse(const struct sk_buff *skb, unsigned char *haddr)
2438 {
2439         memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
2440         return ETH_ALEN;
2441 }
2442
2443 static void mpi_unmap_card(struct pci_dev *pci)
2444 {
2445         unsigned long mem_start = pci_resource_start(pci, 1);
2446         unsigned long mem_len = pci_resource_len(pci, 1);
2447         unsigned long aux_start = pci_resource_start(pci, 2);
2448         unsigned long aux_len = AUXMEMSIZE;
2449
2450         release_mem_region(aux_start, aux_len);
2451         release_mem_region(mem_start, mem_len);
2452 }
2453
2454 /*************************************************************
2455  *  This routine assumes that descriptors have been setup .
2456  *  Run at insmod time or after reset  when the decriptors
2457  *  have been initialized . Returns 0 if all is well nz
2458  *  otherwise . Does not allocate memory but sets up card
2459  *  using previously allocated descriptors.
2460  */
2461 static int mpi_init_descriptors (struct airo_info *ai)
2462 {
2463         Cmd cmd;
2464         Resp rsp;
2465         int i;
2466         int rc = SUCCESS;
2467
2468         /* Alloc  card RX descriptors */
2469         netif_stop_queue(ai->dev);
2470
2471         memset(&rsp,0,sizeof(rsp));
2472         memset(&cmd,0,sizeof(cmd));
2473
2474         cmd.cmd = CMD_ALLOCATEAUX;
2475         cmd.parm0 = FID_RX;
2476         cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2477         cmd.parm2 = MPI_MAX_FIDS;
2478         rc=issuecommand(ai, &cmd, &rsp);
2479         if (rc != SUCCESS) {
2480                 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
2481                 return rc;
2482         }
2483
2484         for (i=0; i<MPI_MAX_FIDS; i++) {
2485                 memcpy_toio(ai->rxfids[i].card_ram_off,
2486                         &ai->rxfids[i].rx_desc, sizeof(RxFid));
2487         }
2488
2489         /* Alloc card TX descriptors */
2490
2491         memset(&rsp,0,sizeof(rsp));
2492         memset(&cmd,0,sizeof(cmd));
2493
2494         cmd.cmd = CMD_ALLOCATEAUX;
2495         cmd.parm0 = FID_TX;
2496         cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2497         cmd.parm2 = MPI_MAX_FIDS;
2498
2499         for (i=0; i<MPI_MAX_FIDS; i++) {
2500                 ai->txfids[i].tx_desc.valid = 1;
2501                 memcpy_toio(ai->txfids[i].card_ram_off,
2502                         &ai->txfids[i].tx_desc, sizeof(TxFid));
2503         }
2504         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2505
2506         rc=issuecommand(ai, &cmd, &rsp);
2507         if (rc != SUCCESS) {
2508                 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
2509                 return rc;
2510         }
2511
2512         /* Alloc card Rid descriptor */
2513         memset(&rsp,0,sizeof(rsp));
2514         memset(&cmd,0,sizeof(cmd));
2515
2516         cmd.cmd = CMD_ALLOCATEAUX;
2517         cmd.parm0 = RID_RW;
2518         cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2519         cmd.parm2 = 1; /* Magic number... */
2520         rc=issuecommand(ai, &cmd, &rsp);
2521         if (rc != SUCCESS) {
2522                 airo_print_err(ai->dev->name, "Couldn't allocate RID");
2523                 return rc;
2524         }
2525
2526         memcpy_toio(ai->config_desc.card_ram_off,
2527                 &ai->config_desc.rid_desc, sizeof(Rid));
2528
2529         return rc;
2530 }
2531
2532 /*
2533  * We are setting up three things here:
2534  * 1) Map AUX memory for descriptors: Rid, TxFid, or RxFid.
2535  * 2) Map PCI memory for issuing commands.
2536  * 3) Allocate memory (shared) to send and receive ethernet frames.
2537  */
2538 static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci)
2539 {
2540         unsigned long mem_start, mem_len, aux_start, aux_len;
2541         int rc = -1;
2542         int i;
2543         dma_addr_t busaddroff;
2544         unsigned char *vpackoff;
2545         unsigned char __iomem *pciaddroff;
2546
2547         mem_start = pci_resource_start(pci, 1);
2548         mem_len = pci_resource_len(pci, 1);
2549         aux_start = pci_resource_start(pci, 2);
2550         aux_len = AUXMEMSIZE;
2551
2552         if (!request_mem_region(mem_start, mem_len, DRV_NAME)) {
2553                 airo_print_err("", "Couldn't get region %x[%x]",
2554                         (int)mem_start, (int)mem_len);
2555                 goto out;
2556         }
2557         if (!request_mem_region(aux_start, aux_len, DRV_NAME)) {
2558                 airo_print_err("", "Couldn't get region %x[%x]",
2559                         (int)aux_start, (int)aux_len);
2560                 goto free_region1;
2561         }
2562
2563         ai->pcimem = ioremap(mem_start, mem_len);
2564         if (!ai->pcimem) {
2565                 airo_print_err("", "Couldn't map region %x[%x]",
2566                         (int)mem_start, (int)mem_len);
2567                 goto free_region2;
2568         }
2569         ai->pciaux = ioremap(aux_start, aux_len);
2570         if (!ai->pciaux) {
2571                 airo_print_err("", "Couldn't map region %x[%x]",
2572                         (int)aux_start, (int)aux_len);
2573                 goto free_memmap;
2574         }
2575
2576         /* Reserve PKTSIZE for each fid and 2K for the Rids */
2577         ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2578         if (!ai->shared) {
2579                 airo_print_err("", "Couldn't alloc_consistent %d",
2580                         PCI_SHARED_LEN);
2581                 goto free_auxmap;
2582         }
2583
2584         /*
2585          * Setup descriptor RX, TX, CONFIG
2586          */
2587         busaddroff = ai->shared_dma;
2588         pciaddroff = ai->pciaux + AUX_OFFSET;
2589         vpackoff   = ai->shared;
2590
2591         /* RX descriptor setup */
2592         for(i = 0; i < MPI_MAX_FIDS; i++) {
2593                 ai->rxfids[i].pending = 0;
2594                 ai->rxfids[i].card_ram_off = pciaddroff;
2595                 ai->rxfids[i].virtual_host_addr = vpackoff;
2596                 ai->rxfids[i].rx_desc.host_addr = busaddroff;
2597                 ai->rxfids[i].rx_desc.valid = 1;
2598                 ai->rxfids[i].rx_desc.len = PKTSIZE;
2599                 ai->rxfids[i].rx_desc.rdy = 0;
2600
2601                 pciaddroff += sizeof(RxFid);
2602                 busaddroff += PKTSIZE;
2603                 vpackoff   += PKTSIZE;
2604         }
2605
2606         /* TX descriptor setup */
2607         for(i = 0; i < MPI_MAX_FIDS; i++) {
2608                 ai->txfids[i].card_ram_off = pciaddroff;
2609                 ai->txfids[i].virtual_host_addr = vpackoff;
2610                 ai->txfids[i].tx_desc.valid = 1;
2611                 ai->txfids[i].tx_desc.host_addr = busaddroff;
2612                 memcpy(ai->txfids[i].virtual_host_addr,
2613                         &wifictlhdr8023, sizeof(wifictlhdr8023));
2614
2615                 pciaddroff += sizeof(TxFid);
2616                 busaddroff += PKTSIZE;
2617                 vpackoff   += PKTSIZE;
2618         }
2619         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2620
2621         /* Rid descriptor setup */
2622         ai->config_desc.card_ram_off = pciaddroff;
2623         ai->config_desc.virtual_host_addr = vpackoff;
2624         ai->config_desc.rid_desc.host_addr = busaddroff;
2625         ai->ridbus = busaddroff;
2626         ai->config_desc.rid_desc.rid = 0;
2627         ai->config_desc.rid_desc.len = RIDSIZE;
2628         ai->config_desc.rid_desc.valid = 1;
2629         pciaddroff += sizeof(Rid);
2630         busaddroff += RIDSIZE;
2631         vpackoff   += RIDSIZE;
2632
2633         /* Tell card about descriptors */
2634         if (mpi_init_descriptors (ai) != SUCCESS)
2635                 goto free_shared;
2636
2637         return 0;
2638  free_shared:
2639         pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2640  free_auxmap:
2641         iounmap(ai->pciaux);
2642  free_memmap:
2643         iounmap(ai->pcimem);
2644  free_region2:
2645         release_mem_region(aux_start, aux_len);
2646  free_region1:
2647         release_mem_region(mem_start, mem_len);
2648  out:
2649         return rc;
2650 }
2651
2652 static const struct header_ops airo_header_ops = {
2653         .parse = wll_header_parse,
2654 };
2655
2656 static const struct net_device_ops airo11_netdev_ops = {
2657         .ndo_open               = airo_open,
2658         .ndo_stop               = airo_close,
2659         .ndo_start_xmit         = airo_start_xmit11,
2660         .ndo_get_stats          = airo_get_stats,
2661         .ndo_set_mac_address    = airo_set_mac_address,
2662         .ndo_do_ioctl           = airo_ioctl,
2663 };
2664
2665 static void wifi_setup(struct net_device *dev)
2666 {
2667         dev->netdev_ops = &airo11_netdev_ops;
2668         dev->header_ops = &airo_header_ops;
2669         dev->wireless_handlers = &airo_handler_def;
2670
2671         dev->type               = ARPHRD_IEEE80211;
2672         dev->hard_header_len    = ETH_HLEN;
2673         dev->mtu                = AIRO_DEF_MTU;
2674         dev->min_mtu            = 68;
2675         dev->max_mtu            = MIC_MSGLEN_MAX;
2676         dev->addr_len           = ETH_ALEN;
2677         dev->tx_queue_len       = 100;
2678
2679         eth_broadcast_addr(dev->broadcast);
2680
2681         dev->flags              = IFF_BROADCAST|IFF_MULTICAST;
2682 }
2683
2684 static struct net_device *init_wifidev(struct airo_info *ai,
2685                                         struct net_device *ethdev)
2686 {
2687         int err;
2688         struct net_device *dev = alloc_netdev(0, "wifi%d", NET_NAME_UNKNOWN,
2689                                               wifi_setup);
2690         if (!dev)
2691                 return NULL;
2692         dev->ml_priv = ethdev->ml_priv;
2693         dev->irq = ethdev->irq;
2694         dev->base_addr = ethdev->base_addr;
2695         dev->wireless_data = ethdev->wireless_data;
2696         SET_NETDEV_DEV(dev, ethdev->dev.parent);
2697         eth_hw_addr_inherit(dev, ethdev);
2698         err = register_netdev(dev);
2699         if (err<0) {
2700                 free_netdev(dev);
2701                 return NULL;
2702         }
2703         return dev;
2704 }
2705
2706 static int reset_card( struct net_device *dev , int lock) {
2707         struct airo_info *ai = dev->ml_priv;
2708
2709         if (lock && down_interruptible(&ai->sem))
2710                 return -1;
2711         waitbusy (ai);
2712         OUT4500(ai,COMMAND,CMD_SOFTRESET);
2713         msleep(200);
2714         waitbusy (ai);
2715         msleep(200);
2716         if (lock)
2717                 up(&ai->sem);
2718         return 0;
2719 }
2720
2721 #define AIRO_MAX_NETWORK_COUNT  64
2722 static int airo_networks_allocate(struct airo_info *ai)
2723 {
2724         if (ai->networks)
2725                 return 0;
2726
2727         ai->networks = kcalloc(AIRO_MAX_NETWORK_COUNT, sizeof(BSSListElement),
2728                                GFP_KERNEL);
2729         if (!ai->networks) {
2730                 airo_print_warn("", "Out of memory allocating beacons");
2731                 return -ENOMEM;
2732         }
2733
2734         return 0;
2735 }
2736
2737 static void airo_networks_free(struct airo_info *ai)
2738 {
2739         kfree(ai->networks);
2740         ai->networks = NULL;
2741 }
2742
2743 static void airo_networks_initialize(struct airo_info *ai)
2744 {
2745         int i;
2746
2747         INIT_LIST_HEAD(&ai->network_free_list);
2748         INIT_LIST_HEAD(&ai->network_list);
2749         for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
2750                 list_add_tail(&ai->networks[i].list,
2751                               &ai->network_free_list);
2752 }
2753
2754 static const struct net_device_ops airo_netdev_ops = {
2755         .ndo_open               = airo_open,
2756         .ndo_stop               = airo_close,
2757         .ndo_start_xmit         = airo_start_xmit,
2758         .ndo_get_stats          = airo_get_stats,
2759         .ndo_set_rx_mode        = airo_set_multicast_list,
2760         .ndo_set_mac_address    = airo_set_mac_address,
2761         .ndo_do_ioctl           = airo_ioctl,
2762         .ndo_validate_addr      = eth_validate_addr,
2763 };
2764
2765 static const struct net_device_ops mpi_netdev_ops = {
2766         .ndo_open               = airo_open,
2767         .ndo_stop               = airo_close,
2768         .ndo_start_xmit         = mpi_start_xmit,
2769         .ndo_get_stats          = airo_get_stats,
2770         .ndo_set_rx_mode        = airo_set_multicast_list,
2771         .ndo_set_mac_address    = airo_set_mac_address,
2772         .ndo_do_ioctl           = airo_ioctl,
2773         .ndo_validate_addr      = eth_validate_addr,
2774 };
2775
2776
2777 static struct net_device *_init_airo_card( unsigned short irq, int port,
2778                                            int is_pcmcia, struct pci_dev *pci,
2779                                            struct device *dmdev )
2780 {
2781         struct net_device *dev;
2782         struct airo_info *ai;
2783         int i, rc;
2784         CapabilityRid cap_rid;
2785
2786         /* Create the network device object. */
2787         dev = alloc_netdev(sizeof(*ai), "", NET_NAME_UNKNOWN, ether_setup);
2788         if (!dev) {
2789                 airo_print_err("", "Couldn't alloc_etherdev");
2790                 return NULL;
2791         }
2792
2793         ai = dev->ml_priv = netdev_priv(dev);
2794         ai->wifidev = NULL;
2795         ai->flags = 1 << FLAG_RADIO_DOWN;
2796         ai->jobs = 0;
2797         ai->dev = dev;
2798         if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
2799                 airo_print_dbg("", "Found an MPI350 card");
2800                 set_bit(FLAG_MPI, &ai->flags);
2801         }
2802         spin_lock_init(&ai->aux_lock);
2803         sema_init(&ai->sem, 1);
2804         ai->config.len = 0;
2805         ai->pci = pci;
2806         init_waitqueue_head (&ai->thr_wait);
2807         ai->tfm = NULL;
2808         add_airo_dev(ai);
2809         ai->APList.len = cpu_to_le16(sizeof(struct APListRid));
2810
2811         if (airo_networks_allocate (ai))
2812                 goto err_out_free;
2813         airo_networks_initialize (ai);
2814
2815         skb_queue_head_init (&ai->txq);
2816
2817         /* The Airo-specific entries in the device structure. */
2818         if (test_bit(FLAG_MPI,&ai->flags))
2819                 dev->netdev_ops = &mpi_netdev_ops;
2820         else
2821                 dev->netdev_ops = &airo_netdev_ops;
2822         dev->wireless_handlers = &airo_handler_def;
2823         ai->wireless_data.spy_data = &ai->spy_data;
2824         dev->wireless_data = &ai->wireless_data;
2825         dev->irq = irq;
2826         dev->base_addr = port;
2827         dev->priv_flags &= ~IFF_TX_SKB_SHARING;
2828         dev->max_mtu = MIC_MSGLEN_MAX;
2829
2830         SET_NETDEV_DEV(dev, dmdev);
2831
2832         reset_card (dev, 1);
2833         msleep(400);
2834
2835         if (!is_pcmcia) {
2836                 if (!request_region(dev->base_addr, 64, DRV_NAME)) {
2837                         rc = -EBUSY;
2838                         airo_print_err(dev->name, "Couldn't request region");
2839                         goto err_out_nets;
2840                 }
2841         }
2842
2843         if (test_bit(FLAG_MPI,&ai->flags)) {
2844                 if (mpi_map_card(ai, pci)) {
2845                         airo_print_err("", "Could not map memory");
2846                         goto err_out_res;
2847                 }
2848         }
2849
2850         if (probe) {
2851                 if (setup_card(ai, dev->dev_addr, 1) != SUCCESS) {
2852                         airo_print_err(dev->name, "MAC could not be enabled" );
2853                         rc = -EIO;
2854                         goto err_out_map;
2855                 }
2856         } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2857                 ai->bap_read = fast_bap_read;
2858                 set_bit(FLAG_FLASHING, &ai->flags);
2859         }
2860
2861         strcpy(dev->name, "eth%d");
2862         rc = register_netdev(dev);
2863         if (rc) {
2864                 airo_print_err(dev->name, "Couldn't register_netdev");
2865                 goto err_out_map;
2866         }
2867         ai->wifidev = init_wifidev(ai, dev);
2868         if (!ai->wifidev)
2869                 goto err_out_reg;
2870
2871         rc = readCapabilityRid(ai, &cap_rid, 1);
2872         if (rc != SUCCESS) {
2873                 rc = -EIO;
2874                 goto err_out_wifi;
2875         }
2876         /* WEP capability discovery */
2877         ai->wep_capable = (cap_rid.softCap & cpu_to_le16(0x02)) ? 1 : 0;
2878         ai->max_wep_idx = (cap_rid.softCap & cpu_to_le16(0x80)) ? 3 : 0;
2879
2880         airo_print_info(dev->name, "Firmware version %x.%x.%02d",
2881                         ((le16_to_cpu(cap_rid.softVer) >> 8) & 0xF),
2882                         (le16_to_cpu(cap_rid.softVer) & 0xFF),
2883                         le16_to_cpu(cap_rid.softSubVer));
2884
2885         /* Test for WPA support */
2886         /* Only firmware versions 5.30.17 or better can do WPA */
2887         if (le16_to_cpu(cap_rid.softVer) > 0x530
2888          || (le16_to_cpu(cap_rid.softVer) == 0x530
2889               && le16_to_cpu(cap_rid.softSubVer) >= 17)) {
2890                 airo_print_info(ai->dev->name, "WPA supported.");
2891
2892                 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2893                 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2894                 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2895                 ai->bssListRidLen = sizeof(BSSListRid);
2896         } else {
2897                 airo_print_info(ai->dev->name, "WPA unsupported with firmware "
2898                         "versions older than 5.30.17.");
2899
2900                 ai->bssListFirst = RID_BSSLISTFIRST;
2901                 ai->bssListNext = RID_BSSLISTNEXT;
2902                 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2903         }
2904
2905         set_bit(FLAG_REGISTERED,&ai->flags);
2906         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2907
2908         /* Allocate the transmit buffers */
2909         if (probe && !test_bit(FLAG_MPI,&ai->flags))
2910                 for( i = 0; i < MAX_FIDS; i++ )
2911                         ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2912
2913         if (setup_proc_entry(dev, dev->ml_priv) < 0)
2914                 goto err_out_wifi;
2915
2916         return dev;
2917
2918 err_out_wifi:
2919         unregister_netdev(ai->wifidev);
2920         free_netdev(ai->wifidev);
2921 err_out_reg:
2922         unregister_netdev(dev);
2923 err_out_map:
2924         if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2925                 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2926                 iounmap(ai->pciaux);
2927                 iounmap(ai->pcimem);
2928                 mpi_unmap_card(ai->pci);
2929         }
2930 err_out_res:
2931         if (!is_pcmcia)
2932                 release_region( dev->base_addr, 64 );
2933 err_out_nets:
2934         airo_networks_free(ai);
2935 err_out_free:
2936         del_airo_dev(ai);
2937         free_netdev(dev);
2938         return NULL;
2939 }
2940
2941 struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2942                                   struct device *dmdev)
2943 {
2944         return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2945 }
2946
2947 EXPORT_SYMBOL(init_airo_card);
2948
2949 static int waitbusy (struct airo_info *ai) {
2950         int delay = 0;
2951         while ((IN4500(ai, COMMAND) & COMMAND_BUSY) && (delay < 10000)) {
2952                 udelay (10);
2953                 if ((++delay % 20) == 0)
2954                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2955         }
2956         return delay < 10000;
2957 }
2958
2959 int reset_airo_card( struct net_device *dev )
2960 {
2961         int i;
2962         struct airo_info *ai = dev->ml_priv;
2963
2964         if (reset_card (dev, 1))
2965                 return -1;
2966
2967         if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
2968                 airo_print_err(dev->name, "MAC could not be enabled");
2969                 return -1;
2970         }
2971         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2972         /* Allocate the transmit buffers if needed */
2973         if (!test_bit(FLAG_MPI,&ai->flags))
2974                 for( i = 0; i < MAX_FIDS; i++ )
2975                         ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2976
2977         enable_interrupts( ai );
2978         netif_wake_queue(dev);
2979         return 0;
2980 }
2981
2982 EXPORT_SYMBOL(reset_airo_card);
2983
2984 static void airo_send_event(struct net_device *dev) {
2985         struct airo_info *ai = dev->ml_priv;
2986         union iwreq_data wrqu;
2987         StatusRid status_rid;
2988
2989         clear_bit(JOB_EVENT, &ai->jobs);
2990         PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
2991         up(&ai->sem);
2992         wrqu.data.length = 0;
2993         wrqu.data.flags = 0;
2994         memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
2995         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
2996
2997         /* Send event to user space */
2998         wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
2999 }
3000
3001 static void airo_process_scan_results (struct airo_info *ai) {
3002         union iwreq_data        wrqu;
3003         BSSListRid bss;
3004         int rc;
3005         BSSListElement * loop_net;
3006         BSSListElement * tmp_net;
3007
3008         /* Blow away current list of scan results */
3009         list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
3010                 list_move_tail (&loop_net->list, &ai->network_free_list);
3011                 /* Don't blow away ->list, just BSS data */
3012                 memset (loop_net, 0, sizeof (loop_net->bss));
3013         }
3014
3015         /* Try to read the first entry of the scan result */
3016         rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
3017         if((rc) || (bss.index == cpu_to_le16(0xffff))) {
3018                 /* No scan results */
3019                 goto out;
3020         }
3021
3022         /* Read and parse all entries */
3023         tmp_net = NULL;
3024         while((!rc) && (bss.index != cpu_to_le16(0xffff))) {
3025                 /* Grab a network off the free list */
3026                 if (!list_empty(&ai->network_free_list)) {
3027                         tmp_net = list_entry(ai->network_free_list.next,
3028                                             BSSListElement, list);
3029                         list_del(ai->network_free_list.next);
3030                 }
3031
3032                 if (tmp_net != NULL) {
3033                         memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
3034                         list_add_tail(&tmp_net->list, &ai->network_list);
3035                         tmp_net = NULL;
3036                 }
3037
3038                 /* Read next entry */
3039                 rc = PC4500_readrid(ai, ai->bssListNext,
3040                                     &bss, ai->bssListRidLen, 0);
3041         }
3042
3043 out:
3044         /* write APList back (we cleared it in airo_set_scan) */
3045         disable_MAC(ai, 2);
3046         writeAPListRid(ai, &ai->APList, 0);
3047         enable_MAC(ai, 0);
3048
3049         ai->scan_timeout = 0;
3050         clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
3051         up(&ai->sem);
3052
3053         /* Send an empty event to user space.
3054          * We don't send the received data on
3055          * the event because it would require
3056          * us to do complex transcoding, and
3057          * we want to minimise the work done in
3058          * the irq handler. Use a request to
3059          * extract the data - Jean II */
3060         wrqu.data.length = 0;
3061         wrqu.data.flags = 0;
3062         wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3063 }
3064
3065 static int airo_thread(void *data) {
3066         struct net_device *dev = data;
3067         struct airo_info *ai = dev->ml_priv;
3068         int locked;
3069
3070         set_freezable();
3071         while(1) {
3072                 /* make swsusp happy with our thread */
3073                 try_to_freeze();
3074
3075                 if (test_bit(JOB_DIE, &ai->jobs))
3076                         break;
3077
3078                 if (ai->jobs) {
3079                         locked = down_interruptible(&ai->sem);
3080                 } else {
3081                         wait_queue_entry_t wait;
3082
3083                         init_waitqueue_entry(&wait, current);
3084                         add_wait_queue(&ai->thr_wait, &wait);
3085                         for (;;) {
3086                                 set_current_state(TASK_INTERRUPTIBLE);
3087                                 if (ai->jobs)
3088                                         break;
3089                                 if (ai->expires || ai->scan_timeout) {
3090                                         if (ai->scan_timeout &&
3091                                                         time_after_eq(jiffies,ai->scan_timeout)){
3092                                                 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
3093                                                 break;
3094                                         } else if (ai->expires &&
3095                                                         time_after_eq(jiffies,ai->expires)){
3096                                                 set_bit(JOB_AUTOWEP, &ai->jobs);
3097                                                 break;
3098                                         }
3099                                         if (!kthread_should_stop() &&
3100                                             !freezing(current)) {
3101                                                 unsigned long wake_at;
3102                                                 if (!ai->expires || !ai->scan_timeout) {
3103                                                         wake_at = max(ai->expires,
3104                                                                 ai->scan_timeout);
3105                                                 } else {
3106                                                         wake_at = min(ai->expires,
3107                                                                 ai->scan_timeout);
3108                                                 }
3109                                                 schedule_timeout(wake_at - jiffies);
3110                                                 continue;
3111                                         }
3112                                 } else if (!kthread_should_stop() &&
3113                                            !freezing(current)) {
3114                                         schedule();
3115                                         continue;
3116                                 }
3117                                 break;
3118                         }
3119                         current->state = TASK_RUNNING;
3120                         remove_wait_queue(&ai->thr_wait, &wait);
3121                         locked = 1;
3122                 }
3123
3124                 if (locked)
3125                         continue;
3126
3127                 if (test_bit(JOB_DIE, &ai->jobs)) {
3128                         up(&ai->sem);
3129                         break;
3130                 }
3131
3132                 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
3133                         up(&ai->sem);
3134                         continue;
3135                 }
3136
3137                 if (test_bit(JOB_XMIT, &ai->jobs))
3138                         airo_end_xmit(dev);
3139                 else if (test_bit(JOB_XMIT11, &ai->jobs))
3140                         airo_end_xmit11(dev);
3141                 else if (test_bit(JOB_STATS, &ai->jobs))
3142                         airo_read_stats(dev);
3143                 else if (test_bit(JOB_WSTATS, &ai->jobs))
3144                         airo_read_wireless_stats(ai);
3145                 else if (test_bit(JOB_PROMISC, &ai->jobs))
3146                         airo_set_promisc(ai);
3147                 else if (test_bit(JOB_MIC, &ai->jobs))
3148                         micinit(ai);
3149                 else if (test_bit(JOB_EVENT, &ai->jobs))
3150                         airo_send_event(dev);
3151                 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
3152                         timer_func(dev);
3153                 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
3154                         airo_process_scan_results(ai);
3155                 else  /* Shouldn't get here, but we make sure to unlock */
3156                         up(&ai->sem);
3157         }
3158
3159         return 0;
3160 }
3161
3162 static int header_len(__le16 ctl)
3163 {
3164         u16 fc = le16_to_cpu(ctl);
3165         switch (fc & 0xc) {
3166         case 4:
3167                 if ((fc & 0xe0) == 0xc0)
3168                         return 10;      /* one-address control packet */
3169                 return 16;      /* two-address control packet */
3170         case 8:
3171                 if ((fc & 0x300) == 0x300)
3172                         return 30;      /* WDS packet */
3173         }
3174         return 24;
3175 }
3176
3177 static void airo_handle_cisco_mic(struct airo_info *ai)
3178 {
3179         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags)) {
3180                 set_bit(JOB_MIC, &ai->jobs);
3181                 wake_up_interruptible(&ai->thr_wait);
3182         }
3183 }
3184
3185 /* Airo Status codes */
3186 #define STAT_NOBEACON   0x8000 /* Loss of sync - missed beacons */
3187 #define STAT_MAXRETRIES 0x8001 /* Loss of sync - max retries */
3188 #define STAT_MAXARL     0x8002 /* Loss of sync - average retry level exceeded*/
3189 #define STAT_FORCELOSS  0x8003 /* Loss of sync - host request */
3190 #define STAT_TSFSYNC    0x8004 /* Loss of sync - TSF synchronization */
3191 #define STAT_DEAUTH     0x8100 /* low byte is 802.11 reason code */
3192 #define STAT_DISASSOC   0x8200 /* low byte is 802.11 reason code */
3193 #define STAT_ASSOC_FAIL 0x8400 /* low byte is 802.11 reason code */
3194 #define STAT_AUTH_FAIL  0x0300 /* low byte is 802.11 reason code */
3195 #define STAT_ASSOC      0x0400 /* Associated */
3196 #define STAT_REASSOC    0x0600 /* Reassociated?  Only on firmware >= 5.30.17 */
3197
3198 static void airo_print_status(const char *devname, u16 status)
3199 {
3200         u8 reason = status & 0xFF;
3201
3202         switch (status & 0xFF00) {
3203         case STAT_NOBEACON:
3204                 switch (status) {
3205                 case STAT_NOBEACON:
3206                         airo_print_dbg(devname, "link lost (missed beacons)");
3207                         break;
3208                 case STAT_MAXRETRIES:
3209                 case STAT_MAXARL:
3210                         airo_print_dbg(devname, "link lost (max retries)");
3211                         break;
3212                 case STAT_FORCELOSS:
3213                         airo_print_dbg(devname, "link lost (local choice)");
3214                         break;
3215                 case STAT_TSFSYNC:
3216                         airo_print_dbg(devname, "link lost (TSF sync lost)");
3217                         break;
3218                 default:
3219                         airo_print_dbg(devname, "unknown status %x\n", status);
3220                         break;
3221                 }
3222                 break;
3223         case STAT_DEAUTH:
3224                 airo_print_dbg(devname, "deauthenticated (reason: %d)", reason);
3225                 break;
3226         case STAT_DISASSOC:
3227                 airo_print_dbg(devname, "disassociated (reason: %d)", reason);
3228                 break;
3229         case STAT_ASSOC_FAIL:
3230                 airo_print_dbg(devname, "association failed (reason: %d)",
3231                                reason);
3232                 break;
3233         case STAT_AUTH_FAIL:
3234                 airo_print_dbg(devname, "authentication failed (reason: %d)",
3235                                reason);
3236                 break;
3237         case STAT_ASSOC:
3238         case STAT_REASSOC:
3239                 break;
3240         default:
3241                 airo_print_dbg(devname, "unknown status %x\n", status);
3242                 break;
3243         }
3244 }
3245
3246 static void airo_handle_link(struct airo_info *ai)
3247 {
3248         union iwreq_data wrqu;
3249         int scan_forceloss = 0;
3250         u16 status;
3251
3252         /* Get new status and acknowledge the link change */
3253         status = le16_to_cpu(IN4500(ai, LINKSTAT));
3254         OUT4500(ai, EVACK, EV_LINK);
3255
3256         if ((status == STAT_FORCELOSS) && (ai->scan_timeout > 0))
3257                 scan_forceloss = 1;
3258
3259         airo_print_status(ai->dev->name, status);
3260
3261         if ((status == STAT_ASSOC) || (status == STAT_REASSOC)) {
3262                 if (auto_wep)
3263                         ai->expires = 0;
3264                 if (ai->list_bss_task)
3265                         wake_up_process(ai->list_bss_task);
3266                 set_bit(FLAG_UPDATE_UNI, &ai->flags);
3267                 set_bit(FLAG_UPDATE_MULTI, &ai->flags);
3268
3269                 if (down_trylock(&ai->sem) != 0) {
3270                         set_bit(JOB_EVENT, &ai->jobs);
3271                         wake_up_interruptible(&ai->thr_wait);
3272                 } else
3273                         airo_send_event(ai->dev);
3274                 netif_carrier_on(ai->dev);
3275         } else if (!scan_forceloss) {
3276                 if (auto_wep && !ai->expires) {
3277                         ai->expires = RUN_AT(3*HZ);
3278                         wake_up_interruptible(&ai->thr_wait);
3279                 }
3280
3281                 /* Send event to user space */
3282                 eth_zero_addr(wrqu.ap_addr.sa_data);
3283                 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3284                 wireless_send_event(ai->dev, SIOCGIWAP, &wrqu, NULL);
3285                 netif_carrier_off(ai->dev);
3286         } else {
3287                 netif_carrier_off(ai->dev);
3288         }
3289 }
3290
3291 static void airo_handle_rx(struct airo_info *ai)
3292 {
3293         struct sk_buff *skb = NULL;
3294         __le16 fc, v, *buffer, tmpbuf[4];
3295         u16 len, hdrlen = 0, gap, fid;
3296         struct rx_hdr hdr;
3297         int success = 0;
3298
3299         if (test_bit(FLAG_MPI, &ai->flags)) {
3300                 if (test_bit(FLAG_802_11, &ai->flags))
3301                         mpi_receive_802_11(ai);
3302                 else
3303                         mpi_receive_802_3(ai);
3304                 OUT4500(ai, EVACK, EV_RX);
3305                 return;
3306         }
3307
3308         fid = IN4500(ai, RXFID);
3309
3310         /* Get the packet length */
3311         if (test_bit(FLAG_802_11, &ai->flags)) {
3312                 bap_setup (ai, fid, 4, BAP0);
3313                 bap_read (ai, (__le16*)&hdr, sizeof(hdr), BAP0);
3314                 /* Bad CRC. Ignore packet */
3315                 if (le16_to_cpu(hdr.status) & 2)
3316                         hdr.len = 0;
3317                 if (ai->wifidev == NULL)
3318                         hdr.len = 0;
3319         } else {
3320                 bap_setup(ai, fid, 0x36, BAP0);
3321                 bap_read(ai, &hdr.len, 2, BAP0);
3322         }
3323         len = le16_to_cpu(hdr.len);
3324
3325         if (len > AIRO_DEF_MTU) {
3326                 airo_print_err(ai->dev->name, "Bad size %d", len);
3327                 goto done;
3328         }
3329         if (len == 0)
3330                 goto done;
3331
3332         if (test_bit(FLAG_802_11, &ai->flags)) {
3333                 bap_read(ai, &fc, sizeof (fc), BAP0);
3334                 hdrlen = header_len(fc);
3335         } else
3336                 hdrlen = ETH_ALEN * 2;
3337
3338         skb = dev_alloc_skb(len + hdrlen + 2 + 2);
3339         if (!skb) {
3340                 ai->dev->stats.rx_dropped++;
3341                 goto done;
3342         }
3343
3344         skb_reserve(skb, 2); /* This way the IP header is aligned */
3345         buffer = skb_put(skb, len + hdrlen);
3346         if (test_bit(FLAG_802_11, &ai->flags)) {
3347                 buffer[0] = fc;
3348                 bap_read(ai, buffer + 1, hdrlen - 2, BAP0);
3349                 if (hdrlen == 24)
3350                         bap_read(ai, tmpbuf, 6, BAP0);
3351
3352                 bap_read(ai, &v, sizeof(v), BAP0);
3353                 gap = le16_to_cpu(v);
3354                 if (gap) {
3355                         if (gap <= 8) {
3356                                 bap_read(ai, tmpbuf, gap, BAP0);
3357                         } else {
3358                                 airo_print_err(ai->dev->name, "gaplen too "
3359                                         "big. Problems will follow...");
3360                         }
3361                 }
3362                 bap_read(ai, buffer + hdrlen/2, len, BAP0);
3363         } else {
3364                 MICBuffer micbuf;
3365
3366                 bap_read(ai, buffer, ETH_ALEN * 2, BAP0);
3367                 if (ai->micstats.enabled) {
3368                         bap_read(ai, (__le16 *) &micbuf, sizeof (micbuf), BAP0);
3369                         if (ntohs(micbuf.typelen) > 0x05DC)
3370                                 bap_setup(ai, fid, 0x44, BAP0);
3371                         else {
3372                                 if (len <= sizeof (micbuf)) {
3373                                         dev_kfree_skb_irq(skb);
3374                                         goto done;
3375                                 }
3376
3377                                 len -= sizeof(micbuf);
3378                                 skb_trim(skb, len + hdrlen);
3379                         }
3380                 }
3381
3382                 bap_read(ai, buffer + ETH_ALEN, len, BAP0);
3383                 if (decapsulate(ai, &micbuf, (etherHead*) buffer, len))
3384                         dev_kfree_skb_irq (skb);
3385                 else
3386                         success = 1;
3387         }
3388
3389 #ifdef WIRELESS_SPY
3390         if (success && (ai->spy_data.spy_number > 0)) {
3391                 char *sa;
3392                 struct iw_quality wstats;
3393
3394                 /* Prepare spy data : addr + qual */
3395                 if (!test_bit(FLAG_802_11, &ai->flags)) {
3396                         sa = (char *) buffer + 6;
3397                         bap_setup(ai, fid, 8, BAP0);
3398                         bap_read(ai, (__le16 *) hdr.rssi, 2, BAP0);
3399                 } else
3400                         sa = (char *) buffer + 10;
3401                 wstats.qual = hdr.rssi[0];
3402                 if (ai->rssi)
3403                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3404                 else
3405                         wstats.level = (hdr.rssi[1] + 321) / 2;
3406                 wstats.noise = ai->wstats.qual.noise;
3407                 wstats.updated =  IW_QUAL_LEVEL_UPDATED
3408                                 | IW_QUAL_QUAL_UPDATED
3409                                 | IW_QUAL_DBM;
3410                 /* Update spy records */
3411                 wireless_spy_update(ai->dev, sa, &wstats);
3412         }
3413 #endif /* WIRELESS_SPY */
3414
3415 done:
3416         OUT4500(ai, EVACK, EV_RX);
3417
3418         if (success) {
3419                 if (test_bit(FLAG_802_11, &ai->flags)) {
3420                         skb_reset_mac_header(skb);
3421                         skb->pkt_type = PACKET_OTHERHOST;
3422                         skb->dev = ai->wifidev;
3423                         skb->protocol = htons(ETH_P_802_2);
3424                 } else
3425                         skb->protocol = eth_type_trans(skb, ai->dev);
3426                 skb->ip_summed = CHECKSUM_NONE;
3427
3428                 netif_rx(skb);
3429         }
3430 }
3431
3432 static void airo_handle_tx(struct airo_info *ai, u16 status)
3433 {
3434         int i, index = -1;
3435         u16 fid;
3436
3437         if (test_bit(FLAG_MPI, &ai->flags)) {
3438                 unsigned long flags;
3439
3440                 if (status & EV_TXEXC)
3441                         get_tx_error(ai, -1);
3442
3443                 spin_lock_irqsave(&ai->aux_lock, flags);
3444                 if (!skb_queue_empty(&ai->txq)) {
3445                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3446                         mpi_send_packet(ai->dev);
3447                 } else {
3448                         clear_bit(FLAG_PENDING_XMIT, &ai->flags);
3449                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3450                         netif_wake_queue(ai->dev);
3451                 }
3452                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3453                 return;
3454         }
3455
3456         fid = IN4500(ai, TXCOMPLFID);
3457
3458         for (i = 0; i < MAX_FIDS; i++) {
3459                 if ((ai->fids[i] & 0xffff) == fid)
3460                         index = i;
3461         }
3462
3463         if (index != -1) {
3464                 if (status & EV_TXEXC)
3465                         get_tx_error(ai, index);
3466
3467                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXEXC));
3468
3469                 /* Set up to be used again */
3470                 ai->fids[index] &= 0xffff;
3471                 if (index < MAX_FIDS / 2) {
3472                         if (!test_bit(FLAG_PENDING_XMIT, &ai->flags))
3473                                 netif_wake_queue(ai->dev);
3474                 } else {
3475                         if (!test_bit(FLAG_PENDING_XMIT11, &ai->flags))
3476                                 netif_wake_queue(ai->wifidev);
3477                 }
3478         } else {
3479                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3480                 airo_print_err(ai->dev->name, "Unallocated FID was used to xmit");
3481         }
3482 }
3483
3484 static irqreturn_t airo_interrupt(int irq, void *dev_id)
3485 {
3486         struct net_device *dev = dev_id;
3487         u16 status, savedInterrupts = 0;
3488         struct airo_info *ai = dev->ml_priv;
3489         int handled = 0;
3490
3491         if (!netif_device_present(dev))
3492                 return IRQ_NONE;
3493
3494         for (;;) {
3495                 status = IN4500(ai, EVSTAT);
3496                 if (!(status & STATUS_INTS) || (status == 0xffff))
3497                         break;
3498
3499                 handled = 1;
3500
3501                 if (status & EV_AWAKE) {
3502                         OUT4500(ai, EVACK, EV_AWAKE);
3503                         OUT4500(ai, EVACK, EV_AWAKE);
3504                 }
3505
3506                 if (!savedInterrupts) {
3507                         savedInterrupts = IN4500(ai, EVINTEN);
3508                         OUT4500(ai, EVINTEN, 0);
3509                 }
3510
3511                 if (status & EV_MIC) {
3512                         OUT4500(ai, EVACK, EV_MIC);
3513                         airo_handle_cisco_mic(ai);
3514                 }
3515
3516                 if (status & EV_LINK) {
3517                         /* Link status changed */
3518                         airo_handle_link(ai);
3519                 }
3520
3521                 /* Check to see if there is something to receive */
3522                 if (status & EV_RX)
3523                         airo_handle_rx(ai);
3524
3525                 /* Check to see if a packet has been transmitted */
3526                 if (status & (EV_TX | EV_TXCPY | EV_TXEXC))
3527                         airo_handle_tx(ai, status);
3528
3529                 if ( status & ~STATUS_INTS & ~IGNORE_INTS ) {
3530                         airo_print_warn(ai->dev->name, "Got weird status %x",
3531                                 status & ~STATUS_INTS & ~IGNORE_INTS );
3532                 }
3533         }
3534
3535         if (savedInterrupts)
3536                 OUT4500(ai, EVINTEN, savedInterrupts);
3537
3538         return IRQ_RETVAL(handled);
3539 }
3540
3541 /*
3542  *  Routines to talk to the card
3543  */
3544
3545 /*
3546  *  This was originally written for the 4500, hence the name
3547  *  NOTE:  If use with 8bit mode and SMP bad things will happen!
3548  *         Why would some one do 8 bit IO in an SMP machine?!?
3549  */
3550 static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3551         if (test_bit(FLAG_MPI,&ai->flags))
3552                 reg <<= 1;
3553         if ( !do8bitIO )
3554                 outw( val, ai->dev->base_addr + reg );
3555         else {
3556                 outb( val & 0xff, ai->dev->base_addr + reg );
3557                 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3558         }
3559 }
3560
3561 static u16 IN4500( struct airo_info *ai, u16 reg ) {
3562         unsigned short rc;
3563
3564         if (test_bit(FLAG_MPI,&ai->flags))
3565                 reg <<= 1;
3566         if ( !do8bitIO )
3567                 rc = inw( ai->dev->base_addr + reg );
3568         else {
3569                 rc = inb( ai->dev->base_addr + reg );
3570                 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3571         }
3572         return rc;
3573 }
3574
3575 static int enable_MAC(struct airo_info *ai, int lock)
3576 {
3577         int rc;
3578         Cmd cmd;
3579         Resp rsp;
3580
3581         /* FLAG_RADIO_OFF : Radio disabled via /proc or Wireless Extensions
3582          * FLAG_RADIO_DOWN : Radio disabled via "ifconfig ethX down"
3583          * Note : we could try to use !netif_running(dev) in enable_MAC()
3584          * instead of this flag, but I don't trust it *within* the
3585          * open/close functions, and testing both flags together is
3586          * "cheaper" - Jean II */
3587         if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3588
3589         if (lock && down_interruptible(&ai->sem))
3590                 return -ERESTARTSYS;
3591
3592         if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3593                 memset(&cmd, 0, sizeof(cmd));
3594                 cmd.cmd = MAC_ENABLE;
3595                 rc = issuecommand(ai, &cmd, &rsp);
3596                 if (rc == SUCCESS)
3597                         set_bit(FLAG_ENABLED, &ai->flags);
3598         } else
3599                 rc = SUCCESS;
3600
3601         if (lock)
3602             up(&ai->sem);
3603
3604         if (rc)
3605                 airo_print_err(ai->dev->name, "Cannot enable MAC");
3606         else if ((rsp.status & 0xFF00) != 0) {
3607                 airo_print_err(ai->dev->name, "Bad MAC enable reason=%x, "
3608                         "rid=%x, offset=%d", rsp.rsp0, rsp.rsp1, rsp.rsp2);
3609                 rc = ERROR;
3610         }
3611         return rc;
3612 }
3613
3614 static void disable_MAC( struct airo_info *ai, int lock ) {
3615         Cmd cmd;
3616         Resp rsp;
3617
3618         if (lock == 1 && down_interruptible(&ai->sem))
3619                 return;
3620
3621         if (test_bit(FLAG_ENABLED, &ai->flags)) {
3622                 if (lock != 2) /* lock == 2 means don't disable carrier */
3623                         netif_carrier_off(ai->dev);
3624                 memset(&cmd, 0, sizeof(cmd));
3625                 cmd.cmd = MAC_DISABLE; // disable in case already enabled
3626                 issuecommand(ai, &cmd, &rsp);
3627                 clear_bit(FLAG_ENABLED, &ai->flags);
3628         }
3629         if (lock == 1)
3630                 up(&ai->sem);
3631 }
3632
3633 static void enable_interrupts( struct airo_info *ai ) {
3634         /* Enable the interrupts */
3635         OUT4500( ai, EVINTEN, STATUS_INTS );
3636 }
3637
3638 static void disable_interrupts( struct airo_info *ai ) {
3639         OUT4500( ai, EVINTEN, 0 );
3640 }
3641
3642 static void mpi_receive_802_3(struct airo_info *ai)
3643 {
3644         RxFid rxd;
3645         int len = 0;
3646         struct sk_buff *skb;
3647         char *buffer;
3648         int off = 0;
3649         MICBuffer micbuf;
3650
3651         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3652         /* Make sure we got something */
3653         if (rxd.rdy && rxd.valid == 0) {
3654                 len = rxd.len + 12;
3655                 if (len < 12 || len > 2048)
3656                         goto badrx;
3657
3658                 skb = dev_alloc_skb(len);
3659                 if (!skb) {
3660                         ai->dev->stats.rx_dropped++;
3661                         goto badrx;
3662                 }
3663                 buffer = skb_put(skb,len);
3664                 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3665                 if (ai->micstats.enabled) {
3666                         memcpy(&micbuf,
3667                                 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3668                                 sizeof(micbuf));
3669                         if (ntohs(micbuf.typelen) <= 0x05DC) {
3670                                 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3671                                         goto badmic;
3672
3673                                 off = sizeof(micbuf);
3674                                 skb_trim (skb, len - off);
3675                         }
3676                 }
3677                 memcpy(buffer + ETH_ALEN * 2,
3678                         ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3679                         len - ETH_ALEN * 2 - off);
3680                 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3681 badmic:
3682                         dev_kfree_skb_irq (skb);
3683                         goto badrx;
3684                 }
3685 #ifdef WIRELESS_SPY
3686                 if (ai->spy_data.spy_number > 0) {
3687                         char *sa;
3688                         struct iw_quality wstats;
3689                         /* Prepare spy data : addr + qual */
3690                         sa = buffer + ETH_ALEN;
3691                         wstats.qual = 0; /* XXX Where do I get that info from ??? */
3692                         wstats.level = 0;
3693                         wstats.updated = 0;
3694                         /* Update spy records */
3695                         wireless_spy_update(ai->dev, sa, &wstats);
3696                 }
3697 #endif /* WIRELESS_SPY */
3698
3699                 skb->ip_summed = CHECKSUM_NONE;
3700                 skb->protocol = eth_type_trans(skb, ai->dev);
3701                 netif_rx(skb);
3702         }
3703 badrx:
3704         if (rxd.valid == 0) {
3705                 rxd.valid = 1;
3706                 rxd.rdy = 0;
3707                 rxd.len = PKTSIZE;
3708                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3709         }
3710 }
3711
3712 static void mpi_receive_802_11(struct airo_info *ai)
3713 {
3714         RxFid rxd;
3715         struct sk_buff *skb = NULL;
3716         u16 len, hdrlen = 0;
3717         __le16 fc;
3718         struct rx_hdr hdr;
3719         u16 gap;
3720         u16 *buffer;
3721         char *ptr = ai->rxfids[0].virtual_host_addr + 4;
3722
3723         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3724         memcpy ((char *)&hdr, ptr, sizeof(hdr));
3725         ptr += sizeof(hdr);
3726         /* Bad CRC. Ignore packet */
3727         if (le16_to_cpu(hdr.status) & 2)
3728                 hdr.len = 0;
3729         if (ai->wifidev == NULL)
3730                 hdr.len = 0;
3731         len = le16_to_cpu(hdr.len);
3732         if (len > AIRO_DEF_MTU) {
3733                 airo_print_err(ai->dev->name, "Bad size %d", len);
3734                 goto badrx;
3735         }
3736         if (len == 0)
3737                 goto badrx;
3738
3739         fc = get_unaligned((__le16 *)ptr);
3740         hdrlen = header_len(fc);
3741
3742         skb = dev_alloc_skb( len + hdrlen + 2 );
3743         if ( !skb ) {
3744                 ai->dev->stats.rx_dropped++;
3745                 goto badrx;
3746         }
3747         buffer = skb_put(skb, len + hdrlen);
3748         memcpy ((char *)buffer, ptr, hdrlen);
3749         ptr += hdrlen;
3750         if (hdrlen == 24)
3751                 ptr += 6;
3752         gap = get_unaligned_le16(ptr);
3753         ptr += sizeof(__le16);
3754         if (gap) {
3755                 if (gap <= 8)
3756                         ptr += gap;
3757                 else
3758                         airo_print_err(ai->dev->name,
3759                             "gaplen too big. Problems will follow...");
3760         }
3761         memcpy ((char *)buffer + hdrlen, ptr, len);
3762         ptr += len;
3763 #ifdef IW_WIRELESS_SPY    /* defined in iw_handler.h */
3764         if (ai->spy_data.spy_number > 0) {
3765                 char *sa;
3766                 struct iw_quality wstats;
3767                 /* Prepare spy data : addr + qual */
3768                 sa = (char*)buffer + 10;
3769                 wstats.qual = hdr.rssi[0];
3770                 if (ai->rssi)
3771                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3772                 else
3773                         wstats.level = (hdr.rssi[1] + 321) / 2;
3774                 wstats.noise = ai->wstats.qual.noise;
3775                 wstats.updated = IW_QUAL_QUAL_UPDATED
3776                         | IW_QUAL_LEVEL_UPDATED
3777                         | IW_QUAL_DBM;
3778                 /* Update spy records */
3779                 wireless_spy_update(ai->dev, sa, &wstats);
3780         }
3781 #endif /* IW_WIRELESS_SPY */
3782         skb_reset_mac_header(skb);
3783         skb->pkt_type = PACKET_OTHERHOST;
3784         skb->dev = ai->wifidev;
3785         skb->protocol = htons(ETH_P_802_2);
3786         skb->ip_summed = CHECKSUM_NONE;
3787         netif_rx( skb );
3788
3789 badrx:
3790         if (rxd.valid == 0) {
3791                 rxd.valid = 1;
3792                 rxd.rdy = 0;
3793                 rxd.len = PKTSIZE;
3794                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3795         }
3796 }
3797
3798 static inline void set_auth_type(struct airo_info *local, int auth_type)
3799 {
3800         local->config.authType = auth_type;
3801         /* Cache the last auth type used (of AUTH_OPEN and AUTH_ENCRYPT).
3802          * Used by airo_set_auth()
3803          */
3804         if (auth_type == AUTH_OPEN || auth_type == AUTH_ENCRYPT)
3805                 local->last_auth = auth_type;
3806 }
3807
3808 static u16 setup_card(struct airo_info *ai, u8 *mac, int lock)
3809 {
3810         Cmd cmd;
3811         Resp rsp;
3812         int status;
3813         SsidRid mySsid;
3814         __le16 lastindex;
3815         WepKeyRid wkr;
3816         int rc;
3817
3818         memset( &mySsid, 0, sizeof( mySsid ) );
3819         kfree (ai->flash);
3820         ai->flash = NULL;
3821
3822         /* The NOP is the first step in getting the card going */
3823         cmd.cmd = NOP;
3824         cmd.parm0 = cmd.parm1 = cmd.parm2 = 0;
3825         if (lock && down_interruptible(&ai->sem))
3826                 return ERROR;
3827         if ( issuecommand( ai, &cmd, &rsp ) != SUCCESS ) {
3828                 if (lock)
3829                         up(&ai->sem);
3830                 return ERROR;
3831         }
3832         disable_MAC( ai, 0);
3833
3834         // Let's figure out if we need to use the AUX port
3835         if (!test_bit(FLAG_MPI,&ai->flags)) {
3836                 cmd.cmd = CMD_ENABLEAUX;
3837                 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
3838                         if (lock)
3839                                 up(&ai->sem);
3840                         airo_print_err(ai->dev->name, "Error checking for AUX port");
3841                         return ERROR;
3842                 }
3843                 if (!aux_bap || rsp.status & 0xff00) {
3844                         ai->bap_read = fast_bap_read;
3845                         airo_print_dbg(ai->dev->name, "Doing fast bap_reads");
3846                 } else {
3847                         ai->bap_read = aux_bap_read;
3848                         airo_print_dbg(ai->dev->name, "Doing AUX bap_reads");
3849                 }
3850         }
3851         if (lock)
3852                 up(&ai->sem);
3853         if (ai->config.len == 0) {
3854                 int i;
3855                 tdsRssiRid rssi_rid;
3856                 CapabilityRid cap_rid;
3857
3858                 kfree(ai->SSID);
3859                 ai->SSID = NULL;
3860                 // general configuration (read/modify/write)
3861                 status = readConfigRid(ai, lock);
3862                 if ( status != SUCCESS ) return ERROR;
3863
3864                 status = readCapabilityRid(ai, &cap_rid, lock);
3865                 if ( status != SUCCESS ) return ERROR;
3866
3867                 status = PC4500_readrid(ai,RID_RSSI,&rssi_rid,sizeof(rssi_rid),lock);
3868                 if ( status == SUCCESS ) {
3869                         if (ai->rssi || (ai->rssi = kmalloc(512, GFP_KERNEL)) != NULL)
3870                                 memcpy(ai->rssi, (u8*)&rssi_rid + 2, 512); /* Skip RID length member */
3871                 }
3872                 else {
3873                         kfree(ai->rssi);
3874                         ai->rssi = NULL;
3875                         if (cap_rid.softCap & cpu_to_le16(8))
3876                                 ai->config.rmode |= RXMODE_NORMALIZED_RSSI;
3877                         else
3878                                 airo_print_warn(ai->dev->name, "unknown received signal "
3879                                                 "level scale");
3880                 }
3881                 ai->config.opmode = adhoc ? MODE_STA_IBSS : MODE_STA_ESS;
3882                 set_auth_type(ai, AUTH_OPEN);
3883                 ai->config.modulation = MOD_CCK;
3884
3885                 if (le16_to_cpu(cap_rid.len) >= sizeof(cap_rid) &&
3886                     (cap_rid.extSoftCap & cpu_to_le16(1)) &&
3887                     micsetup(ai) == SUCCESS) {
3888                         ai->config.opmode |= MODE_MIC;
3889                         set_bit(FLAG_MIC_CAPABLE, &ai->flags);
3890                 }
3891
3892                 /* Save off the MAC */
3893                 for( i = 0; i < ETH_ALEN; i++ ) {
3894                         mac[i] = ai->config.macAddr[i];
3895                 }
3896
3897                 /* Check to see if there are any insmod configured
3898                    rates to add */
3899                 if ( rates[0] ) {
3900                         memset(ai->config.rates,0,sizeof(ai->config.rates));
3901                         for( i = 0; i < 8 && rates[i]; i++ ) {
3902                                 ai->config.rates[i] = rates[i];
3903                         }
3904                 }
3905                 set_bit (FLAG_COMMIT, &ai->flags);
3906         }
3907
3908         /* Setup the SSIDs if present */
3909         if ( ssids[0] ) {
3910                 int i;
3911                 for( i = 0; i < 3 && ssids[i]; i++ ) {
3912                         size_t len = strlen(ssids[i]);
3913                         if (len > 32)
3914                                 len = 32;
3915                         mySsid.ssids[i].len = cpu_to_le16(len);
3916                         memcpy(mySsid.ssids[i].ssid, ssids[i], len);
3917                 }
3918                 mySsid.len = cpu_to_le16(sizeof(mySsid));
3919         }
3920
3921         status = writeConfigRid(ai, lock);
3922         if ( status != SUCCESS ) return ERROR;
3923
3924         /* Set up the SSID list */
3925         if ( ssids[0] ) {
3926                 status = writeSsidRid(ai, &mySsid, lock);
3927                 if ( status != SUCCESS ) return ERROR;
3928         }
3929
3930         status = enable_MAC(ai, lock);
3931         if (status != SUCCESS)
3932                 return ERROR;
3933
3934         /* Grab the initial wep key, we gotta save it for auto_wep */
3935         rc = readWepKeyRid(ai, &wkr, 1, lock);
3936         if (rc == SUCCESS) do {
3937                 lastindex = wkr.kindex;
3938                 if (wkr.kindex == cpu_to_le16(0xffff)) {
3939                         ai->defindex = wkr.mac[0];
3940                 }
3941                 rc = readWepKeyRid(ai, &wkr, 0, lock);
3942         } while(lastindex != wkr.kindex);
3943
3944         try_auto_wep(ai);
3945
3946         return SUCCESS;
3947 }
3948
3949 static u16 issuecommand(struct airo_info *ai, Cmd *pCmd, Resp *pRsp) {
3950         // Im really paranoid about letting it run forever!
3951         int max_tries = 600000;
3952
3953         if (IN4500(ai, EVSTAT) & EV_CMD)
3954                 OUT4500(ai, EVACK, EV_CMD);
3955
3956         OUT4500(ai, PARAM0, pCmd->parm0);
3957         OUT4500(ai, PARAM1, pCmd->parm1);
3958         OUT4500(ai, PARAM2, pCmd->parm2);
3959         OUT4500(ai, COMMAND, pCmd->cmd);
3960
3961         while (max_tries-- && (IN4500(ai, EVSTAT) & EV_CMD) == 0) {
3962                 if ((IN4500(ai, COMMAND)) == pCmd->cmd)
3963                         // PC4500 didn't notice command, try again
3964                         OUT4500(ai, COMMAND, pCmd->cmd);
3965                 if (!in_atomic() && (max_tries & 255) == 0)
3966                         schedule();
3967         }
3968
3969         if ( max_tries == -1 ) {
3970                 airo_print_err(ai->dev->name,
3971                         "Max tries exceeded when issuing command");
3972                 if (IN4500(ai, COMMAND) & COMMAND_BUSY)
3973                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3974                 return ERROR;
3975         }
3976
3977         // command completed
3978         pRsp->status = IN4500(ai, STATUS);
3979         pRsp->rsp0 = IN4500(ai, RESP0);
3980         pRsp->rsp1 = IN4500(ai, RESP1);
3981         pRsp->rsp2 = IN4500(ai, RESP2);
3982         if ((pRsp->status & 0xff00)!=0 && pCmd->cmd != CMD_SOFTRESET)
3983                 airo_print_err(ai->dev->name,
3984                         "cmd:%x status:%x rsp0:%x rsp1:%x rsp2:%x",
3985                         pCmd->cmd, pRsp->status, pRsp->rsp0, pRsp->rsp1,
3986                         pRsp->rsp2);
3987
3988         // clear stuck command busy if necessary
3989         if (IN4500(ai, COMMAND) & COMMAND_BUSY) {
3990                 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3991         }
3992         // acknowledge processing the status/response
3993         OUT4500(ai, EVACK, EV_CMD);
3994
3995         return SUCCESS;
3996 }
3997
3998 /* Sets up the bap to start exchange data.  whichbap should
3999  * be one of the BAP0 or BAP1 defines.  Locks should be held before
4000  * calling! */
4001 static int bap_setup(struct airo_info *ai, u16 rid, u16 offset, int whichbap )
4002 {
4003         int timeout = 50;
4004         int max_tries = 3;
4005
4006         OUT4500(ai, SELECT0+whichbap, rid);
4007         OUT4500(ai, OFFSET0+whichbap, offset);
4008         while (1) {
4009                 int status = IN4500(ai, OFFSET0+whichbap);
4010                 if (status & BAP_BUSY) {
4011                         /* This isn't really a timeout, but its kinda
4012                            close */
4013                         if (timeout--) {
4014                                 continue;
4015                         }
4016                 } else if ( status & BAP_ERR ) {
4017                         /* invalid rid or offset */
4018                         airo_print_err(ai->dev->name, "BAP error %x %d",
4019                                 status, whichbap );
4020                         return ERROR;
4021                 } else if (status & BAP_DONE) { // success
4022                         return SUCCESS;
4023                 }
4024                 if ( !(max_tries--) ) {
4025                         airo_print_err(ai->dev->name,
4026                                 "BAP setup error too many retries\n");
4027                         return ERROR;
4028                 }
4029                 // -- PC4500 missed it, try again
4030                 OUT4500(ai, SELECT0+whichbap, rid);
4031                 OUT4500(ai, OFFSET0+whichbap, offset);
4032                 timeout = 50;
4033         }
4034 }
4035
4036 /* should only be called by aux_bap_read.  This aux function and the
4037    following use concepts not documented in the developers guide.  I
4038    got them from a patch given to my by Aironet */
4039 static u16 aux_setup(struct airo_info *ai, u16 page,
4040                      u16 offset, u16 *len)
4041 {
4042         u16 next;
4043
4044         OUT4500(ai, AUXPAGE, page);
4045         OUT4500(ai, AUXOFF, 0);
4046         next = IN4500(ai, AUXDATA);
4047         *len = IN4500(ai, AUXDATA)&0xff;
4048         if (offset != 4) OUT4500(ai, AUXOFF, offset);
4049         return next;
4050 }
4051
4052 /* requires call to bap_setup() first */
4053 static int aux_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4054                         int bytelen, int whichbap)
4055 {
4056         u16 len;
4057         u16 page;
4058         u16 offset;
4059         u16 next;
4060         int words;
4061         int i;
4062         unsigned long flags;
4063
4064         spin_lock_irqsave(&ai->aux_lock, flags);
4065         page = IN4500(ai, SWS0+whichbap);
4066         offset = IN4500(ai, SWS2+whichbap);
4067         next = aux_setup(ai, page, offset, &len);
4068         words = (bytelen+1)>>1;
4069
4070         for (i=0; i<words;) {
4071                 int count;
4072                 count = (len>>1) < (words-i) ? (len>>1) : (words-i);
4073                 if ( !do8bitIO )
4074                         insw( ai->dev->base_addr+DATA0+whichbap,
4075                               pu16Dst+i,count );
4076                 else
4077                         insb( ai->dev->base_addr+DATA0+whichbap,
4078                               pu16Dst+i, count << 1 );
4079                 i += count;
4080                 if (i<words) {
4081                         next = aux_setup(ai, next, 4, &len);
4082                 }
4083         }
4084         spin_unlock_irqrestore(&ai->aux_lock, flags);
4085         return SUCCESS;
4086 }
4087
4088
4089 /* requires call to bap_setup() first */
4090 static int fast_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4091                          int bytelen, int whichbap)
4092 {
4093         bytelen = (bytelen + 1) & (~1); // round up to even value
4094         if ( !do8bitIO )
4095                 insw( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen>>1 );
4096         else
4097                 insb( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen );
4098         return SUCCESS;
4099 }
4100
4101 /* requires call to bap_setup() first */
4102 static int bap_write(struct airo_info *ai, const __le16 *pu16Src,
4103                      int bytelen, int whichbap)
4104 {
4105         bytelen = (bytelen + 1) & (~1); // round up to even value
4106         if ( !do8bitIO )
4107                 outsw( ai->dev->base_addr+DATA0+whichbap,
4108                        pu16Src, bytelen>>1 );
4109         else
4110                 outsb( ai->dev->base_addr+DATA0+whichbap, pu16Src, bytelen );
4111         return SUCCESS;
4112 }
4113
4114 static int PC4500_accessrid(struct airo_info *ai, u16 rid, u16 accmd)
4115 {
4116         Cmd cmd; /* for issuing commands */
4117         Resp rsp; /* response from commands */
4118         u16 status;
4119
4120         memset(&cmd, 0, sizeof(cmd));
4121         cmd.cmd = accmd;
4122         cmd.parm0 = rid;
4123         status = issuecommand(ai, &cmd, &rsp);
4124         if (status != 0) return status;
4125         if ( (rsp.status & 0x7F00) != 0) {
4126                 return (accmd << 8) + (rsp.rsp0 & 0xFF);
4127         }
4128         return 0;
4129 }
4130
4131 /*  Note, that we are using BAP1 which is also used by transmit, so
4132  *  we must get a lock. */
4133 static int PC4500_readrid(struct airo_info *ai, u16 rid, void *pBuf, int len, int lock)
4134 {
4135         u16 status;
4136         int rc = SUCCESS;
4137
4138         if (lock) {
4139                 if (down_interruptible(&ai->sem))
4140                         return ERROR;
4141         }
4142         if (test_bit(FLAG_MPI,&ai->flags)) {
4143                 Cmd cmd;
4144                 Resp rsp;
4145
4146                 memset(&cmd, 0, sizeof(cmd));
4147                 memset(&rsp, 0, sizeof(rsp));
4148                 ai->config_desc.rid_desc.valid = 1;
4149                 ai->config_desc.rid_desc.len = RIDSIZE;
4150                 ai->config_desc.rid_desc.rid = 0;
4151                 ai->config_desc.rid_desc.host_addr = ai->ridbus;
4152
4153                 cmd.cmd = CMD_ACCESS;
4154                 cmd.parm0 = rid;
4155
4156                 memcpy_toio(ai->config_desc.card_ram_off,
4157                         &ai->config_desc.rid_desc, sizeof(Rid));
4158
4159                 rc = issuecommand(ai, &cmd, &rsp);
4160
4161                 if (rsp.status & 0x7f00)
4162                         rc = rsp.rsp0;
4163                 if (!rc)
4164                         memcpy(pBuf, ai->config_desc.virtual_host_addr, len);
4165                 goto done;
4166         } else {
4167                 if ((status = PC4500_accessrid(ai, rid, CMD_ACCESS))!=SUCCESS) {
4168                         rc = status;
4169                         goto done;
4170                 }
4171                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4172                         rc = ERROR;
4173                         goto done;
4174                 }
4175                 // read the rid length field
4176                 bap_read(ai, pBuf, 2, BAP1);
4177                 // length for remaining part of rid
4178                 len = min(len, (int)le16_to_cpu(*(__le16*)pBuf)) - 2;
4179
4180                 if ( len <= 2 ) {
4181                         airo_print_err(ai->dev->name,
4182                                 "Rid %x has a length of %d which is too short",
4183                                 (int)rid, (int)len );
4184                         rc = ERROR;
4185                         goto done;
4186                 }
4187                 // read remainder of the rid
4188                 rc = bap_read(ai, ((__le16*)pBuf)+1, len, BAP1);
4189         }
4190 done:
4191         if (lock)
4192                 up(&ai->sem);
4193         return rc;
4194 }
4195
4196 /*  Note, that we are using BAP1 which is also used by transmit, so
4197  *  make sure this isn't called when a transmit is happening */
4198 static int PC4500_writerid(struct airo_info *ai, u16 rid,
4199                            const void *pBuf, int len, int lock)
4200 {
4201         u16 status;
4202         int rc = SUCCESS;
4203
4204         *(__le16*)pBuf = cpu_to_le16((u16)len);
4205
4206         if (lock) {
4207                 if (down_interruptible(&ai->sem))
4208                         return ERROR;
4209         }
4210         if (test_bit(FLAG_MPI,&ai->flags)) {
4211                 Cmd cmd;
4212                 Resp rsp;
4213
4214                 if (test_bit(FLAG_ENABLED, &ai->flags) && (RID_WEP_TEMP != rid))
4215                         airo_print_err(ai->dev->name,
4216                                 "%s: MAC should be disabled (rid=%04x)",
4217                                 __func__, rid);
4218                 memset(&cmd, 0, sizeof(cmd));
4219                 memset(&rsp, 0, sizeof(rsp));
4220
4221                 ai->config_desc.rid_desc.valid = 1;
4222                 ai->config_desc.rid_desc.len = *((u16 *)pBuf);
4223                 ai->config_desc.rid_desc.rid = 0;
4224
4225                 cmd.cmd = CMD_WRITERID;
4226                 cmd.parm0 = rid;
4227
4228                 memcpy_toio(ai->config_desc.card_ram_off,
4229                         &ai->config_desc.rid_desc, sizeof(Rid));
4230
4231                 if (len < 4 || len > 2047) {
4232                         airo_print_err(ai->dev->name, "%s: len=%d", __func__, len);
4233                         rc = -1;
4234                 } else {
4235                         memcpy(ai->config_desc.virtual_host_addr,
4236                                 pBuf, len);
4237
4238                         rc = issuecommand(ai, &cmd, &rsp);
4239                         if ((rc & 0xff00) != 0) {
4240                                 airo_print_err(ai->dev->name, "%s: Write rid Error %d",
4241                                                 __func__, rc);
4242                                 airo_print_err(ai->dev->name, "%s: Cmd=%04x",
4243                                                 __func__, cmd.cmd);
4244                         }
4245
4246                         if ((rsp.status & 0x7f00))
4247                                 rc = rsp.rsp0;
4248                 }
4249         } else {
4250                 // --- first access so that we can write the rid data
4251                 if ( (status = PC4500_accessrid(ai, rid, CMD_ACCESS)) != 0) {
4252                         rc = status;
4253                         goto done;
4254                 }
4255                 // --- now write the rid data
4256                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4257                         rc = ERROR;
4258                         goto done;
4259                 }
4260                 bap_write(ai, pBuf, len, BAP1);
4261                 // ---now commit the rid data
4262                 rc = PC4500_accessrid(ai, rid, 0x100|CMD_ACCESS);
4263         }
4264 done:
4265         if (lock)
4266                 up(&ai->sem);
4267         return rc;
4268 }
4269
4270 /* Allocates a FID to be used for transmitting packets.  We only use
4271    one for now. */
4272 static u16 transmit_allocate(struct airo_info *ai, int lenPayload, int raw)
4273 {
4274         unsigned int loop = 3000;
4275         Cmd cmd;
4276         Resp rsp;
4277         u16 txFid;
4278         __le16 txControl;
4279
4280         cmd.cmd = CMD_ALLOCATETX;
4281         cmd.parm0 = lenPayload;
4282         if (down_interruptible(&ai->sem))
4283                 return ERROR;
4284         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
4285                 txFid = ERROR;
4286                 goto done;
4287         }
4288         if ( (rsp.status & 0xFF00) != 0) {
4289                 txFid = ERROR;
4290                 goto done;
4291         }
4292         /* wait for the allocate event/indication
4293          * It makes me kind of nervous that this can just sit here and spin,
4294          * but in practice it only loops like four times. */
4295         while (((IN4500(ai, EVSTAT) & EV_ALLOC) == 0) && --loop);
4296         if (!loop) {
4297                 txFid = ERROR;
4298                 goto done;
4299         }
4300
4301         // get the allocated fid and acknowledge
4302         txFid = IN4500(ai, TXALLOCFID);
4303         OUT4500(ai, EVACK, EV_ALLOC);
4304
4305         /*  The CARD is pretty cool since it converts the ethernet packet
4306          *  into 802.11.  Also note that we don't release the FID since we
4307          *  will be using the same one over and over again. */
4308         /*  We only have to setup the control once since we are not
4309          *  releasing the fid. */
4310         if (raw)
4311                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_11
4312                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4313         else
4314                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_3
4315                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4316         if (bap_setup(ai, txFid, 0x0008, BAP1) != SUCCESS)
4317                 txFid = ERROR;
4318         else
4319                 bap_write(ai, &txControl, sizeof(txControl), BAP1);
4320
4321 done:
4322         up(&ai->sem);
4323
4324         return txFid;
4325 }
4326
4327 /* In general BAP1 is dedicated to transmiting packets.  However,
4328    since we need a BAP when accessing RIDs, we also use BAP1 for that.
4329    Make sure the BAP1 spinlock is held when this is called. */
4330 static int transmit_802_3_packet(struct airo_info *ai, int len, char *pPacket)
4331 {
4332         __le16 payloadLen;
4333         Cmd cmd;
4334         Resp rsp;
4335         int miclen = 0;
4336         u16 txFid = len;
4337         MICBuffer pMic;
4338
4339         len >>= 16;
4340
4341         if (len <= ETH_ALEN * 2) {
4342                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4343                 return ERROR;
4344         }
4345         len -= ETH_ALEN * 2;
4346
4347         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
4348             (ntohs(((__be16 *)pPacket)[6]) != 0x888E)) {
4349                 if (encapsulate(ai,(etherHead *)pPacket,&pMic,len) != SUCCESS)
4350                         return ERROR;
4351                 miclen = sizeof(pMic);
4352         }
4353         // packet is destination[6], source[6], payload[len-12]
4354         // write the payload length and dst/src/payload
4355         if (bap_setup(ai, txFid, 0x0036, BAP1) != SUCCESS) return ERROR;
4356         /* The hardware addresses aren't counted as part of the payload, so
4357          * we have to subtract the 12 bytes for the addresses off */
4358         payloadLen = cpu_to_le16(len + miclen);
4359         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4360         bap_write(ai, (__le16*)pPacket, sizeof(etherHead), BAP1);
4361         if (miclen)
4362                 bap_write(ai, (__le16*)&pMic, miclen, BAP1);
4363         bap_write(ai, (__le16*)(pPacket + sizeof(etherHead)), len, BAP1);
4364         // issue the transmit command
4365         memset( &cmd, 0, sizeof( cmd ) );
4366         cmd.cmd = CMD_TRANSMIT;
4367         cmd.parm0 = txFid;
4368         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4369         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4370         return SUCCESS;
4371 }
4372
4373 static int transmit_802_11_packet(struct airo_info *ai, int len, char *pPacket)
4374 {
4375         __le16 fc, payloadLen;
4376         Cmd cmd;
4377         Resp rsp;
4378         int hdrlen;
4379         static u8 tail[(30-10) + 2 + 6] = {[30-10] = 6};
4380         /* padding of header to full size + le16 gaplen (6) + gaplen bytes */
4381         u16 txFid = len;
4382         len >>= 16;
4383
4384         fc = *(__le16*)pPacket;
4385         hdrlen = header_len(fc);
4386
4387         if (len < hdrlen) {
4388                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4389                 return ERROR;
4390         }
4391
4392         /* packet is 802.11 header +  payload
4393          * write the payload length and dst/src/payload */
4394         if (bap_setup(ai, txFid, 6, BAP1) != SUCCESS) return ERROR;
4395         /* The 802.11 header aren't counted as part of the payload, so
4396          * we have to subtract the header bytes off */
4397         payloadLen = cpu_to_le16(len-hdrlen);
4398         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4399         if (bap_setup(ai, txFid, 0x0014, BAP1) != SUCCESS) return ERROR;
4400         bap_write(ai, (__le16 *)pPacket, hdrlen, BAP1);
4401         bap_write(ai, (__le16 *)(tail + (hdrlen - 10)), 38 - hdrlen, BAP1);
4402
4403         bap_write(ai, (__le16 *)(pPacket + hdrlen), len - hdrlen, BAP1);
4404         // issue the transmit command
4405         memset( &cmd, 0, sizeof( cmd ) );
4406         cmd.cmd = CMD_TRANSMIT;
4407         cmd.parm0 = txFid;
4408         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4409         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4410         return SUCCESS;
4411 }
4412
4413 /*
4414  *  This is the proc_fs routines.  It is a bit messier than I would
4415  *  like!  Feel free to clean it up!
4416  */
4417
4418 static ssize_t proc_read( struct file *file,
4419                           char __user *buffer,
4420                           size_t len,
4421                           loff_t *offset);
4422
4423 static ssize_t proc_write( struct file *file,
4424                            const char __user *buffer,
4425                            size_t len,
4426                            loff_t *offset );
4427 static int proc_close( struct inode *inode, struct file *file );
4428
4429 static int proc_stats_open( struct inode *inode, struct file *file );
4430 static int proc_statsdelta_open( struct inode *inode, struct file *file );
4431 static int proc_status_open( struct inode *inode, struct file *file );
4432 static int proc_SSID_open( struct inode *inode, struct file *file );
4433 static int proc_APList_open( struct inode *inode, struct file *file );
4434 static int proc_BSSList_open( struct inode *inode, struct file *file );
4435 static int proc_config_open( struct inode *inode, struct file *file );
4436 static int proc_wepkey_open( struct inode *inode, struct file *file );
4437
4438 static const struct file_operations proc_statsdelta_ops = {
4439         .owner          = THIS_MODULE,
4440         .read           = proc_read,
4441         .open           = proc_statsdelta_open,
4442         .release        = proc_close,
4443         .llseek         = default_llseek,
4444 };
4445
4446 static const struct file_operations proc_stats_ops = {
4447         .owner          = THIS_MODULE,
4448         .read           = proc_read,
4449         .open           = proc_stats_open,
4450         .release        = proc_close,
4451         .llseek         = default_llseek,
4452 };
4453
4454 static const struct file_operations proc_status_ops = {
4455         .owner          = THIS_MODULE,
4456         .read           = proc_read,
4457         .open           = proc_status_open,
4458         .release        = proc_close,
4459         .llseek         = default_llseek,
4460 };
4461
4462 static const struct file_operations proc_SSID_ops = {
4463         .owner          = THIS_MODULE,
4464         .read           = proc_read,
4465         .write          = proc_write,
4466         .open           = proc_SSID_open,
4467         .release        = proc_close,
4468         .llseek         = default_llseek,
4469 };
4470
4471 static const struct file_operations proc_BSSList_ops = {
4472         .owner          = THIS_MODULE,
4473         .read           = proc_read,
4474         .write          = proc_write,
4475         .open           = proc_BSSList_open,
4476         .release        = proc_close,
4477         .llseek         = default_llseek,
4478 };
4479
4480 static const struct file_operations proc_APList_ops = {
4481         .owner          = THIS_MODULE,
4482         .read           = proc_read,
4483         .write          = proc_write,
4484         .open           = proc_APList_open,
4485         .release        = proc_close,
4486         .llseek         = default_llseek,
4487 };
4488
4489 static const struct file_operations proc_config_ops = {
4490         .owner          = THIS_MODULE,
4491         .read           = proc_read,
4492         .write          = proc_write,
4493         .open           = proc_config_open,
4494         .release        = proc_close,
4495         .llseek         = default_llseek,
4496 };
4497
4498 static const struct file_operations proc_wepkey_ops = {
4499         .owner          = THIS_MODULE,
4500         .read           = proc_read,
4501         .write          = proc_write,
4502         .open           = proc_wepkey_open,
4503         .release        = proc_close,
4504         .llseek         = default_llseek,
4505 };
4506
4507 static struct proc_dir_entry *airo_entry;
4508
4509 struct proc_data {
4510         int release_buffer;
4511         int readlen;
4512         char *rbuffer;
4513         int writelen;
4514         int maxwritelen;
4515         char *wbuffer;
4516         void (*on_close) (struct inode *, struct file *);
4517 };
4518
4519 static int setup_proc_entry( struct net_device *dev,
4520                              struct airo_info *apriv ) {
4521         struct proc_dir_entry *entry;
4522
4523         /* First setup the device directory */
4524         strcpy(apriv->proc_name,dev->name);
4525         apriv->proc_entry = proc_mkdir_mode(apriv->proc_name, airo_perm,
4526                                             airo_entry);
4527         if (!apriv->proc_entry)
4528                 return -ENOMEM;
4529         proc_set_user(apriv->proc_entry, proc_kuid, proc_kgid);
4530
4531         /* Setup the StatsDelta */
4532         entry = proc_create_data("StatsDelta", 0444 & proc_perm,
4533                                  apriv->proc_entry, &proc_statsdelta_ops, dev);
4534         if (!entry)
4535                 goto fail;
4536         proc_set_user(entry, proc_kuid, proc_kgid);
4537
4538         /* Setup the Stats */
4539         entry = proc_create_data("Stats", 0444 & proc_perm,
4540                                  apriv->proc_entry, &proc_stats_ops, dev);
4541         if (!entry)
4542                 goto fail;
4543         proc_set_user(entry, proc_kuid, proc_kgid);
4544
4545         /* Setup the Status */
4546         entry = proc_create_data("Status", 0444 & proc_perm,
4547                                  apriv->proc_entry, &proc_status_ops, dev);
4548         if (!entry)
4549                 goto fail;
4550         proc_set_user(entry, proc_kuid, proc_kgid);
4551
4552         /* Setup the Config */
4553         entry = proc_create_data("Config", proc_perm,
4554                                  apriv->proc_entry, &proc_config_ops, dev);
4555         if (!entry)
4556                 goto fail;
4557         proc_set_user(entry, proc_kuid, proc_kgid);
4558
4559         /* Setup the SSID */
4560         entry = proc_create_data("SSID", proc_perm,
4561                                  apriv->proc_entry, &proc_SSID_ops, dev);
4562         if (!entry)
4563                 goto fail;
4564         proc_set_user(entry, proc_kuid, proc_kgid);
4565
4566         /* Setup the APList */
4567         entry = proc_create_data("APList", proc_perm,
4568                                  apriv->proc_entry, &proc_APList_ops, dev);
4569         if (!entry)
4570                 goto fail;
4571         proc_set_user(entry, proc_kuid, proc_kgid);
4572
4573         /* Setup the BSSList */
4574         entry = proc_create_data("BSSList", proc_perm,
4575                                  apriv->proc_entry, &proc_BSSList_ops, dev);
4576         if (!entry)
4577                 goto fail;
4578         proc_set_user(entry, proc_kuid, proc_kgid);
4579
4580         /* Setup the WepKey */
4581         entry = proc_create_data("WepKey", proc_perm,
4582                                  apriv->proc_entry, &proc_wepkey_ops, dev);
4583         if (!entry)
4584                 goto fail;
4585         proc_set_user(entry, proc_kuid, proc_kgid);
4586         return 0;
4587
4588 fail:
4589         remove_proc_subtree(apriv->proc_name, airo_entry);
4590         return -ENOMEM;
4591 }
4592
4593 static int takedown_proc_entry( struct net_device *dev,
4594                                 struct airo_info *apriv )
4595 {
4596         remove_proc_subtree(apriv->proc_name, airo_entry);
4597         return 0;
4598 }
4599
4600 /*
4601  *  What we want from the proc_fs is to be able to efficiently read
4602  *  and write the configuration.  To do this, we want to read the
4603  *  configuration when the file is opened and write it when the file is
4604  *  closed.  So basically we allocate a read buffer at open and fill it
4605  *  with data, and allocate a write buffer and read it at close.
4606  */
4607
4608 /*
4609  *  The read routine is generic, it relies on the preallocated rbuffer
4610  *  to supply the data.
4611  */
4612 static ssize_t proc_read( struct file *file,
4613                           char __user *buffer,
4614                           size_t len,
4615                           loff_t *offset )
4616 {
4617         struct proc_data *priv = file->private_data;
4618
4619         if (!priv->rbuffer)
4620                 return -EINVAL;
4621
4622         return simple_read_from_buffer(buffer, len, offset, priv->rbuffer,
4623                                         priv->readlen);
4624 }
4625
4626 /*
4627  *  The write routine is generic, it fills in a preallocated rbuffer
4628  *  to supply the data.
4629  */
4630 static ssize_t proc_write( struct file *file,
4631                            const char __user *buffer,
4632                            size_t len,
4633                            loff_t *offset )
4634 {
4635         ssize_t ret;
4636         struct proc_data *priv = file->private_data;
4637
4638         if (!priv->wbuffer)
4639                 return -EINVAL;
4640
4641         ret = simple_write_to_buffer(priv->wbuffer, priv->maxwritelen, offset,
4642                                         buffer, len);
4643         if (ret > 0)
4644                 priv->writelen = max_t(int, priv->writelen, *offset);
4645
4646         return ret;
4647 }
4648
4649 static int proc_status_open(struct inode *inode, struct file *file)
4650 {
4651         struct proc_data *data;
4652         struct net_device *dev = PDE_DATA(inode);
4653         struct airo_info *apriv = dev->ml_priv;
4654         CapabilityRid cap_rid;
4655         StatusRid status_rid;
4656         u16 mode;
4657         int i;
4658
4659         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4660                 return -ENOMEM;
4661         data = file->private_data;
4662         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4663                 kfree (file->private_data);
4664                 return -ENOMEM;
4665         }
4666
4667         readStatusRid(apriv, &status_rid, 1);
4668         readCapabilityRid(apriv, &cap_rid, 1);
4669
4670         mode = le16_to_cpu(status_rid.mode);
4671
4672         i = sprintf(data->rbuffer, "Status: %s%s%s%s%s%s%s%s%s\n",
4673                     mode & 1 ? "CFG ": "",
4674                     mode & 2 ? "ACT ": "",
4675                     mode & 0x10 ? "SYN ": "",
4676                     mode & 0x20 ? "LNK ": "",
4677                     mode & 0x40 ? "LEAP ": "",
4678                     mode & 0x80 ? "PRIV ": "",
4679                     mode & 0x100 ? "KEY ": "",
4680                     mode & 0x200 ? "WEP ": "",
4681                     mode & 0x8000 ? "ERR ": "");
4682         sprintf( data->rbuffer+i, "Mode: %x\n"
4683                  "Signal Strength: %d\n"
4684                  "Signal Quality: %d\n"
4685                  "SSID: %-.*s\n"
4686                  "AP: %-.16s\n"
4687                  "Freq: %d\n"
4688                  "BitRate: %dmbs\n"
4689                  "Driver Version: %s\n"
4690                  "Device: %s\nManufacturer: %s\nFirmware Version: %s\n"
4691                  "Radio type: %x\nCountry: %x\nHardware Version: %x\n"
4692                  "Software Version: %x\nSoftware Subversion: %x\n"
4693                  "Boot block version: %x\n",
4694                  le16_to_cpu(status_rid.mode),
4695                  le16_to_cpu(status_rid.normalizedSignalStrength),
4696                  le16_to_cpu(status_rid.signalQuality),
4697                  le16_to_cpu(status_rid.SSIDlen),
4698                  status_rid.SSID,
4699                  status_rid.apName,
4700                  le16_to_cpu(status_rid.channel),
4701                  le16_to_cpu(status_rid.currentXmitRate) / 2,
4702                  version,
4703                  cap_rid.prodName,
4704                  cap_rid.manName,
4705                  cap_rid.prodVer,
4706                  le16_to_cpu(cap_rid.radioType),
4707                  le16_to_cpu(cap_rid.country),
4708                  le16_to_cpu(cap_rid.hardVer),
4709                  le16_to_cpu(cap_rid.softVer),
4710                  le16_to_cpu(cap_rid.softSubVer),
4711                  le16_to_cpu(cap_rid.bootBlockVer));
4712         data->readlen = strlen( data->rbuffer );
4713         return 0;
4714 }
4715
4716 static int proc_stats_rid_open(struct inode*, struct file*, u16);
4717 static int proc_statsdelta_open( struct inode *inode,
4718                                  struct file *file ) {
4719         if (file->f_mode&FMODE_WRITE) {
4720                 return proc_stats_rid_open(inode, file, RID_STATSDELTACLEAR);
4721         }
4722         return proc_stats_rid_open(inode, file, RID_STATSDELTA);
4723 }
4724
4725 static int proc_stats_open( struct inode *inode, struct file *file ) {
4726         return proc_stats_rid_open(inode, file, RID_STATS);
4727 }
4728
4729 static int proc_stats_rid_open( struct inode *inode,
4730                                 struct file *file,
4731                                 u16 rid )
4732 {
4733         struct proc_data *data;
4734         struct net_device *dev = PDE_DATA(inode);
4735         struct airo_info *apriv = dev->ml_priv;
4736         StatsRid stats;
4737         int i, j;
4738         __le32 *vals = stats.vals;
4739         int len;
4740
4741         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4742                 return -ENOMEM;
4743         data = file->private_data;
4744         if ((data->rbuffer = kmalloc( 4096, GFP_KERNEL )) == NULL) {
4745                 kfree (file->private_data);
4746                 return -ENOMEM;
4747         }
4748
4749         readStatsRid(apriv, &stats, rid, 1);
4750         len = le16_to_cpu(stats.len);
4751
4752         j = 0;
4753         for(i=0; statsLabels[i]!=(char *)-1 && i*4<len; i++) {
4754                 if (!statsLabels[i]) continue;
4755                 if (j+strlen(statsLabels[i])+16>4096) {
4756                         airo_print_warn(apriv->dev->name,
4757                                "Potentially disastrous buffer overflow averted!");
4758                         break;
4759                 }
4760                 j+=sprintf(data->rbuffer+j, "%s: %u\n", statsLabels[i],
4761                                 le32_to_cpu(vals[i]));
4762         }
4763         if (i*4 >= len) {
4764                 airo_print_warn(apriv->dev->name, "Got a short rid");
4765         }
4766         data->readlen = j;
4767         return 0;
4768 }
4769
4770 static int get_dec_u16( char *buffer, int *start, int limit ) {
4771         u16 value;
4772         int valid = 0;
4773         for (value = 0; *start < limit && buffer[*start] >= '0' &&
4774                         buffer[*start] <= '9'; (*start)++) {
4775                 valid = 1;
4776                 value *= 10;
4777                 value += buffer[*start] - '0';
4778         }
4779         if ( !valid ) return -1;
4780         return value;
4781 }
4782
4783 static int airo_config_commit(struct net_device *dev,
4784                               struct iw_request_info *info, void *zwrq,
4785                               char *extra);
4786
4787 static inline int sniffing_mode(struct airo_info *ai)
4788 {
4789         return (le16_to_cpu(ai->config.rmode) & le16_to_cpu(RXMODE_MASK)) >=
4790                 le16_to_cpu(RXMODE_RFMON);
4791 }
4792
4793 static void proc_config_on_close(struct inode *inode, struct file *file)
4794 {
4795         struct proc_data *data = file->private_data;
4796         struct net_device *dev = PDE_DATA(inode);
4797         struct airo_info *ai = dev->ml_priv;
4798         char *line;
4799
4800         if ( !data->writelen ) return;
4801
4802         readConfigRid(ai, 1);
4803         set_bit (FLAG_COMMIT, &ai->flags);
4804
4805         line = data->wbuffer;
4806         while( line[0] ) {
4807 /*** Mode processing */
4808                 if ( !strncmp( line, "Mode: ", 6 ) ) {
4809                         line += 6;
4810                         if (sniffing_mode(ai))
4811                                 set_bit (FLAG_RESET, &ai->flags);
4812                         ai->config.rmode &= ~RXMODE_FULL_MASK;
4813                         clear_bit (FLAG_802_11, &ai->flags);
4814                         ai->config.opmode &= ~MODE_CFG_MASK;
4815                         ai->config.scanMode = SCANMODE_ACTIVE;
4816                         if ( line[0] == 'a' ) {
4817                                 ai->config.opmode |= MODE_STA_IBSS;
4818                         } else {
4819                                 ai->config.opmode |= MODE_STA_ESS;
4820                                 if ( line[0] == 'r' ) {
4821                                         ai->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
4822                                         ai->config.scanMode = SCANMODE_PASSIVE;
4823                                         set_bit (FLAG_802_11, &ai->flags);
4824                                 } else if ( line[0] == 'y' ) {
4825                                         ai->config.rmode |= RXMODE_RFMON_ANYBSS | RXMODE_DISABLE_802_3_HEADER;
4826                                         ai->config.scanMode = SCANMODE_PASSIVE;
4827                                         set_bit (FLAG_802_11, &ai->flags);
4828                                 } else if ( line[0] == 'l' )
4829                                         ai->config.rmode |= RXMODE_LANMON;
4830                         }
4831                         set_bit (FLAG_COMMIT, &ai->flags);
4832                 }
4833
4834 /*** Radio status */
4835                 else if (!strncmp(line,"Radio: ", 7)) {
4836                         line += 7;
4837                         if (!strncmp(line,"off",3)) {
4838                                 set_bit (FLAG_RADIO_OFF, &ai->flags);
4839                         } else {
4840                                 clear_bit (FLAG_RADIO_OFF, &ai->flags);
4841                         }
4842                 }
4843 /*** NodeName processing */
4844                 else if ( !strncmp( line, "NodeName: ", 10 ) ) {
4845                         int j;
4846
4847                         line += 10;
4848                         memset( ai->config.nodeName, 0, 16 );
4849 /* Do the name, assume a space between the mode and node name */
4850                         for( j = 0; j < 16 && line[j] != '\n'; j++ ) {
4851                                 ai->config.nodeName[j] = line[j];
4852                         }
4853                         set_bit (FLAG_COMMIT, &ai->flags);
4854                 }
4855
4856 /*** PowerMode processing */
4857                 else if ( !strncmp( line, "PowerMode: ", 11 ) ) {
4858                         line += 11;
4859                         if ( !strncmp( line, "PSPCAM", 6 ) ) {
4860                                 ai->config.powerSaveMode = POWERSAVE_PSPCAM;
4861                                 set_bit (FLAG_COMMIT, &ai->flags);
4862                         } else if ( !strncmp( line, "PSP", 3 ) ) {
4863                                 ai->config.powerSaveMode = POWERSAVE_PSP;
4864                                 set_bit (FLAG_COMMIT, &ai->flags);
4865                         } else {
4866                                 ai->config.powerSaveMode = POWERSAVE_CAM;
4867                                 set_bit (FLAG_COMMIT, &ai->flags);
4868                         }
4869                 } else if ( !strncmp( line, "DataRates: ", 11 ) ) {
4870                         int v, i = 0, k = 0; /* i is index into line,
4871                                                 k is index to rates */
4872
4873                         line += 11;
4874                         while((v = get_dec_u16(line, &i, 3))!=-1) {
4875                                 ai->config.rates[k++] = (u8)v;
4876                                 line += i + 1;
4877                                 i = 0;
4878                         }
4879                         set_bit (FLAG_COMMIT, &ai->flags);
4880                 } else if ( !strncmp( line, "Channel: ", 9 ) ) {
4881                         int v, i = 0;
4882                         line += 9;
4883                         v = get_dec_u16(line, &i, i+3);
4884                         if ( v != -1 ) {
4885                                 ai->config.channelSet = cpu_to_le16(v);
4886                                 set_bit (FLAG_COMMIT, &ai->flags);
4887                         }
4888                 } else if ( !strncmp( line, "XmitPower: ", 11 ) ) {
4889                         int v, i = 0;
4890                         line += 11;
4891                         v = get_dec_u16(line, &i, i+3);
4892                         if ( v != -1 ) {
4893                                 ai->config.txPower = cpu_to_le16(v);
4894                                 set_bit (FLAG_COMMIT, &ai->flags);
4895                         }
4896                 } else if ( !strncmp( line, "WEP: ", 5 ) ) {
4897                         line += 5;
4898                         switch( line[0] ) {
4899                         case 's':
4900                                 set_auth_type(ai, AUTH_SHAREDKEY);
4901                                 break;
4902                         case 'e':
4903                                 set_auth_type(ai, AUTH_ENCRYPT);
4904                                 break;
4905                         default:
4906                                 set_auth_type(ai, AUTH_OPEN);
4907                                 break;
4908                         }
4909                         set_bit (FLAG_COMMIT, &ai->flags);
4910                 } else if ( !strncmp( line, "LongRetryLimit: ", 16 ) ) {
4911                         int v, i = 0;
4912
4913                         line += 16;
4914                         v = get_dec_u16(line, &i, 3);
4915                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4916                         ai->config.longRetryLimit = cpu_to_le16(v);
4917                         set_bit (FLAG_COMMIT, &ai->flags);
4918                 } else if ( !strncmp( line, "ShortRetryLimit: ", 17 ) ) {
4919                         int v, i = 0;
4920
4921                         line += 17;
4922                         v = get_dec_u16(line, &i, 3);
4923                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4924                         ai->config.shortRetryLimit = cpu_to_le16(v);
4925                         set_bit (FLAG_COMMIT, &ai->flags);
4926                 } else if ( !strncmp( line, "RTSThreshold: ", 14 ) ) {
4927                         int v, i = 0;
4928
4929                         line += 14;
4930                         v = get_dec_u16(line, &i, 4);
4931                         v = (v<0) ? 0 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4932                         ai->config.rtsThres = cpu_to_le16(v);
4933                         set_bit (FLAG_COMMIT, &ai->flags);
4934                 } else if ( !strncmp( line, "TXMSDULifetime: ", 16 ) ) {
4935                         int v, i = 0;
4936
4937                         line += 16;
4938                         v = get_dec_u16(line, &i, 5);
4939                         v = (v<0) ? 0 : v;
4940                         ai->config.txLifetime = cpu_to_le16(v);
4941                         set_bit (FLAG_COMMIT, &ai->flags);
4942                 } else if ( !strncmp( line, "RXMSDULifetime: ", 16 ) ) {
4943                         int v, i = 0;
4944
4945                         line += 16;
4946                         v = get_dec_u16(line, &i, 5);
4947                         v = (v<0) ? 0 : v;
4948                         ai->config.rxLifetime = cpu_to_le16(v);
4949                         set_bit (FLAG_COMMIT, &ai->flags);
4950                 } else if ( !strncmp( line, "TXDiversity: ", 13 ) ) {
4951                         ai->config.txDiversity =
4952                                 (line[13]=='l') ? 1 :
4953                                 ((line[13]=='r')? 2: 3);
4954                         set_bit (FLAG_COMMIT, &ai->flags);
4955                 } else if ( !strncmp( line, "RXDiversity: ", 13 ) ) {
4956                         ai->config.rxDiversity =
4957                                 (line[13]=='l') ? 1 :
4958                                 ((line[13]=='r')? 2: 3);
4959                         set_bit (FLAG_COMMIT, &ai->flags);
4960                 } else if ( !strncmp( line, "FragThreshold: ", 15 ) ) {
4961                         int v, i = 0;
4962
4963                         line += 15;
4964                         v = get_dec_u16(line, &i, 4);
4965                         v = (v<256) ? 256 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4966                         v = v & 0xfffe; /* Make sure its even */
4967                         ai->config.fragThresh = cpu_to_le16(v);
4968                         set_bit (FLAG_COMMIT, &ai->flags);
4969                 } else if (!strncmp(line, "Modulation: ", 12)) {
4970                         line += 12;
4971                         switch(*line) {
4972                         case 'd':  ai->config.modulation=MOD_DEFAULT; set_bit(FLAG_COMMIT, &ai->flags); break;
4973                         case 'c':  ai->config.modulation=MOD_CCK; set_bit(FLAG_COMMIT, &ai->flags); break;
4974                         case 'm':  ai->config.modulation=MOD_MOK; set_bit(FLAG_COMMIT, &ai->flags); break;
4975                         default: airo_print_warn(ai->dev->name, "Unknown modulation");
4976                         }
4977                 } else if (!strncmp(line, "Preamble: ", 10)) {
4978                         line += 10;
4979                         switch(*line) {
4980                         case 'a': ai->config.preamble=PREAMBLE_AUTO; set_bit(FLAG_COMMIT, &ai->flags); break;
4981                         case 'l': ai->config.preamble=PREAMBLE_LONG; set_bit(FLAG_COMMIT, &ai->flags); break;
4982                         case 's': ai->config.preamble=PREAMBLE_SHORT; set_bit(FLAG_COMMIT, &ai->flags); break;
4983                         default: airo_print_warn(ai->dev->name, "Unknown preamble");
4984                         }
4985                 } else {
4986                         airo_print_warn(ai->dev->name, "Couldn't figure out %s", line);
4987                 }
4988                 while( line[0] && line[0] != '\n' ) line++;
4989                 if ( line[0] ) line++;
4990         }
4991         airo_config_commit(dev, NULL, NULL, NULL);
4992 }
4993
4994 static const char *get_rmode(__le16 mode)
4995 {
4996         switch(mode & RXMODE_MASK) {
4997         case RXMODE_RFMON:  return "rfmon";
4998         case RXMODE_RFMON_ANYBSS:  return "yna (any) bss rfmon";
4999         case RXMODE_LANMON:  return "lanmon";
5000         }
5001         return "ESS";
5002 }
5003
5004 static int proc_config_open(struct inode *inode, struct file *file)
5005 {
5006         struct proc_data *data;
5007         struct net_device *dev = PDE_DATA(inode);
5008         struct airo_info *ai = dev->ml_priv;
5009         int i;
5010         __le16 mode;
5011
5012         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5013                 return -ENOMEM;
5014         data = file->private_data;
5015         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
5016                 kfree (file->private_data);
5017                 return -ENOMEM;
5018         }
5019         if ((data->wbuffer = kzalloc( 2048, GFP_KERNEL )) == NULL) {
5020                 kfree (data->rbuffer);
5021                 kfree (file->private_data);
5022                 return -ENOMEM;
5023         }
5024         data->maxwritelen = 2048;
5025         data->on_close = proc_config_on_close;
5026
5027         readConfigRid(ai, 1);
5028
5029         mode = ai->config.opmode & MODE_CFG_MASK;
5030         i = sprintf( data->rbuffer,
5031                      "Mode: %s\n"
5032                      "Radio: %s\n"
5033                      "NodeName: %-16s\n"
5034                      "PowerMode: %s\n"
5035                      "DataRates: %d %d %d %d %d %d %d %d\n"
5036                      "Channel: %d\n"
5037                      "XmitPower: %d\n",
5038                      mode == MODE_STA_IBSS ? "adhoc" :
5039                      mode == MODE_STA_ESS ? get_rmode(ai->config.rmode):
5040                      mode == MODE_AP ? "AP" :
5041                      mode == MODE_AP_RPTR ? "AP RPTR" : "Error",
5042                      test_bit(FLAG_RADIO_OFF, &ai->flags) ? "off" : "on",
5043                      ai->config.nodeName,
5044                      ai->config.powerSaveMode == POWERSAVE_CAM ? "CAM" :
5045                      ai->config.powerSaveMode == POWERSAVE_PSP ? "PSP" :
5046                      ai->config.powerSaveMode == POWERSAVE_PSPCAM ? "PSPCAM" :
5047                      "Error",
5048                      (int)ai->config.rates[0],
5049                      (int)ai->config.rates[1],
5050                      (int)ai->config.rates[2],
5051                      (int)ai->config.rates[3],
5052                      (int)ai->config.rates[4],
5053                      (int)ai->config.rates[5],
5054                      (int)ai->config.rates[6],
5055                      (int)ai->config.rates[7],
5056                      le16_to_cpu(ai->config.channelSet),
5057                      le16_to_cpu(ai->config.txPower)
5058                 );
5059         sprintf( data->rbuffer + i,
5060                  "LongRetryLimit: %d\n"
5061                  "ShortRetryLimit: %d\n"
5062                  "RTSThreshold: %d\n"
5063                  "TXMSDULifetime: %d\n"
5064                  "RXMSDULifetime: %d\n"
5065                  "TXDiversity: %s\n"
5066                  "RXDiversity: %s\n"
5067                  "FragThreshold: %d\n"
5068                  "WEP: %s\n"
5069                  "Modulation: %s\n"
5070                  "Preamble: %s\n",
5071                  le16_to_cpu(ai->config.longRetryLimit),
5072                  le16_to_cpu(ai->config.shortRetryLimit),
5073                  le16_to_cpu(ai->config.rtsThres),
5074                  le16_to_cpu(ai->config.txLifetime),
5075                  le16_to_cpu(ai->config.rxLifetime),
5076                  ai->config.txDiversity == 1 ? "left" :
5077                  ai->config.txDiversity == 2 ? "right" : "both",
5078                  ai->config.rxDiversity == 1 ? "left" :
5079                  ai->config.rxDiversity == 2 ? "right" : "both",
5080                  le16_to_cpu(ai->config.fragThresh),
5081                  ai->config.authType == AUTH_ENCRYPT ? "encrypt" :
5082                  ai->config.authType == AUTH_SHAREDKEY ? "shared" : "open",
5083                  ai->config.modulation == MOD_DEFAULT ? "default" :
5084                  ai->config.modulation == MOD_CCK ? "cck" :
5085                  ai->config.modulation == MOD_MOK ? "mok" : "error",
5086                  ai->config.preamble == PREAMBLE_AUTO ? "auto" :
5087                  ai->config.preamble == PREAMBLE_LONG ? "long" :
5088                  ai->config.preamble == PREAMBLE_SHORT ? "short" : "error"
5089                 );
5090         data->readlen = strlen( data->rbuffer );
5091         return 0;
5092 }
5093
5094 static void proc_SSID_on_close(struct inode *inode, struct file *file)
5095 {
5096         struct proc_data *data = file->private_data;
5097         struct net_device *dev = PDE_DATA(inode);
5098         struct airo_info *ai = dev->ml_priv;
5099         SsidRid SSID_rid;
5100         int i;
5101         char *p = data->wbuffer;
5102         char *end = p + data->writelen;
5103
5104         if (!data->writelen)
5105                 return;
5106
5107         *end = '\n'; /* sentinel; we have space for it */
5108
5109         memset(&SSID_rid, 0, sizeof(SSID_rid));
5110
5111         for (i = 0; i < 3 && p < end; i++) {
5112                 int j = 0;
5113                 /* copy up to 32 characters from this line */
5114                 while (*p != '\n' && j < 32)
5115                         SSID_rid.ssids[i].ssid[j++] = *p++;
5116                 if (j == 0)
5117                         break;
5118                 SSID_rid.ssids[i].len = cpu_to_le16(j);
5119                 /* skip to the beginning of the next line */
5120                 while (*p++ != '\n')
5121                         ;
5122         }
5123         if (i)
5124                 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5125         disable_MAC(ai, 1);
5126         writeSsidRid(ai, &SSID_rid, 1);
5127         enable_MAC(ai, 1);
5128 }
5129
5130 static void proc_APList_on_close( struct inode *inode, struct file *file ) {
5131         struct proc_data *data = file->private_data;
5132         struct net_device *dev = PDE_DATA(inode);
5133         struct airo_info *ai = dev->ml_priv;
5134         APListRid *APList_rid = &ai->APList;
5135         int i;
5136
5137         if ( !data->writelen ) return;
5138
5139         memset(APList_rid, 0, sizeof(*APList_rid));
5140         APList_rid->len = cpu_to_le16(sizeof(*APList_rid));
5141
5142         for (i = 0; i < 4 && data->writelen >= (i + 1) * 6 * 3; i++)
5143                 mac_pton(data->wbuffer + i * 6 * 3, APList_rid->ap[i]);
5144
5145         disable_MAC(ai, 1);
5146         writeAPListRid(ai, APList_rid, 1);
5147         enable_MAC(ai, 1);
5148 }
5149
5150 /* This function wraps PC4500_writerid with a MAC disable */
5151 static int do_writerid( struct airo_info *ai, u16 rid, const void *rid_data,
5152                         int len, int dummy ) {
5153         int rc;
5154
5155         disable_MAC(ai, 1);
5156         rc = PC4500_writerid(ai, rid, rid_data, len, 1);
5157         enable_MAC(ai, 1);
5158         return rc;
5159 }
5160
5161 /* Returns the WEP key at the specified index, or -1 if that key does
5162  * not exist.  The buffer is assumed to be at least 16 bytes in length.
5163  */
5164 static int get_wep_key(struct airo_info *ai, u16 index, char *buf, u16 buflen)
5165 {
5166         WepKeyRid wkr;
5167         int rc;
5168         __le16 lastindex;
5169
5170         rc = readWepKeyRid(ai, &wkr, 1, 1);
5171         if (rc != SUCCESS)
5172                 return -1;
5173         do {
5174                 lastindex = wkr.kindex;
5175                 if (le16_to_cpu(wkr.kindex) == index) {
5176                         int klen = min_t(int, buflen, le16_to_cpu(wkr.klen));
5177                         memcpy(buf, wkr.key, klen);
5178                         return klen;
5179                 }
5180                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5181                 if (rc != SUCCESS)
5182                         return -1;
5183         } while (lastindex != wkr.kindex);
5184         return -1;
5185 }
5186
5187 static int get_wep_tx_idx(struct airo_info *ai)
5188 {
5189         WepKeyRid wkr;
5190         int rc;
5191         __le16 lastindex;
5192
5193         rc = readWepKeyRid(ai, &wkr, 1, 1);
5194         if (rc != SUCCESS)
5195                 return -1;
5196         do {
5197                 lastindex = wkr.kindex;
5198                 if (wkr.kindex == cpu_to_le16(0xffff))
5199                         return wkr.mac[0];
5200                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5201                 if (rc != SUCCESS)
5202                         return -1;
5203         } while (lastindex != wkr.kindex);
5204         return -1;
5205 }
5206
5207 static int set_wep_key(struct airo_info *ai, u16 index, const char *key,
5208                        u16 keylen, int perm, int lock)
5209 {
5210         static const unsigned char macaddr[ETH_ALEN] = { 0x01, 0, 0, 0, 0, 0 };
5211         WepKeyRid wkr;
5212         int rc;
5213
5214         if (WARN_ON(keylen == 0))
5215                 return -1;
5216
5217         memset(&wkr, 0, sizeof(wkr));
5218         wkr.len = cpu_to_le16(sizeof(wkr));
5219         wkr.kindex = cpu_to_le16(index);
5220         wkr.klen = cpu_to_le16(keylen);
5221         memcpy(wkr.key, key, keylen);
5222         memcpy(wkr.mac, macaddr, ETH_ALEN);
5223
5224         if (perm) disable_MAC(ai, lock);
5225         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5226         if (perm) enable_MAC(ai, lock);
5227         return rc;
5228 }
5229
5230 static int set_wep_tx_idx(struct airo_info *ai, u16 index, int perm, int lock)
5231 {
5232         WepKeyRid wkr;
5233         int rc;
5234
5235         memset(&wkr, 0, sizeof(wkr));
5236         wkr.len = cpu_to_le16(sizeof(wkr));
5237         wkr.kindex = cpu_to_le16(0xffff);
5238         wkr.mac[0] = (char)index;
5239
5240         if (perm) {
5241                 ai->defindex = (char)index;
5242                 disable_MAC(ai, lock);
5243         }
5244
5245         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5246
5247         if (perm)
5248                 enable_MAC(ai, lock);
5249         return rc;
5250 }
5251
5252 static void proc_wepkey_on_close( struct inode *inode, struct file *file ) {
5253         struct proc_data *data;
5254         struct net_device *dev = PDE_DATA(inode);
5255         struct airo_info *ai = dev->ml_priv;
5256         int i, rc;
5257         char key[16];
5258         u16 index = 0;
5259         int j = 0;
5260
5261         memset(key, 0, sizeof(key));
5262
5263         data = file->private_data;
5264         if ( !data->writelen ) return;
5265
5266         if (data->wbuffer[0] >= '0' && data->wbuffer[0] <= '3' &&
5267             (data->wbuffer[1] == ' ' || data->wbuffer[1] == '\n')) {
5268                 index = data->wbuffer[0] - '0';
5269                 if (data->wbuffer[1] == '\n') {
5270                         rc = set_wep_tx_idx(ai, index, 1, 1);
5271                         if (rc < 0) {
5272                                 airo_print_err(ai->dev->name, "failed to set "
5273                                                "WEP transmit index to %d: %d.",
5274                                                index, rc);
5275                         }
5276                         return;
5277                 }
5278                 j = 2;
5279         } else {
5280                 airo_print_err(ai->dev->name, "WepKey passed invalid key index");
5281                 return;
5282         }
5283
5284         for( i = 0; i < 16*3 && data->wbuffer[i+j]; i++ ) {
5285                 switch(i%3) {
5286                 case 0:
5287                         key[i/3] = hex_to_bin(data->wbuffer[i+j])<<4;
5288                         break;
5289                 case 1:
5290                         key[i/3] |= hex_to_bin(data->wbuffer[i+j]);
5291                         break;
5292                 }
5293         }
5294
5295         rc = set_wep_key(ai, index, key, i/3, 1, 1);
5296         if (rc < 0) {
5297                 airo_print_err(ai->dev->name, "failed to set WEP key at index "
5298                                "%d: %d.", index, rc);
5299         }
5300 }
5301
5302 static int proc_wepkey_open( struct inode *inode, struct file *file )
5303 {
5304         struct proc_data *data;
5305         struct net_device *dev = PDE_DATA(inode);
5306         struct airo_info *ai = dev->ml_priv;
5307         char *ptr;
5308         WepKeyRid wkr;
5309         __le16 lastindex;
5310         int j=0;
5311         int rc;
5312
5313         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5314                 return -ENOMEM;
5315         memset(&wkr, 0, sizeof(wkr));
5316         data = file->private_data;
5317         if ((data->rbuffer = kzalloc( 180, GFP_KERNEL )) == NULL) {
5318                 kfree (file->private_data);
5319                 return -ENOMEM;
5320         }
5321         data->writelen = 0;
5322         data->maxwritelen = 80;
5323         if ((data->wbuffer = kzalloc( 80, GFP_KERNEL )) == NULL) {
5324                 kfree (data->rbuffer);
5325                 kfree (file->private_data);
5326                 return -ENOMEM;
5327         }
5328         data->on_close = proc_wepkey_on_close;
5329
5330         ptr = data->rbuffer;
5331         strcpy(ptr, "No wep keys\n");
5332         rc = readWepKeyRid(ai, &wkr, 1, 1);
5333         if (rc == SUCCESS) do {
5334                 lastindex = wkr.kindex;
5335                 if (wkr.kindex == cpu_to_le16(0xffff)) {
5336                         j += sprintf(ptr+j, "Tx key = %d\n",
5337                                      (int)wkr.mac[0]);
5338                 } else {
5339                         j += sprintf(ptr+j, "Key %d set with length = %d\n",
5340                                      le16_to_cpu(wkr.kindex),
5341                                      le16_to_cpu(wkr.klen));
5342                 }
5343                 readWepKeyRid(ai, &wkr, 0, 1);
5344         } while((lastindex != wkr.kindex) && (j < 180-30));
5345
5346         data->readlen = strlen( data->rbuffer );
5347         return 0;
5348 }
5349
5350 static int proc_SSID_open(struct inode *inode, struct file *file)
5351 {
5352         struct proc_data *data;
5353         struct net_device *dev = PDE_DATA(inode);
5354         struct airo_info *ai = dev->ml_priv;
5355         int i;
5356         char *ptr;
5357         SsidRid SSID_rid;
5358
5359         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5360                 return -ENOMEM;
5361         data = file->private_data;
5362         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5363                 kfree (file->private_data);
5364                 return -ENOMEM;
5365         }
5366         data->writelen = 0;
5367         data->maxwritelen = 33*3;
5368         /* allocate maxwritelen + 1; we'll want a sentinel */
5369         if ((data->wbuffer = kzalloc(33*3 + 1, GFP_KERNEL)) == NULL) {
5370                 kfree (data->rbuffer);
5371                 kfree (file->private_data);
5372                 return -ENOMEM;
5373         }
5374         data->on_close = proc_SSID_on_close;
5375
5376         readSsidRid(ai, &SSID_rid);
5377         ptr = data->rbuffer;
5378         for (i = 0; i < 3; i++) {
5379                 int j;
5380                 size_t len = le16_to_cpu(SSID_rid.ssids[i].len);
5381                 if (!len)
5382                         break;
5383                 if (len > 32)
5384                         len = 32;
5385                 for (j = 0; j < len && SSID_rid.ssids[i].ssid[j]; j++)
5386                         *ptr++ = SSID_rid.ssids[i].ssid[j];
5387                 *ptr++ = '\n';
5388         }
5389         *ptr = '\0';
5390         data->readlen = strlen( data->rbuffer );
5391         return 0;
5392 }
5393
5394 static int proc_APList_open( struct inode *inode, struct file *file ) {
5395         struct proc_data *data;
5396         struct net_device *dev = PDE_DATA(inode);
5397         struct airo_info *ai = dev->ml_priv;
5398         int i;
5399         char *ptr;
5400         APListRid *APList_rid = &ai->APList;
5401
5402         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5403                 return -ENOMEM;
5404         data = file->private_data;
5405         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5406                 kfree (file->private_data);
5407                 return -ENOMEM;
5408         }
5409         data->writelen = 0;
5410         data->maxwritelen = 4*6*3;
5411         if ((data->wbuffer = kzalloc( data->maxwritelen, GFP_KERNEL )) == NULL) {
5412                 kfree (data->rbuffer);
5413                 kfree (file->private_data);
5414                 return -ENOMEM;
5415         }
5416         data->on_close = proc_APList_on_close;
5417
5418         ptr = data->rbuffer;
5419         for( i = 0; i < 4; i++ ) {
5420 // We end when we find a zero MAC
5421                 if ( !*(int*)APList_rid->ap[i] &&
5422                      !*(int*)&APList_rid->ap[i][2]) break;
5423                 ptr += sprintf(ptr, "%pM\n", APList_rid->ap[i]);
5424         }
5425         if (i==0) ptr += sprintf(ptr, "Not using specific APs\n");
5426
5427         *ptr = '\0';
5428         data->readlen = strlen( data->rbuffer );
5429         return 0;
5430 }
5431
5432 static int proc_BSSList_open( struct inode *inode, struct file *file ) {
5433         struct proc_data *data;
5434         struct net_device *dev = PDE_DATA(inode);
5435         struct airo_info *ai = dev->ml_priv;
5436         char *ptr;
5437         BSSListRid BSSList_rid;
5438         int rc;
5439         /* If doLoseSync is not 1, we won't do a Lose Sync */
5440         int doLoseSync = -1;
5441
5442         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5443                 return -ENOMEM;
5444         data = file->private_data;
5445         if ((data->rbuffer = kmalloc( 1024, GFP_KERNEL )) == NULL) {
5446                 kfree (file->private_data);
5447                 return -ENOMEM;
5448         }
5449         data->writelen = 0;
5450         data->maxwritelen = 0;
5451         data->wbuffer = NULL;
5452         data->on_close = NULL;
5453
5454         if (file->f_mode & FMODE_WRITE) {
5455                 if (!(file->f_mode & FMODE_READ)) {
5456                         Cmd cmd;
5457                         Resp rsp;
5458
5459                         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
5460                         memset(&cmd, 0, sizeof(cmd));
5461                         cmd.cmd=CMD_LISTBSS;
5462                         if (down_interruptible(&ai->sem))
5463                                 return -ERESTARTSYS;
5464                         issuecommand(ai, &cmd, &rsp);
5465                         up(&ai->sem);
5466                         data->readlen = 0;
5467                         return 0;
5468                 }
5469                 doLoseSync = 1;
5470         }
5471         ptr = data->rbuffer;
5472         /* There is a race condition here if there are concurrent opens.
5473            Since it is a rare condition, we'll just live with it, otherwise
5474            we have to add a spin lock... */
5475         rc = readBSSListRid(ai, doLoseSync, &BSSList_rid);
5476         while(rc == 0 && BSSList_rid.index != cpu_to_le16(0xffff)) {
5477                 ptr += sprintf(ptr, "%pM %.*s rssi = %d",
5478                                BSSList_rid.bssid,
5479                                 (int)BSSList_rid.ssidLen,
5480                                 BSSList_rid.ssid,
5481                                 le16_to_cpu(BSSList_rid.dBm));
5482                 ptr += sprintf(ptr, " channel = %d %s %s %s %s\n",
5483                                 le16_to_cpu(BSSList_rid.dsChannel),
5484                                 BSSList_rid.cap & CAP_ESS ? "ESS" : "",
5485                                 BSSList_rid.cap & CAP_IBSS ? "adhoc" : "",
5486                                 BSSList_rid.cap & CAP_PRIVACY ? "wep" : "",
5487                                 BSSList_rid.cap & CAP_SHORTHDR ? "shorthdr" : "");
5488                 rc = readBSSListRid(ai, 0, &BSSList_rid);
5489         }
5490         *ptr = '\0';
5491         data->readlen = strlen( data->rbuffer );
5492         return 0;
5493 }
5494
5495 static int proc_close( struct inode *inode, struct file *file )
5496 {
5497         struct proc_data *data = file->private_data;
5498
5499         if (data->on_close != NULL)
5500                 data->on_close(inode, file);
5501         kfree(data->rbuffer);
5502         kfree(data->wbuffer);
5503         kfree(data);
5504         return 0;
5505 }
5506
5507 /* Since the card doesn't automatically switch to the right WEP mode,
5508    we will make it do it.  If the card isn't associated, every secs we
5509    will switch WEP modes to see if that will help.  If the card is
5510    associated we will check every minute to see if anything has
5511    changed. */
5512 static void timer_func( struct net_device *dev ) {
5513         struct airo_info *apriv = dev->ml_priv;
5514
5515 /* We don't have a link so try changing the authtype */
5516         readConfigRid(apriv, 0);
5517         disable_MAC(apriv, 0);
5518         switch(apriv->config.authType) {
5519                 case AUTH_ENCRYPT:
5520 /* So drop to OPEN */
5521                         apriv->config.authType = AUTH_OPEN;
5522                         break;
5523                 case AUTH_SHAREDKEY:
5524                         if (apriv->keyindex < auto_wep) {
5525                                 set_wep_tx_idx(apriv, apriv->keyindex, 0, 0);
5526                                 apriv->config.authType = AUTH_SHAREDKEY;
5527                                 apriv->keyindex++;
5528                         } else {
5529                                 /* Drop to ENCRYPT */
5530                                 apriv->keyindex = 0;
5531                                 set_wep_tx_idx(apriv, apriv->defindex, 0, 0);
5532                                 apriv->config.authType = AUTH_ENCRYPT;
5533                         }
5534                         break;
5535                 default:  /* We'll escalate to SHAREDKEY */
5536                         apriv->config.authType = AUTH_SHAREDKEY;
5537         }
5538         set_bit (FLAG_COMMIT, &apriv->flags);
5539         writeConfigRid(apriv, 0);
5540         enable_MAC(apriv, 0);
5541         up(&apriv->sem);
5542
5543 /* Schedule check to see if the change worked */
5544         clear_bit(JOB_AUTOWEP, &apriv->jobs);
5545         apriv->expires = RUN_AT(HZ*3);
5546 }
5547
5548 #ifdef CONFIG_PCI
5549 static int airo_pci_probe(struct pci_dev *pdev,
5550                                     const struct pci_device_id *pent)
5551 {
5552         struct net_device *dev;
5553
5554         if (pci_enable_device(pdev))
5555                 return -ENODEV;
5556         pci_set_master(pdev);
5557
5558         if (pdev->device == 0x5000 || pdev->device == 0xa504)
5559                         dev = _init_airo_card(pdev->irq, pdev->resource[0].start, 0, pdev, &pdev->dev);
5560         else
5561                         dev = _init_airo_card(pdev->irq, pdev->resource[2].start, 0, pdev, &pdev->dev);
5562         if (!dev) {
5563                 pci_disable_device(pdev);
5564                 return -ENODEV;
5565         }
5566
5567         pci_set_drvdata(pdev, dev);
5568         return 0;
5569 }
5570
5571 static void airo_pci_remove(struct pci_dev *pdev)
5572 {
5573         struct net_device *dev = pci_get_drvdata(pdev);
5574
5575         airo_print_info(dev->name, "Unregistering...");
5576         stop_airo_card(dev, 1);
5577         pci_disable_device(pdev);
5578 }
5579
5580 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state)
5581 {
5582         struct net_device *dev = pci_get_drvdata(pdev);
5583         struct airo_info *ai = dev->ml_priv;
5584         Cmd cmd;
5585         Resp rsp;
5586
5587         if (!ai->SSID)
5588                 ai->SSID = kmalloc(sizeof(SsidRid), GFP_KERNEL);
5589         if (!ai->SSID)
5590                 return -ENOMEM;
5591         readSsidRid(ai, ai->SSID);
5592         memset(&cmd, 0, sizeof(cmd));
5593         /* the lock will be released at the end of the resume callback */
5594         if (down_interruptible(&ai->sem))
5595                 return -EAGAIN;
5596         disable_MAC(ai, 0);
5597         netif_device_detach(dev);
5598         ai->power = state;
5599         cmd.cmd = HOSTSLEEP;
5600         issuecommand(ai, &cmd, &rsp);
5601
5602         pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
5603         pci_save_state(pdev);
5604         pci_set_power_state(pdev, pci_choose_state(pdev, state));
5605         return 0;
5606 }
5607
5608 static int airo_pci_resume(struct pci_dev *pdev)
5609 {
5610         struct net_device *dev = pci_get_drvdata(pdev);
5611         struct airo_info *ai = dev->ml_priv;
5612         pci_power_t prev_state = pdev->current_state;
5613
5614         pci_set_power_state(pdev, PCI_D0);
5615         pci_restore_state(pdev);
5616         pci_enable_wake(pdev, PCI_D0, 0);
5617
5618         if (prev_state != PCI_D1) {
5619                 reset_card(dev, 0);
5620                 mpi_init_descriptors(ai);
5621                 setup_card(ai, dev->dev_addr, 0);
5622                 clear_bit(FLAG_RADIO_OFF, &ai->flags);
5623                 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
5624         } else {
5625                 OUT4500(ai, EVACK, EV_AWAKEN);
5626                 OUT4500(ai, EVACK, EV_AWAKEN);
5627                 msleep(100);
5628         }
5629
5630         set_bit(FLAG_COMMIT, &ai->flags);
5631         disable_MAC(ai, 0);
5632         msleep(200);
5633         if (ai->SSID) {
5634                 writeSsidRid(ai, ai->SSID, 0);
5635                 kfree(ai->SSID);
5636                 ai->SSID = NULL;
5637         }
5638         writeAPListRid(ai, &ai->APList, 0);
5639         writeConfigRid(ai, 0);
5640         enable_MAC(ai, 0);
5641         ai->power = PMSG_ON;
5642         netif_device_attach(dev);
5643         netif_wake_queue(dev);
5644         enable_interrupts(ai);
5645         up(&ai->sem);
5646         return 0;
5647 }
5648 #endif
5649
5650 static int __init airo_init_module( void )
5651 {
5652         int i;
5653
5654         proc_kuid = make_kuid(&init_user_ns, proc_uid);
5655         proc_kgid = make_kgid(&init_user_ns, proc_gid);
5656         if (!uid_valid(proc_kuid) || !gid_valid(proc_kgid))
5657                 return -EINVAL;
5658
5659         airo_entry = proc_mkdir_mode("driver/aironet", airo_perm, NULL);
5660
5661         if (airo_entry)
5662                 proc_set_user(airo_entry, proc_kuid, proc_kgid);
5663
5664         for (i = 0; i < 4 && io[i] && irq[i]; i++) {
5665                 airo_print_info("", "Trying to configure ISA adapter at irq=%d "
5666                         "io=0x%x", irq[i], io[i] );
5667                 if (init_airo_card( irq[i], io[i], 0, NULL ))
5668                         /* do nothing */ ;
5669         }
5670
5671 #ifdef CONFIG_PCI
5672         airo_print_info("", "Probing for PCI adapters");
5673         i = pci_register_driver(&airo_driver);
5674         airo_print_info("", "Finished probing for PCI adapters");
5675
5676         if (i) {
5677                 remove_proc_entry("driver/aironet", NULL);
5678                 return i;
5679         }
5680 #endif
5681
5682         /* Always exit with success, as we are a library module
5683          * as well as a driver module
5684          */
5685         return 0;
5686 }
5687
5688 static void __exit airo_cleanup_module( void )
5689 {
5690         struct airo_info *ai;
5691         while(!list_empty(&airo_devices)) {
5692                 ai = list_entry(airo_devices.next, struct airo_info, dev_list);
5693                 airo_print_info(ai->dev->name, "Unregistering...");
5694                 stop_airo_card(ai->dev, 1);
5695         }
5696 #ifdef CONFIG_PCI
5697         pci_unregister_driver(&airo_driver);
5698 #endif
5699         remove_proc_entry("driver/aironet", NULL);
5700 }
5701
5702 /*
5703  * Initial Wireless Extension code for Aironet driver by :
5704  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00
5705  * Conversion to new driver API by :
5706  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02
5707  * Javier also did a good amount of work here, adding some new extensions
5708  * and fixing my code. Let's just say that without him this code just
5709  * would not work at all... - Jean II
5710  */
5711
5712 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi)
5713 {
5714         if (!rssi_rid)
5715                 return 0;
5716
5717         return (0x100 - rssi_rid[rssi].rssidBm);
5718 }
5719
5720 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm)
5721 {
5722         int i;
5723
5724         if (!rssi_rid)
5725                 return 0;
5726
5727         for (i = 0; i < 256; i++)
5728                 if (rssi_rid[i].rssidBm == dbm)
5729                         return rssi_rid[i].rssipct;
5730
5731         return 0;
5732 }
5733
5734
5735 static int airo_get_quality (StatusRid *status_rid, CapabilityRid *cap_rid)
5736 {
5737         int quality = 0;
5738         u16 sq;
5739
5740         if ((status_rid->mode & cpu_to_le16(0x3f)) != cpu_to_le16(0x3f))
5741                 return 0;
5742
5743         if (!(cap_rid->hardCap & cpu_to_le16(8)))
5744                 return 0;
5745
5746         sq = le16_to_cpu(status_rid->signalQuality);
5747         if (memcmp(cap_rid->prodName, "350", 3))
5748                 if (sq > 0x20)
5749                         quality = 0;
5750                 else
5751                         quality = 0x20 - sq;
5752         else
5753                 if (sq > 0xb0)
5754                         quality = 0;
5755                 else if (sq < 0x10)
5756                         quality = 0xa0;
5757                 else
5758                         quality = 0xb0 - sq;
5759         return quality;
5760 }
5761
5762 #define airo_get_max_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x20 : 0xa0)
5763 #define airo_get_avg_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x10 : 0x50);
5764
5765 /*------------------------------------------------------------------*/
5766 /*
5767  * Wireless Handler : get protocol name
5768  */
5769 static int airo_get_name(struct net_device *dev,
5770                          struct iw_request_info *info,
5771                          char *cwrq,
5772                          char *extra)
5773 {
5774         strcpy(cwrq, "IEEE 802.11-DS");
5775         return 0;
5776 }
5777
5778 /*------------------------------------------------------------------*/
5779 /*
5780  * Wireless Handler : set frequency
5781  */
5782 static int airo_set_freq(struct net_device *dev,
5783                          struct iw_request_info *info,
5784                          struct iw_freq *fwrq,
5785                          char *extra)
5786 {
5787         struct airo_info *local = dev->ml_priv;
5788         int rc = -EINPROGRESS;          /* Call commit handler */
5789
5790         /* If setting by frequency, convert to a channel */
5791         if(fwrq->e == 1) {
5792                 int f = fwrq->m / 100000;
5793
5794                 /* Hack to fall through... */
5795                 fwrq->e = 0;
5796                 fwrq->m = ieee80211_frequency_to_channel(f);
5797         }
5798         /* Setting by channel number */
5799         if (fwrq->m < 0 || fwrq->m > 1000 || fwrq->e > 0)
5800                 rc = -EOPNOTSUPP;
5801         else {
5802                 int channel = fwrq->m;
5803                 /* We should do a better check than that,
5804                  * based on the card capability !!! */
5805                 if((channel < 1) || (channel > 14)) {
5806                         airo_print_dbg(dev->name, "New channel value of %d is invalid!",
5807                                 fwrq->m);
5808                         rc = -EINVAL;
5809                 } else {
5810                         readConfigRid(local, 1);
5811                         /* Yes ! We can set it !!! */
5812                         local->config.channelSet = cpu_to_le16(channel);
5813                         set_bit (FLAG_COMMIT, &local->flags);
5814                 }
5815         }
5816         return rc;
5817 }
5818
5819 /*------------------------------------------------------------------*/
5820 /*
5821  * Wireless Handler : get frequency
5822  */
5823 static int airo_get_freq(struct net_device *dev,
5824                          struct iw_request_info *info,
5825                          struct iw_freq *fwrq,
5826                          char *extra)
5827 {
5828         struct airo_info *local = dev->ml_priv;
5829         StatusRid status_rid;           /* Card status info */
5830         int ch;
5831
5832         readConfigRid(local, 1);
5833         if ((local->config.opmode & MODE_CFG_MASK) == MODE_STA_ESS)
5834                 status_rid.channel = local->config.channelSet;
5835         else
5836                 readStatusRid(local, &status_rid, 1);
5837
5838         ch = le16_to_cpu(status_rid.channel);
5839         if((ch > 0) && (ch < 15)) {
5840                 fwrq->m = 100000 *
5841                         ieee80211_channel_to_frequency(ch, NL80211_BAND_2GHZ);
5842                 fwrq->e = 1;
5843         } else {
5844                 fwrq->m = ch;
5845                 fwrq->e = 0;
5846         }
5847
5848         return 0;
5849 }
5850
5851 /*------------------------------------------------------------------*/
5852 /*
5853  * Wireless Handler : set ESSID
5854  */
5855 static int airo_set_essid(struct net_device *dev,
5856                           struct iw_request_info *info,
5857                           struct iw_point *dwrq,
5858                           char *extra)
5859 {
5860         struct airo_info *local = dev->ml_priv;
5861         SsidRid SSID_rid;               /* SSIDs */
5862
5863         /* Reload the list of current SSID */
5864         readSsidRid(local, &SSID_rid);
5865
5866         /* Check if we asked for `any' */
5867         if (dwrq->flags == 0) {
5868                 /* Just send an empty SSID list */
5869                 memset(&SSID_rid, 0, sizeof(SSID_rid));
5870         } else {
5871                 unsigned index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
5872
5873                 /* Check the size of the string */
5874                 if (dwrq->length > IW_ESSID_MAX_SIZE)
5875                         return -E2BIG ;
5876
5877                 /* Check if index is valid */
5878                 if (index >= ARRAY_SIZE(SSID_rid.ssids))
5879                         return -EINVAL;
5880
5881                 /* Set the SSID */
5882                 memset(SSID_rid.ssids[index].ssid, 0,
5883                        sizeof(SSID_rid.ssids[index].ssid));
5884                 memcpy(SSID_rid.ssids[index].ssid, extra, dwrq->length);
5885                 SSID_rid.ssids[index].len = cpu_to_le16(dwrq->length);
5886         }
5887         SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5888         /* Write it to the card */
5889         disable_MAC(local, 1);
5890         writeSsidRid(local, &SSID_rid, 1);
5891         enable_MAC(local, 1);
5892
5893         return 0;
5894 }
5895
5896 /*------------------------------------------------------------------*/
5897 /*
5898  * Wireless Handler : get ESSID
5899  */
5900 static int airo_get_essid(struct net_device *dev,
5901                           struct iw_request_info *info,
5902                           struct iw_point *dwrq,
5903                           char *extra)
5904 {
5905         struct airo_info *local = dev->ml_priv;
5906         StatusRid status_rid;           /* Card status info */
5907
5908         readStatusRid(local, &status_rid, 1);
5909
5910         /* Note : if dwrq->flags != 0, we should
5911          * get the relevant SSID from the SSID list... */
5912
5913         /* Get the current SSID */
5914         memcpy(extra, status_rid.SSID, le16_to_cpu(status_rid.SSIDlen));
5915         /* If none, we may want to get the one that was set */
5916
5917         /* Push it out ! */
5918         dwrq->length = le16_to_cpu(status_rid.SSIDlen);
5919         dwrq->flags = 1; /* active */
5920
5921         return 0;
5922 }
5923
5924 /*------------------------------------------------------------------*/
5925 /*
5926  * Wireless Handler : set AP address
5927  */
5928 static int airo_set_wap(struct net_device *dev,
5929                         struct iw_request_info *info,
5930                         struct sockaddr *awrq,
5931                         char *extra)
5932 {
5933         struct airo_info *local = dev->ml_priv;
5934         Cmd cmd;
5935         Resp rsp;
5936         APListRid *APList_rid = &local->APList;
5937
5938         if (awrq->sa_family != ARPHRD_ETHER)
5939                 return -EINVAL;
5940         else if (is_broadcast_ether_addr(awrq->sa_data) ||
5941                  is_zero_ether_addr(awrq->sa_data)) {
5942                 memset(&cmd, 0, sizeof(cmd));
5943                 cmd.cmd=CMD_LOSE_SYNC;
5944                 if (down_interruptible(&local->sem))
5945                         return -ERESTARTSYS;
5946                 issuecommand(local, &cmd, &rsp);
5947                 up(&local->sem);
5948         } else {
5949                 memset(APList_rid, 0, sizeof(*APList_rid));
5950                 APList_rid->len = cpu_to_le16(sizeof(*APList_rid));
5951                 memcpy(APList_rid->ap[0], awrq->sa_data, ETH_ALEN);
5952                 disable_MAC(local, 1);
5953                 writeAPListRid(local, APList_rid, 1);
5954                 enable_MAC(local, 1);
5955         }
5956         return 0;
5957 }
5958
5959 /*------------------------------------------------------------------*/
5960 /*
5961  * Wireless Handler : get AP address
5962  */
5963 static int airo_get_wap(struct net_device *dev,
5964                         struct iw_request_info *info,
5965                         struct sockaddr *awrq,
5966                         char *extra)
5967 {
5968         struct airo_info *local = dev->ml_priv;
5969         StatusRid status_rid;           /* Card status info */
5970
5971         readStatusRid(local, &status_rid, 1);
5972
5973         /* Tentative. This seems to work, wow, I'm lucky !!! */
5974         memcpy(awrq->sa_data, status_rid.bssid[0], ETH_ALEN);
5975         awrq->sa_family = ARPHRD_ETHER;
5976
5977         return 0;
5978 }
5979
5980 /*------------------------------------------------------------------*/
5981 /*
5982  * Wireless Handler : set Nickname
5983  */
5984 static int airo_set_nick(struct net_device *dev,
5985                          struct iw_request_info *info,
5986                          struct iw_point *dwrq,
5987                          char *extra)
5988 {
5989         struct airo_info *local = dev->ml_priv;
5990
5991         /* Check the size of the string */
5992         if(dwrq->length > 16) {
5993                 return -E2BIG;
5994         }
5995         readConfigRid(local, 1);
5996         memset(local->config.nodeName, 0, sizeof(local->config.nodeName));
5997         memcpy(local->config.nodeName, extra, dwrq->length);
5998         set_bit (FLAG_COMMIT, &local->flags);
5999
6000         return -EINPROGRESS;            /* Call commit handler */
6001 }
6002
6003 /*------------------------------------------------------------------*/
6004 /*
6005  * Wireless Handler : get Nickname
6006  */
6007 static int airo_get_nick(struct net_device *dev,
6008                          struct iw_request_info *info,
6009                          struct iw_point *dwrq,
6010                          char *extra)
6011 {
6012         struct airo_info *local = dev->ml_priv;
6013
6014         readConfigRid(local, 1);
6015         strncpy(extra, local->config.nodeName, 16);
6016         extra[16] = '\0';
6017         dwrq->length = strlen(extra);
6018
6019         return 0;
6020 }
6021
6022 /*------------------------------------------------------------------*/
6023 /*
6024  * Wireless Handler : set Bit-Rate
6025  */
6026 static int airo_set_rate(struct net_device *dev,
6027                          struct iw_request_info *info,
6028                          struct iw_param *vwrq,
6029                          char *extra)
6030 {
6031         struct airo_info *local = dev->ml_priv;
6032         CapabilityRid cap_rid;          /* Card capability info */
6033         u8      brate = 0;
6034         int     i;
6035
6036         /* First : get a valid bit rate value */
6037         readCapabilityRid(local, &cap_rid, 1);
6038
6039         /* Which type of value ? */
6040         if((vwrq->value < 8) && (vwrq->value >= 0)) {
6041                 /* Setting by rate index */
6042                 /* Find value in the magic rate table */
6043                 brate = cap_rid.supportedRates[vwrq->value];
6044         } else {
6045                 /* Setting by frequency value */
6046                 u8      normvalue = (u8) (vwrq->value/500000);
6047
6048                 /* Check if rate is valid */
6049                 for(i = 0 ; i < 8 ; i++) {
6050                         if(normvalue == cap_rid.supportedRates[i]) {
6051                                 brate = normvalue;
6052                                 break;
6053                         }
6054                 }
6055         }
6056         /* -1 designed the max rate (mostly auto mode) */
6057         if(vwrq->value == -1) {
6058                 /* Get the highest available rate */
6059                 for(i = 0 ; i < 8 ; i++) {
6060                         if(cap_rid.supportedRates[i] == 0)
6061                                 break;
6062                 }
6063                 if(i != 0)
6064                         brate = cap_rid.supportedRates[i - 1];
6065         }
6066         /* Check that it is valid */
6067         if(brate == 0) {
6068                 return -EINVAL;
6069         }
6070
6071         readConfigRid(local, 1);
6072         /* Now, check if we want a fixed or auto value */
6073         if(vwrq->fixed == 0) {
6074                 /* Fill all the rates up to this max rate */
6075                 memset(local->config.rates, 0, 8);
6076                 for(i = 0 ; i < 8 ; i++) {
6077                         local->config.rates[i] = cap_rid.supportedRates[i];
6078                         if(local->config.rates[i] == brate)
6079                                 break;
6080                 }
6081         } else {
6082                 /* Fixed mode */
6083                 /* One rate, fixed */
6084                 memset(local->config.rates, 0, 8);
6085                 local->config.rates[0] = brate;
6086         }
6087         set_bit (FLAG_COMMIT, &local->flags);
6088
6089         return -EINPROGRESS;            /* Call commit handler */
6090 }
6091
6092 /*------------------------------------------------------------------*/
6093 /*
6094  * Wireless Handler : get Bit-Rate
6095  */
6096 static int airo_get_rate(struct net_device *dev,
6097                          struct iw_request_info *info,
6098                          struct iw_param *vwrq,
6099                          char *extra)
6100 {
6101         struct airo_info *local = dev->ml_priv;
6102         StatusRid status_rid;           /* Card status info */
6103
6104         readStatusRid(local, &status_rid, 1);
6105
6106         vwrq->value = le16_to_cpu(status_rid.currentXmitRate) * 500000;
6107         /* If more than one rate, set auto */
6108         readConfigRid(local, 1);
6109         vwrq->fixed = (local->config.rates[1] == 0);
6110
6111         return 0;
6112 }
6113
6114 /*------------------------------------------------------------------*/
6115 /*
6116  * Wireless Handler : set RTS threshold
6117  */
6118 static int airo_set_rts(struct net_device *dev,
6119                         struct iw_request_info *info,
6120                         struct iw_param *vwrq,
6121                         char *extra)
6122 {
6123         struct airo_info *local = dev->ml_priv;
6124         int rthr = vwrq->value;
6125
6126         if(vwrq->disabled)
6127                 rthr = AIRO_DEF_MTU;
6128         if((rthr < 0) || (rthr > AIRO_DEF_MTU)) {
6129                 return -EINVAL;
6130         }
6131         readConfigRid(local, 1);
6132         local->config.rtsThres = cpu_to_le16(rthr);
6133         set_bit (FLAG_COMMIT, &local->flags);
6134
6135         return -EINPROGRESS;            /* Call commit handler */
6136 }
6137
6138 /*------------------------------------------------------------------*/
6139 /*
6140  * Wireless Handler : get RTS threshold
6141  */
6142 static int airo_get_rts(struct net_device *dev,
6143                         struct iw_request_info *info,
6144                         struct iw_param *vwrq,
6145                         char *extra)
6146 {
6147         struct airo_info *local = dev->ml_priv;
6148
6149         readConfigRid(local, 1);
6150         vwrq->value = le16_to_cpu(local->config.rtsThres);
6151         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6152         vwrq->fixed = 1;
6153
6154         return 0;
6155 }
6156
6157 /*------------------------------------------------------------------*/
6158 /*
6159  * Wireless Handler : set Fragmentation threshold
6160  */
6161 static int airo_set_frag(struct net_device *dev,
6162                          struct iw_request_info *info,
6163                          struct iw_param *vwrq,
6164                          char *extra)
6165 {
6166         struct airo_info *local = dev->ml_priv;
6167         int fthr = vwrq->value;
6168
6169         if(vwrq->disabled)
6170                 fthr = AIRO_DEF_MTU;
6171         if((fthr < 256) || (fthr > AIRO_DEF_MTU)) {
6172                 return -EINVAL;
6173         }
6174         fthr &= ~0x1;   /* Get an even value - is it really needed ??? */
6175         readConfigRid(local, 1);
6176         local->config.fragThresh = cpu_to_le16(fthr);
6177         set_bit (FLAG_COMMIT, &local->flags);
6178
6179         return -EINPROGRESS;            /* Call commit handler */
6180 }
6181
6182 /*------------------------------------------------------------------*/
6183 /*
6184  * Wireless Handler : get Fragmentation threshold
6185  */
6186 static int airo_get_frag(struct net_device *dev,
6187                          struct iw_request_info *info,
6188                          struct iw_param *vwrq,
6189                          char *extra)
6190 {
6191         struct airo_info *local = dev->ml_priv;
6192
6193         readConfigRid(local, 1);
6194         vwrq->value = le16_to_cpu(local->config.fragThresh);
6195         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6196         vwrq->fixed = 1;
6197
6198         return 0;
6199 }
6200
6201 /*------------------------------------------------------------------*/
6202 /*
6203  * Wireless Handler : set Mode of Operation
6204  */
6205 static int airo_set_mode(struct net_device *dev,
6206                          struct iw_request_info *info,
6207                          __u32 *uwrq,
6208                          char *extra)
6209 {
6210         struct airo_info *local = dev->ml_priv;
6211         int reset = 0;
6212
6213         readConfigRid(local, 1);
6214         if (sniffing_mode(local))
6215                 reset = 1;
6216
6217         switch(*uwrq) {
6218                 case IW_MODE_ADHOC:
6219                         local->config.opmode &= ~MODE_CFG_MASK;
6220                         local->config.opmode |= MODE_STA_IBSS;
6221                         local->config.rmode &= ~RXMODE_FULL_MASK;
6222                         local->config.scanMode = SCANMODE_ACTIVE;
6223                         clear_bit (FLAG_802_11, &local->flags);
6224                         break;
6225                 case IW_MODE_INFRA:
6226                         local->config.opmode &= ~MODE_CFG_MASK;
6227                         local->config.opmode |= MODE_STA_ESS;
6228                         local->config.rmode &= ~RXMODE_FULL_MASK;
6229                         local->config.scanMode = SCANMODE_ACTIVE;
6230                         clear_bit (FLAG_802_11, &local->flags);
6231                         break;
6232                 case IW_MODE_MASTER:
6233                         local->config.opmode &= ~MODE_CFG_MASK;
6234                         local->config.opmode |= MODE_AP;
6235                         local->config.rmode &= ~RXMODE_FULL_MASK;
6236                         local->config.scanMode = SCANMODE_ACTIVE;
6237                         clear_bit (FLAG_802_11, &local->flags);
6238                         break;
6239                 case IW_MODE_REPEAT:
6240                         local->config.opmode &= ~MODE_CFG_MASK;
6241                         local->config.opmode |= MODE_AP_RPTR;
6242                         local->config.rmode &= ~RXMODE_FULL_MASK;
6243                         local->config.scanMode = SCANMODE_ACTIVE;
6244                         clear_bit (FLAG_802_11, &local->flags);
6245                         break;
6246                 case IW_MODE_MONITOR:
6247                         local->config.opmode &= ~MODE_CFG_MASK;
6248                         local->config.opmode |= MODE_STA_ESS;
6249                         local->config.rmode &= ~RXMODE_FULL_MASK;
6250                         local->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
6251                         local->config.scanMode = SCANMODE_PASSIVE;
6252                         set_bit (FLAG_802_11, &local->flags);
6253                         break;
6254                 default:
6255                         return -EINVAL;
6256         }
6257         if (reset)
6258                 set_bit (FLAG_RESET, &local->flags);
6259         set_bit (FLAG_COMMIT, &local->flags);
6260
6261         return -EINPROGRESS;            /* Call commit handler */
6262 }
6263
6264 /*------------------------------------------------------------------*/
6265 /*
6266  * Wireless Handler : get Mode of Operation
6267  */
6268 static int airo_get_mode(struct net_device *dev,
6269                          struct iw_request_info *info,
6270                          __u32 *uwrq,
6271                          char *extra)
6272 {
6273         struct airo_info *local = dev->ml_priv;
6274
6275         readConfigRid(local, 1);
6276         /* If not managed, assume it's ad-hoc */
6277         switch (local->config.opmode & MODE_CFG_MASK) {
6278                 case MODE_STA_ESS:
6279                         *uwrq = IW_MODE_INFRA;
6280                         break;
6281                 case MODE_AP:
6282                         *uwrq = IW_MODE_MASTER;
6283                         break;
6284                 case MODE_AP_RPTR:
6285                         *uwrq = IW_MODE_REPEAT;
6286                         break;
6287                 default:
6288                         *uwrq = IW_MODE_ADHOC;
6289         }
6290
6291         return 0;
6292 }
6293
6294 static inline int valid_index(struct airo_info *ai, int index)
6295 {
6296         return (index >= 0) && (index <= ai->max_wep_idx);
6297 }
6298
6299 /*------------------------------------------------------------------*/
6300 /*
6301  * Wireless Handler : set Encryption Key
6302  */
6303 static int airo_set_encode(struct net_device *dev,
6304                            struct iw_request_info *info,
6305                            struct iw_point *dwrq,
6306                            char *extra)
6307 {
6308         struct airo_info *local = dev->ml_priv;
6309         int perm = (dwrq->flags & IW_ENCODE_TEMP ? 0 : 1);
6310         __le16 currentAuthType = local->config.authType;
6311         int rc = 0;
6312
6313         if (!local->wep_capable)
6314                 return -EOPNOTSUPP;
6315
6316         readConfigRid(local, 1);
6317
6318         /* Basic checking: do we have a key to set ?
6319          * Note : with the new API, it's impossible to get a NULL pointer.
6320          * Therefore, we need to check a key size == 0 instead.
6321          * New version of iwconfig properly set the IW_ENCODE_NOKEY flag
6322          * when no key is present (only change flags), but older versions
6323          * don't do it. - Jean II */
6324         if (dwrq->length > 0) {
6325                 wep_key_t key;
6326                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6327                 int current_index;
6328
6329                 /* Check the size of the key */
6330                 if (dwrq->length > MAX_KEY_SIZE) {
6331                         return -EINVAL;
6332                 }
6333
6334                 current_index = get_wep_tx_idx(local);
6335                 if (current_index < 0)
6336                         current_index = 0;
6337
6338                 /* Check the index (none -> use current) */
6339                 if (!valid_index(local, index))
6340                         index = current_index;
6341
6342                 /* Set the length */
6343                 if (dwrq->length > MIN_KEY_SIZE)
6344                         key.len = MAX_KEY_SIZE;
6345                 else
6346                         key.len = MIN_KEY_SIZE;
6347                 /* Check if the key is not marked as invalid */
6348                 if(!(dwrq->flags & IW_ENCODE_NOKEY)) {
6349                         /* Cleanup */
6350                         memset(key.key, 0, MAX_KEY_SIZE);
6351                         /* Copy the key in the driver */
6352                         memcpy(key.key, extra, dwrq->length);
6353                         /* Send the key to the card */
6354                         rc = set_wep_key(local, index, key.key, key.len, perm, 1);
6355                         if (rc < 0) {
6356                                 airo_print_err(local->dev->name, "failed to set"
6357                                                " WEP key at index %d: %d.",
6358                                                index, rc);
6359                                 return rc;
6360                         }
6361                 }
6362                 /* WE specify that if a valid key is set, encryption
6363                  * should be enabled (user may turn it off later)
6364                  * This is also how "iwconfig ethX key on" works */
6365                 if((index == current_index) && (key.len > 0) &&
6366                    (local->config.authType == AUTH_OPEN))
6367                         set_auth_type(local, AUTH_ENCRYPT);
6368         } else {
6369                 /* Do we want to just set the transmit key index ? */
6370                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6371                 if (valid_index(local, index)) {
6372                         rc = set_wep_tx_idx(local, index, perm, 1);
6373                         if (rc < 0) {
6374                                 airo_print_err(local->dev->name, "failed to set"
6375                                                " WEP transmit index to %d: %d.",
6376                                                index, rc);
6377                                 return rc;
6378                         }
6379                 } else {
6380                         /* Don't complain if only change the mode */
6381                         if (!(dwrq->flags & IW_ENCODE_MODE))
6382                                 return -EINVAL;
6383                 }
6384         }
6385         /* Read the flags */
6386         if (dwrq->flags & IW_ENCODE_DISABLED)
6387                 set_auth_type(local, AUTH_OPEN);        /* disable encryption */
6388         if(dwrq->flags & IW_ENCODE_RESTRICTED)
6389                 set_auth_type(local, AUTH_SHAREDKEY);   /* Only Both */
6390         if (dwrq->flags & IW_ENCODE_OPEN)
6391                 set_auth_type(local, AUTH_ENCRYPT);     /* Only Wep */
6392         /* Commit the changes to flags if needed */
6393         if (local->config.authType != currentAuthType)
6394                 set_bit (FLAG_COMMIT, &local->flags);
6395         return -EINPROGRESS;            /* Call commit handler */
6396 }
6397
6398 /*------------------------------------------------------------------*/
6399 /*
6400  * Wireless Handler : get Encryption Key
6401  */
6402 static int airo_get_encode(struct net_device *dev,
6403                            struct iw_request_info *info,
6404                            struct iw_point *dwrq,
6405                            char *extra)
6406 {
6407         struct airo_info *local = dev->ml_priv;
6408         int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6409         int wep_key_len;
6410         u8 buf[16];
6411
6412         if (!local->wep_capable)
6413                 return -EOPNOTSUPP;
6414
6415         readConfigRid(local, 1);
6416
6417         /* Check encryption mode */
6418         switch(local->config.authType)  {
6419                 case AUTH_ENCRYPT:
6420                         dwrq->flags = IW_ENCODE_OPEN;
6421                         break;
6422                 case AUTH_SHAREDKEY:
6423                         dwrq->flags = IW_ENCODE_RESTRICTED;
6424                         break;
6425                 default:
6426                 case AUTH_OPEN:
6427                         dwrq->flags = IW_ENCODE_DISABLED;
6428                         break;
6429         }
6430         /* We can't return the key, so set the proper flag and return zero */
6431         dwrq->flags |= IW_ENCODE_NOKEY;
6432         memset(extra, 0, 16);
6433
6434         /* Which key do we want ? -1 -> tx index */
6435         if (!valid_index(local, index)) {
6436                 index = get_wep_tx_idx(local);
6437                 if (index < 0)
6438                         index = 0;
6439         }
6440         dwrq->flags |= index + 1;
6441
6442         /* Copy the key to the user buffer */
6443         wep_key_len = get_wep_key(local, index, &buf[0], sizeof(buf));
6444         if (wep_key_len < 0) {
6445                 dwrq->length = 0;
6446         } else {
6447                 dwrq->length = wep_key_len;
6448                 memcpy(extra, buf, dwrq->length);
6449         }
6450
6451         return 0;
6452 }
6453
6454 /*------------------------------------------------------------------*/
6455 /*
6456  * Wireless Handler : set extended Encryption parameters
6457  */
6458 static int airo_set_encodeext(struct net_device *dev,
6459                            struct iw_request_info *info,
6460                             union iwreq_data *wrqu,
6461                             char *extra)
6462 {
6463         struct airo_info *local = dev->ml_priv;
6464         struct iw_point *encoding = &wrqu->encoding;
6465         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6466         int perm = ( encoding->flags & IW_ENCODE_TEMP ? 0 : 1 );
6467         __le16 currentAuthType = local->config.authType;
6468         int idx, key_len, alg = ext->alg, set_key = 1, rc;
6469         wep_key_t key;
6470
6471         if (!local->wep_capable)
6472                 return -EOPNOTSUPP;
6473
6474         readConfigRid(local, 1);
6475
6476         /* Determine and validate the key index */
6477         idx = encoding->flags & IW_ENCODE_INDEX;
6478         if (idx) {
6479                 if (!valid_index(local, idx - 1))
6480                         return -EINVAL;
6481                 idx--;
6482         } else {
6483                 idx = get_wep_tx_idx(local);
6484                 if (idx < 0)
6485                         idx = 0;
6486         }
6487
6488         if (encoding->flags & IW_ENCODE_DISABLED)
6489                 alg = IW_ENCODE_ALG_NONE;
6490
6491         if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
6492                 /* Only set transmit key index here, actual
6493                  * key is set below if needed.
6494                  */
6495                 rc = set_wep_tx_idx(local, idx, perm, 1);
6496                 if (rc < 0) {
6497                         airo_print_err(local->dev->name, "failed to set "
6498                                        "WEP transmit index to %d: %d.",
6499                                        idx, rc);
6500                         return rc;
6501                 }
6502                 set_key = ext->key_len > 0 ? 1 : 0;
6503         }
6504
6505         if (set_key) {
6506                 /* Set the requested key first */
6507                 memset(key.key, 0, MAX_KEY_SIZE);
6508                 switch (alg) {
6509                 case IW_ENCODE_ALG_NONE:
6510                         key.len = 0;
6511                         break;
6512                 case IW_ENCODE_ALG_WEP:
6513                         if (ext->key_len > MIN_KEY_SIZE) {
6514                                 key.len = MAX_KEY_SIZE;
6515                         } else if (ext->key_len > 0) {
6516                                 key.len = MIN_KEY_SIZE;
6517                         } else {
6518                                 return -EINVAL;
6519                         }
6520                         key_len = min (ext->key_len, key.len);
6521                         memcpy(key.key, ext->key, key_len);
6522                         break;
6523                 default:
6524                         return -EINVAL;
6525                 }
6526                 if (key.len == 0) {
6527                         rc = set_wep_tx_idx(local, idx, perm, 1);
6528                         if (rc < 0) {
6529                                 airo_print_err(local->dev->name,
6530                                                "failed to set WEP transmit index to %d: %d.",
6531                                                idx, rc);
6532                                 return rc;
6533                         }
6534                 } else {
6535                         rc = set_wep_key(local, idx, key.key, key.len, perm, 1);
6536                         if (rc < 0) {
6537                                 airo_print_err(local->dev->name,
6538                                                "failed to set WEP key at index %d: %d.",
6539                                                idx, rc);
6540                                 return rc;
6541                         }
6542                 }
6543         }
6544
6545         /* Read the flags */
6546         if (encoding->flags & IW_ENCODE_DISABLED)
6547                 set_auth_type(local, AUTH_OPEN);        /* disable encryption */
6548         if(encoding->flags & IW_ENCODE_RESTRICTED)
6549                 set_auth_type(local, AUTH_SHAREDKEY);   /* Only Both */
6550         if (encoding->flags & IW_ENCODE_OPEN)
6551                 set_auth_type(local, AUTH_ENCRYPT);
6552         /* Commit the changes to flags if needed */
6553         if (local->config.authType != currentAuthType)
6554                 set_bit (FLAG_COMMIT, &local->flags);
6555
6556         return -EINPROGRESS;
6557 }
6558
6559
6560 /*------------------------------------------------------------------*/
6561 /*
6562  * Wireless Handler : get extended Encryption parameters
6563  */
6564 static int airo_get_encodeext(struct net_device *dev,
6565                             struct iw_request_info *info,
6566                             union iwreq_data *wrqu,
6567                             char *extra)
6568 {
6569         struct airo_info *local = dev->ml_priv;
6570         struct iw_point *encoding = &wrqu->encoding;
6571         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6572         int idx, max_key_len, wep_key_len;
6573         u8 buf[16];
6574
6575         if (!local->wep_capable)
6576                 return -EOPNOTSUPP;
6577
6578         readConfigRid(local, 1);
6579
6580         max_key_len = encoding->length - sizeof(*ext);
6581         if (max_key_len < 0)
6582                 return -EINVAL;
6583
6584         idx = encoding->flags & IW_ENCODE_INDEX;
6585         if (idx) {
6586                 if (!valid_index(local, idx - 1))
6587                         return -EINVAL;
6588                 idx--;
6589         } else {
6590                 idx = get_wep_tx_idx(local);
6591                 if (idx < 0)
6592                         idx = 0;
6593         }
6594
6595         encoding->flags = idx + 1;
6596         memset(ext, 0, sizeof(*ext));
6597
6598         /* Check encryption mode */
6599         switch(local->config.authType) {
6600                 case AUTH_ENCRYPT:
6601                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6602                         break;
6603                 case AUTH_SHAREDKEY:
6604                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6605                         break;
6606                 default:
6607                 case AUTH_OPEN:
6608                         encoding->flags = IW_ENCODE_ALG_NONE | IW_ENCODE_DISABLED;
6609                         break;
6610         }
6611         /* We can't return the key, so set the proper flag and return zero */
6612         encoding->flags |= IW_ENCODE_NOKEY;
6613         memset(extra, 0, 16);
6614
6615         /* Copy the key to the user buffer */
6616         wep_key_len = get_wep_key(local, idx, &buf[0], sizeof(buf));
6617         if (wep_key_len < 0) {
6618                 ext->key_len = 0;
6619         } else {
6620                 ext->key_len = wep_key_len;
6621                 memcpy(extra, buf, ext->key_len);
6622         }
6623
6624         return 0;
6625 }
6626
6627
6628 /*------------------------------------------------------------------*/
6629 /*
6630  * Wireless Handler : set extended authentication parameters
6631  */
6632 static int airo_set_auth(struct net_device *dev,
6633                                struct iw_request_info *info,
6634                                union iwreq_data *wrqu, char *extra)
6635 {
6636         struct airo_info *local = dev->ml_priv;
6637         struct iw_param *param = &wrqu->param;
6638         __le16 currentAuthType = local->config.authType;
6639
6640         switch (param->flags & IW_AUTH_INDEX) {
6641         case IW_AUTH_WPA_VERSION:
6642         case IW_AUTH_CIPHER_PAIRWISE:
6643         case IW_AUTH_CIPHER_GROUP:
6644         case IW_AUTH_KEY_MGMT:
6645         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6646         case IW_AUTH_PRIVACY_INVOKED:
6647                 /*
6648                  * airo does not use these parameters
6649                  */
6650                 break;
6651
6652         case IW_AUTH_DROP_UNENCRYPTED:
6653                 if (param->value) {
6654                         /* Only change auth type if unencrypted */
6655                         if (currentAuthType == AUTH_OPEN)
6656                                 set_auth_type(local, AUTH_ENCRYPT);
6657                 } else {
6658                         set_auth_type(local, AUTH_OPEN);
6659                 }
6660
6661                 /* Commit the changes to flags if needed */
6662                 if (local->config.authType != currentAuthType)
6663                         set_bit (FLAG_COMMIT, &local->flags);
6664                 break;
6665
6666         case IW_AUTH_80211_AUTH_ALG: {
6667                         if (param->value & IW_AUTH_ALG_SHARED_KEY) {
6668                                 set_auth_type(local, AUTH_SHAREDKEY);
6669                         } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
6670                                 /* We don't know here if WEP open system or
6671                                  * unencrypted mode was requested - so use the
6672                                  * last mode (of these two) used last time
6673                                  */
6674                                 set_auth_type(local, local->last_auth);
6675                         } else
6676                                 return -EINVAL;
6677
6678                         /* Commit the changes to flags if needed */
6679                         if (local->config.authType != currentAuthType)
6680                                 set_bit (FLAG_COMMIT, &local->flags);
6681                         break;
6682                 }
6683
6684         case IW_AUTH_WPA_ENABLED:
6685                 /* Silently accept disable of WPA */
6686                 if (param->value > 0)
6687                         return -EOPNOTSUPP;
6688                 break;
6689
6690         default:
6691                 return -EOPNOTSUPP;
6692         }
6693         return -EINPROGRESS;
6694 }
6695
6696
6697 /*------------------------------------------------------------------*/
6698 /*
6699  * Wireless Handler : get extended authentication parameters
6700  */
6701 static int airo_get_auth(struct net_device *dev,
6702                                struct iw_request_info *info,
6703                                union iwreq_data *wrqu, char *extra)
6704 {
6705         struct airo_info *local = dev->ml_priv;
6706         struct iw_param *param = &wrqu->param;
6707         __le16 currentAuthType = local->config.authType;
6708
6709         switch (param->flags & IW_AUTH_INDEX) {
6710         case IW_AUTH_DROP_UNENCRYPTED:
6711                 switch (currentAuthType) {
6712                 case AUTH_SHAREDKEY:
6713                 case AUTH_ENCRYPT:
6714                         param->value = 1;
6715                         break;
6716                 default:
6717                         param->value = 0;
6718                         break;
6719                 }
6720                 break;
6721
6722         case IW_AUTH_80211_AUTH_ALG:
6723                 switch (currentAuthType) {
6724                 case AUTH_SHAREDKEY:
6725                         param->value = IW_AUTH_ALG_SHARED_KEY;
6726                         break;
6727                 case AUTH_ENCRYPT:
6728                 default:
6729                         param->value = IW_AUTH_ALG_OPEN_SYSTEM;
6730                         break;
6731                 }
6732                 break;
6733
6734         case IW_AUTH_WPA_ENABLED:
6735                 param->value = 0;
6736                 break;
6737
6738         default:
6739                 return -EOPNOTSUPP;
6740         }
6741         return 0;
6742 }
6743
6744
6745 /*------------------------------------------------------------------*/
6746 /*
6747  * Wireless Handler : set Tx-Power
6748  */
6749 static int airo_set_txpow(struct net_device *dev,
6750                           struct iw_request_info *info,
6751                           struct iw_param *vwrq,
6752                           char *extra)
6753 {
6754         struct airo_info *local = dev->ml_priv;
6755         CapabilityRid cap_rid;          /* Card capability info */
6756         int i;
6757         int rc = -EINVAL;
6758         __le16 v = cpu_to_le16(vwrq->value);
6759
6760         readCapabilityRid(local, &cap_rid, 1);
6761
6762         if (vwrq->disabled) {
6763                 set_bit (FLAG_RADIO_OFF, &local->flags);
6764                 set_bit (FLAG_COMMIT, &local->flags);
6765                 return -EINPROGRESS;            /* Call commit handler */
6766         }
6767         if (vwrq->flags != IW_TXPOW_MWATT) {
6768                 return -EINVAL;
6769         }
6770         clear_bit (FLAG_RADIO_OFF, &local->flags);
6771         for (i = 0; i < 8 && cap_rid.txPowerLevels[i]; i++)
6772                 if (v == cap_rid.txPowerLevels[i]) {
6773                         readConfigRid(local, 1);
6774                         local->config.txPower = v;
6775                         set_bit (FLAG_COMMIT, &local->flags);
6776                         rc = -EINPROGRESS;      /* Call commit handler */
6777                         break;
6778                 }
6779         return rc;
6780 }
6781
6782 /*------------------------------------------------------------------*/
6783 /*
6784  * Wireless Handler : get Tx-Power
6785  */
6786 static int airo_get_txpow(struct net_device *dev,
6787                           struct iw_request_info *info,
6788                           struct iw_param *vwrq,
6789                           char *extra)
6790 {
6791         struct airo_info *local = dev->ml_priv;
6792
6793         readConfigRid(local, 1);
6794         vwrq->value = le16_to_cpu(local->config.txPower);
6795         vwrq->fixed = 1;        /* No power control */
6796         vwrq->disabled = test_bit(FLAG_RADIO_OFF, &local->flags);
6797         vwrq->flags = IW_TXPOW_MWATT;
6798
6799         return 0;
6800 }
6801
6802 /*------------------------------------------------------------------*/
6803 /*
6804  * Wireless Handler : set Retry limits
6805  */
6806 static int airo_set_retry(struct net_device *dev,
6807                           struct iw_request_info *info,
6808                           struct iw_param *vwrq,
6809                           char *extra)
6810 {
6811         struct airo_info *local = dev->ml_priv;
6812         int rc = -EINVAL;
6813
6814         if(vwrq->disabled) {
6815                 return -EINVAL;
6816         }
6817         readConfigRid(local, 1);
6818         if(vwrq->flags & IW_RETRY_LIMIT) {
6819                 __le16 v = cpu_to_le16(vwrq->value);
6820                 if(vwrq->flags & IW_RETRY_LONG)
6821                         local->config.longRetryLimit = v;
6822                 else if (vwrq->flags & IW_RETRY_SHORT)
6823                         local->config.shortRetryLimit = v;
6824                 else {
6825                         /* No modifier : set both */
6826                         local->config.longRetryLimit = v;
6827                         local->config.shortRetryLimit = v;
6828                 }
6829                 set_bit (FLAG_COMMIT, &local->flags);
6830                 rc = -EINPROGRESS;              /* Call commit handler */
6831         }
6832         if(vwrq->flags & IW_RETRY_LIFETIME) {
6833                 local->config.txLifetime = cpu_to_le16(vwrq->value / 1024);
6834                 set_bit (FLAG_COMMIT, &local->flags);
6835                 rc = -EINPROGRESS;              /* Call commit handler */
6836         }
6837         return rc;
6838 }
6839
6840 /*------------------------------------------------------------------*/
6841 /*
6842  * Wireless Handler : get Retry limits
6843  */
6844 static int airo_get_retry(struct net_device *dev,
6845                           struct iw_request_info *info,
6846                           struct iw_param *vwrq,
6847                           char *extra)
6848 {
6849         struct airo_info *local = dev->ml_priv;
6850
6851         vwrq->disabled = 0;      /* Can't be disabled */
6852
6853         readConfigRid(local, 1);
6854         /* Note : by default, display the min retry number */
6855         if((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
6856                 vwrq->flags = IW_RETRY_LIFETIME;
6857                 vwrq->value = le16_to_cpu(local->config.txLifetime) * 1024;
6858         } else if((vwrq->flags & IW_RETRY_LONG)) {
6859                 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
6860                 vwrq->value = le16_to_cpu(local->config.longRetryLimit);
6861         } else {
6862                 vwrq->flags = IW_RETRY_LIMIT;
6863                 vwrq->value = le16_to_cpu(local->config.shortRetryLimit);
6864                 if(local->config.shortRetryLimit != local->config.longRetryLimit)
6865                         vwrq->flags |= IW_RETRY_SHORT;
6866         }
6867
6868         return 0;
6869 }
6870
6871 /*------------------------------------------------------------------*/
6872 /*
6873  * Wireless Handler : get range info
6874  */
6875 static int airo_get_range(struct net_device *dev,
6876                           struct iw_request_info *info,
6877                           struct iw_point *dwrq,
6878                           char *extra)
6879 {
6880         struct airo_info *local = dev->ml_priv;
6881         struct iw_range *range = (struct iw_range *) extra;
6882         CapabilityRid cap_rid;          /* Card capability info */
6883         int             i;
6884         int             k;
6885
6886         readCapabilityRid(local, &cap_rid, 1);
6887
6888         dwrq->length = sizeof(struct iw_range);
6889         memset(range, 0, sizeof(*range));
6890         range->min_nwid = 0x0000;
6891         range->max_nwid = 0x0000;
6892         range->num_channels = 14;
6893         /* Should be based on cap_rid.country to give only
6894          * what the current card support */
6895         k = 0;
6896         for(i = 0; i < 14; i++) {
6897                 range->freq[k].i = i + 1; /* List index */
6898                 range->freq[k].m = 100000 *
6899                      ieee80211_channel_to_frequency(i + 1, NL80211_BAND_2GHZ);
6900                 range->freq[k++].e = 1; /* Values in MHz -> * 10^5 * 10 */
6901         }
6902         range->num_frequency = k;
6903
6904         range->sensitivity = 65535;
6905
6906         /* Hum... Should put the right values there */
6907         if (local->rssi)
6908                 range->max_qual.qual = 100;     /* % */
6909         else
6910                 range->max_qual.qual = airo_get_max_quality(&cap_rid);
6911         range->max_qual.level = 0x100 - 120;    /* -120 dBm */
6912         range->max_qual.noise = 0x100 - 120;    /* -120 dBm */
6913
6914         /* Experimental measurements - boundary 11/5.5 Mb/s */
6915         /* Note : with or without the (local->rssi), results
6916          * are somewhat different. - Jean II */
6917         if (local->rssi) {
6918                 range->avg_qual.qual = 50;              /* % */
6919                 range->avg_qual.level = 0x100 - 70;     /* -70 dBm */
6920         } else {
6921                 range->avg_qual.qual = airo_get_avg_quality(&cap_rid);
6922                 range->avg_qual.level = 0x100 - 80;     /* -80 dBm */
6923         }
6924         range->avg_qual.noise = 0x100 - 85;             /* -85 dBm */
6925
6926         for(i = 0 ; i < 8 ; i++) {
6927                 range->bitrate[i] = cap_rid.supportedRates[i] * 500000;
6928                 if(range->bitrate[i] == 0)
6929                         break;
6930         }
6931         range->num_bitrates = i;
6932
6933         /* Set an indication of the max TCP throughput
6934          * in bit/s that we can expect using this interface.
6935          * May be use for QoS stuff... Jean II */
6936         if(i > 2)
6937                 range->throughput = 5000 * 1000;
6938         else
6939                 range->throughput = 1500 * 1000;
6940
6941         range->min_rts = 0;
6942         range->max_rts = AIRO_DEF_MTU;
6943         range->min_frag = 256;
6944         range->max_frag = AIRO_DEF_MTU;
6945
6946         if(cap_rid.softCap & cpu_to_le16(2)) {
6947                 // WEP: RC4 40 bits
6948                 range->encoding_size[0] = 5;
6949                 // RC4 ~128 bits
6950                 if (cap_rid.softCap & cpu_to_le16(0x100)) {
6951                         range->encoding_size[1] = 13;
6952                         range->num_encoding_sizes = 2;
6953                 } else
6954                         range->num_encoding_sizes = 1;
6955                 range->max_encoding_tokens =
6956                         cap_rid.softCap & cpu_to_le16(0x80) ? 4 : 1;
6957         } else {
6958                 range->num_encoding_sizes = 0;
6959                 range->max_encoding_tokens = 0;
6960         }
6961         range->min_pmp = 0;
6962         range->max_pmp = 5000000;       /* 5 secs */
6963         range->min_pmt = 0;
6964         range->max_pmt = 65535 * 1024;  /* ??? */
6965         range->pmp_flags = IW_POWER_PERIOD;
6966         range->pmt_flags = IW_POWER_TIMEOUT;
6967         range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
6968
6969         /* Transmit Power - values are in mW */
6970         for(i = 0 ; i < 8 ; i++) {
6971                 range->txpower[i] = le16_to_cpu(cap_rid.txPowerLevels[i]);
6972                 if(range->txpower[i] == 0)
6973                         break;
6974         }
6975         range->num_txpower = i;
6976         range->txpower_capa = IW_TXPOW_MWATT;
6977         range->we_version_source = 19;
6978         range->we_version_compiled = WIRELESS_EXT;
6979         range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
6980         range->retry_flags = IW_RETRY_LIMIT;
6981         range->r_time_flags = IW_RETRY_LIFETIME;
6982         range->min_retry = 1;
6983         range->max_retry = 65535;
6984         range->min_r_time = 1024;
6985         range->max_r_time = 65535 * 1024;
6986
6987         /* Event capability (kernel + driver) */
6988         range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
6989                                 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
6990                                 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
6991                                 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
6992         range->event_capa[1] = IW_EVENT_CAPA_K_1;
6993         range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVTXDROP);
6994         return 0;
6995 }
6996
6997 /*------------------------------------------------------------------*/
6998 /*
6999  * Wireless Handler : set Power Management
7000  */
7001 static int airo_set_power(struct net_device *dev,
7002                           struct iw_request_info *info,
7003                           struct iw_param *vwrq,
7004                           char *extra)
7005 {
7006         struct airo_info *local = dev->ml_priv;
7007
7008         readConfigRid(local, 1);
7009         if (vwrq->disabled) {
7010                 if (sniffing_mode(local))
7011                         return -EINVAL;
7012                 local->config.powerSaveMode = POWERSAVE_CAM;
7013                 local->config.rmode &= ~RXMODE_MASK;
7014                 local->config.rmode |= RXMODE_BC_MC_ADDR;
7015                 set_bit (FLAG_COMMIT, &local->flags);
7016                 return -EINPROGRESS;            /* Call commit handler */
7017         }
7018         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7019                 local->config.fastListenDelay = cpu_to_le16((vwrq->value + 500) / 1024);
7020                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7021                 set_bit (FLAG_COMMIT, &local->flags);
7022         } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
7023                 local->config.fastListenInterval =
7024                 local->config.listenInterval =
7025                         cpu_to_le16((vwrq->value + 500) / 1024);
7026                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7027                 set_bit (FLAG_COMMIT, &local->flags);
7028         }
7029         switch (vwrq->flags & IW_POWER_MODE) {
7030                 case IW_POWER_UNICAST_R:
7031                         if (sniffing_mode(local))
7032                                 return -EINVAL;
7033                         local->config.rmode &= ~RXMODE_MASK;
7034                         local->config.rmode |= RXMODE_ADDR;
7035                         set_bit (FLAG_COMMIT, &local->flags);
7036                         break;
7037                 case IW_POWER_ALL_R:
7038                         if (sniffing_mode(local))
7039                                 return -EINVAL;
7040                         local->config.rmode &= ~RXMODE_MASK;
7041                         local->config.rmode |= RXMODE_BC_MC_ADDR;
7042                         set_bit (FLAG_COMMIT, &local->flags);
7043                 case IW_POWER_ON:
7044                         /* This is broken, fixme ;-) */
7045                         break;
7046                 default:
7047                         return -EINVAL;
7048         }
7049         // Note : we may want to factor local->need_commit here
7050         // Note2 : may also want to factor RXMODE_RFMON test
7051         return -EINPROGRESS;            /* Call commit handler */
7052 }
7053
7054 /*------------------------------------------------------------------*/
7055 /*
7056  * Wireless Handler : get Power Management
7057  */
7058 static int airo_get_power(struct net_device *dev,
7059                           struct iw_request_info *info,
7060                           struct iw_param *vwrq,
7061                           char *extra)
7062 {
7063         struct airo_info *local = dev->ml_priv;
7064         __le16 mode;
7065
7066         readConfigRid(local, 1);
7067         mode = local->config.powerSaveMode;
7068         if ((vwrq->disabled = (mode == POWERSAVE_CAM)))
7069                 return 0;
7070         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7071                 vwrq->value = le16_to_cpu(local->config.fastListenDelay) * 1024;
7072                 vwrq->flags = IW_POWER_TIMEOUT;
7073         } else {
7074                 vwrq->value = le16_to_cpu(local->config.fastListenInterval) * 1024;
7075                 vwrq->flags = IW_POWER_PERIOD;
7076         }
7077         if ((local->config.rmode & RXMODE_MASK) == RXMODE_ADDR)
7078                 vwrq->flags |= IW_POWER_UNICAST_R;
7079         else
7080                 vwrq->flags |= IW_POWER_ALL_R;
7081
7082         return 0;
7083 }
7084
7085 /*------------------------------------------------------------------*/
7086 /*
7087  * Wireless Handler : set Sensitivity
7088  */
7089 static int airo_set_sens(struct net_device *dev,
7090                          struct iw_request_info *info,
7091                          struct iw_param *vwrq,
7092                          char *extra)
7093 {
7094         struct airo_info *local = dev->ml_priv;
7095
7096         readConfigRid(local, 1);
7097         local->config.rssiThreshold =
7098                 cpu_to_le16(vwrq->disabled ? RSSI_DEFAULT : vwrq->value);
7099         set_bit (FLAG_COMMIT, &local->flags);
7100
7101         return -EINPROGRESS;            /* Call commit handler */
7102 }
7103
7104 /*------------------------------------------------------------------*/
7105 /*
7106  * Wireless Handler : get Sensitivity
7107  */
7108 static int airo_get_sens(struct net_device *dev,
7109                          struct iw_request_info *info,
7110                          struct iw_param *vwrq,
7111                          char *extra)
7112 {
7113         struct airo_info *local = dev->ml_priv;
7114
7115         readConfigRid(local, 1);
7116         vwrq->value = le16_to_cpu(local->config.rssiThreshold);
7117         vwrq->disabled = (vwrq->value == 0);
7118         vwrq->fixed = 1;
7119
7120         return 0;
7121 }
7122
7123 /*------------------------------------------------------------------*/
7124 /*
7125  * Wireless Handler : get AP List
7126  * Note : this is deprecated in favor of IWSCAN
7127  */
7128 static int airo_get_aplist(struct net_device *dev,
7129                            struct iw_request_info *info,
7130                            struct iw_point *dwrq,
7131                            char *extra)
7132 {
7133         struct airo_info *local = dev->ml_priv;
7134         struct sockaddr *address = (struct sockaddr *) extra;
7135         struct iw_quality *qual;
7136         BSSListRid BSSList;
7137         int i;
7138         int loseSync = capable(CAP_NET_ADMIN) ? 1: -1;
7139
7140         qual = kmalloc_array(IW_MAX_AP, sizeof(*qual), GFP_KERNEL);
7141         if (!qual)
7142                 return -ENOMEM;
7143
7144         for (i = 0; i < IW_MAX_AP; i++) {
7145                 u16 dBm;
7146                 if (readBSSListRid(local, loseSync, &BSSList))
7147                         break;
7148                 loseSync = 0;
7149                 memcpy(address[i].sa_data, BSSList.bssid, ETH_ALEN);
7150                 address[i].sa_family = ARPHRD_ETHER;
7151                 dBm = le16_to_cpu(BSSList.dBm);
7152                 if (local->rssi) {
7153                         qual[i].level = 0x100 - dBm;
7154                         qual[i].qual = airo_dbm_to_pct(local->rssi, dBm);
7155                         qual[i].updated = IW_QUAL_QUAL_UPDATED
7156                                         | IW_QUAL_LEVEL_UPDATED
7157                                         | IW_QUAL_DBM;
7158                 } else {
7159                         qual[i].level = (dBm + 321) / 2;
7160                         qual[i].qual = 0;
7161                         qual[i].updated = IW_QUAL_QUAL_INVALID
7162                                         | IW_QUAL_LEVEL_UPDATED
7163                                         | IW_QUAL_DBM;
7164                 }
7165                 qual[i].noise = local->wstats.qual.noise;
7166                 if (BSSList.index == cpu_to_le16(0xffff))
7167                         break;
7168         }
7169         if (!i) {
7170                 StatusRid status_rid;           /* Card status info */
7171                 readStatusRid(local, &status_rid, 1);
7172                 for (i = 0;
7173                      i < min(IW_MAX_AP, 4) &&
7174                              (status_rid.bssid[i][0]
7175                               & status_rid.bssid[i][1]
7176                               & status_rid.bssid[i][2]
7177                               & status_rid.bssid[i][3]
7178                               & status_rid.bssid[i][4]
7179                               & status_rid.bssid[i][5])!=0xff &&
7180                              (status_rid.bssid[i][0]
7181                               | status_rid.bssid[i][1]
7182                               | status_rid.bssid[i][2]
7183                               | status_rid.bssid[i][3]
7184                               | status_rid.bssid[i][4]
7185                               | status_rid.bssid[i][5]);
7186                      i++) {
7187                         memcpy(address[i].sa_data,
7188                                status_rid.bssid[i], ETH_ALEN);
7189                         address[i].sa_family = ARPHRD_ETHER;
7190                 }
7191         } else {
7192                 dwrq->flags = 1; /* Should be define'd */
7193                 memcpy(extra + sizeof(struct sockaddr) * i, qual,
7194                        sizeof(struct iw_quality) * i);
7195         }
7196         dwrq->length = i;
7197
7198         kfree(qual);
7199         return 0;
7200 }
7201
7202 /*------------------------------------------------------------------*/
7203 /*
7204  * Wireless Handler : Initiate Scan
7205  */
7206 static int airo_set_scan(struct net_device *dev,
7207                          struct iw_request_info *info,
7208                          struct iw_point *dwrq,
7209                          char *extra)
7210 {
7211         struct airo_info *ai = dev->ml_priv;
7212         Cmd cmd;
7213         Resp rsp;
7214         int wake = 0;
7215         APListRid APList_rid_empty;
7216
7217         /* Note : you may have realised that, as this is a SET operation,
7218          * this is privileged and therefore a normal user can't
7219          * perform scanning.
7220          * This is not an error, while the device perform scanning,
7221          * traffic doesn't flow, so it's a perfect DoS...
7222          * Jean II */
7223         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
7224
7225         if (down_interruptible(&ai->sem))
7226                 return -ERESTARTSYS;
7227
7228         /* If there's already a scan in progress, don't
7229          * trigger another one. */
7230         if (ai->scan_timeout > 0)
7231                 goto out;
7232
7233         /* Clear APList as it affects scan results */
7234         memset(&APList_rid_empty, 0, sizeof(APList_rid_empty));
7235         APList_rid_empty.len = cpu_to_le16(sizeof(APList_rid_empty));
7236         disable_MAC(ai, 2);
7237         writeAPListRid(ai, &APList_rid_empty, 0);
7238         enable_MAC(ai, 0);
7239
7240         /* Initiate a scan command */
7241         ai->scan_timeout = RUN_AT(3*HZ);
7242         memset(&cmd, 0, sizeof(cmd));
7243         cmd.cmd=CMD_LISTBSS;
7244         issuecommand(ai, &cmd, &rsp);
7245         wake = 1;
7246
7247 out:
7248         up(&ai->sem);
7249         if (wake)
7250                 wake_up_interruptible(&ai->thr_wait);
7251         return 0;
7252 }
7253
7254 /*------------------------------------------------------------------*/
7255 /*
7256  * Translate scan data returned from the card to a card independent
7257  * format that the Wireless Tools will understand - Jean II
7258  */
7259 static inline char *airo_translate_scan(struct net_device *dev,
7260                                         struct iw_request_info *info,
7261                                         char *current_ev,
7262                                         char *end_buf,
7263                                         BSSListRid *bss)
7264 {
7265         struct airo_info *ai = dev->ml_priv;
7266         struct iw_event         iwe;            /* Temporary buffer */
7267         __le16                  capabilities;
7268         char *                  current_val;    /* For rates */
7269         int                     i;
7270         char *          buf;
7271         u16 dBm;
7272
7273         /* First entry *MUST* be the AP MAC address */
7274         iwe.cmd = SIOCGIWAP;
7275         iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
7276         memcpy(iwe.u.ap_addr.sa_data, bss->bssid, ETH_ALEN);
7277         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7278                                           &iwe, IW_EV_ADDR_LEN);
7279
7280         /* Other entries will be displayed in the order we give them */
7281
7282         /* Add the ESSID */
7283         iwe.u.data.length = bss->ssidLen;
7284         if(iwe.u.data.length > 32)
7285                 iwe.u.data.length = 32;
7286         iwe.cmd = SIOCGIWESSID;
7287         iwe.u.data.flags = 1;
7288         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7289                                           &iwe, bss->ssid);
7290
7291         /* Add mode */
7292         iwe.cmd = SIOCGIWMODE;
7293         capabilities = bss->cap;
7294         if(capabilities & (CAP_ESS | CAP_IBSS)) {
7295                 if(capabilities & CAP_ESS)
7296                         iwe.u.mode = IW_MODE_MASTER;
7297                 else
7298                         iwe.u.mode = IW_MODE_ADHOC;
7299                 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7300                                                   &iwe, IW_EV_UINT_LEN);
7301         }
7302
7303         /* Add frequency */
7304         iwe.cmd = SIOCGIWFREQ;
7305         iwe.u.freq.m = le16_to_cpu(bss->dsChannel);
7306         iwe.u.freq.m = 100000 *
7307               ieee80211_channel_to_frequency(iwe.u.freq.m, NL80211_BAND_2GHZ);
7308         iwe.u.freq.e = 1;
7309         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7310                                           &iwe, IW_EV_FREQ_LEN);
7311
7312         dBm = le16_to_cpu(bss->dBm);
7313
7314         /* Add quality statistics */
7315         iwe.cmd = IWEVQUAL;
7316         if (ai->rssi) {
7317                 iwe.u.qual.level = 0x100 - dBm;
7318                 iwe.u.qual.qual = airo_dbm_to_pct(ai->rssi, dBm);
7319                 iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED
7320                                 | IW_QUAL_LEVEL_UPDATED
7321                                 | IW_QUAL_DBM;
7322         } else {
7323                 iwe.u.qual.level = (dBm + 321) / 2;
7324                 iwe.u.qual.qual = 0;
7325                 iwe.u.qual.updated = IW_QUAL_QUAL_INVALID
7326                                 | IW_QUAL_LEVEL_UPDATED
7327                                 | IW_QUAL_DBM;
7328         }
7329         iwe.u.qual.noise = ai->wstats.qual.noise;
7330         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7331                                           &iwe, IW_EV_QUAL_LEN);
7332
7333         /* Add encryption capability */
7334         iwe.cmd = SIOCGIWENCODE;
7335         if(capabilities & CAP_PRIVACY)
7336                 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
7337         else
7338                 iwe.u.data.flags = IW_ENCODE_DISABLED;
7339         iwe.u.data.length = 0;
7340         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7341                                           &iwe, bss->ssid);
7342
7343         /* Rate : stuffing multiple values in a single event require a bit
7344          * more of magic - Jean II */
7345         current_val = current_ev + iwe_stream_lcp_len(info);
7346
7347         iwe.cmd = SIOCGIWRATE;
7348         /* Those two flags are ignored... */
7349         iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
7350         /* Max 8 values */
7351         for(i = 0 ; i < 8 ; i++) {
7352                 /* NULL terminated */
7353                 if(bss->rates[i] == 0)
7354                         break;
7355                 /* Bit rate given in 500 kb/s units (+ 0x80) */
7356                 iwe.u.bitrate.value = ((bss->rates[i] & 0x7f) * 500000);
7357                 /* Add new value to event */
7358                 current_val = iwe_stream_add_value(info, current_ev,
7359                                                    current_val, end_buf,
7360                                                    &iwe, IW_EV_PARAM_LEN);
7361         }
7362         /* Check if we added any event */
7363         if ((current_val - current_ev) > iwe_stream_lcp_len(info))
7364                 current_ev = current_val;
7365
7366         /* Beacon interval */
7367         buf = kmalloc(30, GFP_KERNEL);
7368         if (buf) {
7369                 iwe.cmd = IWEVCUSTOM;
7370                 sprintf(buf, "bcn_int=%d", bss->beaconInterval);
7371                 iwe.u.data.length = strlen(buf);
7372                 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7373                                                   &iwe, buf);
7374                 kfree(buf);
7375         }
7376
7377         /* Put WPA/RSN Information Elements into the event stream */
7378         if (test_bit(FLAG_WPA_CAPABLE, &ai->flags)) {
7379                 unsigned int num_null_ies = 0;
7380                 u16 length = sizeof (bss->extra.iep);
7381                 u8 *ie = (void *)&bss->extra.iep;
7382
7383                 while ((length >= 2) && (num_null_ies < 2)) {
7384                         if (2 + ie[1] > length) {
7385                                 /* Invalid element, don't continue parsing IE */
7386                                 break;
7387                         }
7388
7389                         switch (ie[0]) {
7390                         case WLAN_EID_SSID:
7391                                 /* Two zero-length SSID elements
7392                                  * mean we're done parsing elements */
7393                                 if (!ie[1])
7394                                         num_null_ies++;
7395                                 break;
7396
7397                         case WLAN_EID_VENDOR_SPECIFIC:
7398                                 if (ie[1] >= 4 &&
7399                                     ie[2] == 0x00 &&
7400                                     ie[3] == 0x50 &&
7401                                     ie[4] == 0xf2 &&
7402                                     ie[5] == 0x01) {
7403                                         iwe.cmd = IWEVGENIE;
7404                                         /* 64 is an arbitrary cut-off */
7405                                         iwe.u.data.length = min(ie[1] + 2,
7406                                                                 64);
7407                                         current_ev = iwe_stream_add_point(
7408                                                         info, current_ev,
7409                                                         end_buf, &iwe, ie);
7410                                 }
7411                                 break;
7412
7413                         case WLAN_EID_RSN:
7414                                 iwe.cmd = IWEVGENIE;
7415                                 /* 64 is an arbitrary cut-off */
7416                                 iwe.u.data.length = min(ie[1] + 2, 64);
7417                                 current_ev = iwe_stream_add_point(
7418                                         info, current_ev, end_buf,
7419                                         &iwe, ie);
7420                                 break;
7421
7422                         default:
7423                                 break;
7424                         }
7425
7426                         length -= 2 + ie[1];
7427                         ie += 2 + ie[1];
7428                 }
7429         }
7430         return current_ev;
7431 }
7432
7433 /*------------------------------------------------------------------*/
7434 /*
7435  * Wireless Handler : Read Scan Results
7436  */
7437 static int airo_get_scan(struct net_device *dev,
7438                          struct iw_request_info *info,
7439                          struct iw_point *dwrq,
7440                          char *extra)
7441 {
7442         struct airo_info *ai = dev->ml_priv;
7443         BSSListElement *net;
7444         int err = 0;
7445         char *current_ev = extra;
7446
7447         /* If a scan is in-progress, return -EAGAIN */
7448         if (ai->scan_timeout > 0)
7449                 return -EAGAIN;
7450
7451         if (down_interruptible(&ai->sem))
7452                 return -EAGAIN;
7453
7454         list_for_each_entry (net, &ai->network_list, list) {
7455                 /* Translate to WE format this entry */
7456                 current_ev = airo_translate_scan(dev, info, current_ev,
7457                                                  extra + dwrq->length,
7458                                                  &net->bss);
7459
7460                 /* Check if there is space for one more entry */
7461                 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
7462                         /* Ask user space to try again with a bigger buffer */
7463                         err = -E2BIG;
7464                         goto out;
7465                 }
7466         }
7467
7468         /* Length of data */
7469         dwrq->length = (current_ev - extra);
7470         dwrq->flags = 0;        /* todo */
7471
7472 out:
7473         up(&ai->sem);
7474         return err;
7475 }
7476
7477 /*------------------------------------------------------------------*/
7478 /*
7479  * Commit handler : called after a bunch of SET operations
7480  */
7481 static int airo_config_commit(struct net_device *dev,
7482                               struct iw_request_info *info,     /* NULL */
7483                               void *zwrq,                       /* NULL */
7484                               char *extra)                      /* NULL */
7485 {
7486         struct airo_info *local = dev->ml_priv;
7487
7488         if (!test_bit (FLAG_COMMIT, &local->flags))
7489                 return 0;
7490
7491         /* Some of the "SET" function may have modified some of the
7492          * parameters. It's now time to commit them in the card */
7493         disable_MAC(local, 1);
7494         if (test_bit (FLAG_RESET, &local->flags)) {
7495                 SsidRid SSID_rid;
7496
7497                 readSsidRid(local, &SSID_rid);
7498                 if (test_bit(FLAG_MPI,&local->flags))
7499                         setup_card(local, dev->dev_addr, 1 );
7500                 else
7501                         reset_airo_card(dev);
7502                 disable_MAC(local, 1);
7503                 writeSsidRid(local, &SSID_rid, 1);
7504                 writeAPListRid(local, &local->APList, 1);
7505         }
7506         if (down_interruptible(&local->sem))
7507                 return -ERESTARTSYS;
7508         writeConfigRid(local, 0);
7509         enable_MAC(local, 0);
7510         if (test_bit (FLAG_RESET, &local->flags))
7511                 airo_set_promisc(local);
7512         else
7513                 up(&local->sem);
7514
7515         return 0;
7516 }
7517
7518 /*------------------------------------------------------------------*/
7519 /*
7520  * Structures to export the Wireless Handlers
7521  */
7522
7523 static const struct iw_priv_args airo_private_args[] = {
7524 /*{ cmd,         set_args,                            get_args, name } */
7525   { AIROIOCTL, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7526     IW_PRIV_TYPE_BYTE | 2047, "airoioctl" },
7527   { AIROIDIFC, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7528     IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "airoidifc" },
7529 };
7530
7531 static const iw_handler         airo_handler[] =
7532 {
7533         (iw_handler) airo_config_commit,        /* SIOCSIWCOMMIT */
7534         (iw_handler) airo_get_name,             /* SIOCGIWNAME */
7535         (iw_handler) NULL,                      /* SIOCSIWNWID */
7536         (iw_handler) NULL,                      /* SIOCGIWNWID */
7537         (iw_handler) airo_set_freq,             /* SIOCSIWFREQ */
7538         (iw_handler) airo_get_freq,             /* SIOCGIWFREQ */
7539         (iw_handler) airo_set_mode,             /* SIOCSIWMODE */
7540         (iw_handler) airo_get_mode,             /* SIOCGIWMODE */
7541         (iw_handler) airo_set_sens,             /* SIOCSIWSENS */
7542         (iw_handler) airo_get_sens,             /* SIOCGIWSENS */
7543         (iw_handler) NULL,                      /* SIOCSIWRANGE */
7544         (iw_handler) airo_get_range,            /* SIOCGIWRANGE */
7545         (iw_handler) NULL,                      /* SIOCSIWPRIV */
7546         (iw_handler) NULL,                      /* SIOCGIWPRIV */
7547         (iw_handler) NULL,                      /* SIOCSIWSTATS */
7548         (iw_handler) NULL,                      /* SIOCGIWSTATS */
7549         iw_handler_set_spy,                     /* SIOCSIWSPY */
7550         iw_handler_get_spy,                     /* SIOCGIWSPY */
7551         iw_handler_set_thrspy,                  /* SIOCSIWTHRSPY */
7552         iw_handler_get_thrspy,                  /* SIOCGIWTHRSPY */
7553         (iw_handler) airo_set_wap,              /* SIOCSIWAP */
7554         (iw_handler) airo_get_wap,              /* SIOCGIWAP */
7555         (iw_handler) NULL,                      /* -- hole -- */
7556         (iw_handler) airo_get_aplist,           /* SIOCGIWAPLIST */
7557         (iw_handler) airo_set_scan,             /* SIOCSIWSCAN */
7558         (iw_handler) airo_get_scan,             /* SIOCGIWSCAN */
7559         (iw_handler) airo_set_essid,            /* SIOCSIWESSID */
7560         (iw_handler) airo_get_essid,            /* SIOCGIWESSID */
7561         (iw_handler) airo_set_nick,             /* SIOCSIWNICKN */
7562         (iw_handler) airo_get_nick,             /* SIOCGIWNICKN */
7563         (iw_handler) NULL,                      /* -- hole -- */
7564         (iw_handler) NULL,                      /* -- hole -- */
7565         (iw_handler) airo_set_rate,             /* SIOCSIWRATE */
7566         (iw_handler) airo_get_rate,             /* SIOCGIWRATE */
7567         (iw_handler) airo_set_rts,              /* SIOCSIWRTS */
7568         (iw_handler) airo_get_rts,              /* SIOCGIWRTS */
7569         (iw_handler) airo_set_frag,             /* SIOCSIWFRAG */
7570         (iw_handler) airo_get_frag,             /* SIOCGIWFRAG */
7571         (iw_handler) airo_set_txpow,            /* SIOCSIWTXPOW */
7572         (iw_handler) airo_get_txpow,            /* SIOCGIWTXPOW */
7573         (iw_handler) airo_set_retry,            /* SIOCSIWRETRY */
7574         (iw_handler) airo_get_retry,            /* SIOCGIWRETRY */
7575         (iw_handler) airo_set_encode,           /* SIOCSIWENCODE */
7576         (iw_handler) airo_get_encode,           /* SIOCGIWENCODE */
7577         (iw_handler) airo_set_power,            /* SIOCSIWPOWER */
7578         (iw_handler) airo_get_power,            /* SIOCGIWPOWER */
7579         (iw_handler) NULL,                      /* -- hole -- */
7580         (iw_handler) NULL,                      /* -- hole -- */
7581         (iw_handler) NULL,                      /* SIOCSIWGENIE */
7582         (iw_handler) NULL,                      /* SIOCGIWGENIE */
7583         (iw_handler) airo_set_auth,             /* SIOCSIWAUTH */
7584         (iw_handler) airo_get_auth,             /* SIOCGIWAUTH */
7585         (iw_handler) airo_set_encodeext,        /* SIOCSIWENCODEEXT */
7586         (iw_handler) airo_get_encodeext,        /* SIOCGIWENCODEEXT */
7587         (iw_handler) NULL,                      /* SIOCSIWPMKSA */
7588 };
7589
7590 /* Note : don't describe AIROIDIFC and AIROOLDIDIFC in here.
7591  * We want to force the use of the ioctl code, because those can't be
7592  * won't work the iw_handler code (because they simultaneously read
7593  * and write data and iw_handler can't do that).
7594  * Note that it's perfectly legal to read/write on a single ioctl command,
7595  * you just can't use iwpriv and need to force it via the ioctl handler.
7596  * Jean II */
7597 static const iw_handler         airo_private_handler[] =
7598 {
7599         NULL,                           /* SIOCIWFIRSTPRIV */
7600 };
7601
7602 static const struct iw_handler_def      airo_handler_def =
7603 {
7604         .num_standard   = ARRAY_SIZE(airo_handler),
7605         .num_private    = ARRAY_SIZE(airo_private_handler),
7606         .num_private_args = ARRAY_SIZE(airo_private_args),
7607         .standard       = airo_handler,
7608         .private        = airo_private_handler,
7609         .private_args   = airo_private_args,
7610         .get_wireless_stats = airo_get_wireless_stats,
7611 };
7612
7613 /*
7614  * This defines the configuration part of the Wireless Extensions
7615  * Note : irq and spinlock protection will occur in the subroutines
7616  *
7617  * TODO :
7618  *      o Check input value more carefully and fill correct values in range
7619  *      o Test and shakeout the bugs (if any)
7620  *
7621  * Jean II
7622  *
7623  * Javier Achirica did a great job of merging code from the unnamed CISCO
7624  * developer that added support for flashing the card.
7625  */
7626 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
7627 {
7628         int rc = 0;
7629         struct airo_info *ai = dev->ml_priv;
7630
7631         if (ai->power.event)
7632                 return 0;
7633
7634         switch (cmd) {
7635 #ifdef CISCO_EXT
7636         case AIROIDIFC:
7637 #ifdef AIROOLDIDIFC
7638         case AIROOLDIDIFC:
7639 #endif
7640         {
7641                 int val = AIROMAGIC;
7642                 aironet_ioctl com;
7643                 if (copy_from_user(&com,rq->ifr_data,sizeof(com)))
7644                         rc = -EFAULT;
7645                 else if (copy_to_user(com.data,(char *)&val,sizeof(val)))
7646                         rc = -EFAULT;
7647         }
7648         break;
7649
7650         case AIROIOCTL:
7651 #ifdef AIROOLDIOCTL
7652         case AIROOLDIOCTL:
7653 #endif
7654                 /* Get the command struct and hand it off for evaluation by
7655                  * the proper subfunction
7656                  */
7657         {
7658                 aironet_ioctl com;
7659                 if (copy_from_user(&com,rq->ifr_data,sizeof(com))) {
7660                         rc = -EFAULT;
7661                         break;
7662                 }
7663
7664                 /* Separate R/W functions bracket legality here
7665                  */
7666                 if ( com.command == AIRORSWVERSION ) {
7667                         if (copy_to_user(com.data, swversion, sizeof(swversion)))
7668                                 rc = -EFAULT;
7669                         else
7670                                 rc = 0;
7671                 }
7672                 else if ( com.command <= AIRORRID)
7673                         rc = readrids(dev,&com);
7674                 else if ( com.command >= AIROPCAP && com.command <= (AIROPLEAPUSR+2) )
7675                         rc = writerids(dev,&com);
7676                 else if ( com.command >= AIROFLSHRST && com.command <= AIRORESTART )
7677                         rc = flashcard(dev,&com);
7678                 else
7679                         rc = -EINVAL;      /* Bad command in ioctl */
7680         }
7681         break;
7682 #endif /* CISCO_EXT */
7683
7684         // All other calls are currently unsupported
7685         default:
7686                 rc = -EOPNOTSUPP;
7687         }
7688         return rc;
7689 }
7690
7691 /*
7692  * Get the Wireless stats out of the driver
7693  * Note : irq and spinlock protection will occur in the subroutines
7694  *
7695  * TODO :
7696  *      o Check if work in Ad-Hoc mode (otherwise, use SPY, as in wvlan_cs)
7697  *
7698  * Jean
7699  */
7700 static void airo_read_wireless_stats(struct airo_info *local)
7701 {
7702         StatusRid status_rid;
7703         StatsRid stats_rid;
7704         CapabilityRid cap_rid;
7705         __le32 *vals = stats_rid.vals;
7706
7707         /* Get stats out of the card */
7708         clear_bit(JOB_WSTATS, &local->jobs);
7709         if (local->power.event) {
7710                 up(&local->sem);
7711                 return;
7712         }
7713         readCapabilityRid(local, &cap_rid, 0);
7714         readStatusRid(local, &status_rid, 0);
7715         readStatsRid(local, &stats_rid, RID_STATS, 0);
7716         up(&local->sem);
7717
7718         /* The status */
7719         local->wstats.status = le16_to_cpu(status_rid.mode);
7720
7721         /* Signal quality and co */
7722         if (local->rssi) {
7723                 local->wstats.qual.level =
7724                         airo_rssi_to_dbm(local->rssi,
7725                                          le16_to_cpu(status_rid.sigQuality));
7726                 /* normalizedSignalStrength appears to be a percentage */
7727                 local->wstats.qual.qual =
7728                         le16_to_cpu(status_rid.normalizedSignalStrength);
7729         } else {
7730                 local->wstats.qual.level =
7731                         (le16_to_cpu(status_rid.normalizedSignalStrength) + 321) / 2;
7732                 local->wstats.qual.qual = airo_get_quality(&status_rid, &cap_rid);
7733         }
7734         if (le16_to_cpu(status_rid.len) >= 124) {
7735                 local->wstats.qual.noise = 0x100 - status_rid.noisedBm;
7736                 local->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
7737         } else {
7738                 local->wstats.qual.noise = 0;
7739                 local->wstats.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID | IW_QUAL_DBM;
7740         }
7741
7742         /* Packets discarded in the wireless adapter due to wireless
7743          * specific problems */
7744         local->wstats.discard.nwid = le32_to_cpu(vals[56]) +
7745                                      le32_to_cpu(vals[57]) +
7746                                      le32_to_cpu(vals[58]); /* SSID Mismatch */
7747         local->wstats.discard.code = le32_to_cpu(vals[6]);/* RxWepErr */
7748         local->wstats.discard.fragment = le32_to_cpu(vals[30]);
7749         local->wstats.discard.retries = le32_to_cpu(vals[10]);
7750         local->wstats.discard.misc = le32_to_cpu(vals[1]) +
7751                                      le32_to_cpu(vals[32]);
7752         local->wstats.miss.beacon = le32_to_cpu(vals[34]);
7753 }
7754
7755 static struct iw_statistics *airo_get_wireless_stats(struct net_device *dev)
7756 {
7757         struct airo_info *local =  dev->ml_priv;
7758
7759         if (!test_bit(JOB_WSTATS, &local->jobs)) {
7760                 /* Get stats out of the card if available */
7761                 if (down_trylock(&local->sem) != 0) {
7762                         set_bit(JOB_WSTATS, &local->jobs);
7763                         wake_up_interruptible(&local->thr_wait);
7764                 } else
7765                         airo_read_wireless_stats(local);
7766         }
7767
7768         return &local->wstats;
7769 }
7770
7771 #ifdef CISCO_EXT
7772 /*
7773  * This just translates from driver IOCTL codes to the command codes to
7774  * feed to the radio's host interface. Things can be added/deleted
7775  * as needed.  This represents the READ side of control I/O to
7776  * the card
7777  */
7778 static int readrids(struct net_device *dev, aironet_ioctl *comp) {
7779         unsigned short ridcode;
7780         unsigned char *iobuf;
7781         int len;
7782         struct airo_info *ai = dev->ml_priv;
7783
7784         if (test_bit(FLAG_FLASHING, &ai->flags))
7785                 return -EIO;
7786
7787         switch(comp->command)
7788         {
7789         case AIROGCAP:      ridcode = RID_CAPABILITIES; break;
7790         case AIROGCFG:      ridcode = RID_CONFIG;
7791                 if (test_bit(FLAG_COMMIT, &ai->flags)) {
7792                         disable_MAC (ai, 1);
7793                         writeConfigRid (ai, 1);
7794                         enable_MAC(ai, 1);
7795                 }
7796                 break;
7797         case AIROGSLIST:    ridcode = RID_SSID;         break;
7798         case AIROGVLIST:    ridcode = RID_APLIST;       break;
7799         case AIROGDRVNAM:   ridcode = RID_DRVNAME;      break;
7800         case AIROGEHTENC:   ridcode = RID_ETHERENCAP;   break;
7801         case AIROGWEPKTMP:  ridcode = RID_WEP_TEMP;     break;
7802         case AIROGWEPKNV:   ridcode = RID_WEP_PERM;     break;
7803         case AIROGSTAT:     ridcode = RID_STATUS;       break;
7804         case AIROGSTATSD32: ridcode = RID_STATSDELTA;   break;
7805         case AIROGSTATSC32: ridcode = RID_STATS;        break;
7806         case AIROGMICSTATS:
7807                 if (copy_to_user(comp->data, &ai->micstats,
7808                                  min((int)comp->len,(int)sizeof(ai->micstats))))
7809                         return -EFAULT;
7810                 return 0;
7811         case AIRORRID:      ridcode = comp->ridnum;     break;
7812         default:
7813                 return -EINVAL;
7814         }
7815
7816         if (ridcode == RID_WEP_TEMP || ridcode == RID_WEP_PERM) {
7817                 /* Only super-user can read WEP keys */
7818                 if (!capable(CAP_NET_ADMIN))
7819                         return -EPERM;
7820         }
7821
7822         if ((iobuf = kzalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7823                 return -ENOMEM;
7824
7825         PC4500_readrid(ai,ridcode,iobuf,RIDSIZE, 1);
7826         /* get the count of bytes in the rid  docs say 1st 2 bytes is it.
7827          * then return it to the user
7828          * 9/22/2000 Honor user given length
7829          */
7830         len = comp->len;
7831
7832         if (copy_to_user(comp->data, iobuf, min(len, (int)RIDSIZE))) {
7833                 kfree (iobuf);
7834                 return -EFAULT;
7835         }
7836         kfree (iobuf);
7837         return 0;
7838 }
7839
7840 /*
7841  * Danger Will Robinson write the rids here
7842  */
7843
7844 static int writerids(struct net_device *dev, aironet_ioctl *comp) {
7845         struct airo_info *ai = dev->ml_priv;
7846         int  ridcode;
7847         int  enabled;
7848         int (*writer)(struct airo_info *, u16 rid, const void *, int, int);
7849         unsigned char *iobuf;
7850
7851         /* Only super-user can write RIDs */
7852         if (!capable(CAP_NET_ADMIN))
7853                 return -EPERM;
7854
7855         if (test_bit(FLAG_FLASHING, &ai->flags))
7856                 return -EIO;
7857
7858         ridcode = 0;
7859         writer = do_writerid;
7860
7861         switch(comp->command)
7862         {
7863         case AIROPSIDS:     ridcode = RID_SSID;         break;
7864         case AIROPCAP:      ridcode = RID_CAPABILITIES; break;
7865         case AIROPAPLIST:   ridcode = RID_APLIST;       break;
7866         case AIROPCFG: ai->config.len = 0;
7867                             clear_bit(FLAG_COMMIT, &ai->flags);
7868                             ridcode = RID_CONFIG;       break;
7869         case AIROPWEPKEYNV: ridcode = RID_WEP_PERM;     break;
7870         case AIROPLEAPUSR:  ridcode = RID_LEAPUSERNAME; break;
7871         case AIROPLEAPPWD:  ridcode = RID_LEAPPASSWORD; break;
7872         case AIROPWEPKEY:   ridcode = RID_WEP_TEMP; writer = PC4500_writerid;
7873                 break;
7874         case AIROPLEAPUSR+1: ridcode = 0xFF2A;          break;
7875         case AIROPLEAPUSR+2: ridcode = 0xFF2B;          break;
7876
7877                 /* this is not really a rid but a command given to the card
7878                  * same with MAC off
7879                  */
7880         case AIROPMACON:
7881                 if (enable_MAC(ai, 1) != 0)
7882                         return -EIO;
7883                 return 0;
7884
7885                 /*
7886                  * Evidently this code in the airo driver does not get a symbol
7887                  * as disable_MAC. it's probably so short the compiler does not gen one.
7888                  */
7889         case AIROPMACOFF:
7890                 disable_MAC(ai, 1);
7891                 return 0;
7892
7893                 /* This command merely clears the counts does not actually store any data
7894                  * only reads rid. But as it changes the cards state, I put it in the
7895                  * writerid routines.
7896                  */
7897         case AIROPSTCLR:
7898                 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7899                         return -ENOMEM;
7900
7901                 PC4500_readrid(ai,RID_STATSDELTACLEAR,iobuf,RIDSIZE, 1);
7902
7903                 enabled = ai->micstats.enabled;
7904                 memset(&ai->micstats,0,sizeof(ai->micstats));
7905                 ai->micstats.enabled = enabled;
7906
7907                 if (copy_to_user(comp->data, iobuf,
7908                                  min((int)comp->len, (int)RIDSIZE))) {
7909                         kfree (iobuf);
7910                         return -EFAULT;
7911                 }
7912                 kfree (iobuf);
7913                 return 0;
7914
7915         default:
7916                 return -EOPNOTSUPP;     /* Blarg! */
7917         }
7918         if(comp->len > RIDSIZE)
7919                 return -EINVAL;
7920
7921         if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7922                 return -ENOMEM;
7923
7924         if (copy_from_user(iobuf,comp->data,comp->len)) {
7925                 kfree (iobuf);
7926                 return -EFAULT;
7927         }
7928
7929         if (comp->command == AIROPCFG) {
7930                 ConfigRid *cfg = (ConfigRid *)iobuf;
7931
7932                 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags))
7933                         cfg->opmode |= MODE_MIC;
7934
7935                 if ((cfg->opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
7936                         set_bit (FLAG_ADHOC, &ai->flags);
7937                 else
7938                         clear_bit (FLAG_ADHOC, &ai->flags);
7939         }
7940
7941         if((*writer)(ai, ridcode, iobuf,comp->len,1)) {
7942                 kfree (iobuf);
7943                 return -EIO;
7944         }
7945         kfree (iobuf);
7946         return 0;
7947 }
7948
7949 /*****************************************************************************
7950  * Ancillary flash / mod functions much black magic lurkes here              *
7951  *****************************************************************************
7952  */
7953
7954 /*
7955  * Flash command switch table
7956  */
7957
7958 static int flashcard(struct net_device *dev, aironet_ioctl *comp) {
7959         int z;
7960
7961         /* Only super-user can modify flash */
7962         if (!capable(CAP_NET_ADMIN))
7963                 return -EPERM;
7964
7965         switch(comp->command)
7966         {
7967         case AIROFLSHRST:
7968                 return cmdreset((struct airo_info *)dev->ml_priv);
7969
7970         case AIROFLSHSTFL:
7971                 if (!AIRO_FLASH(dev) &&
7972                     (AIRO_FLASH(dev) = kmalloc(FLASHSIZE, GFP_KERNEL)) == NULL)
7973                         return -ENOMEM;
7974                 return setflashmode((struct airo_info *)dev->ml_priv);
7975
7976         case AIROFLSHGCHR: /* Get char from aux */
7977                 if(comp->len != sizeof(int))
7978                         return -EINVAL;
7979                 if (copy_from_user(&z,comp->data,comp->len))
7980                         return -EFAULT;
7981                 return flashgchar((struct airo_info *)dev->ml_priv, z, 8000);
7982
7983         case AIROFLSHPCHR: /* Send char to card. */
7984                 if(comp->len != sizeof(int))
7985                         return -EINVAL;
7986                 if (copy_from_user(&z,comp->data,comp->len))
7987                         return -EFAULT;
7988                 return flashpchar((struct airo_info *)dev->ml_priv, z, 8000);
7989
7990         case AIROFLPUTBUF: /* Send 32k to card */
7991                 if (!AIRO_FLASH(dev))
7992                         return -ENOMEM;
7993                 if(comp->len > FLASHSIZE)
7994                         return -EINVAL;
7995                 if (copy_from_user(AIRO_FLASH(dev), comp->data, comp->len))
7996                         return -EFAULT;
7997
7998                 flashputbuf((struct airo_info *)dev->ml_priv);
7999                 return 0;
8000
8001         case AIRORESTART:
8002                 if (flashrestart((struct airo_info *)dev->ml_priv, dev))
8003                         return -EIO;
8004                 return 0;
8005         }
8006         return -EINVAL;
8007 }
8008
8009 #define FLASH_COMMAND  0x7e7e
8010
8011 /*
8012  * STEP 1)
8013  * Disable MAC and do soft reset on
8014  * card.
8015  */
8016
8017 static int cmdreset(struct airo_info *ai) {
8018         disable_MAC(ai, 1);
8019
8020         if(!waitbusy (ai)){
8021                 airo_print_info(ai->dev->name, "Waitbusy hang before RESET");
8022                 return -EBUSY;
8023         }
8024
8025         OUT4500(ai,COMMAND,CMD_SOFTRESET);
8026
8027         ssleep(1);                      /* WAS 600 12/7/00 */
8028
8029         if(!waitbusy (ai)){
8030                 airo_print_info(ai->dev->name, "Waitbusy hang AFTER RESET");
8031                 return -EBUSY;
8032         }
8033         return 0;
8034 }
8035
8036 /* STEP 2)
8037  * Put the card in legendary flash
8038  * mode
8039  */
8040
8041 static int setflashmode (struct airo_info *ai) {
8042         set_bit (FLAG_FLASHING, &ai->flags);
8043
8044         OUT4500(ai, SWS0, FLASH_COMMAND);
8045         OUT4500(ai, SWS1, FLASH_COMMAND);
8046         if (probe) {
8047                 OUT4500(ai, SWS0, FLASH_COMMAND);
8048                 OUT4500(ai, COMMAND,0x10);
8049         } else {
8050                 OUT4500(ai, SWS2, FLASH_COMMAND);
8051                 OUT4500(ai, SWS3, FLASH_COMMAND);
8052                 OUT4500(ai, COMMAND,0);
8053         }
8054         msleep(500);            /* 500ms delay */
8055
8056         if(!waitbusy(ai)) {
8057                 clear_bit (FLAG_FLASHING, &ai->flags);
8058                 airo_print_info(ai->dev->name, "Waitbusy hang after setflash mode");
8059                 return -EIO;
8060         }
8061         return 0;
8062 }
8063
8064 /* Put character to SWS0 wait for dwelltime
8065  * x 50us for  echo .
8066  */
8067
8068 static int flashpchar(struct airo_info *ai,int byte,int dwelltime) {
8069         int echo;
8070         int waittime;
8071
8072         byte |= 0x8000;
8073
8074         if(dwelltime == 0 )
8075                 dwelltime = 200;
8076
8077         waittime=dwelltime;
8078
8079         /* Wait for busy bit d15 to go false indicating buffer empty */
8080         while ((IN4500 (ai, SWS0) & 0x8000) && waittime > 0) {
8081                 udelay (50);
8082                 waittime -= 50;
8083         }
8084
8085         /* timeout for busy clear wait */
8086         if(waittime <= 0 ){
8087                 airo_print_info(ai->dev->name, "flash putchar busywait timeout!");
8088                 return -EBUSY;
8089         }
8090
8091         /* Port is clear now write byte and wait for it to echo back */
8092         do {
8093                 OUT4500(ai,SWS0,byte);
8094                 udelay(50);
8095                 dwelltime -= 50;
8096                 echo = IN4500(ai,SWS1);
8097         } while (dwelltime >= 0 && echo != byte);
8098
8099         OUT4500(ai,SWS1,0);
8100
8101         return (echo == byte) ? 0 : -EIO;
8102 }
8103
8104 /*
8105  * Get a character from the card matching matchbyte
8106  * Step 3)
8107  */
8108 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime){
8109         int           rchar;
8110         unsigned char rbyte=0;
8111
8112         do {
8113                 rchar = IN4500(ai,SWS1);
8114
8115                 if(dwelltime && !(0x8000 & rchar)){
8116                         dwelltime -= 10;
8117                         mdelay(10);
8118                         continue;
8119                 }
8120                 rbyte = 0xff & rchar;
8121
8122                 if( (rbyte == matchbyte) && (0x8000 & rchar) ){
8123                         OUT4500(ai,SWS1,0);
8124                         return 0;
8125                 }
8126                 if( rbyte == 0x81 || rbyte == 0x82 || rbyte == 0x83 || rbyte == 0x1a || 0xffff == rchar)
8127                         break;
8128                 OUT4500(ai,SWS1,0);
8129
8130         }while(dwelltime > 0);
8131         return -EIO;
8132 }
8133
8134 /*
8135  * Transfer 32k of firmware data from user buffer to our buffer and
8136  * send to the card
8137  */
8138
8139 static int flashputbuf(struct airo_info *ai){
8140         int            nwords;
8141
8142         /* Write stuff */
8143         if (test_bit(FLAG_MPI,&ai->flags))
8144                 memcpy_toio(ai->pciaux + 0x8000, ai->flash, FLASHSIZE);
8145         else {
8146                 OUT4500(ai,AUXPAGE,0x100);
8147                 OUT4500(ai,AUXOFF,0);
8148
8149                 for(nwords=0;nwords != FLASHSIZE / 2;nwords++){
8150                         OUT4500(ai,AUXDATA,ai->flash[nwords] & 0xffff);
8151                 }
8152         }
8153         OUT4500(ai,SWS0,0x8000);
8154
8155         return 0;
8156 }
8157
8158 /*
8159  *
8160  */
8161 static int flashrestart(struct airo_info *ai,struct net_device *dev){
8162         int    i,status;
8163
8164         ssleep(1);                      /* Added 12/7/00 */
8165         clear_bit (FLAG_FLASHING, &ai->flags);
8166         if (test_bit(FLAG_MPI, &ai->flags)) {
8167                 status = mpi_init_descriptors(ai);
8168                 if (status != SUCCESS)
8169                         return status;
8170         }
8171         status = setup_card(ai, dev->dev_addr, 1);
8172
8173         if (!test_bit(FLAG_MPI,&ai->flags))
8174                 for( i = 0; i < MAX_FIDS; i++ ) {
8175                         ai->fids[i] = transmit_allocate
8176                                 ( ai, AIRO_DEF_MTU, i >= MAX_FIDS / 2 );
8177                 }
8178
8179         ssleep(1);                      /* Added 12/7/00 */
8180         return status;
8181 }
8182 #endif /* CISCO_EXT */
8183
8184 /*
8185     This program is free software; you can redistribute it and/or
8186     modify it under the terms of the GNU General Public License
8187     as published by the Free Software Foundation; either version 2
8188     of the License, or (at your option) any later version.
8189
8190     This program is distributed in the hope that it will be useful,
8191     but WITHOUT ANY WARRANTY; without even the implied warranty of
8192     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
8193     GNU General Public License for more details.
8194
8195     In addition:
8196
8197     Redistribution and use in source and binary forms, with or without
8198     modification, are permitted provided that the following conditions
8199     are met:
8200
8201     1. Redistributions of source code must retain the above copyright
8202        notice, this list of conditions and the following disclaimer.
8203     2. Redistributions in binary form must reproduce the above copyright
8204        notice, this list of conditions and the following disclaimer in the
8205        documentation and/or other materials provided with the distribution.
8206     3. The name of the author may not be used to endorse or promote
8207        products derived from this software without specific prior written
8208        permission.
8209
8210     THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
8211     IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
8212     WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
8213     ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
8214     INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
8215     (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
8216     SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
8217     HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
8218     STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
8219     IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
8220     POSSIBILITY OF SUCH DAMAGE.
8221 */
8222
8223 module_init(airo_init_module);
8224 module_exit(airo_cleanup_module);