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