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