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