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