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 #include <linux/freezer.h>
  53
  54 #include "airo.h"
  55
  56 #ifdef CONFIG_PCI
  57 static struct pci_device_id card_ids[] = {
  58         { 0x14b9, 1, PCI_ANY_ID, PCI_ANY_ID, },
  59         { 0x14b9, 0x4500, PCI_ANY_ID, PCI_ANY_ID },
  60         { 0x14b9, 0x4800, PCI_ANY_ID, PCI_ANY_ID, },
  61         { 0x14b9, 0x0340, PCI_ANY_ID, PCI_ANY_ID, },
  62         { 0x14b9, 0x0350, PCI_ANY_ID, PCI_ANY_ID, },
  63         { 0x14b9, 0x5000, PCI_ANY_ID, PCI_ANY_ID, },
  64         { 0x14b9, 0xa504, PCI_ANY_ID, PCI_ANY_ID, },
  65         { 0, }
  66 };
  67 MODULE_DEVICE_TABLE(pci, card_ids);
  68
  69 static int airo_pci_probe(struct pci_dev *, const struct pci_device_id *);
  70 static void airo_pci_remove(struct pci_dev *);
  71 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state);
  72 static int airo_pci_resume(struct pci_dev *pdev);
  73
  74 static struct pci_driver airo_driver = {
  75         .name     = "airo",
  76         .id_table = card_ids,
  77         .probe    = airo_pci_probe,
  78         .remove   = __devexit_p(airo_pci_remove),
  79         .suspend  = airo_pci_suspend,
  80         .resume   = airo_pci_resume,
  81 };
  82 #endif /* CONFIG_PCI */
  83
  84 /* Include Wireless Extension definition and check version - Jean II */
  85 #include <linux/wireless.h>
  86 #define WIRELESS_SPY            // enable iwspy support
  87 #include <net/iw_handler.h>     // New driver API
  88
  89 #define CISCO_EXT               // enable Cisco extensions
  90 #ifdef CISCO_EXT
  91 #include <linux/delay.h>
  92 #endif
  93
  94 /* Hack to do some power saving */
  95 #define POWER_ON_DOWN
  96
  97 /* As you can see this list is HUGH!
  98    I really don't know what a lot of these counts are about, but they
  99    are all here for completeness.  If the IGNLABEL macro is put in
 100    infront of the label, that statistic will not be included in the list
 101    of statistics in the /proc filesystem */
 102
 103 #define IGNLABEL(comment) NULL
 104 static char *statsLabels[] = {
 105         "RxOverrun",
 106         IGNLABEL("RxPlcpCrcErr"),
 107         IGNLABEL("RxPlcpFormatErr"),
 108         IGNLABEL("RxPlcpLengthErr"),
 109         "RxMacCrcErr",
 110         "RxMacCrcOk",
 111         "RxWepErr",
 112         "RxWepOk",
 113         "RetryLong",
 114         "RetryShort",
 115         "MaxRetries",
 116         "NoAck",
 117         "NoCts",
 118         "RxAck",
 119         "RxCts",
 120         "TxAck",
 121         "TxRts",
 122         "TxCts",
 123         "TxMc",
 124         "TxBc",
 125         "TxUcFrags",
 126         "TxUcPackets",
 127         "TxBeacon",
 128         "RxBeacon",
 129         "TxSinColl",
 130         "TxMulColl",
 131         "DefersNo",
 132         "DefersProt",
 133         "DefersEngy",
 134         "DupFram",
 135         "RxFragDisc",
 136         "TxAged",
 137         "RxAged",
 138         "LostSync-MaxRetry",
 139         "LostSync-MissedBeacons",
 140         "LostSync-ArlExceeded",
 141         "LostSync-Deauth",
 142         "LostSync-Disassoced",
 143         "LostSync-TsfTiming",
 144         "HostTxMc",
 145         "HostTxBc",
 146         "HostTxUc",
 147         "HostTxFail",
 148         "HostRxMc",
 149         "HostRxBc",
 150         "HostRxUc",
 151         "HostRxDiscard",
 152         IGNLABEL("HmacTxMc"),
 153         IGNLABEL("HmacTxBc"),
 154         IGNLABEL("HmacTxUc"),
 155         IGNLABEL("HmacTxFail"),
 156         IGNLABEL("HmacRxMc"),
 157         IGNLABEL("HmacRxBc"),
 158         IGNLABEL("HmacRxUc"),
 159         IGNLABEL("HmacRxDiscard"),
 160         IGNLABEL("HmacRxAccepted"),
 161         "SsidMismatch",
 162         "ApMismatch",
 163         "RatesMismatch",
 164         "AuthReject",
 165         "AuthTimeout",
 166         "AssocReject",
 167         "AssocTimeout",
 168         IGNLABEL("ReasonOutsideTable"),
 169         IGNLABEL("ReasonStatus1"),
 170         IGNLABEL("ReasonStatus2"),
 171         IGNLABEL("ReasonStatus3"),
 172         IGNLABEL("ReasonStatus4"),
 173         IGNLABEL("ReasonStatus5"),
 174         IGNLABEL("ReasonStatus6"),
 175         IGNLABEL("ReasonStatus7"),
 176         IGNLABEL("ReasonStatus8"),
 177         IGNLABEL("ReasonStatus9"),
 178         IGNLABEL("ReasonStatus10"),
 179         IGNLABEL("ReasonStatus11"),
 180         IGNLABEL("ReasonStatus12"),
 181         IGNLABEL("ReasonStatus13"),
 182         IGNLABEL("ReasonStatus14"),
 183         IGNLABEL("ReasonStatus15"),
 184         IGNLABEL("ReasonStatus16"),
 185         IGNLABEL("ReasonStatus17"),
 186         IGNLABEL("ReasonStatus18"),
 187         IGNLABEL("ReasonStatus19"),
 188         "RxMan",
 189         "TxMan",
 190         "RxRefresh",
 191         "TxRefresh",
 192         "RxPoll",
 193         "TxPoll",
 194         "HostRetries",
 195         "LostSync-HostReq",
 196         "HostTxBytes",
 197         "HostRxBytes",
 198         "ElapsedUsec",
 199         "ElapsedSec",
 200         "LostSyncBetterAP",
 201         "PrivacyMismatch",
 202         "Jammed",
 203         "DiscRxNotWepped",
 204         "PhyEleMismatch",
 205         (char*)-1 };
 206 #ifndef RUN_AT
 207 #define RUN_AT(x) (jiffies+(x))
 208 #endif
 209
 210
 211 /* These variables are for insmod, since it seems that the rates
 212    can only be set in setup_card.  Rates should be a comma separated
 213    (no spaces) list of rates (up to 8). */
 214
 215 static int rates[8];
 216 static int basic_rate;
 217 static char *ssids[3];
 218
 219 static int io[4];
 220 static int irq[4];
 221
 222 static
 223 int maxencrypt /* = 0 */; /* The highest rate that the card can encrypt at.
 224                        0 means no limit.  For old cards this was 4 */
 225
 226 static int auto_wep /* = 0 */; /* If set, it tries to figure out the wep mode */
 227 static int aux_bap /* = 0 */; /* Checks to see if the aux ports are needed to read
 228                     the bap, needed on some older cards and buses. */
 229 static int adhoc;
 230
 231 static int probe = 1;
 232
 233 static int proc_uid /* = 0 */;
 234
 235 static int proc_gid /* = 0 */;
 236
 237 static int airo_perm = 0555;
 238
 239 static int proc_perm = 0644;
 240
 241 MODULE_AUTHOR("Benjamin Reed");
 242 MODULE_DESCRIPTION("Support for Cisco/Aironet 802.11 wireless ethernet \
 243                    cards.  Direct support for ISA/PCI/MPI cards and support \
 244                    for PCMCIA when used with airo_cs.");
 245 MODULE_LICENSE("Dual BSD/GPL");
 246 MODULE_SUPPORTED_DEVICE("Aironet 4500, 4800 and Cisco 340/350");
 247 module_param_array(io, int, NULL, 0);
 248 module_param_array(irq, int, NULL, 0);
 249 module_param(basic_rate, int, 0);
 250 module_param_array(rates, int, NULL, 0);
 251 module_param_array(ssids, charp, NULL, 0);
 252 module_param(auto_wep, int, 0);
 253 MODULE_PARM_DESC(auto_wep, "If non-zero, the driver will keep looping through \
 254 the authentication options until an association is made.  The value of \
 255 auto_wep is number of the wep keys to check.  A value of 2 will try using \
 256 the key at index 0 and index 1.");
 257 module_param(aux_bap, int, 0);
 258 MODULE_PARM_DESC(aux_bap, "If non-zero, the driver will switch into a mode \
 259 than seems to work better for older cards with some older buses.  Before \
 260 switching it checks that the switch is needed.");
 261 module_param(maxencrypt, int, 0);
 262 MODULE_PARM_DESC(maxencrypt, "The maximum speed that the card can do \
 263 encryption.  Units are in 512kbs.  Zero (default) means there is no limit. \
 264 Older cards used to be limited to 2mbs (4).");
 265 module_param(adhoc, int, 0);
 266 MODULE_PARM_DESC(adhoc, "If non-zero, the card will start in adhoc mode.");
 267 module_param(probe, int, 0);
 268 MODULE_PARM_DESC(probe, "If zero, the driver won't start the card.");
 269
 270 module_param(proc_uid, int, 0);
 271 MODULE_PARM_DESC(proc_uid, "The uid that the /proc files will belong to.");
 272 module_param(proc_gid, int, 0);
 273 MODULE_PARM_DESC(proc_gid, "The gid that the /proc files will belong to.");
 274 module_param(airo_perm, int, 0);
 275 MODULE_PARM_DESC(airo_perm, "The permission bits of /proc/[driver/]aironet.");
 276 module_param(proc_perm, int, 0);
 277 MODULE_PARM_DESC(proc_perm, "The permission bits of the files in /proc");
 278
 279 /* This is a kind of sloppy hack to get this information to OUT4500 and
 280    IN4500.  I would be extremely interested in the situation where this
 281    doesn't work though!!! */
 282 static int do8bitIO = 0;
 283
 284 /* Return codes */
 285 #define SUCCESS 0
 286 #define ERROR -1
 287 #define NO_PACKET -2
 288
 289 /* Commands */
 290 #define NOP2            0x0000
 291 #define MAC_ENABLE      0x0001
 292 #define MAC_DISABLE     0x0002
 293 #define CMD_LOSE_SYNC   0x0003 /* Not sure what this does... */
 294 #define CMD_SOFTRESET   0x0004
 295 #define HOSTSLEEP       0x0005
 296 #define CMD_MAGIC_PKT   0x0006
 297 #define CMD_SETWAKEMASK 0x0007
 298 #define CMD_READCFG     0x0008
 299 #define CMD_SETMODE     0x0009
 300 #define CMD_ALLOCATETX  0x000a
 301 #define CMD_TRANSMIT    0x000b
 302 #define CMD_DEALLOCATETX 0x000c
 303 #define NOP             0x0010
 304 #define CMD_WORKAROUND  0x0011
 305 #define CMD_ALLOCATEAUX 0x0020
 306 #define CMD_ACCESS      0x0021
 307 #define CMD_PCIBAP      0x0022
 308 #define CMD_PCIAUX      0x0023
 309 #define CMD_ALLOCBUF    0x0028
 310 #define CMD_GETTLV      0x0029
 311 #define CMD_PUTTLV      0x002a
 312 #define CMD_DELTLV      0x002b
 313 #define CMD_FINDNEXTTLV 0x002c
 314 #define CMD_PSPNODES    0x0030
 315 #define CMD_SETCW       0x0031
 316 #define CMD_SETPCF      0x0032
 317 #define CMD_SETPHYREG   0x003e
 318 #define CMD_TXTEST      0x003f
 319 #define MAC_ENABLETX    0x0101
 320 #define CMD_LISTBSS     0x0103
 321 #define CMD_SAVECFG     0x0108
 322 #define CMD_ENABLEAUX   0x0111
 323 #define CMD_WRITERID    0x0121
 324 #define CMD_USEPSPNODES 0x0130
 325 #define MAC_ENABLERX    0x0201
 326
 327 /* Command errors */
 328 #define ERROR_QUALIF 0x00
 329 #define ERROR_ILLCMD 0x01
 330 #define ERROR_ILLFMT 0x02
 331 #define ERROR_INVFID 0x03
 332 #define ERROR_INVRID 0x04
 333 #define ERROR_LARGE 0x05
 334 #define ERROR_NDISABL 0x06
 335 #define ERROR_ALLOCBSY 0x07
 336 #define ERROR_NORD 0x0B
 337 #define ERROR_NOWR 0x0C
 338 #define ERROR_INVFIDTX 0x0D
 339 #define ERROR_TESTACT 0x0E
 340 #define ERROR_TAGNFND 0x12
 341 #define ERROR_DECODE 0x20
 342 #define ERROR_DESCUNAV 0x21
 343 #define ERROR_BADLEN 0x22
 344 #define ERROR_MODE 0x80
 345 #define ERROR_HOP 0x81
 346 #define ERROR_BINTER 0x82
 347 #define ERROR_RXMODE 0x83
 348 #define ERROR_MACADDR 0x84
 349 #define ERROR_RATES 0x85
 350 #define ERROR_ORDER 0x86
 351 #define ERROR_SCAN 0x87
 352 #define ERROR_AUTH 0x88
 353 #define ERROR_PSMODE 0x89
 354 #define ERROR_RTYPE 0x8A
 355 #define ERROR_DIVER 0x8B
 356 #define ERROR_SSID 0x8C
 357 #define ERROR_APLIST 0x8D
 358 #define ERROR_AUTOWAKE 0x8E
 359 #define ERROR_LEAP 0x8F
 360
 361 /* Registers */
 362 #define COMMAND 0x00
 363 #define PARAM0 0x02
 364 #define PARAM1 0x04
 365 #define PARAM2 0x06
 366 #define STATUS 0x08
 367 #define RESP0 0x0a
 368 #define RESP1 0x0c
 369 #define RESP2 0x0e
 370 #define LINKSTAT 0x10
 371 #define SELECT0 0x18
 372 #define OFFSET0 0x1c
 373 #define RXFID 0x20
 374 #define TXALLOCFID 0x22
 375 #define TXCOMPLFID 0x24
 376 #define DATA0 0x36
 377 #define EVSTAT 0x30
 378 #define EVINTEN 0x32
 379 #define EVACK 0x34
 380 #define SWS0 0x28
 381 #define SWS1 0x2a
 382 #define SWS2 0x2c
 383 #define SWS3 0x2e
 384 #define AUXPAGE 0x3A
 385 #define AUXOFF 0x3C
 386 #define AUXDATA 0x3E
 387
 388 #define FID_TX 1
 389 #define FID_RX 2
 390 /* Offset into aux memory for descriptors */
 391 #define AUX_OFFSET 0x800
 392 /* Size of allocated packets */
 393 #define PKTSIZE 1840
 394 #define RIDSIZE 2048
 395 /* Size of the transmit queue */
 396 #define MAXTXQ 64
 397
 398 /* BAP selectors */
 399 #define BAP0 0 // Used for receiving packets
 400 #define BAP1 2 // Used for xmiting packets and working with RIDS
 401
 402 /* Flags */
 403 #define COMMAND_BUSY 0x8000
 404
 405 #define BAP_BUSY 0x8000
 406 #define BAP_ERR 0x4000
 407 #define BAP_DONE 0x2000
 408
 409 #define PROMISC 0xffff
 410 #define NOPROMISC 0x0000
 411
 412 #define EV_CMD 0x10
 413 #define EV_CLEARCOMMANDBUSY 0x4000
 414 #define EV_RX 0x01
 415 #define EV_TX 0x02
 416 #define EV_TXEXC 0x04
 417 #define EV_ALLOC 0x08
 418 #define EV_LINK 0x80
 419 #define EV_AWAKE 0x100
 420 #define EV_TXCPY 0x400
 421 #define EV_UNKNOWN 0x800
 422 #define EV_MIC 0x1000 /* Message Integrity Check Interrupt */
 423 #define EV_AWAKEN 0x2000
 424 #define STATUS_INTS (EV_AWAKE|EV_LINK|EV_TXEXC|EV_TX|EV_TXCPY|EV_RX|EV_MIC)
 425
 426 #ifdef CHECK_UNKNOWN_INTS
 427 #define IGNORE_INTS ( EV_CMD | EV_UNKNOWN)
 428 #else
 429 #define IGNORE_INTS (~STATUS_INTS)
 430 #endif
 431
 432 /* RID TYPES */
 433 #define RID_RW 0x20
 434
 435 /* The RIDs */
 436 #define RID_CAPABILITIES 0xFF00
 437 #define RID_APINFO     0xFF01
 438 #define RID_RADIOINFO  0xFF02
 439 #define RID_UNKNOWN3   0xFF03
 440 #define RID_RSSI       0xFF04
 441 #define RID_CONFIG     0xFF10
 442 #define RID_SSID       0xFF11
 443 #define RID_APLIST     0xFF12
 444 #define RID_DRVNAME    0xFF13
 445 #define RID_ETHERENCAP 0xFF14
 446 #define RID_WEP_TEMP   0xFF15
 447 #define RID_WEP_PERM   0xFF16
 448 #define RID_MODULATION 0xFF17
 449 #define RID_OPTIONS    0xFF18
 450 #define RID_ACTUALCONFIG 0xFF20 /*readonly*/
 451 #define RID_FACTORYCONFIG 0xFF21
 452 #define RID_UNKNOWN22  0xFF22
 453 #define RID_LEAPUSERNAME 0xFF23
 454 #define RID_LEAPPASSWORD 0xFF24
 455 #define RID_STATUS     0xFF50
 456 #define RID_BEACON_HST 0xFF51
 457 #define RID_BUSY_HST   0xFF52
 458 #define RID_RETRIES_HST 0xFF53
 459 #define RID_UNKNOWN54  0xFF54
 460 #define RID_UNKNOWN55  0xFF55
 461 #define RID_UNKNOWN56  0xFF56
 462 #define RID_MIC        0xFF57
 463 #define RID_STATS16    0xFF60
 464 #define RID_STATS16DELTA 0xFF61
 465 #define RID_STATS16DELTACLEAR 0xFF62
 466 #define RID_STATS      0xFF68
 467 #define RID_STATSDELTA 0xFF69
 468 #define RID_STATSDELTACLEAR 0xFF6A
 469 #define RID_ECHOTEST_RID 0xFF70
 470 #define RID_ECHOTEST_RESULTS 0xFF71
 471 #define RID_BSSLISTFIRST 0xFF72
 472 #define RID_BSSLISTNEXT  0xFF73
 473 #define RID_WPA_BSSLISTFIRST 0xFF74
 474 #define RID_WPA_BSSLISTNEXT  0xFF75
 475
 476 typedef struct {
 477         u16 cmd;
 478         u16 parm0;
 479         u16 parm1;
 480         u16 parm2;
 481 } Cmd;
 482
 483 typedef struct {
 484         u16 status;
 485         u16 rsp0;
 486         u16 rsp1;
 487         u16 rsp2;
 488 } Resp;
 489
 490 /*
 491  * Rids and endian-ness:  The Rids will always be in cpu endian, since
 492  * this all the patches from the big-endian guys end up doing that.
 493  * so all rid access should use the read/writeXXXRid routines.
 494  */
 495
 496 /* This is redundant for x86 archs, but it seems necessary for ARM */
 497 #pragma pack(1)
 498
 499 /* This structure came from an email sent to me from an engineer at
 500    aironet for inclusion into this driver */
 501 typedef struct {
 502         u16 len;
 503         u16 kindex;
 504         u8 mac[ETH_ALEN];
 505         u16 klen;
 506         u8 key[16];
 507 } WepKeyRid;
 508
 509 /* These structures are from the Aironet's PC4500 Developers Manual */
 510 typedef struct {
 511         u16 len;
 512         u8 ssid[32];
 513 } Ssid;
 514
 515 typedef struct {
 516         u16 len;
 517         Ssid ssids[3];
 518 } SsidRid;
 519
 520 typedef struct {
 521         u16 len;
 522         u16 modulation;
 523 #define MOD_DEFAULT 0
 524 #define MOD_CCK 1
 525 #define MOD_MOK 2
 526 } ModulationRid;
 527
 528 typedef struct {
 529         u16 len; /* sizeof(ConfigRid) */
 530         u16 opmode; /* operating mode */
 531 #define MODE_STA_IBSS 0
 532 #define MODE_STA_ESS 1
 533 #define MODE_AP 2
 534 #define MODE_AP_RPTR 3
 535 #define MODE_ETHERNET_HOST (0<<8) /* rx payloads converted */
 536 #define MODE_LLC_HOST (1<<8) /* rx payloads left as is */
 537 #define MODE_AIRONET_EXTEND (1<<9) /* enable Aironet extenstions */
 538 #define MODE_AP_INTERFACE (1<<10) /* enable ap interface extensions */
 539 #define MODE_ANTENNA_ALIGN (1<<11) /* enable antenna alignment */
 540 #define MODE_ETHER_LLC (1<<12) /* enable ethernet LLC */
 541 #define MODE_LEAF_NODE (1<<13) /* enable leaf node bridge */
 542 #define MODE_CF_POLLABLE (1<<14) /* enable CF pollable */
 543 #define MODE_MIC (1<<15) /* enable MIC */
 544         u16 rmode; /* receive mode */
 545 #define RXMODE_BC_MC_ADDR 0
 546 #define RXMODE_BC_ADDR 1 /* ignore multicasts */
 547 #define RXMODE_ADDR 2 /* ignore multicast and broadcast */
 548 #define RXMODE_RFMON 3 /* wireless monitor mode */
 549 #define RXMODE_RFMON_ANYBSS 4
 550 #define RXMODE_LANMON 5 /* lan style monitor -- data packets only */
 551 #define RXMODE_DISABLE_802_3_HEADER (1<<8) /* disables 802.3 header on rx */
 552 #define RXMODE_NORMALIZED_RSSI (1<<9) /* return normalized RSSI */
 553         u16 fragThresh;
 554         u16 rtsThres;
 555         u8 macAddr[ETH_ALEN];
 556         u8 rates[8];
 557         u16 shortRetryLimit;
 558         u16 longRetryLimit;
 559         u16 txLifetime; /* in kusec */
 560         u16 rxLifetime; /* in kusec */
 561         u16 stationary;
 562         u16 ordering;
 563         u16 u16deviceType; /* for overriding device type */
 564         u16 cfpRate;
 565         u16 cfpDuration;
 566         u16 _reserved1[3];
 567         /*---------- Scanning/Associating ----------*/
 568         u16 scanMode;
 569 #define SCANMODE_ACTIVE 0
 570 #define SCANMODE_PASSIVE 1
 571 #define SCANMODE_AIROSCAN 2
 572         u16 probeDelay; /* in kusec */
 573         u16 probeEnergyTimeout; /* in kusec */
 574         u16 probeResponseTimeout;
 575         u16 beaconListenTimeout;
 576         u16 joinNetTimeout;
 577         u16 authTimeout;
 578         u16 authType;
 579 #define AUTH_OPEN 0x1
 580 #define AUTH_ENCRYPT 0x101
 581 #define AUTH_SHAREDKEY 0x102
 582 #define AUTH_ALLOW_UNENCRYPTED 0x200
 583         u16 associationTimeout;
 584         u16 specifiedApTimeout;
 585         u16 offlineScanInterval;
 586         u16 offlineScanDuration;
 587         u16 linkLossDelay;
 588         u16 maxBeaconLostTime;
 589         u16 refreshInterval;
 590 #define DISABLE_REFRESH 0xFFFF
 591         u16 _reserved1a[1];
 592         /*---------- Power save operation ----------*/
 593         u16 powerSaveMode;
 594 #define POWERSAVE_CAM 0
 595 #define POWERSAVE_PSP 1
 596 #define POWERSAVE_PSPCAM 2
 597         u16 sleepForDtims;
 598         u16 listenInterval;
 599         u16 fastListenInterval;
 600         u16 listenDecay;
 601         u16 fastListenDelay;
 602         u16 _reserved2[2];
 603         /*---------- Ap/Ibss config items ----------*/
 604         u16 beaconPeriod;
 605         u16 atimDuration;
 606         u16 hopPeriod;
 607         u16 channelSet;
 608         u16 channel;
 609         u16 dtimPeriod;
 610         u16 bridgeDistance;
 611         u16 radioID;
 612         /*---------- Radio configuration ----------*/
 613         u16 radioType;
 614 #define RADIOTYPE_DEFAULT 0
 615 #define RADIOTYPE_802_11 1
 616 #define RADIOTYPE_LEGACY 2
 617         u8 rxDiversity;
 618         u8 txDiversity;
 619         u16 txPower;
 620 #define TXPOWER_DEFAULT 0
 621         u16 rssiThreshold;
 622 #define RSSI_DEFAULT 0
 623         u16 modulation;
 624 #define PREAMBLE_AUTO 0
 625 #define PREAMBLE_LONG 1
 626 #define PREAMBLE_SHORT 2
 627         u16 preamble;
 628         u16 homeProduct;
 629         u16 radioSpecific;
 630         /*---------- Aironet Extensions ----------*/
 631         u8 nodeName[16];
 632         u16 arlThreshold;
 633         u16 arlDecay;
 634         u16 arlDelay;
 635         u16 _reserved4[1];
 636         /*---------- Aironet Extensions ----------*/
 637         u8 magicAction;
 638 #define MAGIC_ACTION_STSCHG 1
 639 #define MAGIC_ACTION_RESUME 2
 640 #define MAGIC_IGNORE_MCAST (1<<8)
 641 #define MAGIC_IGNORE_BCAST (1<<9)
 642 #define MAGIC_SWITCH_TO_PSP (0<<10)
 643 #define MAGIC_STAY_IN_CAM (1<<10)
 644         u8 magicControl;
 645         u16 autoWake;
 646 } ConfigRid;
 647
 648 typedef struct {
 649         u16 len;
 650         u8 mac[ETH_ALEN];
 651         u16 mode;
 652         u16 errorCode;
 653         u16 sigQuality;
 654         u16 SSIDlen;
 655         char SSID[32];
 656         char apName[16];
 657         u8 bssid[4][ETH_ALEN];
 658         u16 beaconPeriod;
 659         u16 dimPeriod;
 660         u16 atimDuration;
 661         u16 hopPeriod;
 662         u16 channelSet;
 663         u16 channel;
 664         u16 hopsToBackbone;
 665         u16 apTotalLoad;
 666         u16 generatedLoad;
 667         u16 accumulatedArl;
 668         u16 signalQuality;
 669         u16 currentXmitRate;
 670         u16 apDevExtensions;
 671         u16 normalizedSignalStrength;
 672         u16 shortPreamble;
 673         u8 apIP[4];
 674         u8 noisePercent; /* Noise percent in last second */
 675         u8 noisedBm; /* Noise dBm in last second */
 676         u8 noiseAvePercent; /* Noise percent in last minute */
 677         u8 noiseAvedBm; /* Noise dBm in last minute */
 678         u8 noiseMaxPercent; /* Highest noise percent in last minute */
 679         u8 noiseMaxdBm; /* Highest noise dbm in last minute */
 680         u16 load;
 681         u8 carrier[4];
 682         u16 assocStatus;
 683 #define STAT_NOPACKETS 0
 684 #define STAT_NOCARRIERSET 10
 685 #define STAT_GOTCARRIERSET 11
 686 #define STAT_WRONGSSID 20
 687 #define STAT_BADCHANNEL 25
 688 #define STAT_BADBITRATES 30
 689 #define STAT_BADPRIVACY 35
 690 #define STAT_APFOUND 40
 691 #define STAT_APREJECTED 50
 692 #define STAT_AUTHENTICATING 60
 693 #define STAT_DEAUTHENTICATED 61
 694 #define STAT_AUTHTIMEOUT 62
 695 #define STAT_ASSOCIATING 70
 696 #define STAT_DEASSOCIATED 71
 697 #define STAT_ASSOCTIMEOUT 72
 698 #define STAT_NOTAIROAP 73
 699 #define STAT_ASSOCIATED 80
 700 #define STAT_LEAPING 90
 701 #define STAT_LEAPFAILED 91
 702 #define STAT_LEAPTIMEDOUT 92
 703 #define STAT_LEAPCOMPLETE 93
 704 } StatusRid;
 705
 706 typedef struct {
 707         u16 len;
 708         u16 spacer;
 709         u32 vals[100];
 710 } StatsRid;
 711
 712
 713 typedef struct {
 714         u16 len;
 715         u8 ap[4][ETH_ALEN];
 716 } APListRid;
 717
 718 typedef struct {
 719         u16 len;
 720         char oui[3];
 721         char zero;
 722         u16 prodNum;
 723         char manName[32];
 724         char prodName[16];
 725         char prodVer[8];
 726         char factoryAddr[ETH_ALEN];
 727         char aironetAddr[ETH_ALEN];
 728         u16 radioType;
 729         u16 country;
 730         char callid[ETH_ALEN];
 731         char supportedRates[8];
 732         char rxDiversity;
 733         char txDiversity;
 734         u16 txPowerLevels[8];
 735         u16 hardVer;
 736         u16 hardCap;
 737         u16 tempRange;
 738         u16 softVer;
 739         u16 softSubVer;
 740         u16 interfaceVer;
 741         u16 softCap;
 742         u16 bootBlockVer;
 743         u16 requiredHard;
 744         u16 extSoftCap;
 745 } CapabilityRid;
 746
 747
 748 /* Only present on firmware >= 5.30.17 */
 749 typedef struct {
 750   u16 unknown[4];
 751   u8 fixed[12]; /* WLAN management frame */
 752   u8 iep[624];
 753 } BSSListRidExtra;
 754
 755 typedef struct {
 756   u16 len;
 757   u16 index; /* First is 0 and 0xffff means end of list */
 758 #define RADIO_FH 1 /* Frequency hopping radio type */
 759 #define RADIO_DS 2 /* Direct sequence radio type */
 760 #define RADIO_TMA 4 /* Proprietary radio used in old cards (2500) */
 761   u16 radioType;
 762   u8 bssid[ETH_ALEN]; /* Mac address of the BSS */
 763   u8 zero;
 764   u8 ssidLen;
 765   u8 ssid[32];
 766   u16 dBm;
 767 #define CAP_ESS (1<<0)
 768 #define CAP_IBSS (1<<1)
 769 #define CAP_PRIVACY (1<<4)
 770 #define CAP_SHORTHDR (1<<5)
 771   u16 cap;
 772   u16 beaconInterval;
 773   u8 rates[8]; /* Same as rates for config rid */
 774   struct { /* For frequency hopping only */
 775     u16 dwell;
 776     u8 hopSet;
 777     u8 hopPattern;
 778     u8 hopIndex;
 779     u8 fill;
 780   } fh;
 781   u16 dsChannel;
 782   u16 atimWindow;
 783
 784   /* Only present on firmware >= 5.30.17 */
 785   BSSListRidExtra extra;
 786 } BSSListRid;
 787
 788 typedef struct {
 789   BSSListRid bss;
 790   struct list_head list;
 791 } BSSListElement;
 792
 793 typedef struct {
 794   u8 rssipct;
 795   u8 rssidBm;
 796 } tdsRssiEntry;
 797
 798 typedef struct {
 799   u16 len;
 800   tdsRssiEntry x[256];
 801 } tdsRssiRid;
 802
 803 typedef struct {
 804         u16 len;
 805         u16 state;
 806         u16 multicastValid;
 807         u8  multicast[16];
 808         u16 unicastValid;
 809         u8  unicast[16];
 810 } MICRid;
 811
 812 typedef struct {
 813         u16 typelen;
 814
 815         union {
 816             u8 snap[8];
 817             struct {
 818                 u8 dsap;
 819                 u8 ssap;
 820                 u8 control;
 821                 u8 orgcode[3];
 822                 u8 fieldtype[2];
 823             } llc;
 824         } u;
 825         u32 mic;
 826         u32 seq;
 827 } MICBuffer;
 828
 829 typedef struct {
 830         u8 da[ETH_ALEN];
 831         u8 sa[ETH_ALEN];
 832 } etherHead;
 833
 834 #pragma pack()
 835
 836 #define TXCTL_TXOK (1<<1) /* report if tx is ok */
 837 #define TXCTL_TXEX (1<<2) /* report if tx fails */
 838 #define TXCTL_802_3 (0<<3) /* 802.3 packet */
 839 #define TXCTL_802_11 (1<<3) /* 802.11 mac packet */
 840 #define TXCTL_ETHERNET (0<<4) /* payload has ethertype */
 841 #define TXCTL_LLC (1<<4) /* payload is llc */
 842 #define TXCTL_RELEASE (0<<5) /* release after completion */
 843 #define TXCTL_NORELEASE (1<<5) /* on completion returns to host */
 844
 845 #define BUSY_FID 0x10000
 846
 847 #ifdef CISCO_EXT
 848 #define AIROMAGIC       0xa55a
 849 /* Warning : SIOCDEVPRIVATE may disapear during 2.5.X - Jean II */
 850 #ifdef SIOCIWFIRSTPRIV
 851 #ifdef SIOCDEVPRIVATE
 852 #define AIROOLDIOCTL    SIOCDEVPRIVATE
 853 #define AIROOLDIDIFC    AIROOLDIOCTL + 1
 854 #endif /* SIOCDEVPRIVATE */
 855 #else /* SIOCIWFIRSTPRIV */
 856 #define SIOCIWFIRSTPRIV SIOCDEVPRIVATE
 857 #endif /* SIOCIWFIRSTPRIV */
 858 /* This may be wrong. When using the new SIOCIWFIRSTPRIV range, we probably
 859  * should use only "GET" ioctls (last bit set to 1). "SET" ioctls are root
 860  * only and don't return the modified struct ifreq to the application which
 861  * is usually a problem. - Jean II */
 862 #define AIROIOCTL       SIOCIWFIRSTPRIV
 863 #define AIROIDIFC       AIROIOCTL + 1
 864
 865 /* Ioctl constants to be used in airo_ioctl.command */
 866
 867 #define AIROGCAP                0       // Capability rid
 868 #define AIROGCFG                1       // USED A LOT
 869 #define AIROGSLIST              2       // System ID list
 870 #define AIROGVLIST              3       // List of specified AP's
 871 #define AIROGDRVNAM             4       //  NOTUSED
 872 #define AIROGEHTENC             5       // NOTUSED
 873 #define AIROGWEPKTMP            6
 874 #define AIROGWEPKNV             7
 875 #define AIROGSTAT               8
 876 #define AIROGSTATSC32           9
 877 #define AIROGSTATSD32           10
 878 #define AIROGMICRID             11
 879 #define AIROGMICSTATS           12
 880 #define AIROGFLAGS              13
 881 #define AIROGID                 14
 882 #define AIRORRID                15
 883 #define AIRORSWVERSION          17
 884
 885 /* Leave gap of 40 commands after AIROGSTATSD32 for future */
 886
 887 #define AIROPCAP                AIROGSTATSD32 + 40
 888 #define AIROPVLIST              AIROPCAP      + 1
 889 #define AIROPSLIST              AIROPVLIST    + 1
 890 #define AIROPCFG                AIROPSLIST    + 1
 891 #define AIROPSIDS               AIROPCFG      + 1
 892 #define AIROPAPLIST             AIROPSIDS     + 1
 893 #define AIROPMACON              AIROPAPLIST   + 1       /* Enable mac  */
 894 #define AIROPMACOFF             AIROPMACON    + 1       /* Disable mac */
 895 #define AIROPSTCLR              AIROPMACOFF   + 1
 896 #define AIROPWEPKEY             AIROPSTCLR    + 1
 897 #define AIROPWEPKEYNV           AIROPWEPKEY   + 1
 898 #define AIROPLEAPPWD            AIROPWEPKEYNV + 1
 899 #define AIROPLEAPUSR            AIROPLEAPPWD  + 1
 900
 901 /* Flash codes */
 902
 903 #define AIROFLSHRST            AIROPWEPKEYNV  + 40
 904 #define AIROFLSHGCHR           AIROFLSHRST    + 1
 905 #define AIROFLSHSTFL           AIROFLSHGCHR   + 1
 906 #define AIROFLSHPCHR           AIROFLSHSTFL   + 1
 907 #define AIROFLPUTBUF           AIROFLSHPCHR   + 1
 908 #define AIRORESTART            AIROFLPUTBUF   + 1
 909
 910 #define FLASHSIZE       32768
 911 #define AUXMEMSIZE      (256 * 1024)
 912
 913 typedef struct aironet_ioctl {
 914         unsigned short command;         // What to do
 915         unsigned short len;             // Len of data
 916         unsigned short ridnum;          // rid number
 917         unsigned char __user *data;     // d-data
 918 } aironet_ioctl;
 919
 920 static char swversion[] = "2.1";
 921 #endif /* CISCO_EXT */
 922
 923 #define NUM_MODULES       2
 924 #define MIC_MSGLEN_MAX    2400
 925 #define EMMH32_MSGLEN_MAX MIC_MSGLEN_MAX
 926 #define AIRO_DEF_MTU      2312
 927
 928 typedef struct {
 929         u32   size;            // size
 930         u8    enabled;         // MIC enabled or not
 931         u32   rxSuccess;       // successful packets received
 932         u32   rxIncorrectMIC;  // pkts dropped due to incorrect MIC comparison
 933         u32   rxNotMICed;      // pkts dropped due to not being MIC'd
 934         u32   rxMICPlummed;    // pkts dropped due to not having a MIC plummed
 935         u32   rxWrongSequence; // pkts dropped due to sequence number violation
 936         u32   reserve[32];
 937 } mic_statistics;
 938
 939 typedef struct {
 940         u32 coeff[((EMMH32_MSGLEN_MAX)+3)>>2];
 941         u64 accum;      // accumulated mic, reduced to u32 in final()
 942         int position;   // current position (byte offset) in message
 943         union {
 944                 u8  d8[4];
 945                 u32 d32;
 946         } part; // saves partial message word across update() calls
 947 } emmh32_context;
 948
 949 typedef struct {
 950         emmh32_context seed;        // Context - the seed
 951         u32              rx;        // Received sequence number
 952         u32              tx;        // Tx sequence number
 953         u32              window;    // Start of window
 954         u8               valid;     // Flag to say if context is valid or not
 955         u8               key[16];
 956 } miccntx;
 957
 958 typedef struct {
 959         miccntx mCtx;           // Multicast context
 960         miccntx uCtx;           // Unicast context
 961 } mic_module;
 962
 963 typedef struct {
 964         unsigned int  rid: 16;
 965         unsigned int  len: 15;
 966         unsigned int  valid: 1;
 967         dma_addr_t host_addr;
 968 } Rid;
 969
 970 typedef struct {
 971         unsigned int  offset: 15;
 972         unsigned int  eoc: 1;
 973         unsigned int  len: 15;
 974         unsigned int  valid: 1;
 975         dma_addr_t host_addr;
 976 } TxFid;
 977
 978 typedef struct {
 979         unsigned int  ctl: 15;
 980         unsigned int  rdy: 1;
 981         unsigned int  len: 15;
 982         unsigned int  valid: 1;
 983         dma_addr_t host_addr;
 984 } RxFid;
 985
 986 /*
 987  * Host receive descriptor
 988  */
 989 typedef struct {
 990         unsigned char __iomem *card_ram_off; /* offset into card memory of the
 991                                                 desc */
 992         RxFid         rx_desc;               /* card receive descriptor */
 993         char          *virtual_host_addr;    /* virtual address of host receive
 994                                                 buffer */
 995         int           pending;
 996 } HostRxDesc;
 997
 998 /*
 999  * Host transmit descriptor
1000  */
1001 typedef struct {
1002         unsigned char __iomem *card_ram_off;         /* offset into card memory of the
1003                                                 desc */
1004         TxFid         tx_desc;               /* card transmit descriptor */
1005         char          *virtual_host_addr;    /* virtual address of host receive
1006                                                 buffer */
1007         int           pending;
1008 } HostTxDesc;
1009
1010 /*
1011  * Host RID descriptor
1012  */
1013 typedef struct {
1014         unsigned char __iomem *card_ram_off;      /* offset into card memory of the
1015                                              descriptor */
1016         Rid           rid_desc;           /* card RID descriptor */
1017         char          *virtual_host_addr; /* virtual address of host receive
1018                                              buffer */
1019 } HostRidDesc;
1020
1021 typedef struct {
1022         u16 sw0;
1023         u16 sw1;
1024         u16 status;
1025         u16 len;
1026 #define HOST_SET (1 << 0)
1027 #define HOST_INT_TX (1 << 1) /* Interrupt on successful TX */
1028 #define HOST_INT_TXERR (1 << 2) /* Interrupt on unseccessful TX */
1029 #define HOST_LCC_PAYLOAD (1 << 4) /* LLC payload, 0 = Ethertype */
1030 #define HOST_DONT_RLSE (1 << 5) /* Don't release buffer when done */
1031 #define HOST_DONT_RETRY (1 << 6) /* Don't retry trasmit */
1032 #define HOST_CLR_AID (1 << 7) /* clear AID failure */
1033 #define HOST_RTS (1 << 9) /* Force RTS use */
1034 #define HOST_SHORT (1 << 10) /* Do short preamble */
1035         u16 ctl;
1036         u16 aid;
1037         u16 retries;
1038         u16 fill;
1039 } TxCtlHdr;
1040
1041 typedef struct {
1042         u16 ctl;
1043         u16 duration;
1044         char addr1[6];
1045         char addr2[6];
1046         char addr3[6];
1047         u16 seq;
1048         char addr4[6];
1049 } WifiHdr;
1050
1051
1052 typedef struct {
1053         TxCtlHdr ctlhdr;
1054         u16 fill1;
1055         u16 fill2;
1056         WifiHdr wifihdr;
1057         u16 gaplen;
1058         u16 status;
1059 } WifiCtlHdr;
1060
1061 static WifiCtlHdr wifictlhdr8023 = {
1062         .ctlhdr = {
1063                 .ctl    = HOST_DONT_RLSE,
1064         }
1065 };
1066
1067 // Frequency list (map channels to frequencies)
1068 static const long frequency_list[] = { 2412, 2417, 2422, 2427, 2432, 2437, 2442,
1069                                 2447, 2452, 2457, 2462, 2467, 2472, 2484 };
1070
1071 // A few details needed for WEP (Wireless Equivalent Privacy)
1072 #define MAX_KEY_SIZE 13                 // 128 (?) bits
1073 #define MIN_KEY_SIZE  5                 // 40 bits RC4 - WEP
1074 typedef struct wep_key_t {
1075         u16     len;
1076         u8      key[16];        /* 40-bit and 104-bit keys */
1077 } wep_key_t;
1078
1079 /* Backward compatibility */
1080 #ifndef IW_ENCODE_NOKEY
1081 #define IW_ENCODE_NOKEY         0x0800  /* Key is write only, so not present */
1082 #define IW_ENCODE_MODE  (IW_ENCODE_DISABLED | IW_ENCODE_RESTRICTED | IW_ENCODE_OPEN)
1083 #endif /* IW_ENCODE_NOKEY */
1084
1085 /* List of Wireless Handlers (new API) */
1086 static const struct iw_handler_def      airo_handler_def;
1087
1088 static const char version[] = "airo.c 0.6 (Ben Reed & Javier Achirica)";
1089
1090 struct airo_info;
1091
1092 static int get_dec_u16( char *buffer, int *start, int limit );
1093 static void OUT4500( struct airo_info *, u16 register, u16 value );
1094 static unsigned short IN4500( struct airo_info *, u16 register );
1095 static u16 setup_card(struct airo_info*, u8 *mac, int lock);
1096 static int enable_MAC( struct airo_info *ai, Resp *rsp, int lock );
1097 static void disable_MAC(struct airo_info *ai, int lock);
1098 static void enable_interrupts(struct airo_info*);
1099 static void disable_interrupts(struct airo_info*);
1100 static u16 issuecommand(struct airo_info*, Cmd *pCmd, Resp *pRsp);
1101 static int bap_setup(struct airo_info*, u16 rid, u16 offset, int whichbap);
1102 static int aux_bap_read(struct airo_info*, u16 *pu16Dst, int bytelen,
1103                         int whichbap);
1104 static int fast_bap_read(struct airo_info*, u16 *pu16Dst, int bytelen,
1105                          int whichbap);
1106 static int bap_write(struct airo_info*, const u16 *pu16Src, int bytelen,
1107                      int whichbap);
1108 static int PC4500_accessrid(struct airo_info*, u16 rid, u16 accmd);
1109 static int PC4500_readrid(struct airo_info*, u16 rid, void *pBuf, int len, int lock);
1110 static int PC4500_writerid(struct airo_info*, u16 rid, const void
1111                            *pBuf, int len, int lock);
1112 static int do_writerid( struct airo_info*, u16 rid, const void *rid_data,
1113                         int len, int dummy );
1114 static u16 transmit_allocate(struct airo_info*, int lenPayload, int raw);
1115 static int transmit_802_3_packet(struct airo_info*, int len, char *pPacket);
1116 static int transmit_802_11_packet(struct airo_info*, int len, char *pPacket);
1117
1118 static int mpi_send_packet (struct net_device *dev);
1119 static void mpi_unmap_card(struct pci_dev *pci);
1120 static void mpi_receive_802_3(struct airo_info *ai);
1121 static void mpi_receive_802_11(struct airo_info *ai);
1122 static int waitbusy (struct airo_info *ai);
1123
1124 static irqreturn_t airo_interrupt( int irq, void* dev_id);
1125 static int airo_thread(void *data);
1126 static void timer_func( struct net_device *dev );
1127 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
1128 static struct iw_statistics *airo_get_wireless_stats (struct net_device *dev);
1129 static void airo_read_wireless_stats (struct airo_info *local);
1130 #ifdef CISCO_EXT
1131 static int readrids(struct net_device *dev, aironet_ioctl *comp);
1132 static int writerids(struct net_device *dev, aironet_ioctl *comp);
1133 static int flashcard(struct net_device *dev, aironet_ioctl *comp);
1134 #endif /* CISCO_EXT */
1135 static void micinit(struct airo_info *ai);
1136 static int micsetup(struct airo_info *ai);
1137 static int encapsulate(struct airo_info *ai, etherHead *pPacket, MICBuffer *buffer, int len);
1138 static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *pPacket, u16 payLen);
1139
1140 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi);
1141 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm);
1142
1143 static void airo_networks_free(struct airo_info *ai);
1144
1145 struct airo_info {
1146         struct net_device_stats stats;
1147         struct net_device             *dev;
1148         /* Note, we can have MAX_FIDS outstanding.  FIDs are 16-bits, so we
1149            use the high bit to mark whether it is in use. */
1150 #define MAX_FIDS 6
1151 #define MPI_MAX_FIDS 1
1152         int                           fids[MAX_FIDS];
1153         ConfigRid config;
1154         char keyindex; // Used with auto wep
1155         char defindex; // Used with auto wep
1156         struct proc_dir_entry *proc_entry;
1157         spinlock_t aux_lock;
1158 #define FLAG_RADIO_OFF  0       /* User disabling of MAC */
1159 #define FLAG_RADIO_DOWN 1       /* ifup/ifdown disabling of MAC */
1160 #define FLAG_RADIO_MASK 0x03
1161 #define FLAG_ENABLED    2
1162 #define FLAG_ADHOC      3       /* Needed by MIC */
1163 #define FLAG_MIC_CAPABLE 4
1164 #define FLAG_UPDATE_MULTI 5
1165 #define FLAG_UPDATE_UNI 6
1166 #define FLAG_802_11     7
1167 #define FLAG_PROMISC    8       /* IFF_PROMISC 0x100 - include/linux/if.h */
1168 #define FLAG_PENDING_XMIT 9
1169 #define FLAG_PENDING_XMIT11 10
1170 #define FLAG_MPI        11
1171 #define FLAG_REGISTERED 12
1172 #define FLAG_COMMIT     13
1173 #define FLAG_RESET      14
1174 #define FLAG_FLASHING   15
1175 #define FLAG_WPA_CAPABLE        16
1176         unsigned long flags;
1177 #define JOB_DIE 0
1178 #define JOB_XMIT        1
1179 #define JOB_XMIT11      2
1180 #define JOB_STATS       3
1181 #define JOB_PROMISC     4
1182 #define JOB_MIC 5
1183 #define JOB_EVENT       6
1184 #define JOB_AUTOWEP     7
1185 #define JOB_WSTATS      8
1186 #define JOB_SCAN_RESULTS  9
1187         unsigned long jobs;
1188         int (*bap_read)(struct airo_info*, u16 *pu16Dst, int bytelen,
1189                         int whichbap);
1190         unsigned short *flash;
1191         tdsRssiEntry *rssi;
1192         struct task_struct *list_bss_task;
1193         struct task_struct *airo_thread_task;
1194         struct semaphore sem;
1195         wait_queue_head_t thr_wait;
1196         unsigned long expires;
1197         struct {
1198                 struct sk_buff *skb;
1199                 int fid;
1200         } xmit, xmit11;
1201         struct net_device *wifidev;
1202         struct iw_statistics    wstats;         // wireless stats
1203         unsigned long           scan_timeout;   /* Time scan should be read */
1204         struct iw_spy_data      spy_data;
1205         struct iw_public_data   wireless_data;
1206         /* MIC stuff */
1207         struct crypto_cipher    *tfm;
1208         mic_module              mod[2];
1209         mic_statistics          micstats;
1210         HostRxDesc rxfids[MPI_MAX_FIDS]; // rx/tx/config MPI350 descriptors
1211         HostTxDesc txfids[MPI_MAX_FIDS];
1212         HostRidDesc config_desc;
1213         unsigned long ridbus; // phys addr of config_desc
1214         struct sk_buff_head txq;// tx queue used by mpi350 code
1215         struct pci_dev          *pci;
1216         unsigned char           __iomem *pcimem;
1217         unsigned char           __iomem *pciaux;
1218         unsigned char           *shared;
1219         dma_addr_t              shared_dma;
1220         pm_message_t            power;
1221         SsidRid                 *SSID;
1222         APListRid               *APList;
1223 #define PCI_SHARED_LEN          2*MPI_MAX_FIDS*PKTSIZE+RIDSIZE
1224         char                    proc_name[IFNAMSIZ];
1225
1226         /* WPA-related stuff */
1227         unsigned int bssListFirst;
1228         unsigned int bssListNext;
1229         unsigned int bssListRidLen;
1230
1231         struct list_head network_list;
1232         struct list_head network_free_list;
1233         BSSListElement *networks;
1234 };
1235
1236 static inline int bap_read(struct airo_info *ai, u16 *pu16Dst, int bytelen,
1237                            int whichbap) {
1238         return ai->bap_read(ai, pu16Dst, bytelen, whichbap);
1239 }
1240
1241 static int setup_proc_entry( struct net_device *dev,
1242                              struct airo_info *apriv );
1243 static int takedown_proc_entry( struct net_device *dev,
1244                                 struct airo_info *apriv );
1245
1246 static int cmdreset(struct airo_info *ai);
1247 static int setflashmode (struct airo_info *ai);
1248 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime);
1249 static int flashputbuf(struct airo_info *ai);
1250 static int flashrestart(struct airo_info *ai,struct net_device *dev);
1251
1252 #define airo_print(type, name, fmt, args...) \
1253         { printk(type "airo(%s): " fmt "\n", name, ##args); }
1254
1255 #define airo_print_info(name, fmt, args...) \
1256         airo_print(KERN_INFO, name, fmt, ##args)
1257
1258 #define airo_print_dbg(name, fmt, args...) \
1259         airo_print(KERN_DEBUG, name, fmt, ##args)
1260
1261 #define airo_print_warn(name, fmt, args...) \
1262         airo_print(KERN_WARNING, name, fmt, ##args)
1263
1264 #define airo_print_err(name, fmt, args...) \
1265         airo_print(KERN_ERR, name, fmt, ##args)
1266
1267
1268 /***********************************************************************
1269  *                              MIC ROUTINES                           *
1270  ***********************************************************************
1271  */
1272
1273 static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq);
1274 static void MoveWindow(miccntx *context, u32 micSeq);
1275 static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1276                            struct crypto_cipher *tfm);
1277 static void emmh32_init(emmh32_context *context);
1278 static void emmh32_update(emmh32_context *context, u8 *pOctets, int len);
1279 static void emmh32_final(emmh32_context *context, u8 digest[4]);
1280 static int flashpchar(struct airo_info *ai,int byte,int dwelltime);
1281
1282 /* micinit - Initialize mic seed */
1283
1284 static void micinit(struct airo_info *ai)
1285 {
1286         MICRid mic_rid;
1287
1288         clear_bit(JOB_MIC, &ai->jobs);
1289         PC4500_readrid(ai, RID_MIC, &mic_rid, sizeof(mic_rid), 0);
1290         up(&ai->sem);
1291
1292         ai->micstats.enabled = (mic_rid.state & 0x00FF) ? 1 : 0;
1293
1294         if (ai->micstats.enabled) {
1295                 /* Key must be valid and different */
1296                 if (mic_rid.multicastValid && (!ai->mod[0].mCtx.valid ||
1297                     (memcmp (ai->mod[0].mCtx.key, mic_rid.multicast,
1298                              sizeof(ai->mod[0].mCtx.key)) != 0))) {
1299                         /* Age current mic Context */
1300                         memcpy(&ai->mod[1].mCtx,&ai->mod[0].mCtx,sizeof(miccntx));
1301                         /* Initialize new context */
1302                         memcpy(&ai->mod[0].mCtx.key,mic_rid.multicast,sizeof(mic_rid.multicast));
1303                         ai->mod[0].mCtx.window  = 33; //Window always points to the middle
1304                         ai->mod[0].mCtx.rx      = 0;  //Rx Sequence numbers
1305                         ai->mod[0].mCtx.tx      = 0;  //Tx sequence numbers
1306                         ai->mod[0].mCtx.valid   = 1;  //Key is now valid
1307
1308                         /* Give key to mic seed */
1309                         emmh32_setseed(&ai->mod[0].mCtx.seed,mic_rid.multicast,sizeof(mic_rid.multicast), ai->tfm);
1310                 }
1311
1312                 /* Key must be valid and different */
1313                 if (mic_rid.unicastValid && (!ai->mod[0].uCtx.valid ||
1314                     (memcmp(ai->mod[0].uCtx.key, mic_rid.unicast,
1315                             sizeof(ai->mod[0].uCtx.key)) != 0))) {
1316                         /* Age current mic Context */
1317                         memcpy(&ai->mod[1].uCtx,&ai->mod[0].uCtx,sizeof(miccntx));
1318                         /* Initialize new context */
1319                         memcpy(&ai->mod[0].uCtx.key,mic_rid.unicast,sizeof(mic_rid.unicast));
1320
1321                         ai->mod[0].uCtx.window  = 33; //Window always points to the middle
1322                         ai->mod[0].uCtx.rx      = 0;  //Rx Sequence numbers
1323                         ai->mod[0].uCtx.tx      = 0;  //Tx sequence numbers
1324                         ai->mod[0].uCtx.valid   = 1;  //Key is now valid
1325
1326                         //Give key to mic seed
1327                         emmh32_setseed(&ai->mod[0].uCtx.seed, mic_rid.unicast, sizeof(mic_rid.unicast), ai->tfm);
1328                 }
1329         } else {
1330       /* So next time we have a valid key and mic is enabled, we will update
1331        * the sequence number if the key is the same as before.
1332        */
1333                 ai->mod[0].uCtx.valid = 0;
1334                 ai->mod[0].mCtx.valid = 0;
1335         }
1336 }
1337
1338 /* micsetup - Get ready for business */
1339
1340 static int micsetup(struct airo_info *ai) {
1341         int i;
1342
1343         if (ai->tfm == NULL)
1344                 ai->tfm = crypto_alloc_cipher("aes", 0, CRYPTO_ALG_ASYNC);
1345
1346         if (IS_ERR(ai->tfm)) {
1347                 airo_print_err(ai->dev->name, "failed to load transform for AES");
1348                 ai->tfm = NULL;
1349                 return ERROR;
1350         }
1351
1352         for (i=0; i < NUM_MODULES; i++) {
1353                 memset(&ai->mod[i].mCtx,0,sizeof(miccntx));
1354                 memset(&ai->mod[i].uCtx,0,sizeof(miccntx));
1355         }
1356         return SUCCESS;
1357 }
1358
1359 static char micsnap[] = {0xAA,0xAA,0x03,0x00,0x40,0x96,0x00,0x02};
1360
1361 /*===========================================================================
1362  * Description: Mic a packet
1363  *
1364  *      Inputs: etherHead * pointer to an 802.3 frame
1365  *
1366  *     Returns: BOOLEAN if successful, otherwise false.
1367  *             PacketTxLen will be updated with the mic'd packets size.
1368  *
1369  *    Caveats: It is assumed that the frame buffer will already
1370  *             be big enough to hold the largets mic message possible.
1371  *            (No memory allocation is done here).
1372  *
1373  *    Author: sbraneky (10/15/01)
1374  *    Merciless hacks by rwilcher (1/14/02)
1375  */
1376
1377 static int encapsulate(struct airo_info *ai ,etherHead *frame, MICBuffer *mic, int payLen)
1378 {
1379         miccntx   *context;
1380
1381         // Determine correct context
1382         // If not adhoc, always use unicast key
1383
1384         if (test_bit(FLAG_ADHOC, &ai->flags) && (frame->da[0] & 0x1))
1385                 context = &ai->mod[0].mCtx;
1386         else
1387                 context = &ai->mod[0].uCtx;
1388
1389         if (!context->valid)
1390                 return ERROR;
1391
1392         mic->typelen = htons(payLen + 16); //Length of Mic'd packet
1393
1394         memcpy(&mic->u.snap, micsnap, sizeof(micsnap)); // Add Snap
1395
1396         // Add Tx sequence
1397         mic->seq = htonl(context->tx);
1398         context->tx += 2;
1399
1400         emmh32_init(&context->seed); // Mic the packet
1401         emmh32_update(&context->seed,frame->da,ETH_ALEN * 2); // DA,SA
1402         emmh32_update(&context->seed,(u8*)&mic->typelen,10); // Type/Length and Snap
1403         emmh32_update(&context->seed,(u8*)&mic->seq,sizeof(mic->seq)); //SEQ
1404         emmh32_update(&context->seed,frame->da + ETH_ALEN * 2,payLen); //payload
1405         emmh32_final(&context->seed, (u8*)&mic->mic);
1406
1407         /*    New Type/length ?????????? */
1408         mic->typelen = 0; //Let NIC know it could be an oversized packet
1409         return SUCCESS;
1410 }
1411
1412 typedef enum {
1413     NONE,
1414     NOMIC,
1415     NOMICPLUMMED,
1416     SEQUENCE,
1417     INCORRECTMIC,
1418 } mic_error;
1419
1420 /*===========================================================================
1421  *  Description: Decapsulates a MIC'd packet and returns the 802.3 packet
1422  *               (removes the MIC stuff) if packet is a valid packet.
1423  *
1424  *       Inputs: etherHead  pointer to the 802.3 packet
1425  *
1426  *      Returns: BOOLEAN - TRUE if packet should be dropped otherwise FALSE
1427  *
1428  *      Author: sbraneky (10/15/01)
1429  *    Merciless hacks by rwilcher (1/14/02)
1430  *---------------------------------------------------------------------------
1431  */
1432
1433 static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *eth, u16 payLen)
1434 {
1435         int      i;
1436         u32      micSEQ;
1437         miccntx  *context;
1438         u8       digest[4];
1439         mic_error micError = NONE;
1440
1441         // Check if the packet is a Mic'd packet
1442
1443         if (!ai->micstats.enabled) {
1444                 //No Mic set or Mic OFF but we received a MIC'd packet.
1445                 if (memcmp ((u8*)eth + 14, micsnap, sizeof(micsnap)) == 0) {
1446                         ai->micstats.rxMICPlummed++;
1447                         return ERROR;
1448                 }
1449                 return SUCCESS;
1450         }
1451
1452         if (ntohs(mic->typelen) == 0x888E)
1453                 return SUCCESS;
1454
1455         if (memcmp (mic->u.snap, micsnap, sizeof(micsnap)) != 0) {
1456             // Mic enabled but packet isn't Mic'd
1457                 ai->micstats.rxMICPlummed++;
1458                 return ERROR;
1459         }
1460
1461         micSEQ = ntohl(mic->seq);            //store SEQ as CPU order
1462
1463         //At this point we a have a mic'd packet and mic is enabled
1464         //Now do the mic error checking.
1465
1466         //Receive seq must be odd
1467         if ( (micSEQ & 1) == 0 ) {
1468                 ai->micstats.rxWrongSequence++;
1469                 return ERROR;
1470         }
1471
1472         for (i = 0; i < NUM_MODULES; i++) {
1473                 int mcast = eth->da[0] & 1;
1474                 //Determine proper context
1475                 context = mcast ? &ai->mod[i].mCtx : &ai->mod[i].uCtx;
1476
1477                 //Make sure context is valid
1478                 if (!context->valid) {
1479                         if (i == 0)
1480                                 micError = NOMICPLUMMED;
1481                         continue;
1482                 }
1483                 //DeMic it
1484
1485                 if (!mic->typelen)
1486                         mic->typelen = htons(payLen + sizeof(MICBuffer) - 2);
1487
1488                 emmh32_init(&context->seed);
1489                 emmh32_update(&context->seed, eth->da, ETH_ALEN*2);
1490                 emmh32_update(&context->seed, (u8 *)&mic->typelen, sizeof(mic->typelen)+sizeof(mic->u.snap));
1491                 emmh32_update(&context->seed, (u8 *)&mic->seq,sizeof(mic->seq));
1492                 emmh32_update(&context->seed, eth->da + ETH_ALEN*2,payLen);
1493                 //Calculate MIC
1494                 emmh32_final(&context->seed, digest);
1495
1496                 if (memcmp(digest, &mic->mic, 4)) { //Make sure the mics match
1497                   //Invalid Mic
1498                         if (i == 0)
1499                                 micError = INCORRECTMIC;
1500                         continue;
1501                 }
1502
1503                 //Check Sequence number if mics pass
1504                 if (RxSeqValid(ai, context, mcast, micSEQ) == SUCCESS) {
1505                         ai->micstats.rxSuccess++;
1506                         return SUCCESS;
1507                 }
1508                 if (i == 0)
1509                         micError = SEQUENCE;
1510         }
1511
1512         // Update statistics
1513         switch (micError) {
1514                 case NOMICPLUMMED: ai->micstats.rxMICPlummed++;   break;
1515                 case SEQUENCE:    ai->micstats.rxWrongSequence++; break;
1516                 case INCORRECTMIC: ai->micstats.rxIncorrectMIC++; break;
1517                 case NONE:  break;
1518                 case NOMIC: break;
1519         }
1520         return ERROR;
1521 }
1522
1523 /*===========================================================================
1524  * Description:  Checks the Rx Seq number to make sure it is valid
1525  *               and hasn't already been received
1526  *
1527  *     Inputs: miccntx - mic context to check seq against
1528  *             micSeq  - the Mic seq number
1529  *
1530  *    Returns: TRUE if valid otherwise FALSE.
1531  *
1532  *    Author: sbraneky (10/15/01)
1533  *    Merciless hacks by rwilcher (1/14/02)
1534  *---------------------------------------------------------------------------
1535  */
1536
1537 static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq)
1538 {
1539         u32 seq,index;
1540
1541         //Allow for the ap being rebooted - if it is then use the next
1542         //sequence number of the current sequence number - might go backwards
1543
1544         if (mcast) {
1545                 if (test_bit(FLAG_UPDATE_MULTI, &ai->flags)) {
1546                         clear_bit (FLAG_UPDATE_MULTI, &ai->flags);
1547                         context->window = (micSeq > 33) ? micSeq : 33;
1548                         context->rx     = 0;        // Reset rx
1549                 }
1550         } else if (test_bit(FLAG_UPDATE_UNI, &ai->flags)) {
1551                 clear_bit (FLAG_UPDATE_UNI, &ai->flags);
1552                 context->window = (micSeq > 33) ? micSeq : 33; // Move window
1553                 context->rx     = 0;        // Reset rx
1554         }
1555
1556         //Make sequence number relative to START of window
1557         seq = micSeq - (context->window - 33);
1558
1559         //Too old of a SEQ number to check.
1560         if ((s32)seq < 0)
1561                 return ERROR;
1562
1563         if ( seq > 64 ) {
1564                 //Window is infinite forward
1565                 MoveWindow(context,micSeq);
1566                 return SUCCESS;
1567         }
1568
1569         // We are in the window. Now check the context rx bit to see if it was already sent
1570         seq >>= 1;         //divide by 2 because we only have odd numbers
1571         index = 1 << seq;  //Get an index number
1572
1573         if (!(context->rx & index)) {
1574                 //micSEQ falls inside the window.
1575                 //Add seqence number to the list of received numbers.
1576                 context->rx |= index;
1577
1578                 MoveWindow(context,micSeq);
1579
1580                 return SUCCESS;
1581         }
1582         return ERROR;
1583 }
1584
1585 static void MoveWindow(miccntx *context, u32 micSeq)
1586 {
1587         u32 shift;
1588
1589         //Move window if seq greater than the middle of the window
1590         if (micSeq > context->window) {
1591                 shift = (micSeq - context->window) >> 1;
1592
1593                     //Shift out old
1594                 if (shift < 32)
1595                         context->rx >>= shift;
1596                 else
1597                         context->rx = 0;
1598
1599                 context->window = micSeq;      //Move window
1600         }
1601 }
1602
1603 /*==============================================*/
1604 /*========== EMMH ROUTINES  ====================*/
1605 /*==============================================*/
1606
1607 /* mic accumulate */
1608 #define MIC_ACCUM(val)  \
1609         context->accum += (u64)(val) * context->coeff[coeff_position++];
1610
1611 static unsigned char aes_counter[16];
1612
1613 /* expand the key to fill the MMH coefficient array */
1614 static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1615                            struct crypto_cipher *tfm)
1616 {
1617   /* take the keying material, expand if necessary, truncate at 16-bytes */
1618   /* run through AES counter mode to generate context->coeff[] */
1619
1620         int i,j;
1621         u32 counter;
1622         u8 *cipher, plain[16];
1623
1624         crypto_cipher_setkey(tfm, pkey, 16);
1625         counter = 0;
1626         for (i = 0; i < ARRAY_SIZE(context->coeff); ) {
1627                 aes_counter[15] = (u8)(counter >> 0);
1628                 aes_counter[14] = (u8)(counter >> 8);
1629                 aes_counter[13] = (u8)(counter >> 16);
1630                 aes_counter[12] = (u8)(counter >> 24);
1631                 counter++;
1632                 memcpy (plain, aes_counter, 16);
1633                 crypto_cipher_encrypt_one(tfm, plain, plain);
1634                 cipher = plain;
1635                 for (j = 0; (j < 16) && (i < ARRAY_SIZE(context->coeff)); ) {
1636                         context->coeff[i++] = ntohl(*(u32 *)&cipher[j]);
1637                         j += 4;
1638                 }
1639         }
1640 }
1641
1642 /* prepare for calculation of a new mic */
1643 static void emmh32_init(emmh32_context *context)
1644 {
1645         /* prepare for new mic calculation */
1646         context->accum = 0;
1647         context->position = 0;
1648 }
1649
1650 /* add some bytes to the mic calculation */
1651 static void emmh32_update(emmh32_context *context, u8 *pOctets, int len)
1652 {
1653         int     coeff_position, byte_position;
1654
1655         if (len == 0) return;
1656
1657         coeff_position = context->position >> 2;
1658
1659         /* deal with partial 32-bit word left over from last update */
1660         byte_position = context->position & 3;
1661         if (byte_position) {
1662                 /* have a partial word in part to deal with */
1663                 do {
1664                         if (len == 0) return;
1665                         context->part.d8[byte_position++] = *pOctets++;
1666                         context->position++;
1667                         len--;
1668                 } while (byte_position < 4);
1669                 MIC_ACCUM(htonl(context->part.d32));
1670         }
1671
1672         /* deal with full 32-bit words */
1673         while (len >= 4) {
1674                 MIC_ACCUM(htonl(*(u32 *)pOctets));
1675                 context->position += 4;
1676                 pOctets += 4;
1677                 len -= 4;
1678         }
1679
1680         /* deal with partial 32-bit word that will be left over from this update */
1681         byte_position = 0;
1682         while (len > 0) {
1683                 context->part.d8[byte_position++] = *pOctets++;
1684                 context->position++;
1685                 len--;
1686         }
1687 }
1688
1689 /* mask used to zero empty bytes for final partial word */
1690 static u32 mask32[4] = { 0x00000000L, 0xFF000000L, 0xFFFF0000L, 0xFFFFFF00L };
1691
1692 /* calculate the mic */
1693 static void emmh32_final(emmh32_context *context, u8 digest[4])
1694 {
1695         int     coeff_position, byte_position;
1696         u32     val;
1697
1698         u64 sum, utmp;
1699         s64 stmp;
1700
1701         coeff_position = context->position >> 2;
1702
1703         /* deal with partial 32-bit word left over from last update */
1704         byte_position = context->position & 3;
1705         if (byte_position) {
1706                 /* have a partial word in part to deal with */
1707                 val = htonl(context->part.d32);
1708                 MIC_ACCUM(val & mask32[byte_position]); /* zero empty bytes */
1709         }
1710
1711         /* reduce the accumulated u64 to a 32-bit MIC */
1712         sum = context->accum;
1713         stmp = (sum  & 0xffffffffLL) - ((sum >> 32)  * 15);
1714         utmp = (stmp & 0xffffffffLL) - ((stmp >> 32) * 15);
1715         sum = utmp & 0xffffffffLL;
1716         if (utmp > 0x10000000fLL)
1717                 sum -= 15;
1718
1719         val = (u32)sum;
1720         digest[0] = (val>>24) & 0xFF;
1721         digest[1] = (val>>16) & 0xFF;
1722         digest[2] = (val>>8) & 0xFF;
1723         digest[3] = val & 0xFF;
1724 }
1725
1726 static int readBSSListRid(struct airo_info *ai, int first,
1727                       BSSListRid *list) {
1728         int rc;
1729         Cmd cmd;
1730         Resp rsp;
1731
1732         if (first == 1) {
1733                 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
1734                 memset(&cmd, 0, sizeof(cmd));
1735                 cmd.cmd=CMD_LISTBSS;
1736                 if (down_interruptible(&ai->sem))
1737                         return -ERESTARTSYS;
1738                 ai->list_bss_task = current;
1739                 issuecommand(ai, &cmd, &rsp);
1740                 up(&ai->sem);
1741                 /* Let the command take effect */
1742                 schedule_timeout_uninterruptible(3 * HZ);
1743                 ai->list_bss_task = NULL;
1744         }
1745         rc = PC4500_readrid(ai, first ? ai->bssListFirst : ai->bssListNext,
1746                             list, ai->bssListRidLen, 1);
1747
1748         list->len = le16_to_cpu(list->len);
1749         list->index = le16_to_cpu(list->index);
1750         list->radioType = le16_to_cpu(list->radioType);
1751         list->cap = le16_to_cpu(list->cap);
1752         list->beaconInterval = le16_to_cpu(list->beaconInterval);
1753         list->fh.dwell = le16_to_cpu(list->fh.dwell);
1754         list->dsChannel = le16_to_cpu(list->dsChannel);
1755         list->atimWindow = le16_to_cpu(list->atimWindow);
1756         list->dBm = le16_to_cpu(list->dBm);
1757         return rc;
1758 }
1759
1760 static int readWepKeyRid(struct airo_info*ai, WepKeyRid *wkr, int temp, int lock) {
1761         int rc = PC4500_readrid(ai, temp ? RID_WEP_TEMP : RID_WEP_PERM,
1762                                 wkr, sizeof(*wkr), lock);
1763
1764         wkr->len = le16_to_cpu(wkr->len);
1765         wkr->kindex = le16_to_cpu(wkr->kindex);
1766         wkr->klen = le16_to_cpu(wkr->klen);
1767         return rc;
1768 }
1769 /* In the writeXXXRid routines we copy the rids so that we don't screwup
1770  * the originals when we endian them... */
1771 static int writeWepKeyRid(struct airo_info*ai, WepKeyRid *pwkr, int perm, int lock) {
1772         int rc;
1773         WepKeyRid wkr = *pwkr;
1774
1775         wkr.len = cpu_to_le16(wkr.len);
1776         wkr.kindex = cpu_to_le16(wkr.kindex);
1777         wkr.klen = cpu_to_le16(wkr.klen);
1778         rc = PC4500_writerid(ai, RID_WEP_TEMP, &wkr, sizeof(wkr), lock);
1779         if (rc!=SUCCESS) airo_print_err(ai->dev->name, "WEP_TEMP set %x", rc);
1780         if (perm) {
1781                 rc = PC4500_writerid(ai, RID_WEP_PERM, &wkr, sizeof(wkr), lock);
1782                 if (rc!=SUCCESS) {
1783                         airo_print_err(ai->dev->name, "WEP_PERM set %x", rc);
1784                 }
1785         }
1786         return rc;
1787 }
1788
1789 static int readSsidRid(struct airo_info*ai, SsidRid *ssidr) {
1790         int i;
1791         int rc = PC4500_readrid(ai, RID_SSID, ssidr, sizeof(*ssidr), 1);
1792
1793         ssidr->len = le16_to_cpu(ssidr->len);
1794         for(i = 0; i < 3; i++) {
1795                 ssidr->ssids[i].len = le16_to_cpu(ssidr->ssids[i].len);
1796         }
1797         return rc;
1798 }
1799 static int writeSsidRid(struct airo_info*ai, SsidRid *pssidr, int lock) {
1800         int rc;
1801         int i;
1802         SsidRid ssidr = *pssidr;
1803
1804         ssidr.len = cpu_to_le16(ssidr.len);
1805         for(i = 0; i < 3; i++) {
1806                 ssidr.ssids[i].len = cpu_to_le16(ssidr.ssids[i].len);
1807         }
1808         rc = PC4500_writerid(ai, RID_SSID, &ssidr, sizeof(ssidr), lock);
1809         return rc;
1810 }
1811 static int readConfigRid(struct airo_info*ai, int lock) {
1812         int rc;
1813         u16 *s;
1814         ConfigRid cfg;
1815
1816         if (ai->config.len)
1817                 return SUCCESS;
1818
1819         rc = PC4500_readrid(ai, RID_ACTUALCONFIG, &cfg, sizeof(cfg), lock);
1820         if (rc != SUCCESS)
1821                 return rc;
1822
1823         for(s = &cfg.len; s <= &cfg.rtsThres; s++) *s = le16_to_cpu(*s);
1824
1825         for(s = &cfg.shortRetryLimit; s <= &cfg.radioType; s++)
1826                 *s = le16_to_cpu(*s);
1827
1828         for(s = &cfg.txPower; s <= &cfg.radioSpecific; s++)
1829                 *s = le16_to_cpu(*s);
1830
1831         for(s = &cfg.arlThreshold; s <= &cfg._reserved4[0]; s++)
1832                 *s = cpu_to_le16(*s);
1833
1834         for(s = &cfg.autoWake; s <= &cfg.autoWake; s++)
1835                 *s = cpu_to_le16(*s);
1836
1837         ai->config = cfg;
1838         return SUCCESS;
1839 }
1840 static inline void checkThrottle(struct airo_info *ai) {
1841         int i;
1842 /* Old hardware had a limit on encryption speed */
1843         if (ai->config.authType != AUTH_OPEN && maxencrypt) {
1844                 for(i=0; i<8; i++) {
1845                         if (ai->config.rates[i] > maxencrypt) {
1846                                 ai->config.rates[i] = 0;
1847                         }
1848                 }
1849         }
1850 }
1851 static int writeConfigRid(struct airo_info*ai, int lock) {
1852         u16 *s;
1853         ConfigRid cfgr;
1854
1855         if (!test_bit (FLAG_COMMIT, &ai->flags))
1856                 return SUCCESS;
1857
1858         clear_bit (FLAG_COMMIT, &ai->flags);
1859         clear_bit (FLAG_RESET, &ai->flags);
1860         checkThrottle(ai);
1861         cfgr = ai->config;
1862
1863         if ((cfgr.opmode & 0xFF) == MODE_STA_IBSS)
1864                 set_bit(FLAG_ADHOC, &ai->flags);
1865         else
1866                 clear_bit(FLAG_ADHOC, &ai->flags);
1867
1868         for(s = &cfgr.len; s <= &cfgr.rtsThres; s++) *s = cpu_to_le16(*s);
1869
1870         for(s = &cfgr.shortRetryLimit; s <= &cfgr.radioType; s++)
1871                 *s = cpu_to_le16(*s);
1872
1873         for(s = &cfgr.txPower; s <= &cfgr.radioSpecific; s++)
1874                 *s = cpu_to_le16(*s);
1875
1876         for(s = &cfgr.arlThreshold; s <= &cfgr._reserved4[0]; s++)
1877                 *s = cpu_to_le16(*s);
1878
1879         for(s = &cfgr.autoWake; s <= &cfgr.autoWake; s++)
1880                 *s = cpu_to_le16(*s);
1881
1882         return PC4500_writerid( ai, RID_CONFIG, &cfgr, sizeof(cfgr), lock);
1883 }
1884 static int readStatusRid(struct airo_info*ai, StatusRid *statr, int lock) {
1885         int rc = PC4500_readrid(ai, RID_STATUS, statr, sizeof(*statr), lock);
1886         u16 *s;
1887
1888         statr->len = le16_to_cpu(statr->len);
1889         for(s = &statr->mode; s <= &statr->SSIDlen; s++) *s = le16_to_cpu(*s);
1890
1891         for(s = &statr->beaconPeriod; s <= &statr->shortPreamble; s++)
1892                 *s = le16_to_cpu(*s);
1893         statr->load = le16_to_cpu(statr->load);
1894         statr->assocStatus = le16_to_cpu(statr->assocStatus);
1895         return rc;
1896 }
1897 static int readAPListRid(struct airo_info*ai, APListRid *aplr) {
1898         int rc =  PC4500_readrid(ai, RID_APLIST, aplr, sizeof(*aplr), 1);
1899         aplr->len = le16_to_cpu(aplr->len);
1900         return rc;
1901 }
1902 static int writeAPListRid(struct airo_info*ai, APListRid *aplr, int lock) {
1903         int rc;
1904         aplr->len = cpu_to_le16(aplr->len);
1905         rc = PC4500_writerid(ai, RID_APLIST, aplr, sizeof(*aplr), lock);
1906         return rc;
1907 }
1908 static int readCapabilityRid(struct airo_info*ai, CapabilityRid *capr, int lock) {
1909         int rc = PC4500_readrid(ai, RID_CAPABILITIES, capr, sizeof(*capr), lock);
1910         u16 *s;
1911
1912         capr->len = le16_to_cpu(capr->len);
1913         capr->prodNum = le16_to_cpu(capr->prodNum);
1914         capr->radioType = le16_to_cpu(capr->radioType);
1915         capr->country = le16_to_cpu(capr->country);
1916         for(s = &capr->txPowerLevels[0]; s <= &capr->requiredHard; s++)
1917                 *s = le16_to_cpu(*s);
1918         return rc;
1919 }
1920 static int readStatsRid(struct airo_info*ai, StatsRid *sr, int rid, int lock) {
1921         int rc = PC4500_readrid(ai, rid, sr, sizeof(*sr), lock);
1922         u32 *i;
1923
1924         sr->len = le16_to_cpu(sr->len);
1925         for(i = &sr->vals[0]; i <= &sr->vals[99]; i++) *i = le32_to_cpu(*i);
1926         return rc;
1927 }
1928
1929 static int airo_open(struct net_device *dev) {
1930         struct airo_info *info = dev->priv;
1931         Resp rsp;
1932
1933         if (test_bit(FLAG_FLASHING, &info->flags))
1934                 return -EIO;
1935
1936         /* Make sure the card is configured.
1937          * Wireless Extensions may postpone config changes until the card
1938          * is open (to pipeline changes and speed-up card setup). If
1939          * those changes are not yet commited, do it now - Jean II */
1940         if (test_bit (FLAG_COMMIT, &info->flags)) {
1941                 disable_MAC(info, 1);
1942                 writeConfigRid(info, 1);
1943         }
1944
1945         if (info->wifidev != dev) {
1946                 /* Power on the MAC controller (which may have been disabled) */
1947                 clear_bit(FLAG_RADIO_DOWN, &info->flags);
1948                 enable_interrupts(info);
1949         }
1950         enable_MAC(info, &rsp, 1);
1951
1952         netif_start_queue(dev);
1953         return 0;
1954 }
1955
1956 static int mpi_start_xmit(struct sk_buff *skb, struct net_device *dev) {
1957         int npacks, pending;
1958         unsigned long flags;
1959         struct airo_info *ai = dev->priv;
1960
1961         if (!skb) {
1962                 airo_print_err(dev->name, "%s: skb == NULL!",__FUNCTION__);
1963                 return 0;
1964         }
1965         npacks = skb_queue_len (&ai->txq);
1966
1967         if (npacks >= MAXTXQ - 1) {
1968                 netif_stop_queue (dev);
1969                 if (npacks > MAXTXQ) {
1970                         ai->stats.tx_fifo_errors++;
1971                         return 1;
1972                 }
1973                 skb_queue_tail (&ai->txq, skb);
1974                 return 0;
1975         }
1976
1977         spin_lock_irqsave(&ai->aux_lock, flags);
1978         skb_queue_tail (&ai->txq, skb);
1979         pending = test_bit(FLAG_PENDING_XMIT, &ai->flags);
1980         spin_unlock_irqrestore(&ai->aux_lock,flags);
1981         netif_wake_queue (dev);
1982
1983         if (pending == 0) {
1984                 set_bit(FLAG_PENDING_XMIT, &ai->flags);
1985                 mpi_send_packet (dev);
1986         }
1987         return 0;
1988 }
1989
1990 /*
1991  * @mpi_send_packet
1992  *
1993  * Attempt to transmit a packet. Can be called from interrupt
1994  * or transmit . return number of packets we tried to send
1995  */
1996
1997 static int mpi_send_packet (struct net_device *dev)
1998 {
1999         struct sk_buff *skb;
2000         unsigned char *buffer;
2001         s16 len, *payloadLen;
2002         struct airo_info *ai = dev->priv;
2003         u8 *sendbuf;
2004
2005         /* get a packet to send */
2006
2007         if ((skb = skb_dequeue(&ai->txq)) == 0) {
2008                 airo_print_err(dev->name,
2009                         "%s: Dequeue'd zero in send_packet()",
2010                         __FUNCTION__);
2011                 return 0;
2012         }
2013
2014         /* check min length*/
2015         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2016         buffer = skb->data;
2017
2018         ai->txfids[0].tx_desc.offset = 0;
2019         ai->txfids[0].tx_desc.valid = 1;
2020         ai->txfids[0].tx_desc.eoc = 1;
2021         ai->txfids[0].tx_desc.len =len+sizeof(WifiHdr);
2022
2023 /*
2024  * Magic, the cards firmware needs a length count (2 bytes) in the host buffer
2025  * right after  TXFID_HDR.The TXFID_HDR contains the status short so payloadlen
2026  * is immediatly after it. ------------------------------------------------
2027  *                         |TXFIDHDR+STATUS|PAYLOADLEN|802.3HDR|PACKETDATA|
2028  *                         ------------------------------------------------
2029  */
2030
2031         memcpy((char *)ai->txfids[0].virtual_host_addr,
2032                 (char *)&wifictlhdr8023, sizeof(wifictlhdr8023));
2033
2034         payloadLen = (s16 *)(ai->txfids[0].virtual_host_addr +
2035                 sizeof(wifictlhdr8023));
2036         sendbuf = ai->txfids[0].virtual_host_addr +
2037                 sizeof(wifictlhdr8023) + 2 ;
2038
2039         /*
2040          * Firmware automaticly puts 802 header on so
2041          * we don't need to account for it in the length
2042          */
2043         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
2044                 (ntohs(((u16 *)buffer)[6]) != 0x888E)) {
2045                 MICBuffer pMic;
2046
2047                 if (encapsulate(ai, (etherHead *)buffer, &pMic, len - sizeof(etherHead)) != SUCCESS)
2048                         return ERROR;
2049
2050                 *payloadLen = cpu_to_le16(len-sizeof(etherHead)+sizeof(pMic));
2051                 ai->txfids[0].tx_desc.len += sizeof(pMic);
2052                 /* copy data into airo dma buffer */
2053                 memcpy (sendbuf, buffer, sizeof(etherHead));
2054                 buffer += sizeof(etherHead);
2055                 sendbuf += sizeof(etherHead);
2056                 memcpy (sendbuf, &pMic, sizeof(pMic));
2057                 sendbuf += sizeof(pMic);
2058                 memcpy (sendbuf, buffer, len - sizeof(etherHead));
2059         } else {
2060                 *payloadLen = cpu_to_le16(len - sizeof(etherHead));
2061
2062                 dev->trans_start = jiffies;
2063
2064                 /* copy data into airo dma buffer */
2065                 memcpy(sendbuf, buffer, len);
2066         }
2067
2068         memcpy_toio(ai->txfids[0].card_ram_off,
2069                 &ai->txfids[0].tx_desc, sizeof(TxFid));
2070
2071         OUT4500(ai, EVACK, 8);
2072
2073         dev_kfree_skb_any(skb);
2074         return 1;
2075 }
2076
2077 static void get_tx_error(struct airo_info *ai, s32 fid)
2078 {
2079         u16 status;
2080
2081         if (fid < 0)
2082                 status = ((WifiCtlHdr *)ai->txfids[0].virtual_host_addr)->ctlhdr.status;
2083         else {
2084                 if (bap_setup(ai, ai->fids[fid] & 0xffff, 4, BAP0) != SUCCESS)
2085                         return;
2086                 bap_read(ai, &status, 2, BAP0);
2087         }
2088         if (le16_to_cpu(status) & 2) /* Too many retries */
2089                 ai->stats.tx_aborted_errors++;
2090         if (le16_to_cpu(status) & 4) /* Transmit lifetime exceeded */
2091                 ai->stats.tx_heartbeat_errors++;
2092         if (le16_to_cpu(status) & 8) /* Aid fail */
2093                 { }
2094         if (le16_to_cpu(status) & 0x10) /* MAC disabled */
2095                 ai->stats.tx_carrier_errors++;
2096         if (le16_to_cpu(status) & 0x20) /* Association lost */
2097                 { }
2098         /* We produce a TXDROP event only for retry or lifetime
2099          * exceeded, because that's the only status that really mean
2100          * that this particular node went away.
2101          * Other errors means that *we* screwed up. - Jean II */
2102         if ((le16_to_cpu(status) & 2) ||
2103              (le16_to_cpu(status) & 4)) {
2104                 union iwreq_data        wrqu;
2105                 char junk[0x18];
2106
2107                 /* Faster to skip over useless data than to do
2108                  * another bap_setup(). We are at offset 0x6 and
2109                  * need to go to 0x18 and read 6 bytes - Jean II */
2110                 bap_read(ai, (u16 *) junk, 0x18, BAP0);
2111
2112                 /* Copy 802.11 dest address.
2113                  * We use the 802.11 header because the frame may
2114                  * not be 802.3 or may be mangled...
2115                  * In Ad-Hoc mode, it will be the node address.
2116                  * In managed mode, it will be most likely the AP addr
2117                  * User space will figure out how to convert it to
2118                  * whatever it needs (IP address or else).
2119                  * - Jean II */
2120                 memcpy(wrqu.addr.sa_data, junk + 0x12, ETH_ALEN);
2121                 wrqu.addr.sa_family = ARPHRD_ETHER;
2122
2123                 /* Send event to user space */
2124                 wireless_send_event(ai->dev, IWEVTXDROP, &wrqu, NULL);
2125         }
2126 }
2127
2128 static void airo_end_xmit(struct net_device *dev) {
2129         u16 status;
2130         int i;
2131         struct airo_info *priv = dev->priv;
2132         struct sk_buff *skb = priv->xmit.skb;
2133         int fid = priv->xmit.fid;
2134         u32 *fids = priv->fids;
2135
2136         clear_bit(JOB_XMIT, &priv->jobs);
2137         clear_bit(FLAG_PENDING_XMIT, &priv->flags);
2138         status = transmit_802_3_packet (priv, fids[fid], skb->data);
2139         up(&priv->sem);
2140
2141         i = 0;
2142         if ( status == SUCCESS ) {
2143                 dev->trans_start = jiffies;
2144                 for (; i < MAX_FIDS / 2 && (priv->fids[i] & 0xffff0000); i++);
2145         } else {
2146                 priv->fids[fid] &= 0xffff;
2147                 priv->stats.tx_window_errors++;
2148         }
2149         if (i < MAX_FIDS / 2)
2150                 netif_wake_queue(dev);
2151         dev_kfree_skb(skb);
2152 }
2153
2154 static int airo_start_xmit(struct sk_buff *skb, struct net_device *dev) {
2155         s16 len;
2156         int i, j;
2157         struct airo_info *priv = dev->priv;
2158         u32 *fids = priv->fids;
2159
2160         if ( skb == NULL ) {
2161                 airo_print_err(dev->name, "%s: skb == NULL!", __FUNCTION__);
2162                 return 0;
2163         }
2164
2165         /* Find a vacant FID */
2166         for( i = 0; i < MAX_FIDS / 2 && (fids[i] & 0xffff0000); i++ );
2167         for( j = i + 1; j < MAX_FIDS / 2 && (fids[j] & 0xffff0000); j++ );
2168
2169         if ( j >= MAX_FIDS / 2 ) {
2170                 netif_stop_queue(dev);
2171
2172                 if (i == MAX_FIDS / 2) {
2173                         priv->stats.tx_fifo_errors++;
2174                         return 1;
2175                 }
2176         }
2177         /* check min length*/
2178         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2179         /* Mark fid as used & save length for later */
2180         fids[i] |= (len << 16);
2181         priv->xmit.skb = skb;
2182         priv->xmit.fid = i;
2183         if (down_trylock(&priv->sem) != 0) {
2184                 set_bit(FLAG_PENDING_XMIT, &priv->flags);
2185                 netif_stop_queue(dev);
2186                 set_bit(JOB_XMIT, &priv->jobs);
2187                 wake_up_interruptible(&priv->thr_wait);
2188         } else
2189                 airo_end_xmit(dev);
2190         return 0;
2191 }
2192
2193 static void airo_end_xmit11(struct net_device *dev) {
2194         u16 status;
2195         int i;
2196         struct airo_info *priv = dev->priv;
2197         struct sk_buff *skb = priv->xmit11.skb;
2198         int fid = priv->xmit11.fid;
2199         u32 *fids = priv->fids;
2200
2201         clear_bit(JOB_XMIT11, &priv->jobs);
2202         clear_bit(FLAG_PENDING_XMIT11, &priv->flags);
2203         status = transmit_802_11_packet (priv, fids[fid], skb->data);
2204         up(&priv->sem);
2205
2206         i = MAX_FIDS / 2;
2207         if ( status == SUCCESS ) {
2208                 dev->trans_start = jiffies;
2209                 for (; i < MAX_FIDS && (priv->fids[i] & 0xffff0000); i++);
2210         } else {
2211                 priv->fids[fid] &= 0xffff;
2212                 priv->stats.tx_window_errors++;
2213         }
2214         if (i < MAX_FIDS)
2215                 netif_wake_queue(dev);
2216         dev_kfree_skb(skb);
2217 }
2218
2219 static int airo_start_xmit11(struct sk_buff *skb, struct net_device *dev) {
2220         s16 len;
2221         int i, j;
2222         struct airo_info *priv = dev->priv;
2223         u32 *fids = priv->fids;
2224
2225         if (test_bit(FLAG_MPI, &priv->flags)) {
2226                 /* Not implemented yet for MPI350 */
2227                 netif_stop_queue(dev);
2228                 return -ENETDOWN;
2229         }
2230
2231         if ( skb == NULL ) {
2232                 airo_print_err(dev->name, "%s: skb == NULL!", __FUNCTION__);
2233                 return 0;
2234         }
2235
2236         /* Find a vacant FID */
2237         for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2238         for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2239
2240         if ( j >= MAX_FIDS ) {
2241                 netif_stop_queue(dev);
2242
2243                 if (i == MAX_FIDS) {
2244                         priv->stats.tx_fifo_errors++;
2245                         return 1;
2246                 }
2247         }
2248         /* check min length*/
2249         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2250         /* Mark fid as used & save length for later */
2251         fids[i] |= (len << 16);
2252         priv->xmit11.skb = skb;
2253         priv->xmit11.fid = i;
2254         if (down_trylock(&priv->sem) != 0) {
2255                 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2256                 netif_stop_queue(dev);
2257                 set_bit(JOB_XMIT11, &priv->jobs);
2258                 wake_up_interruptible(&priv->thr_wait);
2259         } else
2260                 airo_end_xmit11(dev);
2261         return 0;
2262 }
2263
2264 static void airo_read_stats(struct airo_info *ai) {
2265         StatsRid stats_rid;
2266         u32 *vals = stats_rid.vals;
2267
2268         clear_bit(JOB_STATS, &ai->jobs);
2269         if (ai->power.event) {
2270                 up(&ai->sem);
2271                 return;
2272         }
2273         readStatsRid(ai, &stats_rid, RID_STATS, 0);
2274         up(&ai->sem);
2275
2276         ai->stats.rx_packets = vals[43] + vals[44] + vals[45];
2277         ai->stats.tx_packets = vals[39] + vals[40] + vals[41];
2278         ai->stats.rx_bytes = vals[92];
2279         ai->stats.tx_bytes = vals[91];
2280         ai->stats.rx_errors = vals[0] + vals[2] + vals[3] + vals[4];
2281         ai->stats.tx_errors = vals[42] + ai->stats.tx_fifo_errors;
2282         ai->stats.multicast = vals[43];
2283         ai->stats.collisions = vals[89];
2284
2285         /* detailed rx_errors: */
2286         ai->stats.rx_length_errors = vals[3];
2287         ai->stats.rx_crc_errors = vals[4];
2288         ai->stats.rx_frame_errors = vals[2];
2289         ai->stats.rx_fifo_errors = vals[0];
2290 }
2291
2292 static struct net_device_stats *airo_get_stats(struct net_device *dev)
2293 {
2294         struct airo_info *local =  dev->priv;
2295
2296         if (!test_bit(JOB_STATS, &local->jobs)) {
2297                 /* Get stats out of the card if available */
2298                 if (down_trylock(&local->sem) != 0) {
2299                         set_bit(JOB_STATS, &local->jobs);
2300                         wake_up_interruptible(&local->thr_wait);
2301                 } else
2302                         airo_read_stats(local);
2303         }
2304
2305         return &local->stats;
2306 }
2307
2308 static void airo_set_promisc(struct airo_info *ai) {
2309         Cmd cmd;
2310         Resp rsp;
2311
2312         memset(&cmd, 0, sizeof(cmd));
2313         cmd.cmd=CMD_SETMODE;
2314         clear_bit(JOB_PROMISC, &ai->jobs);
2315         cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2316         issuecommand(ai, &cmd, &rsp);
2317         up(&ai->sem);
2318 }
2319
2320 static void airo_set_multicast_list(struct net_device *dev) {
2321         struct airo_info *ai = dev->priv;
2322
2323         if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2324                 change_bit(FLAG_PROMISC, &ai->flags);
2325                 if (down_trylock(&ai->sem) != 0) {
2326                         set_bit(JOB_PROMISC, &ai->jobs);
2327                         wake_up_interruptible(&ai->thr_wait);
2328                 } else
2329                         airo_set_promisc(ai);
2330         }
2331
2332         if ((dev->flags&IFF_ALLMULTI)||dev->mc_count>0) {
2333                 /* Turn on multicast.  (Should be already setup...) */
2334         }
2335 }
2336
2337 static int airo_set_mac_address(struct net_device *dev, void *p)
2338 {
2339         struct airo_info *ai = dev->priv;
2340         struct sockaddr *addr = p;
2341         Resp rsp;
2342
2343         readConfigRid(ai, 1);
2344         memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2345         set_bit (FLAG_COMMIT, &ai->flags);
2346         disable_MAC(ai, 1);
2347         writeConfigRid (ai, 1);
2348         enable_MAC(ai, &rsp, 1);
2349         memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2350         if (ai->wifidev)
2351                 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2352         return 0;
2353 }
2354
2355 static int airo_change_mtu(struct net_device *dev, int new_mtu)
2356 {
2357         if ((new_mtu < 68) || (new_mtu > 2400))
2358                 return -EINVAL;
2359         dev->mtu = new_mtu;
2360         return 0;
2361 }
2362
2363
2364 static int airo_close(struct net_device *dev) {
2365         struct airo_info *ai = dev->priv;
2366
2367         netif_stop_queue(dev);
2368
2369         if (ai->wifidev != dev) {
2370 #ifdef POWER_ON_DOWN
2371                 /* Shut power to the card. The idea is that the user can save
2372                  * power when he doesn't need the card with "ifconfig down".
2373                  * That's the method that is most friendly towards the network
2374                  * stack (i.e. the network stack won't try to broadcast
2375                  * anything on the interface and routes are gone. Jean II */
2376                 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2377                 disable_MAC(ai, 1);
2378 #endif
2379                 disable_interrupts( ai );
2380         }
2381         return 0;
2382 }
2383
2384 static void del_airo_dev( struct net_device *dev );
2385
2386 void stop_airo_card( struct net_device *dev, int freeres )
2387 {
2388         struct airo_info *ai = dev->priv;
2389
2390         set_bit(FLAG_RADIO_DOWN, &ai->flags);
2391         disable_MAC(ai, 1);
2392         disable_interrupts(ai);
2393         free_irq( dev->irq, dev );
2394         takedown_proc_entry( dev, ai );
2395         if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2396                 unregister_netdev( dev );
2397                 if (ai->wifidev) {
2398                         unregister_netdev(ai->wifidev);
2399                         free_netdev(ai->wifidev);
2400                         ai->wifidev = NULL;
2401                 }
2402                 clear_bit(FLAG_REGISTERED, &ai->flags);
2403         }
2404         set_bit(JOB_DIE, &ai->jobs);
2405         kthread_stop(ai->airo_thread_task);
2406
2407         /*
2408          * Clean out tx queue
2409          */
2410         if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
2411                 struct sk_buff *skb = NULL;
2412                 for (;(skb = skb_dequeue(&ai->txq));)
2413                         dev_kfree_skb(skb);
2414         }
2415
2416         airo_networks_free (ai);
2417
2418         kfree(ai->flash);
2419         kfree(ai->rssi);
2420         kfree(ai->APList);
2421         kfree(ai->SSID);
2422         if (freeres) {
2423                 /* PCMCIA frees this stuff, so only for PCI and ISA */
2424                 release_region( dev->base_addr, 64 );
2425                 if (test_bit(FLAG_MPI, &ai->flags)) {
2426                         if (ai->pci)
2427                                 mpi_unmap_card(ai->pci);
2428                         if (ai->pcimem)
2429                                 iounmap(ai->pcimem);
2430                         if (ai->pciaux)
2431                                 iounmap(ai->pciaux);
2432                         pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2433                                 ai->shared, ai->shared_dma);
2434                 }
2435         }
2436         crypto_free_cipher(ai->tfm);
2437         del_airo_dev( dev );
2438         free_netdev( dev );
2439 }
2440
2441 EXPORT_SYMBOL(stop_airo_card);
2442
2443 static int add_airo_dev( struct net_device *dev );
2444
2445 static int wll_header_parse(struct sk_buff *skb, unsigned char *haddr)
2446 {
2447         memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
2448         return ETH_ALEN;
2449 }
2450
2451 static void mpi_unmap_card(struct pci_dev *pci)
2452 {
2453         unsigned long mem_start = pci_resource_start(pci, 1);
2454         unsigned long mem_len = pci_resource_len(pci, 1);
2455         unsigned long aux_start = pci_resource_start(pci, 2);
2456         unsigned long aux_len = AUXMEMSIZE;
2457
2458         release_mem_region(aux_start, aux_len);
2459         release_mem_region(mem_start, mem_len);
2460 }
2461
2462 /*************************************************************
2463  *  This routine assumes that descriptors have been setup .
2464  *  Run at insmod time or after reset  when the decriptors
2465  *  have been initialized . Returns 0 if all is well nz
2466  *  otherwise . Does not allocate memory but sets up card
2467  *  using previously allocated descriptors.
2468  */
2469 static int mpi_init_descriptors (struct airo_info *ai)
2470 {
2471         Cmd cmd;
2472         Resp rsp;
2473         int i;
2474         int rc = SUCCESS;
2475
2476         /* Alloc  card RX descriptors */
2477         netif_stop_queue(ai->dev);
2478
2479         memset(&rsp,0,sizeof(rsp));
2480         memset(&cmd,0,sizeof(cmd));
2481
2482         cmd.cmd = CMD_ALLOCATEAUX;
2483         cmd.parm0 = FID_RX;
2484         cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2485         cmd.parm2 = MPI_MAX_FIDS;
2486         rc=issuecommand(ai, &cmd, &rsp);
2487         if (rc != SUCCESS) {
2488                 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
2489                 return rc;
2490         }
2491
2492         for (i=0; i<MPI_MAX_FIDS; i++) {
2493                 memcpy_toio(ai->rxfids[i].card_ram_off,
2494                         &ai->rxfids[i].rx_desc, sizeof(RxFid));
2495         }
2496
2497         /* Alloc card TX descriptors */
2498
2499         memset(&rsp,0,sizeof(rsp));
2500         memset(&cmd,0,sizeof(cmd));
2501
2502         cmd.cmd = CMD_ALLOCATEAUX;
2503         cmd.parm0 = FID_TX;
2504         cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2505         cmd.parm2 = MPI_MAX_FIDS;
2506
2507         for (i=0; i<MPI_MAX_FIDS; i++) {
2508                 ai->txfids[i].tx_desc.valid = 1;
2509                 memcpy_toio(ai->txfids[i].card_ram_off,
2510                         &ai->txfids[i].tx_desc, sizeof(TxFid));
2511         }
2512         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2513
2514         rc=issuecommand(ai, &cmd, &rsp);
2515         if (rc != SUCCESS) {
2516                 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
2517                 return rc;
2518         }
2519
2520         /* Alloc card Rid descriptor */
2521         memset(&rsp,0,sizeof(rsp));
2522         memset(&cmd,0,sizeof(cmd));
2523
2524         cmd.cmd = CMD_ALLOCATEAUX;
2525         cmd.parm0 = RID_RW;
2526         cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2527         cmd.parm2 = 1; /* Magic number... */
2528         rc=issuecommand(ai, &cmd, &rsp);
2529         if (rc != SUCCESS) {
2530                 airo_print_err(ai->dev->name, "Couldn't allocate RID");
2531                 return rc;
2532         }
2533
2534         memcpy_toio(ai->config_desc.card_ram_off,
2535                 &ai->config_desc.rid_desc, sizeof(Rid));
2536
2537         return rc;
2538 }
2539
2540 /*
2541  * We are setting up three things here:
2542  * 1) Map AUX memory for descriptors: Rid, TxFid, or RxFid.
2543  * 2) Map PCI memory for issueing commands.
2544  * 3) Allocate memory (shared) to send and receive ethernet frames.
2545  */
2546 static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci,
2547                     const char *name)
2548 {
2549         unsigned long mem_start, mem_len, aux_start, aux_len;
2550         int rc = -1;
2551         int i;
2552         dma_addr_t busaddroff;
2553         unsigned char *vpackoff;
2554         unsigned char __iomem *pciaddroff;
2555
2556         mem_start = pci_resource_start(pci, 1);
2557         mem_len = pci_resource_len(pci, 1);
2558         aux_start = pci_resource_start(pci, 2);
2559         aux_len = AUXMEMSIZE;
2560
2561         if (!request_mem_region(mem_start, mem_len, name)) {
2562                 airo_print_err(ai->dev->name, "Couldn't get region %x[%x] for %s",
2563                        (int)mem_start, (int)mem_len, name);
2564                 goto out;
2565         }
2566         if (!request_mem_region(aux_start, aux_len, name)) {
2567                 airo_print_err(ai->dev->name, "Couldn't get region %x[%x] for %s",
2568                        (int)aux_start, (int)aux_len, name);
2569                 goto free_region1;
2570         }
2571
2572         ai->pcimem = ioremap(mem_start, mem_len);
2573         if (!ai->pcimem) {
2574                 airo_print_err(ai->dev->name, "Couldn't map region %x[%x] for %s",
2575                        (int)mem_start, (int)mem_len, name);
2576                 goto free_region2;
2577         }
2578         ai->pciaux = ioremap(aux_start, aux_len);
2579         if (!ai->pciaux) {
2580                 airo_print_err(ai->dev->name, "Couldn't map region %x[%x] for %s",
2581                        (int)aux_start, (int)aux_len, name);
2582                 goto free_memmap;
2583         }
2584
2585         /* Reserve PKTSIZE for each fid and 2K for the Rids */
2586         ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2587         if (!ai->shared) {
2588                 airo_print_err(ai->dev->name, "Couldn't alloc_consistent %d",
2589                        PCI_SHARED_LEN);
2590                 goto free_auxmap;
2591         }
2592
2593         /*
2594          * Setup descriptor RX, TX, CONFIG
2595          */
2596         busaddroff = ai->shared_dma;
2597         pciaddroff = ai->pciaux + AUX_OFFSET;
2598         vpackoff   = ai->shared;
2599
2600         /* RX descriptor setup */
2601         for(i = 0; i < MPI_MAX_FIDS; i++) {
2602                 ai->rxfids[i].pending = 0;
2603                 ai->rxfids[i].card_ram_off = pciaddroff;
2604                 ai->rxfids[i].virtual_host_addr = vpackoff;
2605                 ai->rxfids[i].rx_desc.host_addr = busaddroff;
2606                 ai->rxfids[i].rx_desc.valid = 1;
2607                 ai->rxfids[i].rx_desc.len = PKTSIZE;
2608                 ai->rxfids[i].rx_desc.rdy = 0;
2609
2610                 pciaddroff += sizeof(RxFid);
2611                 busaddroff += PKTSIZE;
2612                 vpackoff   += PKTSIZE;
2613         }
2614
2615         /* TX descriptor setup */
2616         for(i = 0; i < MPI_MAX_FIDS; i++) {
2617                 ai->txfids[i].card_ram_off = pciaddroff;
2618                 ai->txfids[i].virtual_host_addr = vpackoff;
2619                 ai->txfids[i].tx_desc.valid = 1;
2620                 ai->txfids[i].tx_desc.host_addr = busaddroff;
2621                 memcpy(ai->txfids[i].virtual_host_addr,
2622                         &wifictlhdr8023, sizeof(wifictlhdr8023));
2623
2624                 pciaddroff += sizeof(TxFid);
2625                 busaddroff += PKTSIZE;
2626                 vpackoff   += PKTSIZE;
2627         }
2628         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2629
2630         /* Rid descriptor setup */
2631         ai->config_desc.card_ram_off = pciaddroff;
2632         ai->config_desc.virtual_host_addr = vpackoff;
2633         ai->config_desc.rid_desc.host_addr = busaddroff;
2634         ai->ridbus = busaddroff;
2635         ai->config_desc.rid_desc.rid = 0;
2636         ai->config_desc.rid_desc.len = RIDSIZE;
2637         ai->config_desc.rid_desc.valid = 1;
2638         pciaddroff += sizeof(Rid);
2639         busaddroff += RIDSIZE;
2640         vpackoff   += RIDSIZE;
2641
2642         /* Tell card about descriptors */
2643         if (mpi_init_descriptors (ai) != SUCCESS)
2644                 goto free_shared;
2645
2646         return 0;
2647  free_shared:
2648         pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2649  free_auxmap:
2650         iounmap(ai->pciaux);
2651  free_memmap:
2652         iounmap(ai->pcimem);
2653  free_region2:
2654         release_mem_region(aux_start, aux_len);
2655  free_region1:
2656         release_mem_region(mem_start, mem_len);
2657  out:
2658         return rc;
2659 }
2660
2661 static void wifi_setup(struct net_device *dev)
2662 {
2663         dev->hard_header        = NULL;
2664         dev->rebuild_header     = NULL;
2665         dev->hard_header_cache  = NULL;
2666         dev->header_cache_update= NULL;
2667
2668         dev->hard_header_parse  = wll_header_parse;
2669         dev->hard_start_xmit = &airo_start_xmit11;
2670         dev->get_stats = &airo_get_stats;
2671         dev->set_mac_address = &airo_set_mac_address;
2672         dev->do_ioctl = &airo_ioctl;
2673         dev->wireless_handlers = &airo_handler_def;
2674         dev->change_mtu = &airo_change_mtu;
2675         dev->open = &airo_open;
2676         dev->stop = &airo_close;
2677
2678         dev->type               = ARPHRD_IEEE80211;
2679         dev->hard_header_len    = ETH_HLEN;
2680         dev->mtu                = AIRO_DEF_MTU;
2681         dev->addr_len           = ETH_ALEN;
2682         dev->tx_queue_len       = 100;
2683
2684         memset(dev->broadcast,0xFF, ETH_ALEN);
2685
2686         dev->flags              = IFF_BROADCAST|IFF_MULTICAST;
2687 }
2688
2689 static struct net_device *init_wifidev(struct airo_info *ai,
2690                                         struct net_device *ethdev)
2691 {
2692         int err;
2693         struct net_device *dev = alloc_netdev(0, "wifi%d", wifi_setup);
2694         if (!dev)
2695                 return NULL;
2696         dev->priv = ethdev->priv;
2697         dev->irq = ethdev->irq;
2698         dev->base_addr = ethdev->base_addr;
2699         dev->wireless_data = ethdev->wireless_data;
2700         memcpy(dev->dev_addr, ethdev->dev_addr, dev->addr_len);
2701         err = register_netdev(dev);
2702         if (err<0) {
2703                 free_netdev(dev);
2704                 return NULL;
2705         }
2706         return dev;
2707 }
2708
2709 static int reset_card( struct net_device *dev , int lock) {
2710         struct airo_info *ai = dev->priv;
2711
2712         if (lock && down_interruptible(&ai->sem))
2713                 return -1;
2714         waitbusy (ai);
2715         OUT4500(ai,COMMAND,CMD_SOFTRESET);
2716         msleep(200);
2717         waitbusy (ai);
2718         msleep(200);
2719         if (lock)
2720                 up(&ai->sem);
2721         return 0;
2722 }
2723
2724 #define AIRO_MAX_NETWORK_COUNT  64
2725 static int airo_networks_allocate(struct airo_info *ai)
2726 {
2727         if (ai->networks)
2728                 return 0;
2729
2730         ai->networks =
2731             kzalloc(AIRO_MAX_NETWORK_COUNT * sizeof(BSSListElement),
2732                     GFP_KERNEL);
2733         if (!ai->networks) {
2734                 airo_print_warn(ai->dev->name, "Out of memory allocating beacons");
2735                 return -ENOMEM;
2736         }
2737
2738         return 0;
2739 }
2740
2741 static void airo_networks_free(struct airo_info *ai)
2742 {
2743         kfree(ai->networks);
2744         ai->networks = NULL;
2745 }
2746
2747 static void airo_networks_initialize(struct airo_info *ai)
2748 {
2749         int i;
2750
2751         INIT_LIST_HEAD(&ai->network_free_list);
2752         INIT_LIST_HEAD(&ai->network_list);
2753         for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
2754                 list_add_tail(&ai->networks[i].list,
2755                               &ai->network_free_list);
2756 }
2757
2758 static int airo_test_wpa_capable(struct airo_info *ai)
2759 {
2760         int status;
2761         CapabilityRid cap_rid;
2762         const char *name = ai->dev->name;
2763
2764         status = readCapabilityRid(ai, &cap_rid, 1);
2765         if (status != SUCCESS) return 0;
2766
2767         /* Only firmware versions 5.30.17 or better can do WPA */
2768         if ((cap_rid.softVer > 0x530)
2769           || ((cap_rid.softVer == 0x530) && (cap_rid.softSubVer >= 17))) {
2770                 airo_print_info(name, "WPA is supported.");
2771                 return 1;
2772         }
2773
2774         /* No WPA support */
2775         airo_print_info(name, "WPA unsupported (only firmware versions 5.30.17"
2776                 " and greater support WPA.  Detected %s)", cap_rid.prodVer);
2777         return 0;
2778 }
2779
2780 static struct net_device *_init_airo_card( unsigned short irq, int port,
2781                                            int is_pcmcia, struct pci_dev *pci,
2782                                            struct device *dmdev )
2783 {
2784         struct net_device *dev;
2785         struct airo_info *ai;
2786         int i, rc;
2787
2788         /* Create the network device object. */
2789         dev = alloc_etherdev(sizeof(*ai));
2790         if (!dev) {
2791                 airo_print_err("", "Couldn't alloc_etherdev");
2792                 return NULL;
2793         }
2794         if (dev_alloc_name(dev, dev->name) < 0) {
2795                 airo_print_err("", "Couldn't get name!");
2796                 goto err_out_free;
2797         }
2798
2799         ai = dev->priv;
2800         ai->wifidev = NULL;
2801         ai->flags = 0;
2802         ai->jobs = 0;
2803         ai->dev = dev;
2804         if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
2805                 airo_print_dbg(dev->name, "Found an MPI350 card");
2806                 set_bit(FLAG_MPI, &ai->flags);
2807         }
2808         spin_lock_init(&ai->aux_lock);
2809         sema_init(&ai->sem, 1);
2810         ai->config.len = 0;
2811         ai->pci = pci;
2812         init_waitqueue_head (&ai->thr_wait);
2813         ai->airo_thread_task = kthread_run(airo_thread, dev, dev->name);
2814         if (IS_ERR(ai->airo_thread_task))
2815                 goto err_out_free;
2816         ai->tfm = NULL;
2817         rc = add_airo_dev( dev );
2818         if (rc)
2819                 goto err_out_thr;
2820
2821         if (airo_networks_allocate (ai))
2822                 goto err_out_unlink;
2823         airo_networks_initialize (ai);
2824
2825         /* The Airo-specific entries in the device structure. */
2826         if (test_bit(FLAG_MPI,&ai->flags)) {
2827                 skb_queue_head_init (&ai->txq);
2828                 dev->hard_start_xmit = &mpi_start_xmit;
2829         } else
2830                 dev->hard_start_xmit = &airo_start_xmit;
2831         dev->get_stats = &airo_get_stats;
2832         dev->set_multicast_list = &airo_set_multicast_list;
2833         dev->set_mac_address = &airo_set_mac_address;
2834         dev->do_ioctl = &airo_ioctl;
2835         dev->wireless_handlers = &airo_handler_def;
2836         ai->wireless_data.spy_data = &ai->spy_data;
2837         dev->wireless_data = &ai->wireless_data;
2838         dev->change_mtu = &airo_change_mtu;
2839         dev->open = &airo_open;
2840         dev->stop = &airo_close;
2841         dev->irq = irq;
2842         dev->base_addr = port;
2843
2844         SET_NETDEV_DEV(dev, dmdev);
2845
2846         reset_card (dev, 1);
2847         msleep(400);
2848
2849         rc = request_irq( dev->irq, airo_interrupt, IRQF_SHARED, dev->name, dev );
2850         if (rc) {
2851                 airo_print_err(dev->name, "register interrupt %d failed, rc %d",
2852                                 irq, rc);
2853                 goto err_out_nets;
2854         }
2855         if (!is_pcmcia) {
2856                 if (!request_region( dev->base_addr, 64, dev->name )) {
2857                         rc = -EBUSY;
2858                         airo_print_err(dev->name, "Couldn't request region");
2859                         goto err_out_irq;
2860                 }
2861         }
2862
2863         if (test_bit(FLAG_MPI,&ai->flags)) {
2864                 if (mpi_map_card(ai, pci, dev->name)) {
2865                         airo_print_err(dev->name, "Could not map memory");
2866                         goto err_out_res;
2867                 }
2868         }
2869
2870         if (probe) {
2871                 if ( setup_card( ai, dev->dev_addr, 1 ) != SUCCESS ) {
2872                         airo_print_err(dev->name, "MAC could not be enabled" );
2873                         rc = -EIO;
2874                         goto err_out_map;
2875                 }
2876         } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2877                 ai->bap_read = fast_bap_read;
2878                 set_bit(FLAG_FLASHING, &ai->flags);
2879         }
2880
2881         /* Test for WPA support */
2882         if (airo_test_wpa_capable(ai)) {
2883                 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2884                 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2885                 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2886                 ai->bssListRidLen = sizeof(BSSListRid);
2887         } else {
2888                 ai->bssListFirst = RID_BSSLISTFIRST;
2889                 ai->bssListNext = RID_BSSLISTNEXT;
2890                 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2891         }
2892
2893         rc = register_netdev(dev);
2894         if (rc) {
2895                 airo_print_err(dev->name, "Couldn't register_netdev");
2896                 goto err_out_map;
2897         }
2898         ai->wifidev = init_wifidev(ai, dev);
2899         if (!ai->wifidev)
2900                 goto err_out_reg;
2901
2902         set_bit(FLAG_REGISTERED,&ai->flags);
2903         airo_print_info(dev->name, "MAC enabled %x:%x:%x:%x:%x:%x",
2904                 dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2],
2905                 dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5] );
2906
2907         /* Allocate the transmit buffers */
2908         if (probe && !test_bit(FLAG_MPI,&ai->flags))
2909                 for( i = 0; i < MAX_FIDS; i++ )
2910                         ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2911
2912         if (setup_proc_entry(dev, dev->priv) < 0)
2913                 goto err_out_wifi;
2914
2915         netif_start_queue(dev);
2916         SET_MODULE_OWNER(dev);
2917         return dev;
2918
2919 err_out_wifi:
2920         unregister_netdev(ai->wifidev);
2921         free_netdev(ai->wifidev);
2922 err_out_reg:
2923         unregister_netdev(dev);
2924 err_out_map:
2925         if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2926                 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2927                 iounmap(ai->pciaux);
2928                 iounmap(ai->pcimem);
2929                 mpi_unmap_card(ai->pci);
2930         }
2931 err_out_res:
2932         if (!is_pcmcia)
2933                 release_region( dev->base_addr, 64 );
2934 err_out_irq:
2935         free_irq(dev->irq, dev);
2936 err_out_nets:
2937         airo_networks_free(ai);
2938 err_out_unlink:
2939         del_airo_dev(dev);
2940 err_out_thr:
2941         set_bit(JOB_DIE, &ai->jobs);
2942         kthread_stop(ai->airo_thread_task);
2943 err_out_free:
2944         free_netdev(dev);
2945         return NULL;
2946 }
2947
2948 struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2949                                   struct device *dmdev)
2950 {
2951         return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2952 }
2953
2954 EXPORT_SYMBOL(init_airo_card);
2955
2956 static int waitbusy (struct airo_info *ai) {
2957         int delay = 0;
2958         while ((IN4500 (ai, COMMAND) & COMMAND_BUSY) & (delay < 10000)) {
2959                 udelay (10);
2960                 if ((++delay % 20) == 0)
2961                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2962         }
2963         return delay < 10000;
2964 }
2965
2966 int reset_airo_card( struct net_device *dev )
2967 {
2968         int i;
2969         struct airo_info *ai = dev->priv;
2970
2971         if (reset_card (dev, 1))
2972                 return -1;
2973
2974         if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
2975                 airo_print_err(dev->name, "MAC could not be enabled");
2976                 return -1;
2977         }
2978         airo_print_info(dev->name, "MAC enabled %x:%x:%x:%x:%x:%x",
2979                         dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2],
2980                         dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5]);
2981         /* Allocate the transmit buffers if needed */
2982         if (!test_bit(FLAG_MPI,&ai->flags))
2983                 for( i = 0; i < MAX_FIDS; i++ )
2984                         ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2985
2986         enable_interrupts( ai );
2987         netif_wake_queue(dev);
2988         return 0;
2989 }
2990
2991 EXPORT_SYMBOL(reset_airo_card);
2992
2993 static void airo_send_event(struct net_device *dev) {
2994         struct airo_info *ai = dev->priv;
2995         union iwreq_data wrqu;
2996         StatusRid status_rid;
2997
2998         clear_bit(JOB_EVENT, &ai->jobs);
2999         PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
3000         up(&ai->sem);
3001         wrqu.data.length = 0;
3002         wrqu.data.flags = 0;
3003         memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
3004         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3005
3006         /* Send event to user space */
3007         wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
3008 }
3009
3010 static void airo_process_scan_results (struct airo_info *ai) {
3011         union iwreq_data        wrqu;
3012         BSSListRid bss;
3013         int rc;
3014         BSSListElement * loop_net;
3015         BSSListElement * tmp_net;
3016
3017         /* Blow away current list of scan results */
3018         list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
3019                 list_move_tail (&loop_net->list, &ai->network_free_list);
3020                 /* Don't blow away ->list, just BSS data */
3021                 memset (loop_net, 0, sizeof (loop_net->bss));
3022         }
3023
3024         /* Try to read the first entry of the scan result */
3025         rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
3026         if((rc) || (bss.index == 0xffff)) {
3027                 /* No scan results */
3028                 goto out;
3029         }
3030
3031         /* Read and parse all entries */
3032         tmp_net = NULL;
3033         while((!rc) && (bss.index != 0xffff)) {
3034                 /* Grab a network off the free list */
3035                 if (!list_empty(&ai->network_free_list)) {
3036                         tmp_net = list_entry(ai->network_free_list.next,
3037                                             BSSListElement, list);
3038                         list_del(ai->network_free_list.next);
3039                 }
3040
3041                 if (tmp_net != NULL) {
3042                         memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
3043                         list_add_tail(&tmp_net->list, &ai->network_list);
3044                         tmp_net = NULL;
3045                 }
3046
3047                 /* Read next entry */
3048                 rc = PC4500_readrid(ai, ai->bssListNext,
3049                                     &bss, ai->bssListRidLen, 0);
3050         }
3051
3052 out:
3053         ai->scan_timeout = 0;
3054         clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
3055         up(&ai->sem);
3056
3057         /* Send an empty event to user space.
3058          * We don't send the received data on
3059          * the event because it would require
3060          * us to do complex transcoding, and
3061          * we want to minimise the work done in
3062          * the irq handler. Use a request to
3063          * extract the data - Jean II */
3064         wrqu.data.length = 0;
3065         wrqu.data.flags = 0;
3066         wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3067 }
3068
3069 static int airo_thread(void *data) {
3070         struct net_device *dev = data;
3071         struct airo_info *ai = dev->priv;
3072         int locked;
3073
3074         while(1) {
3075                 /* make swsusp happy with our thread */
3076                 try_to_freeze();
3077
3078                 if (test_bit(JOB_DIE, &ai->jobs))
3079                         break;
3080
3081                 if (ai->jobs) {
3082                         locked = down_interruptible(&ai->sem);
3083                 } else {
3084                         wait_queue_t wait;
3085
3086                         init_waitqueue_entry(&wait, current);
3087                         add_wait_queue(&ai->thr_wait, &wait);
3088                         for (;;) {
3089                                 set_current_state(TASK_INTERRUPTIBLE);
3090                                 if (ai->jobs)
3091                                         break;
3092                                 if (ai->expires || ai->scan_timeout) {
3093                                         if (ai->scan_timeout &&
3094                                                         time_after_eq(jiffies,ai->scan_timeout)){
3095                                                 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
3096                                                 break;
3097                                         } else if (ai->expires &&
3098                                                         time_after_eq(jiffies,ai->expires)){
3099                                                 set_bit(JOB_AUTOWEP, &ai->jobs);
3100                                                 break;
3101                                         }
3102                                         if (!kthread_should_stop() &&
3103                                             !freezing(current)) {
3104                                                 unsigned long wake_at;
3105                                                 if (!ai->expires || !ai->scan_timeout) {
3106                                                         wake_at = max(ai->expires,
3107                                                                 ai->scan_timeout);
3108                                                 } else {
3109                                                         wake_at = min(ai->expires,
3110                                                                 ai->scan_timeout);
3111                                                 }
3112                                                 schedule_timeout(wake_at - jiffies);
3113                                                 continue;
3114                                         }
3115                                 } else if (!kthread_should_stop() &&
3116                                            !freezing(current)) {
3117                                         schedule();
3118                                         continue;
3119                                 }
3120                                 break;
3121                         }
3122                         current->state = TASK_RUNNING;
3123                         remove_wait_queue(&ai->thr_wait, &wait);
3124                         locked = 1;
3125                 }
3126
3127                 if (locked)
3128                         continue;
3129
3130                 if (test_bit(JOB_DIE, &ai->jobs)) {
3131                         up(&ai->sem);
3132                         break;
3133                 }
3134
3135                 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
3136                         up(&ai->sem);
3137                         continue;
3138                 }
3139
3140                 if (test_bit(JOB_XMIT, &ai->jobs))
3141                         airo_end_xmit(dev);
3142                 else if (test_bit(JOB_XMIT11, &ai->jobs))
3143                         airo_end_xmit11(dev);
3144                 else if (test_bit(JOB_STATS, &ai->jobs))
3145                         airo_read_stats(ai);
3146                 else if (test_bit(JOB_WSTATS, &ai->jobs))
3147                         airo_read_wireless_stats(ai);
3148                 else if (test_bit(JOB_PROMISC, &ai->jobs))
3149                         airo_set_promisc(ai);
3150                 else if (test_bit(JOB_MIC, &ai->jobs))
3151                         micinit(ai);
3152                 else if (test_bit(JOB_EVENT, &ai->jobs))
3153                         airo_send_event(dev);
3154                 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
3155                         timer_func(dev);
3156                 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
3157                         airo_process_scan_results(ai);
3158                 else  /* Shouldn't get here, but we make sure to unlock */
3159                         up(&ai->sem);
3160         }
3161
3162         return 0;
3163 }
3164
3165 static irqreturn_t airo_interrupt ( int irq, void* dev_id) {
3166         struct net_device *dev = (struct net_device *)dev_id;
3167         u16 status;
3168         u16 fid;
3169         struct airo_info *apriv = dev->priv;
3170         u16 savedInterrupts = 0;
3171         int handled = 0;
3172
3173         if (!netif_device_present(dev))
3174                 return IRQ_NONE;
3175
3176         for (;;) {
3177                 status = IN4500( apriv, EVSTAT );
3178                 if ( !(status & STATUS_INTS) || status == 0xffff ) break;
3179
3180                 handled = 1;
3181
3182                 if ( status & EV_AWAKE ) {
3183                         OUT4500( apriv, EVACK, EV_AWAKE );
3184                         OUT4500( apriv, EVACK, EV_AWAKE );
3185                 }
3186
3187                 if (!savedInterrupts) {
3188                         savedInterrupts = IN4500( apriv, EVINTEN );
3189                         OUT4500( apriv, EVINTEN, 0 );
3190                 }
3191
3192                 if ( status & EV_MIC ) {
3193                         OUT4500( apriv, EVACK, EV_MIC );
3194                         if (test_bit(FLAG_MIC_CAPABLE, &apriv->flags)) {
3195                                 set_bit(JOB_MIC, &apriv->jobs);
3196                                 wake_up_interruptible(&apriv->thr_wait);
3197                         }
3198                 }
3199                 if ( status & EV_LINK ) {
3200                         union iwreq_data        wrqu;
3201                         int scan_forceloss = 0;
3202                         /* The link status has changed, if you want to put a
3203                            monitor hook in, do it here.  (Remember that
3204                            interrupts are still disabled!)
3205                         */
3206                         u16 newStatus = IN4500(apriv, LINKSTAT);
3207                         OUT4500( apriv, EVACK, EV_LINK);
3208                         /* Here is what newStatus means: */
3209 #define NOBEACON 0x8000 /* Loss of sync - missed beacons */
3210 #define MAXRETRIES 0x8001 /* Loss of sync - max retries */
3211 #define MAXARL 0x8002 /* Loss of sync - average retry level exceeded*/
3212 #define FORCELOSS 0x8003 /* Loss of sync - host request */
3213 #define TSFSYNC 0x8004 /* Loss of sync - TSF synchronization */
3214 #define DEAUTH 0x8100 /* Deauthentication (low byte is reason code) */
3215 #define DISASS 0x8200 /* Disassociation (low byte is reason code) */
3216 #define ASSFAIL 0x8400 /* Association failure (low byte is reason
3217                           code) */
3218 #define AUTHFAIL 0x0300 /* Authentication failure (low byte is reason
3219                            code) */
3220 #define ASSOCIATED 0x0400 /* Associated */
3221 #define REASSOCIATED 0x0600 /* Reassociated?  Only on firmware >= 5.30.17 */
3222 #define RC_RESERVED 0 /* Reserved return code */
3223 #define RC_NOREASON 1 /* Unspecified reason */
3224 #define RC_AUTHINV 2 /* Previous authentication invalid */
3225 #define RC_DEAUTH 3 /* Deauthenticated because sending station is
3226                        leaving */
3227 #define RC_NOACT 4 /* Disassociated due to inactivity */
3228 #define RC_MAXLOAD 5 /* Disassociated because AP is unable to handle
3229                         all currently associated stations */
3230 #define RC_BADCLASS2 6 /* Class 2 frame received from
3231                           non-Authenticated station */
3232 #define RC_BADCLASS3 7 /* Class 3 frame received from
3233                           non-Associated station */
3234 #define RC_STATLEAVE 8 /* Disassociated because sending station is
3235                           leaving BSS */
3236 #define RC_NOAUTH 9 /* Station requesting (Re)Association is not
3237                        Authenticated with the responding station */
3238                         if (newStatus == FORCELOSS && apriv->scan_timeout > 0)
3239                                 scan_forceloss = 1;
3240                         if(newStatus == ASSOCIATED || newStatus == REASSOCIATED) {
3241                                 if (auto_wep)
3242                                         apriv->expires = 0;
3243                                 if (apriv->list_bss_task)
3244                                         wake_up_process(apriv->list_bss_task);
3245                                 set_bit(FLAG_UPDATE_UNI, &apriv->flags);
3246                                 set_bit(FLAG_UPDATE_MULTI, &apriv->flags);
3247
3248                                 if (down_trylock(&apriv->sem) != 0) {
3249                                         set_bit(JOB_EVENT, &apriv->jobs);
3250                                         wake_up_interruptible(&apriv->thr_wait);
3251                                 } else
3252                                         airo_send_event(dev);
3253                         } else if (!scan_forceloss) {
3254                                 if (auto_wep && !apriv->expires) {
3255                                         apriv->expires = RUN_AT(3*HZ);
3256                                         wake_up_interruptible(&apriv->thr_wait);
3257                                 }
3258
3259                                 /* Send event to user space */
3260                                 memset(wrqu.ap_addr.sa_data, '\0', ETH_ALEN);
3261                                 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3262                                 wireless_send_event(dev, SIOCGIWAP, &wrqu,NULL);
3263                         }
3264                 }
3265
3266                 /* Check to see if there is something to receive */
3267                 if ( status & EV_RX  ) {
3268                         struct sk_buff *skb = NULL;
3269                         u16 fc, len, hdrlen = 0;
3270 #pragma pack(1)
3271                         struct {
3272                                 u16 status, len;
3273                                 u8 rssi[2];
3274                                 u8 rate;
3275                                 u8 freq;
3276                                 u16 tmp[4];
3277                         } hdr;
3278 #pragma pack()
3279                         u16 gap;
3280                         u16 tmpbuf[4];
3281                         u16 *buffer;
3282
3283                         if (test_bit(FLAG_MPI,&apriv->flags)) {
3284                                 if (test_bit(FLAG_802_11, &apriv->flags))
3285                                         mpi_receive_802_11(apriv);
3286                                 else
3287                                         mpi_receive_802_3(apriv);
3288                                 OUT4500(apriv, EVACK, EV_RX);
3289                                 goto exitrx;
3290                         }
3291
3292                         fid = IN4500( apriv, RXFID );
3293
3294                         /* Get the packet length */
3295                         if (test_bit(FLAG_802_11, &apriv->flags)) {
3296                                 bap_setup (apriv, fid, 4, BAP0);
3297                                 bap_read (apriv, (u16*)&hdr, sizeof(hdr), BAP0);
3298                                 /* Bad CRC. Ignore packet */
3299                                 if (le16_to_cpu(hdr.status) & 2)
3300                                         hdr.len = 0;
3301                                 if (apriv->wifidev == NULL)
3302                                         hdr.len = 0;
3303                         } else {
3304                                 bap_setup (apriv, fid, 0x36, BAP0);
3305                                 bap_read (apriv, (u16*)&hdr.len, 2, BAP0);
3306                         }
3307                         len = le16_to_cpu(hdr.len);
3308
3309                         if (len > AIRO_DEF_MTU) {
3310                                 airo_print_err(apriv->dev->name, "Bad size %d", len);
3311                                 goto badrx;
3312                         }
3313                         if (len == 0)
3314                                 goto badrx;
3315
3316                         if (test_bit(FLAG_802_11, &apriv->flags)) {
3317                                 bap_read (apriv, (u16*)&fc, sizeof(fc), BAP0);
3318                                 fc = le16_to_cpu(fc);
3319                                 switch (fc & 0xc) {
3320                                         case 4:
3321                                                 if ((fc & 0xe0) == 0xc0)
3322                                                         hdrlen = 10;
3323                                                 else
3324                                                         hdrlen = 16;
3325                                                 break;
3326                                         case 8:
3327                                                 if ((fc&0x300)==0x300){
3328                                                         hdrlen = 30;
3329                                                         break;
3330                                                 }
3331                                         default:
3332                                                 hdrlen = 24;
3333                                 }
3334                         } else
3335                                 hdrlen = ETH_ALEN * 2;
3336
3337                         skb = dev_alloc_skb( len + hdrlen + 2 + 2 );
3338                         if ( !skb ) {
3339                                 apriv->stats.rx_dropped++;
3340                                 goto badrx;
3341                         }
3342                         skb_reserve(skb, 2); /* This way the IP header is aligned */
3343                         buffer = (u16*)skb_put (skb, len + hdrlen);
3344                         if (test_bit(FLAG_802_11, &apriv->flags)) {
3345                                 buffer[0] = fc;
3346                                 bap_read (apriv, buffer + 1, hdrlen - 2, BAP0);
3347                                 if (hdrlen == 24)
3348                                         bap_read (apriv, tmpbuf, 6, BAP0);
3349
3350                                 bap_read (apriv, &gap, sizeof(gap), BAP0);
3351                                 gap = le16_to_cpu(gap);
3352                                 if (gap) {
3353                                         if (gap <= 8) {
3354                                                 bap_read (apriv, tmpbuf, gap, BAP0);
3355                                         } else {
3356                                                 airo_print_err(apriv->dev->name, "gaplen too "
3357                                                         "big. Problems will follow...");
3358                                         }
3359                                 }
3360                                 bap_read (apriv, buffer + hdrlen/2, len, BAP0);
3361                         } else {
3362                                 MICBuffer micbuf;
3363                                 bap_read (apriv, buffer, ETH_ALEN*2, BAP0);
3364                                 if (apriv->micstats.enabled) {
3365                                         bap_read (apriv,(u16*)&micbuf,sizeof(micbuf),BAP0);
3366                                         if (ntohs(micbuf.typelen) > 0x05DC)
3367                                                 bap_setup (apriv, fid, 0x44, BAP0);
3368                                         else {
3369                                                 if (len <= sizeof(micbuf))
3370                                                         goto badmic;
3371
3372                                                 len -= sizeof(micbuf);
3373                                                 skb_trim (skb, len + hdrlen);
3374                                         }
3375                                 }
3376                                 bap_read(apriv,buffer+ETH_ALEN,len,BAP0);
3377                                 if (decapsulate(apriv,&micbuf,(etherHead*)buffer,len)) {
3378 badmic:
3379                                         dev_kfree_skb_irq (skb);
3380 badrx:
3381                                         OUT4500( apriv, EVACK, EV_RX);
3382                                         goto exitrx;
3383                                 }
3384                         }
3385 #ifdef WIRELESS_SPY
3386                         if (apriv->spy_data.spy_number > 0) {
3387                                 char *sa;
3388                                 struct iw_quality wstats;
3389                                 /* Prepare spy data : addr + qual */
3390                                 if (!test_bit(FLAG_802_11, &apriv->flags)) {
3391                                         sa = (char*)buffer + 6;
3392                                         bap_setup (apriv, fid, 8, BAP0);
3393                                         bap_read (apriv, (u16*)hdr.rssi, 2, BAP0);
3394                                 } else
3395                                         sa = (char*)buffer + 10;
3396                                 wstats.qual = hdr.rssi[0];
3397                                 if (apriv->rssi)
3398                                         wstats.level = 0x100 - apriv->rssi[hdr.rssi[1]].rssidBm;
3399                                 else
3400                                         wstats.level = (hdr.rssi[1] + 321) / 2;
3401                                 wstats.noise = apriv->wstats.qual.noise;
3402                                 wstats.updated = IW_QUAL_LEVEL_UPDATED
3403                                         | IW_QUAL_QUAL_UPDATED
3404                                         | IW_QUAL_DBM;
3405                                 /* Update spy records */
3406                                 wireless_spy_update(dev, sa, &wstats);
3407                         }
3408 #endif /* WIRELESS_SPY */
3409                         OUT4500( apriv, EVACK, EV_RX);
3410
3411                         if (test_bit(FLAG_802_11, &apriv->flags)) {
3412                                 skb_reset_mac_header(skb);
3413                                 skb->pkt_type = PACKET_OTHERHOST;
3414                                 skb->dev = apriv->wifidev;
3415                                 skb->protocol = htons(ETH_P_802_2);
3416                         } else
3417                                 skb->protocol = eth_type_trans(skb,dev);
3418                         skb->dev->last_rx = jiffies;
3419                         skb->ip_summed = CHECKSUM_NONE;
3420
3421                         netif_rx( skb );
3422                 }
3423 exitrx:
3424
3425                 /* Check to see if a packet has been transmitted */
3426                 if (  status & ( EV_TX|EV_TXCPY|EV_TXEXC ) ) {
3427                         int i;
3428                         int len = 0;
3429                         int index = -1;
3430
3431                         if (test_bit(FLAG_MPI,&apriv->flags)) {
3432                                 unsigned long flags;
3433
3434                                 if (status & EV_TXEXC)
3435                                         get_tx_error(apriv, -1);
3436                                 spin_lock_irqsave(&apriv->aux_lock, flags);
3437                                 if (!skb_queue_empty(&apriv->txq)) {
3438                                         spin_unlock_irqrestore(&apriv->aux_lock,flags);
3439                                         mpi_send_packet (dev);
3440                                 } else {
3441                                         clear_bit(FLAG_PENDING_XMIT, &apriv->flags);
3442                                         spin_unlock_irqrestore(&apriv->aux_lock,flags);
3443                                         netif_wake_queue (dev);
3444                                 }
3445                                 OUT4500( apriv, EVACK,
3446                                         status & (EV_TX|EV_TXCPY|EV_TXEXC));
3447                                 goto exittx;
3448                         }
3449
3450                         fid = IN4500(apriv, TXCOMPLFID);
3451
3452                         for( i = 0; i < MAX_FIDS; i++ ) {
3453                                 if ( ( apriv->fids[i] & 0xffff ) == fid ) {
3454                                         len = apriv->fids[i] >> 16;
3455                                         index = i;
3456                                 }
3457                         }
3458                         if (index != -1) {
3459                                 if (status & EV_TXEXC)
3460                                         get_tx_error(apriv, index);
3461                                 OUT4500( apriv, EVACK, status & (EV_TX | EV_TXEXC));
3462                                 /* Set up to be used again */
3463                                 apriv->fids[index] &= 0xffff;
3464                                 if (index < MAX_FIDS / 2) {
3465                                         if (!test_bit(FLAG_PENDING_XMIT, &apriv->flags))
3466                                                 netif_wake_queue(dev);
3467                                 } else {
3468                                         if (!test_bit(FLAG_PENDING_XMIT11, &apriv->flags))
3469                                                 netif_wake_queue(apriv->wifidev);
3470                                 }
3471                         } else {
3472                                 OUT4500( apriv, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3473                                 airo_print_err(apriv->dev->name, "Unallocated FID was "
3474                                         "used to xmit" );
3475                         }
3476                 }
3477 exittx:
3478                 if ( status & ~STATUS_INTS & ~IGNORE_INTS )
3479                         airo_print_warn(apriv->dev->name, "Got weird status %x",
3480                                 status & ~STATUS_INTS & ~IGNORE_INTS );
3481         }
3482
3483         if (savedInterrupts)
3484                 OUT4500( apriv, EVINTEN, savedInterrupts );
3485
3486         /* done.. */
3487         return IRQ_RETVAL(handled);
3488 }
3489
3490 /*
3491  *  Routines to talk to the card
3492  */
3493
3494 /*
3495  *  This was originally written for the 4500, hence the name
3496  *  NOTE:  If use with 8bit mode and SMP bad things will happen!
3497  *         Why would some one do 8 bit IO in an SMP machine?!?
3498  */
3499 static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3500         if (test_bit(FLAG_MPI,&ai->flags))
3501                 reg <<= 1;
3502         if ( !do8bitIO )
3503                 outw( val, ai->dev->base_addr + reg );
3504         else {
3505                 outb( val & 0xff, ai->dev->base_addr + reg );
3506                 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3507         }
3508 }
3509
3510 static u16 IN4500( struct airo_info *ai, u16 reg ) {
3511         unsigned short rc;
3512
3513         if (test_bit(FLAG_MPI,&ai->flags))
3514                 reg <<= 1;
3515         if ( !do8bitIO )
3516                 rc = inw( ai->dev->base_addr + reg );
3517         else {
3518                 rc = inb( ai->dev->base_addr + reg );
3519                 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3520         }
3521         return rc;
3522 }
3523
3524 static int enable_MAC( struct airo_info *ai, Resp *rsp, int lock ) {
3525         int rc;
3526         Cmd cmd;
3527
3528         /* FLAG_RADIO_OFF : Radio disabled via /proc or Wireless Extensions
3529          * FLAG_RADIO_DOWN : Radio disabled via "ifconfig ethX down"
3530          * Note : we could try to use !netif_running(dev) in enable_MAC()
3531          * instead of this flag, but I don't trust it *within* the
3532          * open/close functions, and testing both flags together is
3533          * "cheaper" - Jean II */
3534         if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3535
3536         if (lock && down_interruptible(&ai->sem))
3537                 return -ERESTARTSYS;
3538
3539         if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3540                 memset(&cmd, 0, sizeof(cmd));
3541                 cmd.cmd = MAC_ENABLE;
3542                 rc = issuecommand(ai, &cmd, rsp);
3543                 if (rc == SUCCESS)
3544                         set_bit(FLAG_ENABLED, &ai->flags);
3545         } else
3546                 rc = SUCCESS;
3547
3548         if (lock)
3549             up(&ai->sem);
3550
3551         if (rc)
3552                 airo_print_err(ai->dev->name, "%s: Cannot enable MAC, err=%d",
3553                         __FUNCTION__, rc);
3554         return rc;
3555 }
3556
3557 static void disable_MAC( struct airo_info *ai, int lock ) {
3558         Cmd cmd;
3559         Resp rsp;
3560
3561         if (lock && down_interruptible(&ai->sem))
3562                 return;
3563
3564         if (test_bit(FLAG_ENABLED, &ai->flags)) {
3565                 memset(&cmd, 0, sizeof(cmd));
3566                 cmd.cmd = MAC_DISABLE; // disable in case already enabled
3567                 issuecommand(ai, &cmd, &rsp);
3568                 clear_bit(FLAG_ENABLED, &ai->flags);
3569         }
3570         if (lock)
3571                 up(&ai->sem);
3572 }
3573
3574 static void enable_interrupts( struct airo_info *ai ) {
3575         /* Enable the interrupts */
3576         OUT4500( ai, EVINTEN, STATUS_INTS );
3577 }
3578
3579 static void disable_interrupts( struct airo_info *ai ) {
3580         OUT4500( ai, EVINTEN, 0 );
3581 }
3582
3583 static void mpi_receive_802_3(struct airo_info *ai)
3584 {
3585         RxFid rxd;
3586         int len = 0;
3587         struct sk_buff *skb;
3588         char *buffer;
3589         int off = 0;
3590         MICBuffer micbuf;
3591
3592         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3593         /* Make sure we got something */
3594         if (rxd.rdy && rxd.valid == 0) {
3595                 len = rxd.len + 12;
3596                 if (len < 12 || len > 2048)
3597                         goto badrx;
3598
3599                 skb = dev_alloc_skb(len);
3600                 if (!skb) {
3601                         ai->stats.rx_dropped++;
3602                         goto badrx;
3603                 }
3604                 buffer = skb_put(skb,len);
3605                 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3606                 if (ai->micstats.enabled) {
3607                         memcpy(&micbuf,
3608                                 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3609                                 sizeof(micbuf));
3610                         if (ntohs(micbuf.typelen) <= 0x05DC) {
3611                                 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3612                                         goto badmic;
3613
3614                                 off = sizeof(micbuf);
3615                                 skb_trim (skb, len - off);
3616                         }
3617                 }
3618                 memcpy(buffer + ETH_ALEN * 2,
3619                         ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3620                         len - ETH_ALEN * 2 - off);
3621                 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3622 badmic:
3623                         dev_kfree_skb_irq (skb);
3624                         goto badrx;
3625                 }
3626 #ifdef WIRELESS_SPY
3627                 if (ai->spy_data.spy_number > 0) {
3628                         char *sa;
3629                         struct iw_quality wstats;
3630                         /* Prepare spy data : addr + qual */
3631                         sa = buffer + ETH_ALEN;
3632                         wstats.qual = 0; /* XXX Where do I get that info from ??? */
3633                         wstats.level = 0;
3634                         wstats.updated = 0;
3635                         /* Update spy records */
3636                         wireless_spy_update(ai->dev, sa, &wstats);
3637                 }
3638 #endif /* WIRELESS_SPY */
3639
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_reset_mac_header(skb);
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 const struct file_operations proc_statsdelta_ops = {
4431         .read           = proc_read,
4432         .open           = proc_statsdelta_open,
4433         .release        = proc_close
4434 };
4435
4436 static const struct file_operations proc_stats_ops = {
4437         .read           = proc_read,
4438         .open           = proc_stats_open,
4439         .release        = proc_close
4440 };
4441
4442 static const struct file_operations proc_status_ops = {
4443         .read           = proc_read,
4444         .open           = proc_status_open,
4445         .release        = proc_close
4446 };
4447
4448 static const 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 const 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 const 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 const 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 const 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);