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         int                           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 int mpi_start_xmit(struct sk_buff *skb, struct net_device *dev) {
1924         int npacks, pending;
1925         unsigned long flags;
1926         struct airo_info *ai = dev->ml_priv;
1927
1928         if (!skb) {
1929                 airo_print_err(dev->name, "%s: skb == NULL!",__func__);
1930                 return 0;
1931         }
1932         npacks = skb_queue_len (&ai->txq);
1933
1934         if (npacks >= MAXTXQ - 1) {
1935                 netif_stop_queue (dev);
1936                 if (npacks > MAXTXQ) {
1937                         dev->stats.tx_fifo_errors++;
1938                         return 1;
1939                 }
1940                 skb_queue_tail (&ai->txq, skb);
1941                 return 0;
1942         }
1943
1944         spin_lock_irqsave(&ai->aux_lock, flags);
1945         skb_queue_tail (&ai->txq, skb);
1946         pending = test_bit(FLAG_PENDING_XMIT, &ai->flags);
1947         spin_unlock_irqrestore(&ai->aux_lock,flags);
1948         netif_wake_queue (dev);
1949
1950         if (pending == 0) {
1951                 set_bit(FLAG_PENDING_XMIT, &ai->flags);
1952                 mpi_send_packet (dev);
1953         }
1954         return 0;
1955 }
1956
1957 /*
1958  * @mpi_send_packet
1959  *
1960  * Attempt to transmit a packet. Can be called from interrupt
1961  * or transmit . return number of packets we tried to send
1962  */
1963
1964 static int mpi_send_packet (struct net_device *dev)
1965 {
1966         struct sk_buff *skb;
1967         unsigned char *buffer;
1968         s16 len;
1969         __le16 *payloadLen;
1970         struct airo_info *ai = dev->ml_priv;
1971         u8 *sendbuf;
1972
1973         /* get a packet to send */
1974
1975         if ((skb = skb_dequeue(&ai->txq)) == NULL) {
1976                 airo_print_err(dev->name,
1977                         "%s: Dequeue'd zero in send_packet()",
1978                         __func__);
1979                 return 0;
1980         }
1981
1982         /* check min length*/
1983         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
1984         buffer = skb->data;
1985
1986         ai->txfids[0].tx_desc.offset = 0;
1987         ai->txfids[0].tx_desc.valid = 1;
1988         ai->txfids[0].tx_desc.eoc = 1;
1989         ai->txfids[0].tx_desc.len =len+sizeof(WifiHdr);
1990
1991 /*
1992  * Magic, the cards firmware needs a length count (2 bytes) in the host buffer
1993  * right after  TXFID_HDR.The TXFID_HDR contains the status short so payloadlen
1994  * is immediatly after it. ------------------------------------------------
1995  *                         |TXFIDHDR+STATUS|PAYLOADLEN|802.3HDR|PACKETDATA|
1996  *                         ------------------------------------------------
1997  */
1998
1999         memcpy((char *)ai->txfids[0].virtual_host_addr,
2000                 (char *)&wifictlhdr8023, sizeof(wifictlhdr8023));
2001
2002         payloadLen = (__le16 *)(ai->txfids[0].virtual_host_addr +
2003                 sizeof(wifictlhdr8023));
2004         sendbuf = ai->txfids[0].virtual_host_addr +
2005                 sizeof(wifictlhdr8023) + 2 ;
2006
2007         /*
2008          * Firmware automaticly puts 802 header on so
2009          * we don't need to account for it in the length
2010          */
2011         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
2012                 (ntohs(((__be16 *)buffer)[6]) != 0x888E)) {
2013                 MICBuffer pMic;
2014
2015                 if (encapsulate(ai, (etherHead *)buffer, &pMic, len - sizeof(etherHead)) != SUCCESS)
2016                         return ERROR;
2017
2018                 *payloadLen = cpu_to_le16(len-sizeof(etherHead)+sizeof(pMic));
2019                 ai->txfids[0].tx_desc.len += sizeof(pMic);
2020                 /* copy data into airo dma buffer */
2021                 memcpy (sendbuf, buffer, sizeof(etherHead));
2022                 buffer += sizeof(etherHead);
2023                 sendbuf += sizeof(etherHead);
2024                 memcpy (sendbuf, &pMic, sizeof(pMic));
2025                 sendbuf += sizeof(pMic);
2026                 memcpy (sendbuf, buffer, len - sizeof(etherHead));
2027         } else {
2028                 *payloadLen = cpu_to_le16(len - sizeof(etherHead));
2029
2030                 dev->trans_start = jiffies;
2031
2032                 /* copy data into airo dma buffer */
2033                 memcpy(sendbuf, buffer, len);
2034         }
2035
2036         memcpy_toio(ai->txfids[0].card_ram_off,
2037                 &ai->txfids[0].tx_desc, sizeof(TxFid));
2038
2039         OUT4500(ai, EVACK, 8);
2040
2041         dev_kfree_skb_any(skb);
2042         return 1;
2043 }
2044
2045 static void get_tx_error(struct airo_info *ai, s32 fid)
2046 {
2047         __le16 status;
2048
2049         if (fid < 0)
2050                 status = ((WifiCtlHdr *)ai->txfids[0].virtual_host_addr)->ctlhdr.status;
2051         else {
2052                 if (bap_setup(ai, ai->fids[fid] & 0xffff, 4, BAP0) != SUCCESS)
2053                         return;
2054                 bap_read(ai, &status, 2, BAP0);
2055         }
2056         if (le16_to_cpu(status) & 2) /* Too many retries */
2057                 ai->dev->stats.tx_aborted_errors++;
2058         if (le16_to_cpu(status) & 4) /* Transmit lifetime exceeded */
2059                 ai->dev->stats.tx_heartbeat_errors++;
2060         if (le16_to_cpu(status) & 8) /* Aid fail */
2061                 { }
2062         if (le16_to_cpu(status) & 0x10) /* MAC disabled */
2063                 ai->dev->stats.tx_carrier_errors++;
2064         if (le16_to_cpu(status) & 0x20) /* Association lost */
2065                 { }
2066         /* We produce a TXDROP event only for retry or lifetime
2067          * exceeded, because that's the only status that really mean
2068          * that this particular node went away.
2069          * Other errors means that *we* screwed up. - Jean II */
2070         if ((le16_to_cpu(status) & 2) ||
2071              (le16_to_cpu(status) & 4)) {
2072                 union iwreq_data        wrqu;
2073                 char junk[0x18];
2074
2075                 /* Faster to skip over useless data than to do
2076                  * another bap_setup(). We are at offset 0x6 and
2077                  * need to go to 0x18 and read 6 bytes - Jean II */
2078                 bap_read(ai, (__le16 *) junk, 0x18, BAP0);
2079
2080                 /* Copy 802.11 dest address.
2081                  * We use the 802.11 header because the frame may
2082                  * not be 802.3 or may be mangled...
2083                  * In Ad-Hoc mode, it will be the node address.
2084                  * In managed mode, it will be most likely the AP addr
2085                  * User space will figure out how to convert it to
2086                  * whatever it needs (IP address or else).
2087                  * - Jean II */
2088                 memcpy(wrqu.addr.sa_data, junk + 0x12, ETH_ALEN);
2089                 wrqu.addr.sa_family = ARPHRD_ETHER;
2090
2091                 /* Send event to user space */
2092                 wireless_send_event(ai->dev, IWEVTXDROP, &wrqu, NULL);
2093         }
2094 }
2095
2096 static void airo_end_xmit(struct net_device *dev) {
2097         u16 status;
2098         int i;
2099         struct airo_info *priv = dev->ml_priv;
2100         struct sk_buff *skb = priv->xmit.skb;
2101         int fid = priv->xmit.fid;
2102         u32 *fids = priv->fids;
2103
2104         clear_bit(JOB_XMIT, &priv->jobs);
2105         clear_bit(FLAG_PENDING_XMIT, &priv->flags);
2106         status = transmit_802_3_packet (priv, fids[fid], skb->data);
2107         up(&priv->sem);
2108
2109         i = 0;
2110         if ( status == SUCCESS ) {
2111                 dev->trans_start = jiffies;
2112                 for (; i < MAX_FIDS / 2 && (priv->fids[i] & 0xffff0000); i++);
2113         } else {
2114                 priv->fids[fid] &= 0xffff;
2115                 dev->stats.tx_window_errors++;
2116         }
2117         if (i < MAX_FIDS / 2)
2118                 netif_wake_queue(dev);
2119         dev_kfree_skb(skb);
2120 }
2121
2122 static int airo_start_xmit(struct sk_buff *skb, struct net_device *dev) {
2123         s16 len;
2124         int i, j;
2125         struct airo_info *priv = dev->ml_priv;
2126         u32 *fids = priv->fids;
2127
2128         if ( skb == NULL ) {
2129                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2130                 return 0;
2131         }
2132
2133         /* Find a vacant FID */
2134         for( i = 0; i < MAX_FIDS / 2 && (fids[i] & 0xffff0000); i++ );
2135         for( j = i + 1; j < MAX_FIDS / 2 && (fids[j] & 0xffff0000); j++ );
2136
2137         if ( j >= MAX_FIDS / 2 ) {
2138                 netif_stop_queue(dev);
2139
2140                 if (i == MAX_FIDS / 2) {
2141                         dev->stats.tx_fifo_errors++;
2142                         return 1;
2143                 }
2144         }
2145         /* check min length*/
2146         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2147         /* Mark fid as used & save length for later */
2148         fids[i] |= (len << 16);
2149         priv->xmit.skb = skb;
2150         priv->xmit.fid = i;
2151         if (down_trylock(&priv->sem) != 0) {
2152                 set_bit(FLAG_PENDING_XMIT, &priv->flags);
2153                 netif_stop_queue(dev);
2154                 set_bit(JOB_XMIT, &priv->jobs);
2155                 wake_up_interruptible(&priv->thr_wait);
2156         } else
2157                 airo_end_xmit(dev);
2158         return 0;
2159 }
2160
2161 static void airo_end_xmit11(struct net_device *dev) {
2162         u16 status;
2163         int i;
2164         struct airo_info *priv = dev->ml_priv;
2165         struct sk_buff *skb = priv->xmit11.skb;
2166         int fid = priv->xmit11.fid;
2167         u32 *fids = priv->fids;
2168
2169         clear_bit(JOB_XMIT11, &priv->jobs);
2170         clear_bit(FLAG_PENDING_XMIT11, &priv->flags);
2171         status = transmit_802_11_packet (priv, fids[fid], skb->data);
2172         up(&priv->sem);
2173
2174         i = MAX_FIDS / 2;
2175         if ( status == SUCCESS ) {
2176                 dev->trans_start = jiffies;
2177                 for (; i < MAX_FIDS && (priv->fids[i] & 0xffff0000); i++);
2178         } else {
2179                 priv->fids[fid] &= 0xffff;
2180                 dev->stats.tx_window_errors++;
2181         }
2182         if (i < MAX_FIDS)
2183                 netif_wake_queue(dev);
2184         dev_kfree_skb(skb);
2185 }
2186
2187 static int airo_start_xmit11(struct sk_buff *skb, struct net_device *dev) {
2188         s16 len;
2189         int i, j;
2190         struct airo_info *priv = dev->ml_priv;
2191         u32 *fids = priv->fids;
2192
2193         if (test_bit(FLAG_MPI, &priv->flags)) {
2194                 /* Not implemented yet for MPI350 */
2195                 netif_stop_queue(dev);
2196                 return -ENETDOWN;
2197         }
2198
2199         if ( skb == NULL ) {
2200                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2201                 return 0;
2202         }
2203
2204         /* Find a vacant FID */
2205         for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2206         for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2207
2208         if ( j >= MAX_FIDS ) {
2209                 netif_stop_queue(dev);
2210
2211                 if (i == MAX_FIDS) {
2212                         dev->stats.tx_fifo_errors++;
2213                         return 1;
2214                 }
2215         }
2216         /* check min length*/
2217         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2218         /* Mark fid as used & save length for later */
2219         fids[i] |= (len << 16);
2220         priv->xmit11.skb = skb;
2221         priv->xmit11.fid = i;
2222         if (down_trylock(&priv->sem) != 0) {
2223                 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2224                 netif_stop_queue(dev);
2225                 set_bit(JOB_XMIT11, &priv->jobs);
2226                 wake_up_interruptible(&priv->thr_wait);
2227         } else
2228                 airo_end_xmit11(dev);
2229         return 0;
2230 }
2231
2232 static void airo_read_stats(struct net_device *dev)
2233 {
2234         struct airo_info *ai = dev->ml_priv;
2235         StatsRid stats_rid;
2236         __le32 *vals = stats_rid.vals;
2237
2238         clear_bit(JOB_STATS, &ai->jobs);
2239         if (ai->power.event) {
2240                 up(&ai->sem);
2241                 return;
2242         }
2243         readStatsRid(ai, &stats_rid, RID_STATS, 0);
2244         up(&ai->sem);
2245
2246         dev->stats.rx_packets = le32_to_cpu(vals[43]) + le32_to_cpu(vals[44]) +
2247                                le32_to_cpu(vals[45]);
2248         dev->stats.tx_packets = le32_to_cpu(vals[39]) + le32_to_cpu(vals[40]) +
2249                                le32_to_cpu(vals[41]);
2250         dev->stats.rx_bytes = le32_to_cpu(vals[92]);
2251         dev->stats.tx_bytes = le32_to_cpu(vals[91]);
2252         dev->stats.rx_errors = le32_to_cpu(vals[0]) + le32_to_cpu(vals[2]) +
2253                               le32_to_cpu(vals[3]) + le32_to_cpu(vals[4]);
2254         dev->stats.tx_errors = le32_to_cpu(vals[42]) +
2255                               dev->stats.tx_fifo_errors;
2256         dev->stats.multicast = le32_to_cpu(vals[43]);
2257         dev->stats.collisions = le32_to_cpu(vals[89]);
2258
2259         /* detailed rx_errors: */
2260         dev->stats.rx_length_errors = le32_to_cpu(vals[3]);
2261         dev->stats.rx_crc_errors = le32_to_cpu(vals[4]);
2262         dev->stats.rx_frame_errors = le32_to_cpu(vals[2]);
2263         dev->stats.rx_fifo_errors = le32_to_cpu(vals[0]);
2264 }
2265
2266 static struct net_device_stats *airo_get_stats(struct net_device *dev)
2267 {
2268         struct airo_info *local =  dev->ml_priv;
2269
2270         if (!test_bit(JOB_STATS, &local->jobs)) {
2271                 /* Get stats out of the card if available */
2272                 if (down_trylock(&local->sem) != 0) {
2273                         set_bit(JOB_STATS, &local->jobs);
2274                         wake_up_interruptible(&local->thr_wait);
2275                 } else
2276                         airo_read_stats(dev);
2277         }
2278
2279         return &dev->stats;
2280 }
2281
2282 static void airo_set_promisc(struct airo_info *ai) {
2283         Cmd cmd;
2284         Resp rsp;
2285
2286         memset(&cmd, 0, sizeof(cmd));
2287         cmd.cmd=CMD_SETMODE;
2288         clear_bit(JOB_PROMISC, &ai->jobs);
2289         cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2290         issuecommand(ai, &cmd, &rsp);
2291         up(&ai->sem);
2292 }
2293
2294 static void airo_set_multicast_list(struct net_device *dev) {
2295         struct airo_info *ai = dev->ml_priv;
2296
2297         if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2298                 change_bit(FLAG_PROMISC, &ai->flags);
2299                 if (down_trylock(&ai->sem) != 0) {
2300                         set_bit(JOB_PROMISC, &ai->jobs);
2301                         wake_up_interruptible(&ai->thr_wait);
2302                 } else
2303                         airo_set_promisc(ai);
2304         }
2305
2306         if ((dev->flags&IFF_ALLMULTI)||dev->mc_count>0) {
2307                 /* Turn on multicast.  (Should be already setup...) */
2308         }
2309 }
2310
2311 static int airo_set_mac_address(struct net_device *dev, void *p)
2312 {
2313         struct airo_info *ai = dev->ml_priv;
2314         struct sockaddr *addr = p;
2315
2316         readConfigRid(ai, 1);
2317         memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2318         set_bit (FLAG_COMMIT, &ai->flags);
2319         disable_MAC(ai, 1);
2320         writeConfigRid (ai, 1);
2321         enable_MAC(ai, 1);
2322         memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2323         if (ai->wifidev)
2324                 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2325         return 0;
2326 }
2327
2328 static int airo_change_mtu(struct net_device *dev, int new_mtu)
2329 {
2330         if ((new_mtu < 68) || (new_mtu > 2400))
2331                 return -EINVAL;
2332         dev->mtu = new_mtu;
2333         return 0;
2334 }
2335
2336 static LIST_HEAD(airo_devices);
2337
2338 static void add_airo_dev(struct airo_info *ai)
2339 {
2340         /* Upper layers already keep track of PCI devices,
2341          * so we only need to remember our non-PCI cards. */
2342         if (!ai->pci)
2343                 list_add_tail(&ai->dev_list, &airo_devices);
2344 }
2345
2346 static void del_airo_dev(struct airo_info *ai)
2347 {
2348         if (!ai->pci)
2349                 list_del(&ai->dev_list);
2350 }
2351
2352 static int airo_close(struct net_device *dev) {
2353         struct airo_info *ai = dev->ml_priv;
2354
2355         netif_stop_queue(dev);
2356
2357         if (ai->wifidev != dev) {
2358 #ifdef POWER_ON_DOWN
2359                 /* Shut power to the card. The idea is that the user can save
2360                  * power when he doesn't need the card with "ifconfig down".
2361                  * That's the method that is most friendly towards the network
2362                  * stack (i.e. the network stack won't try to broadcast
2363                  * anything on the interface and routes are gone. Jean II */
2364                 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2365                 disable_MAC(ai, 1);
2366 #endif
2367                 disable_interrupts( ai );
2368
2369                 free_irq(dev->irq, dev);
2370
2371                 set_bit(JOB_DIE, &ai->jobs);
2372                 kthread_stop(ai->airo_thread_task);
2373         }
2374         return 0;
2375 }
2376
2377 void stop_airo_card( struct net_device *dev, int freeres )
2378 {
2379         struct airo_info *ai = dev->ml_priv;
2380
2381         set_bit(FLAG_RADIO_DOWN, &ai->flags);
2382         disable_MAC(ai, 1);
2383         disable_interrupts(ai);
2384         takedown_proc_entry( dev, ai );
2385         if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2386                 unregister_netdev( dev );
2387                 if (ai->wifidev) {
2388                         unregister_netdev(ai->wifidev);
2389                         free_netdev(ai->wifidev);
2390                         ai->wifidev = NULL;
2391                 }
2392                 clear_bit(FLAG_REGISTERED, &ai->flags);
2393         }
2394         /*
2395          * Clean out tx queue
2396          */
2397         if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
2398                 struct sk_buff *skb = NULL;
2399                 for (;(skb = skb_dequeue(&ai->txq));)
2400                         dev_kfree_skb(skb);
2401         }
2402
2403         airo_networks_free (ai);
2404
2405         kfree(ai->flash);
2406         kfree(ai->rssi);
2407         kfree(ai->APList);
2408         kfree(ai->SSID);
2409         if (freeres) {
2410                 /* PCMCIA frees this stuff, so only for PCI and ISA */
2411                 release_region( dev->base_addr, 64 );
2412                 if (test_bit(FLAG_MPI, &ai->flags)) {
2413                         if (ai->pci)
2414                                 mpi_unmap_card(ai->pci);
2415                         if (ai->pcimem)
2416                                 iounmap(ai->pcimem);
2417                         if (ai->pciaux)
2418                                 iounmap(ai->pciaux);
2419                         pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2420                                 ai->shared, ai->shared_dma);
2421                 }
2422         }
2423         crypto_free_cipher(ai->tfm);
2424         del_airo_dev(ai);
2425         free_netdev( dev );
2426 }
2427
2428 EXPORT_SYMBOL(stop_airo_card);
2429
2430 static int wll_header_parse(const struct sk_buff *skb, unsigned char *haddr)
2431 {
2432         memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
2433         return ETH_ALEN;
2434 }
2435
2436 static void mpi_unmap_card(struct pci_dev *pci)
2437 {
2438         unsigned long mem_start = pci_resource_start(pci, 1);
2439         unsigned long mem_len = pci_resource_len(pci, 1);
2440         unsigned long aux_start = pci_resource_start(pci, 2);
2441         unsigned long aux_len = AUXMEMSIZE;
2442
2443         release_mem_region(aux_start, aux_len);
2444         release_mem_region(mem_start, mem_len);
2445 }
2446
2447 /*************************************************************
2448  *  This routine assumes that descriptors have been setup .
2449  *  Run at insmod time or after reset  when the decriptors
2450  *  have been initialized . Returns 0 if all is well nz
2451  *  otherwise . Does not allocate memory but sets up card
2452  *  using previously allocated descriptors.
2453  */
2454 static int mpi_init_descriptors (struct airo_info *ai)
2455 {
2456         Cmd cmd;
2457         Resp rsp;
2458         int i;
2459         int rc = SUCCESS;
2460
2461         /* Alloc  card RX descriptors */
2462         netif_stop_queue(ai->dev);
2463
2464         memset(&rsp,0,sizeof(rsp));
2465         memset(&cmd,0,sizeof(cmd));
2466
2467         cmd.cmd = CMD_ALLOCATEAUX;
2468         cmd.parm0 = FID_RX;
2469         cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2470         cmd.parm2 = MPI_MAX_FIDS;
2471         rc=issuecommand(ai, &cmd, &rsp);
2472         if (rc != SUCCESS) {
2473                 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
2474                 return rc;
2475         }
2476
2477         for (i=0; i<MPI_MAX_FIDS; i++) {
2478                 memcpy_toio(ai->rxfids[i].card_ram_off,
2479                         &ai->rxfids[i].rx_desc, sizeof(RxFid));
2480         }
2481
2482         /* Alloc card TX descriptors */
2483
2484         memset(&rsp,0,sizeof(rsp));
2485         memset(&cmd,0,sizeof(cmd));
2486
2487         cmd.cmd = CMD_ALLOCATEAUX;
2488         cmd.parm0 = FID_TX;
2489         cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2490         cmd.parm2 = MPI_MAX_FIDS;
2491
2492         for (i=0; i<MPI_MAX_FIDS; i++) {
2493                 ai->txfids[i].tx_desc.valid = 1;
2494                 memcpy_toio(ai->txfids[i].card_ram_off,
2495                         &ai->txfids[i].tx_desc, sizeof(TxFid));
2496         }
2497         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2498
2499         rc=issuecommand(ai, &cmd, &rsp);
2500         if (rc != SUCCESS) {
2501                 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
2502                 return rc;
2503         }
2504
2505         /* Alloc card Rid descriptor */
2506         memset(&rsp,0,sizeof(rsp));
2507         memset(&cmd,0,sizeof(cmd));
2508
2509         cmd.cmd = CMD_ALLOCATEAUX;
2510         cmd.parm0 = RID_RW;
2511         cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2512         cmd.parm2 = 1; /* Magic number... */
2513         rc=issuecommand(ai, &cmd, &rsp);
2514         if (rc != SUCCESS) {
2515                 airo_print_err(ai->dev->name, "Couldn't allocate RID");
2516                 return rc;
2517         }
2518
2519         memcpy_toio(ai->config_desc.card_ram_off,
2520                 &ai->config_desc.rid_desc, sizeof(Rid));
2521
2522         return rc;
2523 }
2524
2525 /*
2526  * We are setting up three things here:
2527  * 1) Map AUX memory for descriptors: Rid, TxFid, or RxFid.
2528  * 2) Map PCI memory for issueing commands.
2529  * 3) Allocate memory (shared) to send and receive ethernet frames.
2530  */
2531 static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci)
2532 {
2533         unsigned long mem_start, mem_len, aux_start, aux_len;
2534         int rc = -1;
2535         int i;
2536         dma_addr_t busaddroff;
2537         unsigned char *vpackoff;
2538         unsigned char __iomem *pciaddroff;
2539
2540         mem_start = pci_resource_start(pci, 1);
2541         mem_len = pci_resource_len(pci, 1);
2542         aux_start = pci_resource_start(pci, 2);
2543         aux_len = AUXMEMSIZE;
2544
2545         if (!request_mem_region(mem_start, mem_len, DRV_NAME)) {
2546                 airo_print_err("", "Couldn't get region %x[%x]",
2547                         (int)mem_start, (int)mem_len);
2548                 goto out;
2549         }
2550         if (!request_mem_region(aux_start, aux_len, DRV_NAME)) {
2551                 airo_print_err("", "Couldn't get region %x[%x]",
2552                         (int)aux_start, (int)aux_len);
2553                 goto free_region1;
2554         }
2555
2556         ai->pcimem = ioremap(mem_start, mem_len);
2557         if (!ai->pcimem) {
2558                 airo_print_err("", "Couldn't map region %x[%x]",
2559                         (int)mem_start, (int)mem_len);
2560                 goto free_region2;
2561         }
2562         ai->pciaux = ioremap(aux_start, aux_len);
2563         if (!ai->pciaux) {
2564                 airo_print_err("", "Couldn't map region %x[%x]",
2565                         (int)aux_start, (int)aux_len);
2566                 goto free_memmap;
2567         }
2568
2569         /* Reserve PKTSIZE for each fid and 2K for the Rids */
2570         ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2571         if (!ai->shared) {
2572                 airo_print_err("", "Couldn't alloc_consistent %d",
2573                         PCI_SHARED_LEN);
2574                 goto free_auxmap;
2575         }
2576
2577         /*
2578          * Setup descriptor RX, TX, CONFIG
2579          */
2580         busaddroff = ai->shared_dma;
2581         pciaddroff = ai->pciaux + AUX_OFFSET;
2582         vpackoff   = ai->shared;
2583
2584         /* RX descriptor setup */
2585         for(i = 0; i < MPI_MAX_FIDS; i++) {
2586                 ai->rxfids[i].pending = 0;
2587                 ai->rxfids[i].card_ram_off = pciaddroff;
2588                 ai->rxfids[i].virtual_host_addr = vpackoff;
2589                 ai->rxfids[i].rx_desc.host_addr = busaddroff;
2590                 ai->rxfids[i].rx_desc.valid = 1;
2591                 ai->rxfids[i].rx_desc.len = PKTSIZE;
2592                 ai->rxfids[i].rx_desc.rdy = 0;
2593
2594                 pciaddroff += sizeof(RxFid);
2595                 busaddroff += PKTSIZE;
2596                 vpackoff   += PKTSIZE;
2597         }
2598
2599         /* TX descriptor setup */
2600         for(i = 0; i < MPI_MAX_FIDS; i++) {
2601                 ai->txfids[i].card_ram_off = pciaddroff;
2602                 ai->txfids[i].virtual_host_addr = vpackoff;
2603                 ai->txfids[i].tx_desc.valid = 1;
2604                 ai->txfids[i].tx_desc.host_addr = busaddroff;
2605                 memcpy(ai->txfids[i].virtual_host_addr,
2606                         &wifictlhdr8023, sizeof(wifictlhdr8023));
2607
2608                 pciaddroff += sizeof(TxFid);
2609                 busaddroff += PKTSIZE;
2610                 vpackoff   += PKTSIZE;
2611         }
2612         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2613
2614         /* Rid descriptor setup */
2615         ai->config_desc.card_ram_off = pciaddroff;
2616         ai->config_desc.virtual_host_addr = vpackoff;
2617         ai->config_desc.rid_desc.host_addr = busaddroff;
2618         ai->ridbus = busaddroff;
2619         ai->config_desc.rid_desc.rid = 0;
2620         ai->config_desc.rid_desc.len = RIDSIZE;
2621         ai->config_desc.rid_desc.valid = 1;
2622         pciaddroff += sizeof(Rid);
2623         busaddroff += RIDSIZE;
2624         vpackoff   += RIDSIZE;
2625
2626         /* Tell card about descriptors */
2627         if (mpi_init_descriptors (ai) != SUCCESS)
2628                 goto free_shared;
2629
2630         return 0;
2631  free_shared:
2632         pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2633  free_auxmap:
2634         iounmap(ai->pciaux);
2635  free_memmap:
2636         iounmap(ai->pcimem);
2637  free_region2:
2638         release_mem_region(aux_start, aux_len);
2639  free_region1:
2640         release_mem_region(mem_start, mem_len);
2641  out:
2642         return rc;
2643 }
2644
2645 static const struct header_ops airo_header_ops = {
2646         .parse = wll_header_parse,
2647 };
2648
2649 static void wifi_setup(struct net_device *dev)
2650 {
2651         dev->header_ops = &airo_header_ops;
2652         dev->hard_start_xmit = &airo_start_xmit11;
2653         dev->get_stats = &airo_get_stats;
2654         dev->set_mac_address = &airo_set_mac_address;
2655         dev->do_ioctl = &airo_ioctl;
2656         dev->wireless_handlers = &airo_handler_def;
2657         dev->change_mtu = &airo_change_mtu;
2658         dev->open = &airo_open;
2659         dev->stop = &airo_close;
2660
2661         dev->type               = ARPHRD_IEEE80211;
2662         dev->hard_header_len    = ETH_HLEN;
2663         dev->mtu                = AIRO_DEF_MTU;
2664         dev->addr_len           = ETH_ALEN;
2665         dev->tx_queue_len       = 100;
2666
2667         memset(dev->broadcast,0xFF, ETH_ALEN);
2668
2669         dev->flags              = IFF_BROADCAST|IFF_MULTICAST;
2670 }
2671
2672 static struct net_device *init_wifidev(struct airo_info *ai,
2673                                         struct net_device *ethdev)
2674 {
2675         int err;
2676         struct net_device *dev = alloc_netdev(0, "wifi%d", wifi_setup);
2677         if (!dev)
2678                 return NULL;
2679         dev->ml_priv = ethdev->ml_priv;
2680         dev->irq = ethdev->irq;
2681         dev->base_addr = ethdev->base_addr;
2682         dev->wireless_data = ethdev->wireless_data;
2683         SET_NETDEV_DEV(dev, ethdev->dev.parent);
2684         memcpy(dev->dev_addr, ethdev->dev_addr, dev->addr_len);
2685         err = register_netdev(dev);
2686         if (err<0) {
2687                 free_netdev(dev);
2688                 return NULL;
2689         }
2690         return dev;
2691 }
2692
2693 static int reset_card( struct net_device *dev , int lock) {
2694         struct airo_info *ai = dev->ml_priv;
2695
2696         if (lock && down_interruptible(&ai->sem))
2697                 return -1;
2698         waitbusy (ai);
2699         OUT4500(ai,COMMAND,CMD_SOFTRESET);
2700         msleep(200);
2701         waitbusy (ai);
2702         msleep(200);
2703         if (lock)
2704                 up(&ai->sem);
2705         return 0;
2706 }
2707
2708 #define AIRO_MAX_NETWORK_COUNT  64
2709 static int airo_networks_allocate(struct airo_info *ai)
2710 {
2711         if (ai->networks)
2712                 return 0;
2713
2714         ai->networks =
2715             kzalloc(AIRO_MAX_NETWORK_COUNT * sizeof(BSSListElement),
2716                     GFP_KERNEL);
2717         if (!ai->networks) {
2718                 airo_print_warn("", "Out of memory allocating beacons");
2719                 return -ENOMEM;
2720         }
2721
2722         return 0;
2723 }
2724
2725 static void airo_networks_free(struct airo_info *ai)
2726 {
2727         kfree(ai->networks);
2728         ai->networks = NULL;
2729 }
2730
2731 static void airo_networks_initialize(struct airo_info *ai)
2732 {
2733         int i;
2734
2735         INIT_LIST_HEAD(&ai->network_free_list);
2736         INIT_LIST_HEAD(&ai->network_list);
2737         for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
2738                 list_add_tail(&ai->networks[i].list,
2739                               &ai->network_free_list);
2740 }
2741
2742 static struct net_device *_init_airo_card( unsigned short irq, int port,
2743                                            int is_pcmcia, struct pci_dev *pci,
2744                                            struct device *dmdev )
2745 {
2746         struct net_device *dev;
2747         struct airo_info *ai;
2748         int i, rc;
2749         CapabilityRid cap_rid;
2750
2751         /* Create the network device object. */
2752         dev = alloc_netdev(sizeof(*ai), "", ether_setup);
2753         if (!dev) {
2754                 airo_print_err("", "Couldn't alloc_etherdev");
2755                 return NULL;
2756         }
2757
2758         ai = dev->ml_priv = netdev_priv(dev);
2759         ai->wifidev = NULL;
2760         ai->flags = 1 << FLAG_RADIO_DOWN;
2761         ai->jobs = 0;
2762         ai->dev = dev;
2763         if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
2764                 airo_print_dbg("", "Found an MPI350 card");
2765                 set_bit(FLAG_MPI, &ai->flags);
2766         }
2767         spin_lock_init(&ai->aux_lock);
2768         sema_init(&ai->sem, 1);
2769         ai->config.len = 0;
2770         ai->pci = pci;
2771         init_waitqueue_head (&ai->thr_wait);
2772         ai->tfm = NULL;
2773         add_airo_dev(ai);
2774
2775         if (airo_networks_allocate (ai))
2776                 goto err_out_free;
2777         airo_networks_initialize (ai);
2778
2779         /* The Airo-specific entries in the device structure. */
2780         if (test_bit(FLAG_MPI,&ai->flags)) {
2781                 skb_queue_head_init (&ai->txq);
2782                 dev->hard_start_xmit = &mpi_start_xmit;
2783         } else
2784                 dev->hard_start_xmit = &airo_start_xmit;
2785         dev->get_stats = &airo_get_stats;
2786         dev->set_multicast_list = &airo_set_multicast_list;
2787         dev->set_mac_address = &airo_set_mac_address;
2788         dev->do_ioctl = &airo_ioctl;
2789         dev->wireless_handlers = &airo_handler_def;
2790         ai->wireless_data.spy_data = &ai->spy_data;
2791         dev->wireless_data = &ai->wireless_data;
2792         dev->change_mtu = &airo_change_mtu;
2793         dev->open = &airo_open;
2794         dev->stop = &airo_close;
2795         dev->irq = irq;
2796         dev->base_addr = port;
2797
2798         SET_NETDEV_DEV(dev, dmdev);
2799
2800         reset_card (dev, 1);
2801         msleep(400);
2802
2803         if (!is_pcmcia) {
2804                 if (!request_region(dev->base_addr, 64, DRV_NAME)) {
2805                         rc = -EBUSY;
2806                         airo_print_err(dev->name, "Couldn't request region");
2807                         goto err_out_nets;
2808                 }
2809         }
2810
2811         if (test_bit(FLAG_MPI,&ai->flags)) {
2812                 if (mpi_map_card(ai, pci)) {
2813                         airo_print_err("", "Could not map memory");
2814                         goto err_out_res;
2815                 }
2816         }
2817
2818         if (probe) {
2819                 if (setup_card(ai, dev->dev_addr, 1) != SUCCESS) {
2820                         airo_print_err(dev->name, "MAC could not be enabled" );
2821                         rc = -EIO;
2822                         goto err_out_map;
2823                 }
2824         } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2825                 ai->bap_read = fast_bap_read;
2826                 set_bit(FLAG_FLASHING, &ai->flags);
2827         }
2828
2829         strcpy(dev->name, "eth%d");
2830         rc = register_netdev(dev);
2831         if (rc) {
2832                 airo_print_err(dev->name, "Couldn't register_netdev");
2833                 goto err_out_map;
2834         }
2835         ai->wifidev = init_wifidev(ai, dev);
2836         if (!ai->wifidev)
2837                 goto err_out_reg;
2838
2839         rc = readCapabilityRid(ai, &cap_rid, 1);
2840         if (rc != SUCCESS) {
2841                 rc = -EIO;
2842                 goto err_out_wifi;
2843         }
2844         /* WEP capability discovery */
2845         ai->wep_capable = (cap_rid.softCap & cpu_to_le16(0x02)) ? 1 : 0;
2846         ai->max_wep_idx = (cap_rid.softCap & cpu_to_le16(0x80)) ? 3 : 0;
2847
2848         airo_print_info(dev->name, "Firmware version %x.%x.%02x",
2849                         ((le16_to_cpu(cap_rid.softVer) >> 8) & 0xF),
2850                         (le16_to_cpu(cap_rid.softVer) & 0xFF),
2851                         le16_to_cpu(cap_rid.softSubVer));
2852
2853         /* Test for WPA support */
2854         /* Only firmware versions 5.30.17 or better can do WPA */
2855         if (le16_to_cpu(cap_rid.softVer) > 0x530
2856          || (le16_to_cpu(cap_rid.softVer) == 0x530
2857               && le16_to_cpu(cap_rid.softSubVer) >= 17)) {
2858                 airo_print_info(ai->dev->name, "WPA supported.");
2859
2860                 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2861                 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2862                 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2863                 ai->bssListRidLen = sizeof(BSSListRid);
2864         } else {
2865                 airo_print_info(ai->dev->name, "WPA unsupported with firmware "
2866                         "versions older than 5.30.17.");
2867
2868                 ai->bssListFirst = RID_BSSLISTFIRST;
2869                 ai->bssListNext = RID_BSSLISTNEXT;
2870                 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2871         }
2872
2873         set_bit(FLAG_REGISTERED,&ai->flags);
2874         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2875
2876         /* Allocate the transmit buffers */
2877         if (probe && !test_bit(FLAG_MPI,&ai->flags))
2878                 for( i = 0; i < MAX_FIDS; i++ )
2879                         ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2880
2881         if (setup_proc_entry(dev, dev->ml_priv) < 0)
2882                 goto err_out_wifi;
2883
2884         return dev;
2885
2886 err_out_wifi:
2887         unregister_netdev(ai->wifidev);
2888         free_netdev(ai->wifidev);
2889 err_out_reg:
2890         unregister_netdev(dev);
2891 err_out_map:
2892         if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2893                 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2894                 iounmap(ai->pciaux);
2895                 iounmap(ai->pcimem);
2896                 mpi_unmap_card(ai->pci);
2897         }
2898 err_out_res:
2899         if (!is_pcmcia)
2900                 release_region( dev->base_addr, 64 );
2901 err_out_nets:
2902         airo_networks_free(ai);
2903         del_airo_dev(ai);
2904 err_out_free:
2905         free_netdev(dev);
2906         return NULL;
2907 }
2908
2909 struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2910                                   struct device *dmdev)
2911 {
2912         return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2913 }
2914
2915 EXPORT_SYMBOL(init_airo_card);
2916
2917 static int waitbusy (struct airo_info *ai) {
2918         int delay = 0;
2919         while ((IN4500(ai, COMMAND) & COMMAND_BUSY) && (delay < 10000)) {
2920                 udelay (10);
2921                 if ((++delay % 20) == 0)
2922                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2923         }
2924         return delay < 10000;
2925 }
2926
2927 int reset_airo_card( struct net_device *dev )
2928 {
2929         int i;
2930         struct airo_info *ai = dev->ml_priv;
2931
2932         if (reset_card (dev, 1))
2933                 return -1;
2934
2935         if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
2936                 airo_print_err(dev->name, "MAC could not be enabled");
2937                 return -1;
2938         }
2939         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2940         /* Allocate the transmit buffers if needed */
2941         if (!test_bit(FLAG_MPI,&ai->flags))
2942                 for( i = 0; i < MAX_FIDS; i++ )
2943                         ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2944
2945         enable_interrupts( ai );
2946         netif_wake_queue(dev);
2947         return 0;
2948 }
2949
2950 EXPORT_SYMBOL(reset_airo_card);
2951
2952 static void airo_send_event(struct net_device *dev) {
2953         struct airo_info *ai = dev->ml_priv;
2954         union iwreq_data wrqu;
2955         StatusRid status_rid;
2956
2957         clear_bit(JOB_EVENT, &ai->jobs);
2958         PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
2959         up(&ai->sem);
2960         wrqu.data.length = 0;
2961         wrqu.data.flags = 0;
2962         memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
2963         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
2964
2965         /* Send event to user space */
2966         wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
2967 }
2968
2969 static void airo_process_scan_results (struct airo_info *ai) {
2970         union iwreq_data        wrqu;
2971         BSSListRid bss;
2972         int rc;
2973         BSSListElement * loop_net;
2974         BSSListElement * tmp_net;
2975
2976         /* Blow away current list of scan results */
2977         list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
2978                 list_move_tail (&loop_net->list, &ai->network_free_list);
2979                 /* Don't blow away ->list, just BSS data */
2980                 memset (loop_net, 0, sizeof (loop_net->bss));
2981         }
2982
2983         /* Try to read the first entry of the scan result */
2984         rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
2985         if((rc) || (bss.index == cpu_to_le16(0xffff))) {
2986                 /* No scan results */
2987                 goto out;
2988         }
2989
2990         /* Read and parse all entries */
2991         tmp_net = NULL;
2992         while((!rc) && (bss.index != cpu_to_le16(0xffff))) {
2993                 /* Grab a network off the free list */
2994                 if (!list_empty(&ai->network_free_list)) {
2995                         tmp_net = list_entry(ai->network_free_list.next,
2996                                             BSSListElement, list);
2997                         list_del(ai->network_free_list.next);
2998                 }
2999
3000                 if (tmp_net != NULL) {
3001                         memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
3002                         list_add_tail(&tmp_net->list, &ai->network_list);
3003                         tmp_net = NULL;
3004                 }
3005
3006                 /* Read next entry */
3007                 rc = PC4500_readrid(ai, ai->bssListNext,
3008                                     &bss, ai->bssListRidLen, 0);
3009         }
3010
3011 out:
3012         ai->scan_timeout = 0;
3013         clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
3014         up(&ai->sem);
3015
3016         /* Send an empty event to user space.
3017          * We don't send the received data on
3018          * the event because it would require
3019          * us to do complex transcoding, and
3020          * we want to minimise the work done in
3021          * the irq handler. Use a request to
3022          * extract the data - Jean II */
3023         wrqu.data.length = 0;
3024         wrqu.data.flags = 0;
3025         wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3026 }
3027
3028 static int airo_thread(void *data) {
3029         struct net_device *dev = data;
3030         struct airo_info *ai = dev->ml_priv;
3031         int locked;
3032
3033         set_freezable();
3034         while(1) {
3035                 /* make swsusp happy with our thread */
3036                 try_to_freeze();
3037
3038                 if (test_bit(JOB_DIE, &ai->jobs))
3039                         break;
3040
3041                 if (ai->jobs) {
3042                         locked = down_interruptible(&ai->sem);
3043                 } else {
3044                         wait_queue_t wait;
3045
3046                         init_waitqueue_entry(&wait, current);
3047                         add_wait_queue(&ai->thr_wait, &wait);
3048                         for (;;) {
3049                                 set_current_state(TASK_INTERRUPTIBLE);
3050                                 if (ai->jobs)
3051                                         break;
3052                                 if (ai->expires || ai->scan_timeout) {
3053                                         if (ai->scan_timeout &&
3054                                                         time_after_eq(jiffies,ai->scan_timeout)){
3055                                                 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
3056                                                 break;
3057                                         } else if (ai->expires &&
3058                                                         time_after_eq(jiffies,ai->expires)){
3059                                                 set_bit(JOB_AUTOWEP, &ai->jobs);
3060                                                 break;
3061                                         }
3062                                         if (!kthread_should_stop() &&
3063                                             !freezing(current)) {
3064                                                 unsigned long wake_at;
3065                                                 if (!ai->expires || !ai->scan_timeout) {
3066                                                         wake_at = max(ai->expires,
3067                                                                 ai->scan_timeout);
3068                                                 } else {
3069                                                         wake_at = min(ai->expires,
3070                                                                 ai->scan_timeout);
3071                                                 }
3072                                                 schedule_timeout(wake_at - jiffies);
3073                                                 continue;
3074                                         }
3075                                 } else if (!kthread_should_stop() &&
3076                                            !freezing(current)) {
3077                                         schedule();
3078                                         continue;
3079                                 }
3080                                 break;
3081                         }
3082                         current->state = TASK_RUNNING;
3083                         remove_wait_queue(&ai->thr_wait, &wait);
3084                         locked = 1;
3085                 }
3086
3087                 if (locked)
3088                         continue;
3089
3090                 if (test_bit(JOB_DIE, &ai->jobs)) {
3091                         up(&ai->sem);
3092                         break;
3093                 }
3094
3095                 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
3096                         up(&ai->sem);
3097                         continue;
3098                 }
3099
3100                 if (test_bit(JOB_XMIT, &ai->jobs))
3101                         airo_end_xmit(dev);
3102                 else if (test_bit(JOB_XMIT11, &ai->jobs))
3103                         airo_end_xmit11(dev);
3104                 else if (test_bit(JOB_STATS, &ai->jobs))
3105                         airo_read_stats(dev);
3106                 else if (test_bit(JOB_WSTATS, &ai->jobs))
3107                         airo_read_wireless_stats(ai);
3108                 else if (test_bit(JOB_PROMISC, &ai->jobs))
3109                         airo_set_promisc(ai);
3110                 else if (test_bit(JOB_MIC, &ai->jobs))
3111                         micinit(ai);
3112                 else if (test_bit(JOB_EVENT, &ai->jobs))
3113                         airo_send_event(dev);
3114                 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
3115                         timer_func(dev);
3116                 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
3117                         airo_process_scan_results(ai);
3118                 else  /* Shouldn't get here, but we make sure to unlock */
3119                         up(&ai->sem);
3120         }
3121
3122         return 0;
3123 }
3124
3125 static int header_len(__le16 ctl)
3126 {
3127         u16 fc = le16_to_cpu(ctl);
3128         switch (fc & 0xc) {
3129         case 4:
3130                 if ((fc & 0xe0) == 0xc0)
3131                         return 10;      /* one-address control packet */
3132                 return 16;      /* two-address control packet */
3133         case 8:
3134                 if ((fc & 0x300) == 0x300)
3135                         return 30;      /* WDS packet */
3136         }
3137         return 24;
3138 }
3139
3140 static void airo_handle_cisco_mic(struct airo_info *ai)
3141 {
3142         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags)) {
3143                 set_bit(JOB_MIC, &ai->jobs);
3144                 wake_up_interruptible(&ai->thr_wait);
3145         }
3146 }
3147
3148 /* Airo Status codes */
3149 #define STAT_NOBEACON   0x8000 /* Loss of sync - missed beacons */
3150 #define STAT_MAXRETRIES 0x8001 /* Loss of sync - max retries */
3151 #define STAT_MAXARL     0x8002 /* Loss of sync - average retry level exceeded*/
3152 #define STAT_FORCELOSS  0x8003 /* Loss of sync - host request */
3153 #define STAT_TSFSYNC    0x8004 /* Loss of sync - TSF synchronization */
3154 #define STAT_DEAUTH     0x8100 /* low byte is 802.11 reason code */
3155 #define STAT_DISASSOC   0x8200 /* low byte is 802.11 reason code */
3156 #define STAT_ASSOC_FAIL 0x8400 /* low byte is 802.11 reason code */
3157 #define STAT_AUTH_FAIL  0x0300 /* low byte is 802.11 reason code */
3158 #define STAT_ASSOC      0x0400 /* Associated */
3159 #define STAT_REASSOC    0x0600 /* Reassociated?  Only on firmware >= 5.30.17 */
3160
3161 static void airo_print_status(const char *devname, u16 status)
3162 {
3163         u8 reason = status & 0xFF;
3164
3165         switch (status) {
3166         case STAT_NOBEACON:
3167                 airo_print_dbg(devname, "link lost (missed beacons)");
3168                 break;
3169         case STAT_MAXRETRIES:
3170         case STAT_MAXARL:
3171                 airo_print_dbg(devname, "link lost (max retries)");
3172                 break;
3173         case STAT_FORCELOSS:
3174                 airo_print_dbg(devname, "link lost (local choice)");
3175                 break;
3176         case STAT_TSFSYNC:
3177                 airo_print_dbg(devname, "link lost (TSF sync lost)");
3178                 break;
3179         case STAT_DEAUTH:
3180                 airo_print_dbg(devname, "deauthenticated (reason: %d)", reason);
3181                 break;
3182         case STAT_DISASSOC:
3183                 airo_print_dbg(devname, "disassociated (reason: %d)", reason);
3184                 break;
3185         case STAT_ASSOC_FAIL:
3186                 airo_print_dbg(devname, "association failed (reason: %d)",
3187                                reason);
3188                 break;
3189         case STAT_AUTH_FAIL:
3190                 airo_print_dbg(devname, "authentication failed (reason: %d)",
3191                                reason);
3192                 break;
3193         default:
3194                 break;
3195         }
3196 }
3197
3198 static void airo_handle_link(struct airo_info *ai)
3199 {
3200         union iwreq_data wrqu;
3201         int scan_forceloss = 0;
3202         u16 status;
3203
3204         /* Get new status and acknowledge the link change */
3205         status = le16_to_cpu(IN4500(ai, LINKSTAT));
3206         OUT4500(ai, EVACK, EV_LINK);
3207
3208         if ((status == STAT_FORCELOSS) && (ai->scan_timeout > 0))
3209                 scan_forceloss = 1;
3210
3211         airo_print_status(ai->dev->name, status);
3212
3213         if ((status == STAT_ASSOC) || (status == STAT_REASSOC)) {
3214                 if (auto_wep)
3215                         ai->expires = 0;
3216                 if (ai->list_bss_task)
3217                         wake_up_process(ai->list_bss_task);
3218                 set_bit(FLAG_UPDATE_UNI, &ai->flags);
3219                 set_bit(FLAG_UPDATE_MULTI, &ai->flags);
3220
3221                 if (down_trylock(&ai->sem) != 0) {
3222                         set_bit(JOB_EVENT, &ai->jobs);
3223                         wake_up_interruptible(&ai->thr_wait);
3224                 } else
3225                         airo_send_event(ai->dev);
3226         } else if (!scan_forceloss) {
3227                 if (auto_wep && !ai->expires) {
3228                         ai->expires = RUN_AT(3*HZ);
3229                         wake_up_interruptible(&ai->thr_wait);
3230                 }
3231
3232                 /* Send event to user space */
3233                 memset(wrqu.ap_addr.sa_data, '\0', ETH_ALEN);
3234                 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3235                 wireless_send_event(ai->dev, SIOCGIWAP, &wrqu, NULL);
3236         }
3237 }
3238
3239 static void airo_handle_rx(struct airo_info *ai)
3240 {
3241         struct sk_buff *skb = NULL;
3242         __le16 fc, v, *buffer, tmpbuf[4];
3243         u16 len, hdrlen = 0, gap, fid;
3244         struct rx_hdr hdr;
3245         int success = 0;
3246
3247         if (test_bit(FLAG_MPI, &ai->flags)) {
3248                 if (test_bit(FLAG_802_11, &ai->flags))
3249                         mpi_receive_802_11(ai);
3250                 else
3251                         mpi_receive_802_3(ai);
3252                 OUT4500(ai, EVACK, EV_RX);
3253                 return;
3254         }
3255
3256         fid = IN4500(ai, RXFID);
3257
3258         /* Get the packet length */
3259         if (test_bit(FLAG_802_11, &ai->flags)) {
3260                 bap_setup (ai, fid, 4, BAP0);
3261                 bap_read (ai, (__le16*)&hdr, sizeof(hdr), BAP0);
3262                 /* Bad CRC. Ignore packet */
3263                 if (le16_to_cpu(hdr.status) & 2)
3264                         hdr.len = 0;
3265                 if (ai->wifidev == NULL)
3266                         hdr.len = 0;
3267         } else {
3268                 bap_setup(ai, fid, 0x36, BAP0);
3269                 bap_read(ai, &hdr.len, 2, BAP0);
3270         }
3271         len = le16_to_cpu(hdr.len);
3272
3273         if (len > AIRO_DEF_MTU) {
3274                 airo_print_err(ai->dev->name, "Bad size %d", len);
3275                 goto done;
3276         }
3277         if (len == 0)
3278                 goto done;
3279
3280         if (test_bit(FLAG_802_11, &ai->flags)) {
3281                 bap_read(ai, &fc, sizeof (fc), BAP0);
3282                 hdrlen = header_len(fc);
3283         } else
3284                 hdrlen = ETH_ALEN * 2;
3285
3286         skb = dev_alloc_skb(len + hdrlen + 2 + 2);
3287         if (!skb) {
3288                 ai->dev->stats.rx_dropped++;
3289                 goto done;
3290         }
3291
3292         skb_reserve(skb, 2); /* This way the IP header is aligned */
3293         buffer = (__le16 *) skb_put(skb, len + hdrlen);
3294         if (test_bit(FLAG_802_11, &ai->flags)) {
3295                 buffer[0] = fc;
3296                 bap_read(ai, buffer + 1, hdrlen - 2, BAP0);
3297                 if (hdrlen == 24)
3298                         bap_read(ai, tmpbuf, 6, BAP0);
3299
3300                 bap_read(ai, &v, sizeof(v), BAP0);
3301                 gap = le16_to_cpu(v);
3302                 if (gap) {
3303                         if (gap <= 8) {
3304                                 bap_read(ai, tmpbuf, gap, BAP0);
3305                         } else {
3306                                 airo_print_err(ai->dev->name, "gaplen too "
3307                                         "big. Problems will follow...");
3308                         }
3309                 }
3310                 bap_read(ai, buffer + hdrlen/2, len, BAP0);
3311         } else {
3312                 MICBuffer micbuf;
3313
3314                 bap_read(ai, buffer, ETH_ALEN * 2, BAP0);
3315                 if (ai->micstats.enabled) {
3316                         bap_read(ai, (__le16 *) &micbuf, sizeof (micbuf), BAP0);
3317                         if (ntohs(micbuf.typelen) > 0x05DC)
3318                                 bap_setup(ai, fid, 0x44, BAP0);
3319                         else {
3320                                 if (len <= sizeof (micbuf)) {
3321                                         dev_kfree_skb_irq(skb);
3322                                         goto done;
3323                                 }
3324
3325                                 len -= sizeof(micbuf);
3326                                 skb_trim(skb, len + hdrlen);
3327                         }
3328                 }
3329
3330                 bap_read(ai, buffer + ETH_ALEN, len, BAP0);
3331                 if (decapsulate(ai, &micbuf, (etherHead*) buffer, len))
3332                         dev_kfree_skb_irq (skb);
3333                 else
3334                         success = 1;
3335         }
3336
3337 #ifdef WIRELESS_SPY
3338         if (success && (ai->spy_data.spy_number > 0)) {
3339                 char *sa;
3340                 struct iw_quality wstats;
3341
3342                 /* Prepare spy data : addr + qual */
3343                 if (!test_bit(FLAG_802_11, &ai->flags)) {
3344                         sa = (char *) buffer + 6;
3345                         bap_setup(ai, fid, 8, BAP0);
3346                         bap_read(ai, (__le16 *) hdr.rssi, 2, BAP0);
3347                 } else
3348                         sa = (char *) buffer + 10;
3349                 wstats.qual = hdr.rssi[0];
3350                 if (ai->rssi)
3351                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3352                 else
3353                         wstats.level = (hdr.rssi[1] + 321) / 2;
3354                 wstats.noise = ai->wstats.qual.noise;
3355                 wstats.updated =  IW_QUAL_LEVEL_UPDATED
3356                                 | IW_QUAL_QUAL_UPDATED
3357                                 | IW_QUAL_DBM;
3358                 /* Update spy records */
3359                 wireless_spy_update(ai->dev, sa, &wstats);
3360         }
3361 #endif /* WIRELESS_SPY */
3362
3363 done:
3364         OUT4500(ai, EVACK, EV_RX);
3365
3366         if (success) {
3367                 if (test_bit(FLAG_802_11, &ai->flags)) {
3368                         skb_reset_mac_header(skb);
3369                         skb->pkt_type = PACKET_OTHERHOST;
3370                         skb->dev = ai->wifidev;
3371                         skb->protocol = htons(ETH_P_802_2);
3372                 } else
3373                         skb->protocol = eth_type_trans(skb, ai->dev);
3374                 skb->ip_summed = CHECKSUM_NONE;
3375
3376                 netif_rx(skb);
3377         }
3378 }
3379
3380 static void airo_handle_tx(struct airo_info *ai, u16 status)
3381 {
3382         int i, len = 0, index = -1;
3383         u16 fid;
3384
3385         if (test_bit(FLAG_MPI, &ai->flags)) {
3386                 unsigned long flags;
3387
3388                 if (status & EV_TXEXC)
3389                         get_tx_error(ai, -1);
3390
3391                 spin_lock_irqsave(&ai->aux_lock, flags);
3392                 if (!skb_queue_empty(&ai->txq)) {
3393                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3394                         mpi_send_packet(ai->dev);
3395                 } else {
3396                         clear_bit(FLAG_PENDING_XMIT, &ai->flags);
3397                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3398                         netif_wake_queue(ai->dev);
3399                 }
3400                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3401                 return;
3402         }
3403
3404         fid = IN4500(ai, TXCOMPLFID);
3405
3406         for(i = 0; i < MAX_FIDS; i++) {
3407                 if ((ai->fids[i] & 0xffff) == fid) {
3408                         len = ai->fids[i] >> 16;
3409                         index = i;
3410                 }
3411         }
3412
3413         if (index != -1) {
3414                 if (status & EV_TXEXC)
3415                         get_tx_error(ai, index);
3416
3417                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXEXC));
3418
3419                 /* Set up to be used again */
3420                 ai->fids[index] &= 0xffff;
3421                 if (index < MAX_FIDS / 2) {
3422                         if (!test_bit(FLAG_PENDING_XMIT, &ai->flags))
3423                                 netif_wake_queue(ai->dev);
3424                 } else {
3425                         if (!test_bit(FLAG_PENDING_XMIT11, &ai->flags))
3426                                 netif_wake_queue(ai->wifidev);
3427                 }
3428         } else {
3429                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3430                 airo_print_err(ai->dev->name, "Unallocated FID was used to xmit");
3431         }
3432 }
3433
3434 static irqreturn_t airo_interrupt(int irq, void *dev_id)
3435 {
3436         struct net_device *dev = dev_id;
3437         u16 status, savedInterrupts = 0;
3438         struct airo_info *ai = dev->ml_priv;
3439         int handled = 0;
3440
3441         if (!netif_device_present(dev))
3442                 return IRQ_NONE;
3443
3444         for (;;) {
3445                 status = IN4500(ai, EVSTAT);
3446                 if (!(status & STATUS_INTS) || (status == 0xffff))
3447                         break;
3448
3449                 handled = 1;
3450
3451                 if (status & EV_AWAKE) {
3452                         OUT4500(ai, EVACK, EV_AWAKE);
3453                         OUT4500(ai, EVACK, EV_AWAKE);
3454                 }
3455
3456                 if (!savedInterrupts) {
3457                         savedInterrupts = IN4500(ai, EVINTEN);
3458                         OUT4500(ai, EVINTEN, 0);
3459                 }
3460
3461                 if (status & EV_MIC) {
3462                         OUT4500(ai, EVACK, EV_MIC);
3463                         airo_handle_cisco_mic(ai);
3464                 }
3465
3466                 if (status & EV_LINK) {
3467                         /* Link status changed */
3468                         airo_handle_link(ai);
3469                 }
3470
3471                 /* Check to see if there is something to receive */
3472                 if (status & EV_RX)
3473                         airo_handle_rx(ai);
3474
3475                 /* Check to see if a packet has been transmitted */
3476                 if (status & (EV_TX | EV_TXCPY | EV_TXEXC))
3477                         airo_handle_tx(ai, status);
3478
3479                 if ( status & ~STATUS_INTS & ~IGNORE_INTS ) {
3480                         airo_print_warn(ai->dev->name, "Got weird status %x",
3481                                 status & ~STATUS_INTS & ~IGNORE_INTS );
3482                 }
3483         }
3484
3485         if (savedInterrupts)
3486                 OUT4500(ai, EVINTEN, savedInterrupts);
3487
3488         return IRQ_RETVAL(handled);
3489 }
3490
3491 /*
3492  *  Routines to talk to the card
3493  */
3494
3495 /*
3496  *  This was originally written for the 4500, hence the name
3497  *  NOTE:  If use with 8bit mode and SMP bad things will happen!
3498  *         Why would some one do 8 bit IO in an SMP machine?!?
3499  */
3500 static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3501         if (test_bit(FLAG_MPI,&ai->flags))
3502                 reg <<= 1;
3503         if ( !do8bitIO )
3504                 outw( val, ai->dev->base_addr + reg );
3505         else {
3506                 outb( val & 0xff, ai->dev->base_addr + reg );
3507                 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3508         }
3509 }
3510
3511 static u16 IN4500( struct airo_info *ai, u16 reg ) {
3512         unsigned short rc;
3513
3514         if (test_bit(FLAG_MPI,&ai->flags))
3515                 reg <<= 1;
3516         if ( !do8bitIO )
3517                 rc = inw( ai->dev->base_addr + reg );
3518         else {
3519                 rc = inb( ai->dev->base_addr + reg );
3520                 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3521         }
3522         return rc;
3523 }
3524
3525 static int enable_MAC(struct airo_info *ai, int lock)
3526 {
3527         int rc;
3528         Cmd cmd;
3529         Resp rsp;
3530
3531         /* FLAG_RADIO_OFF : Radio disabled via /proc or Wireless Extensions
3532          * FLAG_RADIO_DOWN : Radio disabled via "ifconfig ethX down"
3533          * Note : we could try to use !netif_running(dev) in enable_MAC()
3534          * instead of this flag, but I don't trust it *within* the
3535          * open/close functions, and testing both flags together is
3536          * "cheaper" - Jean II */
3537         if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3538
3539         if (lock && down_interruptible(&ai->sem))
3540                 return -ERESTARTSYS;
3541
3542         if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3543                 memset(&cmd, 0, sizeof(cmd));
3544                 cmd.cmd = MAC_ENABLE;
3545                 rc = issuecommand(ai, &cmd, &rsp);
3546                 if (rc == SUCCESS)
3547                         set_bit(FLAG_ENABLED, &ai->flags);
3548         } else
3549                 rc = SUCCESS;
3550
3551         if (lock)
3552             up(&ai->sem);
3553
3554         if (rc)
3555                 airo_print_err(ai->dev->name, "Cannot enable MAC");
3556         else if ((rsp.status & 0xFF00) != 0) {
3557                 airo_print_err(ai->dev->name, "Bad MAC enable reason=%x, "
3558                         "rid=%x, offset=%d", rsp.rsp0, rsp.rsp1, rsp.rsp2);
3559                 rc = ERROR;
3560         }
3561         return rc;
3562 }
3563
3564 static void disable_MAC( struct airo_info *ai, int lock ) {
3565         Cmd cmd;
3566         Resp rsp;
3567
3568         if (lock && down_interruptible(&ai->sem))
3569                 return;
3570
3571         if (test_bit(FLAG_ENABLED, &ai->flags)) {
3572                 memset(&cmd, 0, sizeof(cmd));
3573                 cmd.cmd = MAC_DISABLE; // disable in case already enabled
3574                 issuecommand(ai, &cmd, &rsp);
3575                 clear_bit(FLAG_ENABLED, &ai->flags);
3576         }
3577         if (lock)
3578                 up(&ai->sem);
3579 }
3580
3581 static void enable_interrupts( struct airo_info *ai ) {
3582         /* Enable the interrupts */
3583         OUT4500( ai, EVINTEN, STATUS_INTS );
3584 }
3585
3586 static void disable_interrupts( struct airo_info *ai ) {
3587         OUT4500( ai, EVINTEN, 0 );
3588 }
3589
3590 static void mpi_receive_802_3(struct airo_info *ai)
3591 {
3592         RxFid rxd;
3593         int len = 0;
3594         struct sk_buff *skb;
3595         char *buffer;
3596         int off = 0;
3597         MICBuffer micbuf;
3598
3599         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3600         /* Make sure we got something */
3601         if (rxd.rdy && rxd.valid == 0) {
3602                 len = rxd.len + 12;
3603                 if (len < 12 || len > 2048)
3604                         goto badrx;
3605
3606                 skb = dev_alloc_skb(len);
3607                 if (!skb) {
3608                         ai->dev->stats.rx_dropped++;
3609                         goto badrx;
3610                 }
3611                 buffer = skb_put(skb,len);
3612                 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3613                 if (ai->micstats.enabled) {
3614                         memcpy(&micbuf,
3615                                 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3616                                 sizeof(micbuf));
3617                         if (ntohs(micbuf.typelen) <= 0x05DC) {
3618                                 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3619                                         goto badmic;
3620
3621                                 off = sizeof(micbuf);
3622                                 skb_trim (skb, len - off);
3623                         }
3624                 }
3625                 memcpy(buffer + ETH_ALEN * 2,
3626                         ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3627                         len - ETH_ALEN * 2 - off);
3628                 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3629 badmic:
3630                         dev_kfree_skb_irq (skb);
3631                         goto badrx;
3632                 }
3633 #ifdef WIRELESS_SPY
3634                 if (ai->spy_data.spy_number > 0) {
3635                         char *sa;
3636                         struct iw_quality wstats;
3637                         /* Prepare spy data : addr + qual */
3638                         sa = buffer + ETH_ALEN;
3639                         wstats.qual = 0; /* XXX Where do I get that info from ??? */
3640                         wstats.level = 0;
3641                         wstats.updated = 0;
3642                         /* Update spy records */
3643                         wireless_spy_update(ai->dev, sa, &wstats);
3644                 }
3645 #endif /* WIRELESS_SPY */
3646
3647                 skb->ip_summed = CHECKSUM_NONE;
3648                 skb->protocol = eth_type_trans(skb, ai->dev);
3649                 netif_rx(skb);
3650         }
3651 badrx:
3652         if (rxd.valid == 0) {
3653                 rxd.valid = 1;
3654                 rxd.rdy = 0;
3655                 rxd.len = PKTSIZE;
3656                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3657         }
3658 }
3659
3660 static void mpi_receive_802_11(struct airo_info *ai)
3661 {
3662         RxFid rxd;
3663         struct sk_buff *skb = NULL;
3664         u16 len, hdrlen = 0;
3665         __le16 fc;
3666         struct rx_hdr hdr;
3667         u16 gap;
3668         u16 *buffer;
3669         char *ptr = ai->rxfids[0].virtual_host_addr + 4;
3670
3671         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3672         memcpy ((char *)&hdr, ptr, sizeof(hdr));
3673         ptr += sizeof(hdr);
3674         /* Bad CRC. Ignore packet */
3675         if (le16_to_cpu(hdr.status) & 2)
3676                 hdr.len = 0;
3677         if (ai->wifidev == NULL)
3678                 hdr.len = 0;
3679         len = le16_to_cpu(hdr.len);
3680         if (len > AIRO_DEF_MTU) {
3681                 airo_print_err(ai->dev->name, "Bad size %d", len);
3682                 goto badrx;
3683         }
3684         if (len == 0)
3685                 goto badrx;
3686
3687         fc = get_unaligned((__le16 *)ptr);
3688         hdrlen = header_len(fc);
3689
3690         skb = dev_alloc_skb( len + hdrlen + 2 );
3691         if ( !skb ) {
3692                 ai->dev->stats.rx_dropped++;
3693                 goto badrx;
3694         }
3695         buffer = (u16*)skb_put (skb, len + hdrlen);
3696         memcpy ((char *)buffer, ptr, hdrlen);
3697         ptr += hdrlen;
3698         if (hdrlen == 24)
3699                 ptr += 6;
3700         gap = get_unaligned_le16(ptr);
3701         ptr += sizeof(__le16);
3702         if (gap) {
3703                 if (gap <= 8)
3704                         ptr += gap;
3705                 else
3706                         airo_print_err(ai->dev->name,
3707                             "gaplen too big. Problems will follow...");
3708         }
3709         memcpy ((char *)buffer + hdrlen, ptr, len);
3710         ptr += len;
3711 #ifdef IW_WIRELESS_SPY    /* defined in iw_handler.h */
3712         if (ai->spy_data.spy_number > 0) {
3713                 char *sa;
3714                 struct iw_quality wstats;
3715                 /* Prepare spy data : addr + qual */
3716                 sa = (char*)buffer + 10;
3717                 wstats.qual = hdr.rssi[0];
3718                 if (ai->rssi)
3719                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3720                 else
3721                         wstats.level = (hdr.rssi[1] + 321) / 2;
3722                 wstats.noise = ai->wstats.qual.noise;
3723                 wstats.updated = IW_QUAL_QUAL_UPDATED
3724                         | IW_QUAL_LEVEL_UPDATED
3725                         | IW_QUAL_DBM;
3726                 /* Update spy records */
3727                 wireless_spy_update(ai->dev, sa, &wstats);
3728         }
3729 #endif /* IW_WIRELESS_SPY */
3730         skb_reset_mac_header(skb);
3731         skb->pkt_type = PACKET_OTHERHOST;
3732         skb->dev = ai->wifidev;
3733         skb->protocol = htons(ETH_P_802_2);
3734         skb->ip_summed = CHECKSUM_NONE;
3735         netif_rx( skb );
3736
3737 badrx:
3738         if (rxd.valid == 0) {
3739                 rxd.valid = 1;
3740                 rxd.rdy = 0;
3741                 rxd.len = PKTSIZE;
3742                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3743         }
3744 }
3745
3746 static u16 setup_card(struct airo_info *ai, u8 *mac, int lock)
3747 {
3748         Cmd cmd;
3749         Resp rsp;
3750         int status;
3751         int i;
3752         SsidRid mySsid;
3753         __le16 lastindex;
3754         WepKeyRid wkr;
3755         int rc;
3756
3757         memset( &mySsid, 0, sizeof( mySsid ) );
3758         kfree (ai->flash);
3759         ai->flash = NULL;
3760
3761         /* The NOP is the first step in getting the card going */
3762         cmd.cmd = NOP;
3763         cmd.parm0 = cmd.parm1 = cmd.parm2 = 0;
3764         if (lock && down_interruptible(&ai->sem))
3765                 return ERROR;
3766         if ( issuecommand( ai, &cmd, &rsp ) != SUCCESS ) {
3767                 if (lock)
3768                         up(&ai->sem);
3769                 return ERROR;
3770         }
3771         disable_MAC( ai, 0);
3772
3773         // Let's figure out if we need to use the AUX port
3774         if (!test_bit(FLAG_MPI,&ai->flags)) {
3775                 cmd.cmd = CMD_ENABLEAUX;
3776                 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
3777                         if (lock)
3778                                 up(&ai->sem);
3779                         airo_print_err(ai->dev->name, "Error checking for AUX port");
3780                         return ERROR;
3781                 }
3782                 if (!aux_bap || rsp.status & 0xff00) {
3783                         ai->bap_read = fast_bap_read;
3784                         airo_print_dbg(ai->dev->name, "Doing fast bap_reads");
3785                 } else {
3786                         ai->bap_read = aux_bap_read;
3787                         airo_print_dbg(ai->dev->name, "Doing AUX bap_reads");
3788                 }
3789         }
3790         if (lock)
3791                 up(&ai->sem);
3792         if (ai->config.len == 0) {
3793                 tdsRssiRid rssi_rid;
3794                 CapabilityRid cap_rid;
3795
3796                 kfree(ai->APList);
3797                 ai->APList = NULL;
3798                 kfree(ai->SSID);
3799                 ai->SSID = NULL;
3800                 // general configuration (read/modify/write)
3801                 status = readConfigRid(ai, lock);
3802                 if ( status != SUCCESS ) return ERROR;
3803
3804                 status = readCapabilityRid(ai, &cap_rid, lock);
3805                 if ( status != SUCCESS ) return ERROR;
3806
3807                 status = PC4500_readrid(ai,RID_RSSI,&rssi_rid,sizeof(rssi_rid),lock);
3808                 if ( status == SUCCESS ) {
3809                         if (ai->rssi || (ai->rssi = kmalloc(512, GFP_KERNEL)) != NULL)
3810                                 memcpy(ai->rssi, (u8*)&rssi_rid + 2, 512); /* Skip RID length member */
3811                 }
3812                 else {
3813                         kfree(ai->rssi);
3814                         ai->rssi = NULL;
3815                         if (cap_rid.softCap & cpu_to_le16(8))
3816                                 ai->config.rmode |= RXMODE_NORMALIZED_RSSI;
3817                         else
3818                                 airo_print_warn(ai->dev->name, "unknown received signal "
3819                                                 "level scale");
3820                 }
3821                 ai->config.opmode = adhoc ? MODE_STA_IBSS : MODE_STA_ESS;
3822                 ai->config.authType = AUTH_OPEN;
3823                 ai->config.modulation = MOD_CCK;
3824
3825                 if (le16_to_cpu(cap_rid.len) >= sizeof(cap_rid) &&
3826                     (cap_rid.extSoftCap & cpu_to_le16(1)) &&
3827                     micsetup(ai) == SUCCESS) {
3828                         ai->config.opmode |= MODE_MIC;
3829                         set_bit(FLAG_MIC_CAPABLE, &ai->flags);
3830                 }
3831
3832                 /* Save off the MAC */
3833                 for( i = 0; i < ETH_ALEN; i++ ) {
3834                         mac[i] = ai->config.macAddr[i];
3835                 }
3836
3837                 /* Check to see if there are any insmod configured
3838                    rates to add */
3839                 if ( rates[0] ) {
3840                         int i = 0;
3841                         memset(ai->config.rates,0,sizeof(ai->config.rates));
3842                         for( i = 0; i < 8 && rates[i]; i++ ) {
3843                                 ai->config.rates[i] = rates[i];
3844                         }
3845                 }
3846                 if ( basic_rate > 0 ) {
3847                         int i;
3848                         for( i = 0; i < 8; i++ ) {
3849                                 if ( ai->config.rates[i] == basic_rate ||
3850                                      !ai->config.rates ) {
3851                                         ai->config.rates[i] = basic_rate | 0x80;
3852                                         break;
3853                                 }
3854                         }
3855                 }
3856                 set_bit (FLAG_COMMIT, &ai->flags);
3857         }
3858
3859         /* Setup the SSIDs if present */
3860         if ( ssids[0] ) {
3861                 int i;
3862                 for( i = 0; i < 3 && ssids[i]; i++ ) {
3863                         size_t len = strlen(ssids[i]);
3864                         if (len > 32)
3865                                 len = 32;
3866                         mySsid.ssids[i].len = cpu_to_le16(len);
3867                         memcpy(mySsid.ssids[i].ssid, ssids[i], len);
3868                 }
3869                 mySsid.len = cpu_to_le16(sizeof(mySsid));
3870         }
3871
3872         status = writeConfigRid(ai, lock);
3873         if ( status != SUCCESS ) return ERROR;
3874
3875         /* Set up the SSID list */
3876         if ( ssids[0] ) {
3877                 status = writeSsidRid(ai, &mySsid, lock);
3878                 if ( status != SUCCESS ) return ERROR;
3879         }
3880
3881         status = enable_MAC(ai, lock);
3882         if (status != SUCCESS)
3883                 return ERROR;
3884
3885         /* Grab the initial wep key, we gotta save it for auto_wep */
3886         rc = readWepKeyRid(ai, &wkr, 1, lock);
3887         if (rc == SUCCESS) do {
3888                 lastindex = wkr.kindex;
3889                 if (wkr.kindex == cpu_to_le16(0xffff)) {
3890                         ai->defindex = wkr.mac[0];
3891                 }
3892                 rc = readWepKeyRid(ai, &wkr, 0, lock);
3893         } while(lastindex != wkr.kindex);
3894
3895         try_auto_wep(ai);
3896
3897         return SUCCESS;
3898 }
3899
3900 static u16 issuecommand(struct airo_info *ai, Cmd *pCmd, Resp *pRsp) {
3901         // Im really paranoid about letting it run forever!
3902         int max_tries = 600000;
3903
3904         if (IN4500(ai, EVSTAT) & EV_CMD)
3905                 OUT4500(ai, EVACK, EV_CMD);
3906
3907         OUT4500(ai, PARAM0, pCmd->parm0);
3908         OUT4500(ai, PARAM1, pCmd->parm1);
3909         OUT4500(ai, PARAM2, pCmd->parm2);
3910         OUT4500(ai, COMMAND, pCmd->cmd);
3911
3912         while (max_tries-- && (IN4500(ai, EVSTAT) & EV_CMD) == 0) {
3913                 if ((IN4500(ai, COMMAND)) == pCmd->cmd)
3914                         // PC4500 didn't notice command, try again
3915                         OUT4500(ai, COMMAND, pCmd->cmd);
3916                 if (!in_atomic() && (max_tries & 255) == 0)
3917                         schedule();
3918         }
3919
3920         if ( max_tries == -1 ) {
3921                 airo_print_err(ai->dev->name,
3922                         "Max tries exceeded when issueing command");
3923                 if (IN4500(ai, COMMAND) & COMMAND_BUSY)
3924                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3925                 return ERROR;
3926         }
3927
3928         // command completed
3929         pRsp->status = IN4500(ai, STATUS);
3930         pRsp->rsp0 = IN4500(ai, RESP0);
3931         pRsp->rsp1 = IN4500(ai, RESP1);
3932         pRsp->rsp2 = IN4500(ai, RESP2);
3933         if ((pRsp->status & 0xff00)!=0 && pCmd->cmd != CMD_SOFTRESET)
3934                 airo_print_err(ai->dev->name,
3935                         "cmd:%x status:%x rsp0:%x rsp1:%x rsp2:%x",
3936                         pCmd->cmd, pRsp->status, pRsp->rsp0, pRsp->rsp1,
3937                         pRsp->rsp2);
3938
3939         // clear stuck command busy if necessary
3940         if (IN4500(ai, COMMAND) & COMMAND_BUSY) {
3941                 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3942         }
3943         // acknowledge processing the status/response
3944         OUT4500(ai, EVACK, EV_CMD);
3945
3946         return SUCCESS;
3947 }
3948
3949 /* Sets up the bap to start exchange data.  whichbap should
3950  * be one of the BAP0 or BAP1 defines.  Locks should be held before
3951  * calling! */
3952 static int bap_setup(struct airo_info *ai, u16 rid, u16 offset, int whichbap )
3953 {
3954         int timeout = 50;
3955         int max_tries = 3;
3956
3957         OUT4500(ai, SELECT0+whichbap, rid);
3958         OUT4500(ai, OFFSET0+whichbap, offset);
3959         while (1) {
3960                 int status = IN4500(ai, OFFSET0+whichbap);
3961                 if (status & BAP_BUSY) {
3962                         /* This isn't really a timeout, but its kinda
3963                            close */
3964                         if (timeout--) {
3965                                 continue;
3966                         }
3967                 } else if ( status & BAP_ERR ) {
3968                         /* invalid rid or offset */
3969                         airo_print_err(ai->dev->name, "BAP error %x %d",
3970                                 status, whichbap );
3971                         return ERROR;
3972                 } else if (status & BAP_DONE) { // success
3973                         return SUCCESS;
3974                 }
3975                 if ( !(max_tries--) ) {
3976                         airo_print_err(ai->dev->name,
3977                                 "BAP setup error too many retries\n");
3978                         return ERROR;
3979                 }
3980                 // -- PC4500 missed it, try again
3981                 OUT4500(ai, SELECT0+whichbap, rid);
3982                 OUT4500(ai, OFFSET0+whichbap, offset);
3983                 timeout = 50;
3984         }
3985 }
3986
3987 /* should only be called by aux_bap_read.  This aux function and the
3988    following use concepts not documented in the developers guide.  I
3989    got them from a patch given to my by Aironet */
3990 static u16 aux_setup(struct airo_info *ai, u16 page,
3991                      u16 offset, u16 *len)
3992 {
3993         u16 next;
3994
3995         OUT4500(ai, AUXPAGE, page);
3996         OUT4500(ai, AUXOFF, 0);
3997         next = IN4500(ai, AUXDATA);
3998         *len = IN4500(ai, AUXDATA)&0xff;
3999         if (offset != 4) OUT4500(ai, AUXOFF, offset);
4000         return next;
4001 }
4002
4003 /* requires call to bap_setup() first */
4004 static int aux_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4005                         int bytelen, int whichbap)
4006 {
4007         u16 len;
4008         u16 page;
4009         u16 offset;
4010         u16 next;
4011         int words;
4012         int i;
4013         unsigned long flags;
4014
4015         spin_lock_irqsave(&ai->aux_lock, flags);
4016         page = IN4500(ai, SWS0+whichbap);
4017         offset = IN4500(ai, SWS2+whichbap);
4018         next = aux_setup(ai, page, offset, &len);
4019         words = (bytelen+1)>>1;
4020
4021         for (i=0; i<words;) {
4022                 int count;
4023                 count = (len>>1) < (words-i) ? (len>>1) : (words-i);
4024                 if ( !do8bitIO )
4025                         insw( ai->dev->base_addr+DATA0+whichbap,
4026                               pu16Dst+i,count );
4027                 else
4028                         insb( ai->dev->base_addr+DATA0+whichbap,
4029                               pu16Dst+i, count << 1 );
4030                 i += count;
4031                 if (i<words) {
4032                         next = aux_setup(ai, next, 4, &len);
4033                 }
4034         }
4035         spin_unlock_irqrestore(&ai->aux_lock, flags);
4036         return SUCCESS;
4037 }
4038
4039
4040 /* requires call to bap_setup() first */
4041 static int fast_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4042                          int bytelen, int whichbap)
4043 {
4044         bytelen = (bytelen + 1) & (~1); // round up to even value
4045         if ( !do8bitIO )
4046                 insw( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen>>1 );
4047         else
4048                 insb( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen );
4049         return SUCCESS;
4050 }
4051
4052 /* requires call to bap_setup() first */
4053 static int bap_write(struct airo_info *ai, const __le16 *pu16Src,
4054                      int bytelen, int whichbap)
4055 {
4056         bytelen = (bytelen + 1) & (~1); // round up to even value
4057         if ( !do8bitIO )
4058                 outsw( ai->dev->base_addr+DATA0+whichbap,
4059                        pu16Src, bytelen>>1 );
4060         else
4061                 outsb( ai->dev->base_addr+DATA0+whichbap, pu16Src, bytelen );
4062         return SUCCESS;
4063 }
4064
4065 static int PC4500_accessrid(struct airo_info *ai, u16 rid, u16 accmd)
4066 {
4067         Cmd cmd; /* for issuing commands */
4068         Resp rsp; /* response from commands */
4069         u16 status;
4070
4071         memset(&cmd, 0, sizeof(cmd));
4072         cmd.cmd = accmd;
4073         cmd.parm0 = rid;
4074         status = issuecommand(ai, &cmd, &rsp);
4075         if (status != 0) return status;
4076         if ( (rsp.status & 0x7F00) != 0) {
4077                 return (accmd << 8) + (rsp.rsp0 & 0xFF);
4078         }
4079         return 0;
4080 }
4081
4082 /*  Note, that we are using BAP1 which is also used by transmit, so
4083  *  we must get a lock. */
4084 static int PC4500_readrid(struct airo_info *ai, u16 rid, void *pBuf, int len, int lock)
4085 {
4086         u16 status;
4087         int rc = SUCCESS;
4088
4089         if (lock) {
4090                 if (down_interruptible(&ai->sem))
4091                         return ERROR;
4092         }
4093         if (test_bit(FLAG_MPI,&ai->flags)) {
4094                 Cmd cmd;
4095                 Resp rsp;
4096
4097                 memset(&cmd, 0, sizeof(cmd));
4098                 memset(&rsp, 0, sizeof(rsp));
4099                 ai->config_desc.rid_desc.valid = 1;
4100                 ai->config_desc.rid_desc.len = RIDSIZE;
4101                 ai->config_desc.rid_desc.rid = 0;
4102                 ai->config_desc.rid_desc.host_addr = ai->ridbus;
4103
4104                 cmd.cmd = CMD_ACCESS;
4105                 cmd.parm0 = rid;
4106
4107                 memcpy_toio(ai->config_desc.card_ram_off,
4108                         &ai->config_desc.rid_desc, sizeof(Rid));
4109
4110                 rc = issuecommand(ai, &cmd, &rsp);
4111
4112                 if (rsp.status & 0x7f00)
4113                         rc = rsp.rsp0;
4114                 if (!rc)
4115                         memcpy(pBuf, ai->config_desc.virtual_host_addr, len);
4116                 goto done;
4117         } else {
4118                 if ((status = PC4500_accessrid(ai, rid, CMD_ACCESS))!=SUCCESS) {
4119                         rc = status;
4120                         goto done;
4121                 }
4122                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4123                         rc = ERROR;
4124                         goto done;
4125                 }
4126                 // read the rid length field
4127                 bap_read(ai, pBuf, 2, BAP1);
4128                 // length for remaining part of rid
4129                 len = min(len, (int)le16_to_cpu(*(__le16*)pBuf)) - 2;
4130
4131                 if ( len <= 2 ) {
4132                         airo_print_err(ai->dev->name,
4133                                 "Rid %x has a length of %d which is too short",
4134                                 (int)rid, (int)len );
4135                         rc = ERROR;
4136                         goto done;
4137                 }
4138                 // read remainder of the rid
4139                 rc = bap_read(ai, ((__le16*)pBuf)+1, len, BAP1);
4140         }
4141 done:
4142         if (lock)
4143                 up(&ai->sem);
4144         return rc;
4145 }
4146
4147 /*  Note, that we are using BAP1 which is also used by transmit, so
4148  *  make sure this isnt called when a transmit is happening */
4149 static int PC4500_writerid(struct airo_info *ai, u16 rid,
4150                            const void *pBuf, int len, int lock)
4151 {
4152         u16 status;
4153         int rc = SUCCESS;
4154
4155         *(__le16*)pBuf = cpu_to_le16((u16)len);
4156
4157         if (lock) {
4158                 if (down_interruptible(&ai->sem))
4159                         return ERROR;
4160         }
4161         if (test_bit(FLAG_MPI,&ai->flags)) {
4162                 Cmd cmd;
4163                 Resp rsp;
4164
4165                 if (test_bit(FLAG_ENABLED, &ai->flags) && (RID_WEP_TEMP != rid))
4166                         airo_print_err(ai->dev->name,
4167                                 "%s: MAC should be disabled (rid=%04x)",
4168                                 __func__, rid);
4169                 memset(&cmd, 0, sizeof(cmd));
4170                 memset(&rsp, 0, sizeof(rsp));
4171
4172                 ai->config_desc.rid_desc.valid = 1;
4173                 ai->config_desc.rid_desc.len = *((u16 *)pBuf);
4174                 ai->config_desc.rid_desc.rid = 0;
4175
4176                 cmd.cmd = CMD_WRITERID;
4177                 cmd.parm0 = rid;
4178
4179                 memcpy_toio(ai->config_desc.card_ram_off,
4180                         &ai->config_desc.rid_desc, sizeof(Rid));
4181
4182                 if (len < 4 || len > 2047) {
4183                         airo_print_err(ai->dev->name, "%s: len=%d", __func__, len);
4184                         rc = -1;
4185                 } else {
4186                         memcpy((char *)ai->config_desc.virtual_host_addr,
4187                                 pBuf, len);
4188
4189                         rc = issuecommand(ai, &cmd, &rsp);
4190                         if ((rc & 0xff00) != 0) {
4191                                 airo_print_err(ai->dev->name, "%s: Write rid Error %d",
4192                                                 __func__, rc);
4193                                 airo_print_err(ai->dev->name, "%s: Cmd=%04x",
4194                                                 __func__, cmd.cmd);
4195                         }
4196
4197                         if ((rsp.status & 0x7f00))
4198                                 rc = rsp.rsp0;
4199                 }
4200         } else {
4201                 // --- first access so that we can write the rid data
4202                 if ( (status = PC4500_accessrid(ai, rid, CMD_ACCESS)) != 0) {
4203                         rc = status;
4204                         goto done;
4205                 }
4206                 // --- now write the rid data
4207                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4208                         rc = ERROR;
4209                         goto done;
4210                 }
4211                 bap_write(ai, pBuf, len, BAP1);
4212                 // ---now commit the rid data
4213                 rc = PC4500_accessrid(ai, rid, 0x100|CMD_ACCESS);
4214         }
4215 done:
4216         if (lock)
4217                 up(&ai->sem);
4218         return rc;
4219 }
4220
4221 /* Allocates a FID to be used for transmitting packets.  We only use
4222    one for now. */
4223 static u16 transmit_allocate(struct airo_info *ai, int lenPayload, int raw)
4224 {
4225         unsigned int loop = 3000;
4226         Cmd cmd;
4227         Resp rsp;
4228         u16 txFid;
4229         __le16 txControl;
4230
4231         cmd.cmd = CMD_ALLOCATETX;
4232         cmd.parm0 = lenPayload;
4233         if (down_interruptible(&ai->sem))
4234                 return ERROR;
4235         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
4236                 txFid = ERROR;
4237                 goto done;
4238         }
4239         if ( (rsp.status & 0xFF00) != 0) {
4240                 txFid = ERROR;
4241                 goto done;
4242         }
4243         /* wait for the allocate event/indication
4244          * It makes me kind of nervous that this can just sit here and spin,
4245          * but in practice it only loops like four times. */
4246         while (((IN4500(ai, EVSTAT) & EV_ALLOC) == 0) && --loop);
4247         if (!loop) {
4248                 txFid = ERROR;
4249                 goto done;
4250         }
4251
4252         // get the allocated fid and acknowledge
4253         txFid = IN4500(ai, TXALLOCFID);
4254         OUT4500(ai, EVACK, EV_ALLOC);
4255
4256         /*  The CARD is pretty cool since it converts the ethernet packet
4257          *  into 802.11.  Also note that we don't release the FID since we
4258          *  will be using the same one over and over again. */
4259         /*  We only have to setup the control once since we are not
4260          *  releasing the fid. */
4261         if (raw)
4262                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_11
4263                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4264         else
4265                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_3
4266                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4267         if (bap_setup(ai, txFid, 0x0008, BAP1) != SUCCESS)
4268                 txFid = ERROR;
4269         else
4270                 bap_write(ai, &txControl, sizeof(txControl), BAP1);
4271
4272 done:
4273         up(&ai->sem);
4274
4275         return txFid;
4276 }
4277
4278 /* In general BAP1 is dedicated to transmiting packets.  However,
4279    since we need a BAP when accessing RIDs, we also use BAP1 for that.
4280    Make sure the BAP1 spinlock is held when this is called. */
4281 static int transmit_802_3_packet(struct airo_info *ai, int len, char *pPacket)
4282 {
4283         __le16 payloadLen;
4284         Cmd cmd;
4285         Resp rsp;
4286         int miclen = 0;
4287         u16 txFid = len;
4288         MICBuffer pMic;
4289
4290         len >>= 16;
4291
4292         if (len <= ETH_ALEN * 2) {
4293                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4294                 return ERROR;
4295         }
4296         len -= ETH_ALEN * 2;
4297
4298         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
4299             (ntohs(((__be16 *)pPacket)[6]) != 0x888E)) {
4300                 if (encapsulate(ai,(etherHead *)pPacket,&pMic,len) != SUCCESS)
4301                         return ERROR;
4302                 miclen = sizeof(pMic);
4303         }
4304         // packet is destination[6], source[6], payload[len-12]
4305         // write the payload length and dst/src/payload
4306         if (bap_setup(ai, txFid, 0x0036, BAP1) != SUCCESS) return ERROR;
4307         /* The hardware addresses aren't counted as part of the payload, so
4308          * we have to subtract the 12 bytes for the addresses off */
4309         payloadLen = cpu_to_le16(len + miclen);
4310         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4311         bap_write(ai, (__le16*)pPacket, sizeof(etherHead), BAP1);
4312         if (miclen)
4313                 bap_write(ai, (__le16*)&pMic, miclen, BAP1);
4314         bap_write(ai, (__le16*)(pPacket + sizeof(etherHead)), len, BAP1);
4315         // issue the transmit command
4316         memset( &cmd, 0, sizeof( cmd ) );
4317         cmd.cmd = CMD_TRANSMIT;
4318         cmd.parm0 = txFid;
4319         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4320         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4321         return SUCCESS;
4322 }
4323
4324 static int transmit_802_11_packet(struct airo_info *ai, int len, char *pPacket)
4325 {
4326         __le16 fc, payloadLen;
4327         Cmd cmd;
4328         Resp rsp;
4329         int hdrlen;
4330         static u8 tail[(30-10) + 2 + 6] = {[30-10] = 6};
4331         /* padding of header to full size + le16 gaplen (6) + gaplen bytes */
4332         u16 txFid = len;
4333         len >>= 16;
4334
4335         fc = *(__le16*)pPacket;
4336         hdrlen = header_len(fc);
4337
4338         if (len < hdrlen) {
4339                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4340                 return ERROR;
4341         }
4342
4343         /* packet is 802.11 header +  payload
4344          * write the payload length and dst/src/payload */
4345         if (bap_setup(ai, txFid, 6, BAP1) != SUCCESS) return ERROR;
4346         /* The 802.11 header aren't counted as part of the payload, so
4347          * we have to subtract the header bytes off */
4348         payloadLen = cpu_to_le16(len-hdrlen);
4349         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4350         if (bap_setup(ai, txFid, 0x0014, BAP1) != SUCCESS) return ERROR;
4351         bap_write(ai, (__le16 *)pPacket, hdrlen, BAP1);
4352         bap_write(ai, (__le16 *)(tail + (hdrlen - 10)), 38 - hdrlen, BAP1);
4353
4354         bap_write(ai, (__le16 *)(pPacket + hdrlen), len - hdrlen, BAP1);
4355         // issue the transmit command
4356         memset( &cmd, 0, sizeof( cmd ) );
4357         cmd.cmd = CMD_TRANSMIT;
4358         cmd.parm0 = txFid;
4359         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4360         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4361         return SUCCESS;
4362 }
4363
4364 /*
4365  *  This is the proc_fs routines.  It is a bit messier than I would
4366  *  like!  Feel free to clean it up!
4367  */
4368
4369 static ssize_t proc_read( struct file *file,
4370                           char __user *buffer,
4371                           size_t len,
4372                           loff_t *offset);
4373
4374 static ssize_t proc_write( struct file *file,
4375                            const char __user *buffer,
4376                            size_t len,
4377                            loff_t *offset );
4378 static int proc_close( struct inode *inode, struct file *file );
4379
4380 static int proc_stats_open( struct inode *inode, struct file *file );
4381 static int proc_statsdelta_open( struct inode *inode, struct file *file );
4382 static int proc_status_open( struct inode *inode, struct file *file );
4383 static int proc_SSID_open( struct inode *inode, struct file *file );
4384 static int proc_APList_open( struct inode *inode, struct file *file );
4385 static int proc_BSSList_open( struct inode *inode, struct file *file );
4386 static int proc_config_open( struct inode *inode, struct file *file );
4387 static int proc_wepkey_open( struct inode *inode, struct file *file );
4388
4389 static const struct file_operations proc_statsdelta_ops = {
4390         .owner          = THIS_MODULE,
4391         .read           = proc_read,
4392         .open           = proc_statsdelta_open,
4393         .release        = proc_close
4394 };
4395
4396 static const struct file_operations proc_stats_ops = {
4397         .owner          = THIS_MODULE,
4398         .read           = proc_read,
4399         .open           = proc_stats_open,
4400         .release        = proc_close
4401 };
4402
4403 static const struct file_operations proc_status_ops = {
4404         .owner          = THIS_MODULE,
4405         .read           = proc_read,
4406         .open           = proc_status_open,
4407         .release        = proc_close
4408 };
4409
4410 static const struct file_operations proc_SSID_ops = {
4411         .owner          = THIS_MODULE,
4412         .read           = proc_read,
4413         .write          = proc_write,
4414         .open           = proc_SSID_open,
4415         .release        = proc_close
4416 };
4417
4418 static const struct file_operations proc_BSSList_ops = {
4419         .owner          = THIS_MODULE,
4420         .read           = proc_read,
4421         .write          = proc_write,
4422         .open           = proc_BSSList_open,
4423         .release        = proc_close
4424 };
4425
4426 static const struct file_operations proc_APList_ops = {
4427         .owner          = THIS_MODULE,
4428         .read           = proc_read,
4429         .write          = proc_write,
4430         .open           = proc_APList_open,
4431         .release        = proc_close
4432 };
4433
4434 static const struct file_operations proc_config_ops = {
4435         .owner          = THIS_MODULE,
4436         .read           = proc_read,
4437         .write          = proc_write,
4438         .open           = proc_config_open,
4439         .release        = proc_close
4440 };
4441
4442 static const struct file_operations proc_wepkey_ops = {
4443         .owner          = THIS_MODULE,
4444         .read           = proc_read,
4445         .write          = proc_write,
4446         .open           = proc_wepkey_open,
4447         .release        = proc_close
4448 };
4449
4450 static struct proc_dir_entry *airo_entry;
4451
4452 struct proc_data {
4453         int release_buffer;
4454         int readlen;
4455         char *rbuffer;
4456         int writelen;
4457         int maxwritelen;
4458         char *wbuffer;
4459         void (*on_close) (struct inode *, struct file *);
4460 };
4461
4462 static int setup_proc_entry( struct net_device *dev,
4463                              struct airo_info *apriv ) {
4464         struct proc_dir_entry *entry;
4465         /* First setup the device directory */
4466         strcpy(apriv->proc_name,dev->name);
4467         apriv->proc_entry = create_proc_entry(apriv->proc_name,
4468                                               S_IFDIR|airo_perm,
4469                                               airo_entry);
4470         if (!apriv->proc_entry)
4471                 goto fail;
4472         apriv->proc_entry->uid = proc_uid;
4473         apriv->proc_entry->gid = proc_gid;
4474         apriv->proc_entry->owner = THIS_MODULE;
4475
4476         /* Setup the StatsDelta */
4477         entry = proc_create_data("StatsDelta",
4478                                  S_IFREG | (S_IRUGO&proc_perm),
4479                                  apriv->proc_entry, &proc_statsdelta_ops, dev);
4480         if (!entry)
4481                 goto fail_stats_delta;
4482         entry->uid = proc_uid;
4483         entry->gid = proc_gid;
4484
4485         /* Setup the Stats */
4486         entry = proc_create_data("Stats",
4487                                  S_IFREG | (S_IRUGO&proc_perm),
4488                                  apriv->proc_entry, &proc_stats_ops, dev);
4489         if (!entry)
4490                 goto fail_stats;
4491         entry->uid = proc_uid;
4492         entry->gid = proc_gid;
4493
4494         /* Setup the Status */
4495         entry = proc_create_data("Status",
4496                                  S_IFREG | (S_IRUGO&proc_perm),
4497                                  apriv->proc_entry, &proc_status_ops, dev);
4498         if (!entry)
4499                 goto fail_status;
4500         entry->uid = proc_uid;
4501         entry->gid = proc_gid;
4502
4503         /* Setup the Config */
4504         entry = proc_create_data("Config",
4505                                  S_IFREG | proc_perm,
4506                                  apriv->proc_entry, &proc_config_ops, dev);
4507         if (!entry)
4508                 goto fail_config;
4509         entry->uid = proc_uid;
4510         entry->gid = proc_gid;
4511
4512         /* Setup the SSID */
4513         entry = proc_create_data("SSID",
4514                                  S_IFREG | proc_perm,
4515                                  apriv->proc_entry, &proc_SSID_ops, dev);
4516         if (!entry)
4517                 goto fail_ssid;
4518         entry->uid = proc_uid;
4519         entry->gid = proc_gid;
4520
4521         /* Setup the APList */
4522         entry = proc_create_data("APList",
4523                                  S_IFREG | proc_perm,
4524                                  apriv->proc_entry, &proc_APList_ops, dev);
4525         if (!entry)
4526                 goto fail_aplist;
4527         entry->uid = proc_uid;
4528         entry->gid = proc_gid;
4529
4530         /* Setup the BSSList */
4531         entry = proc_create_data("BSSList",
4532                                  S_IFREG | proc_perm,
4533                                  apriv->proc_entry, &proc_BSSList_ops, dev);
4534         if (!entry)
4535                 goto fail_bsslist;
4536         entry->uid = proc_uid;
4537         entry->gid = proc_gid;
4538
4539         /* Setup the WepKey */
4540         entry = proc_create_data("WepKey",
4541                                  S_IFREG | proc_perm,
4542                                  apriv->proc_entry, &proc_wepkey_ops, dev);
4543         if (!entry)
4544                 goto fail_wepkey;
4545         entry->uid = proc_uid;
4546         entry->gid = proc_gid;
4547
4548         return 0;
4549
4550 fail_wepkey:
4551         remove_proc_entry("BSSList", apriv->proc_entry);
4552 fail_bsslist:
4553         remove_proc_entry("APList", apriv->proc_entry);
4554 fail_aplist:
4555         remove_proc_entry("SSID", apriv->proc_entry);
4556 fail_ssid:
4557         remove_proc_entry("Config", apriv->proc_entry);
4558 fail_config:
4559         remove_proc_entry("Status", apriv->proc_entry);
4560 fail_status:
4561         remove_proc_entry("Stats", apriv->proc_entry);
4562 fail_stats:
4563         remove_proc_entry("StatsDelta", apriv->proc_entry);
4564 fail_stats_delta:
4565         remove_proc_entry(apriv->proc_name, airo_entry);
4566 fail:
4567         return -ENOMEM;
4568 }
4569
4570 static int takedown_proc_entry( struct net_device *dev,
4571                                 struct airo_info *apriv ) {
4572         if ( !apriv->proc_entry->namelen ) return 0;
4573         remove_proc_entry("Stats",apriv->proc_entry);
4574         remove_proc_entry("StatsDelta",apriv->proc_entry);
4575         remove_proc_entry("Status",apriv->proc_entry);
4576         remove_proc_entry("Config",apriv->proc_entry);
4577         remove_proc_entry("SSID",apriv->proc_entry);
4578         remove_proc_entry("APList",apriv->proc_entry);
4579         remove_proc_entry("BSSList",apriv->proc_entry);
4580         remove_proc_entry("WepKey",apriv->proc_entry);
4581         remove_proc_entry(apriv->proc_name,airo_entry);
4582         return 0;
4583 }
4584
4585 /*
4586  *  What we want from the proc_fs is to be able to efficiently read
4587  *  and write the configuration.  To do this, we want to read the
4588  *  configuration when the file is opened and write it when the file is
4589  *  closed.  So basically we allocate a read buffer at open and fill it
4590  *  with data, and allocate a write buffer and read it at close.
4591  */
4592
4593 /*
4594  *  The read routine is generic, it relies on the preallocated rbuffer
4595  *  to supply the data.
4596  */
4597 static ssize_t proc_read( struct file *file,
4598                           char __user *buffer,
4599                           size_t len,
4600                           loff_t *offset )
4601 {
4602         struct proc_data *priv = file->private_data;
4603
4604         if (!priv->rbuffer)
4605                 return -EINVAL;
4606
4607         return simple_read_from_buffer(buffer, len, offset, priv->rbuffer,
4608                                         priv->readlen);
4609 }
4610
4611 /*
4612  *  The write routine is generic, it fills in a preallocated rbuffer
4613  *  to supply the data.
4614  */
4615 static ssize_t proc_write( struct file *file,
4616                            const char __user *buffer,
4617                            size_t len,
4618                            loff_t *offset )
4619 {
4620         loff_t pos = *offset;
4621         struct proc_data *priv = (struct proc_data*)file->private_data;
4622
4623         if (!priv->wbuffer)
4624                 return -EINVAL;
4625
4626         if (pos < 0)
4627                 return -EINVAL;
4628         if (pos >= priv->maxwritelen)
4629                 return 0;
4630         if (len > priv->maxwritelen - pos)
4631                 len = priv->maxwritelen - pos;
4632         if (copy_from_user(priv->wbuffer + pos, buffer, len))
4633                 return -EFAULT;
4634         if ( pos + len > priv->writelen )
4635                 priv->writelen = len + file->f_pos;
4636         *offset = pos + len;
4637         return len;
4638 }
4639
4640 static int proc_status_open(struct inode *inode, struct file *file)
4641 {
4642         struct proc_data *data;
4643         struct proc_dir_entry *dp = PDE(inode);
4644         struct net_device *dev = dp->data;
4645         struct airo_info *apriv = dev->ml_priv;
4646         CapabilityRid cap_rid;
4647         StatusRid status_rid;
4648         u16 mode;
4649         int i;
4650
4651         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4652                 return -ENOMEM;
4653         data = (struct proc_data *)file->private_data;
4654         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4655                 kfree (file->private_data);
4656                 return -ENOMEM;
4657         }
4658
4659         readStatusRid(apriv, &status_rid, 1);
4660         readCapabilityRid(apriv, &cap_rid, 1);
4661
4662         mode = le16_to_cpu(status_rid.mode);
4663
4664         i = sprintf(data->rbuffer, "Status: %s%s%s%s%s%s%s%s%s\n",
4665                     mode & 1 ? "CFG ": "",
4666                     mode & 2 ? "ACT ": "",
4667                     mode & 0x10 ? "SYN ": "",
4668                     mode & 0x20 ? "LNK ": "",
4669                     mode & 0x40 ? "LEAP ": "",
4670                     mode & 0x80 ? "PRIV ": "",
4671                     mode & 0x100 ? "KEY ": "",
4672                     mode & 0x200 ? "WEP ": "",
4673                     mode & 0x8000 ? "ERR ": "");
4674         sprintf( data->rbuffer+i, "Mode: %x\n"
4675                  "Signal Strength: %d\n"
4676                  "Signal Quality: %d\n"
4677                  "SSID: %-.*s\n"
4678                  "AP: %-.16s\n"
4679                  "Freq: %d\n"
4680                  "BitRate: %dmbs\n"
4681                  "Driver Version: %s\n"
4682                  "Device: %s\nManufacturer: %s\nFirmware Version: %s\n"
4683                  "Radio type: %x\nCountry: %x\nHardware Version: %x\n"
4684                  "Software Version: %x\nSoftware Subversion: %x\n"
4685                  "Boot block version: %x\n",
4686                  le16_to_cpu(status_rid.mode),
4687                  le16_to_cpu(status_rid.normalizedSignalStrength),
4688                  le16_to_cpu(status_rid.signalQuality),
4689                  le16_to_cpu(status_rid.SSIDlen),
4690                  status_rid.SSID,
4691                  status_rid.apName,
4692                  le16_to_cpu(status_rid.channel),
4693                  le16_to_cpu(status_rid.currentXmitRate) / 2,
4694                  version,
4695                  cap_rid.prodName,
4696                  cap_rid.manName,
4697                  cap_rid.prodVer,
4698                  le16_to_cpu(cap_rid.radioType),
4699                  le16_to_cpu(cap_rid.country),
4700                  le16_to_cpu(cap_rid.hardVer),
4701                  le16_to_cpu(cap_rid.softVer),
4702                  le16_to_cpu(cap_rid.softSubVer),
4703                  le16_to_cpu(cap_rid.bootBlockVer));
4704         data->readlen = strlen( data->rbuffer );
4705         return 0;
4706 }
4707
4708 static int proc_stats_rid_open(struct inode*, struct file*, u16);
4709 static int proc_statsdelta_open( struct inode *inode,
4710                                  struct file *file ) {
4711         if (file->f_mode&FMODE_WRITE) {
4712                 return proc_stats_rid_open(inode, file, RID_STATSDELTACLEAR);
4713         }
4714         return proc_stats_rid_open(inode, file, RID_STATSDELTA);
4715 }
4716
4717 static int proc_stats_open( struct inode *inode, struct file *file ) {
4718         return proc_stats_rid_open(inode, file, RID_STATS);
4719 }
4720
4721 static int proc_stats_rid_open( struct inode *inode,
4722                                 struct file *file,
4723                                 u16 rid )
4724 {
4725         struct proc_data *data;
4726         struct proc_dir_entry *dp = PDE(inode);
4727         struct net_device *dev = dp->data;
4728         struct airo_info *apriv = dev->ml_priv;
4729         StatsRid stats;
4730         int i, j;
4731         __le32 *vals = stats.vals;
4732         int len = le16_to_cpu(stats.len);
4733
4734         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4735                 return -ENOMEM;
4736         data = (struct proc_data *)file->private_data;
4737         if ((data->rbuffer = kmalloc( 4096, GFP_KERNEL )) == NULL) {
4738                 kfree (file->private_data);
4739                 return -ENOMEM;
4740         }
4741
4742         readStatsRid(apriv, &stats, rid, 1);
4743
4744         j = 0;
4745         for(i=0; statsLabels[i]!=(char *)-1 && i*4<len; i++) {
4746                 if (!statsLabels[i]) continue;
4747                 if (j+strlen(statsLabels[i])+16>4096) {
4748                         airo_print_warn(apriv->dev->name,
4749                                "Potentially disasterous buffer overflow averted!");
4750                         break;
4751                 }
4752                 j+=sprintf(data->rbuffer+j, "%s: %u\n", statsLabels[i],
4753                                 le32_to_cpu(vals[i]));
4754         }
4755         if (i*4 >= len) {
4756                 airo_print_warn(apriv->dev->name, "Got a short rid");
4757         }
4758         data->readlen = j;
4759         return 0;
4760 }
4761
4762 static int get_dec_u16( char *buffer, int *start, int limit ) {
4763         u16 value;
4764         int valid = 0;
4765         for( value = 0; buffer[*start] >= '0' &&
4766                      buffer[*start] <= '9' &&
4767                      *start < limit; (*start)++ ) {
4768                 valid = 1;
4769                 value *= 10;
4770                 value += buffer[*start] - '0';
4771         }
4772         if ( !valid ) return -1;
4773         return value;
4774 }
4775
4776 static int airo_config_commit(struct net_device *dev,
4777                               struct iw_request_info *info, void *zwrq,
4778                               char *extra);
4779
4780 static inline int sniffing_mode(struct airo_info *ai)
4781 {
4782         return le16_to_cpu(ai->config.rmode & RXMODE_MASK) >=
4783                 le16_to_cpu(RXMODE_RFMON);
4784 }
4785
4786 static void proc_config_on_close(struct inode *inode, struct file *file)
4787 {
4788         struct proc_data *data = file->private_data;
4789         struct proc_dir_entry *dp = PDE(inode);
4790         struct net_device *dev = dp->data;
4791         struct airo_info *ai = dev->ml_priv;
4792         char *line;
4793
4794         if ( !data->writelen ) return;
4795
4796         readConfigRid(ai, 1);
4797         set_bit (FLAG_COMMIT, &ai->flags);
4798
4799         line = data->wbuffer;
4800         while( line[0] ) {
4801 /*** Mode processing */
4802                 if ( !strncmp( line, "Mode: ", 6 ) ) {
4803                         line += 6;
4804                         if (sniffing_mode(ai))
4805                                 set_bit (FLAG_RESET, &ai->flags);
4806                         ai->config.rmode &= ~RXMODE_FULL_MASK;
4807                         clear_bit (FLAG_802_11, &ai->flags);
4808                         ai->config.opmode &= ~MODE_CFG_MASK;
4809                         ai->config.scanMode = SCANMODE_ACTIVE;
4810                         if ( line[0] == 'a' ) {
4811                                 ai->config.opmode |= MODE_STA_IBSS;
4812                         } else {
4813                                 ai->config.opmode |= MODE_STA_ESS;
4814                                 if ( line[0] == 'r' ) {
4815                                         ai->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
4816                                         ai->config.scanMode = SCANMODE_PASSIVE;
4817                                         set_bit (FLAG_802_11, &ai->flags);
4818                                 } else if ( line[0] == 'y' ) {
4819                                         ai->config.rmode |= RXMODE_RFMON_ANYBSS | RXMODE_DISABLE_802_3_HEADER;
4820                                         ai->config.scanMode = SCANMODE_PASSIVE;
4821                                         set_bit (FLAG_802_11, &ai->flags);
4822                                 } else if ( line[0] == 'l' )
4823                                         ai->config.rmode |= RXMODE_LANMON;
4824                         }
4825                         set_bit (FLAG_COMMIT, &ai->flags);
4826                 }
4827
4828 /*** Radio status */
4829                 else if (!strncmp(line,"Radio: ", 7)) {
4830                         line += 7;
4831                         if (!strncmp(line,"off",3)) {
4832                                 set_bit (FLAG_RADIO_OFF, &ai->flags);
4833                         } else {
4834                                 clear_bit (FLAG_RADIO_OFF, &ai->flags);
4835                         }
4836                 }
4837 /*** NodeName processing */
4838                 else if ( !strncmp( line, "NodeName: ", 10 ) ) {
4839                         int j;
4840
4841                         line += 10;
4842                         memset( ai->config.nodeName, 0, 16 );
4843 /* Do the name, assume a space between the mode and node name */
4844                         for( j = 0; j < 16 && line[j] != '\n'; j++ ) {
4845                                 ai->config.nodeName[j] = line[j];
4846                         }
4847                         set_bit (FLAG_COMMIT, &ai->flags);
4848                 }
4849
4850 /*** PowerMode processing */
4851                 else if ( !strncmp( line, "PowerMode: ", 11 ) ) {
4852                         line += 11;
4853                         if ( !strncmp( line, "PSPCAM", 6 ) ) {
4854                                 ai->config.powerSaveMode = POWERSAVE_PSPCAM;
4855                                 set_bit (FLAG_COMMIT, &ai->flags);
4856                         } else if ( !strncmp( line, "PSP", 3 ) ) {
4857                                 ai->config.powerSaveMode = POWERSAVE_PSP;
4858                                 set_bit (FLAG_COMMIT, &ai->flags);
4859                         } else {
4860                                 ai->config.powerSaveMode = POWERSAVE_CAM;
4861                                 set_bit (FLAG_COMMIT, &ai->flags);
4862                         }
4863                 } else if ( !strncmp( line, "DataRates: ", 11 ) ) {
4864                         int v, i = 0, k = 0; /* i is index into line,
4865                                                 k is index to rates */
4866
4867                         line += 11;
4868                         while((v = get_dec_u16(line, &i, 3))!=-1) {
4869                                 ai->config.rates[k++] = (u8)v;
4870                                 line += i + 1;
4871                                 i = 0;
4872                         }
4873                         set_bit (FLAG_COMMIT, &ai->flags);
4874                 } else if ( !strncmp( line, "Channel: ", 9 ) ) {
4875                         int v, i = 0;
4876                         line += 9;
4877                         v = get_dec_u16(line, &i, i+3);
4878                         if ( v != -1 ) {
4879                                 ai->config.channelSet = cpu_to_le16(v);
4880                                 set_bit (FLAG_COMMIT, &ai->flags);
4881                         }
4882                 } else if ( !strncmp( line, "XmitPower: ", 11 ) ) {
4883                         int v, i = 0;
4884                         line += 11;
4885                         v = get_dec_u16(line, &i, i+3);
4886                         if ( v != -1 ) {
4887                                 ai->config.txPower = cpu_to_le16(v);
4888                                 set_bit (FLAG_COMMIT, &ai->flags);
4889                         }
4890                 } else if ( !strncmp( line, "WEP: ", 5 ) ) {
4891                         line += 5;
4892                         switch( line[0] ) {
4893                         case 's':
4894                                 ai->config.authType = AUTH_SHAREDKEY;
4895                                 break;
4896                         case 'e':
4897                                 ai->config.authType = AUTH_ENCRYPT;
4898                                 break;
4899                         default:
4900                                 ai->config.authType = AUTH_OPEN;
4901                                 break;
4902                         }
4903                         set_bit (FLAG_COMMIT, &ai->flags);
4904                 } else if ( !strncmp( line, "LongRetryLimit: ", 16 ) ) {
4905                         int v, i = 0;
4906
4907                         line += 16;
4908                         v = get_dec_u16(line, &i, 3);
4909                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4910                         ai->config.longRetryLimit = cpu_to_le16(v);
4911                         set_bit (FLAG_COMMIT, &ai->flags);
4912                 } else if ( !strncmp( line, "ShortRetryLimit: ", 17 ) ) {
4913                         int v, i = 0;
4914
4915                         line += 17;
4916                         v = get_dec_u16(line, &i, 3);
4917                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4918                         ai->config.shortRetryLimit = cpu_to_le16(v);
4919                         set_bit (FLAG_COMMIT, &ai->flags);
4920                 } else if ( !strncmp( line, "RTSThreshold: ", 14 ) ) {
4921                         int v, i = 0;
4922
4923                         line += 14;
4924                         v = get_dec_u16(line, &i, 4);
4925                         v = (v<0) ? 0 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4926                         ai->config.rtsThres = cpu_to_le16(v);
4927                         set_bit (FLAG_COMMIT, &ai->flags);
4928                 } else if ( !strncmp( line, "TXMSDULifetime: ", 16 ) ) {
4929                         int v, i = 0;
4930
4931                         line += 16;
4932                         v = get_dec_u16(line, &i, 5);
4933                         v = (v<0) ? 0 : v;
4934                         ai->config.txLifetime = cpu_to_le16(v);
4935                         set_bit (FLAG_COMMIT, &ai->flags);
4936                 } else if ( !strncmp( line, "RXMSDULifetime: ", 16 ) ) {
4937                         int v, i = 0;
4938
4939                         line += 16;
4940                         v = get_dec_u16(line, &i, 5);
4941                         v = (v<0) ? 0 : v;
4942                         ai->config.rxLifetime = cpu_to_le16(v);
4943                         set_bit (FLAG_COMMIT, &ai->flags);
4944                 } else if ( !strncmp( line, "TXDiversity: ", 13 ) ) {
4945                         ai->config.txDiversity =
4946                                 (line[13]=='l') ? 1 :
4947                                 ((line[13]=='r')? 2: 3);
4948                         set_bit (FLAG_COMMIT, &ai->flags);
4949                 } else if ( !strncmp( line, "RXDiversity: ", 13 ) ) {
4950                         ai->config.rxDiversity =
4951                                 (line[13]=='l') ? 1 :
4952                                 ((line[13]=='r')? 2: 3);
4953                         set_bit (FLAG_COMMIT, &ai->flags);
4954                 } else if ( !strncmp( line, "FragThreshold: ", 15 ) ) {
4955                         int v, i = 0;
4956
4957                         line += 15;
4958                         v = get_dec_u16(line, &i, 4);
4959                         v = (v<256) ? 256 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4960                         v = v & 0xfffe; /* Make sure its even */
4961                         ai->config.fragThresh = cpu_to_le16(v);
4962                         set_bit (FLAG_COMMIT, &ai->flags);
4963                 } else if (!strncmp(line, "Modulation: ", 12)) {
4964                         line += 12;
4965                         switch(*line) {
4966                         case 'd':  ai->config.modulation=MOD_DEFAULT; set_bit(FLAG_COMMIT, &ai->flags); break;
4967                         case 'c':  ai->config.modulation=MOD_CCK; set_bit(FLAG_COMMIT, &ai->flags); break;
4968                         case 'm':  ai->config.modulation=MOD_MOK; set_bit(FLAG_COMMIT, &ai->flags); break;
4969                         default: airo_print_warn(ai->dev->name, "Unknown modulation");
4970                         }
4971                 } else if (!strncmp(line, "Preamble: ", 10)) {
4972                         line += 10;
4973                         switch(*line) {
4974                         case 'a': ai->config.preamble=PREAMBLE_AUTO; set_bit(FLAG_COMMIT, &ai->flags); break;
4975                         case 'l': ai->config.preamble=PREAMBLE_LONG; set_bit(FLAG_COMMIT, &ai->flags); break;
4976                         case 's': ai->config.preamble=PREAMBLE_SHORT; set_bit(FLAG_COMMIT, &ai->flags); break;
4977                         default: airo_print_warn(ai->dev->name, "Unknown preamble");
4978                         }
4979                 } else {
4980                         airo_print_warn(ai->dev->name, "Couldn't figure out %s", line);
4981                 }
4982                 while( line[0] && line[0] != '\n' ) line++;
4983                 if ( line[0] ) line++;
4984         }
4985         airo_config_commit(dev, NULL, NULL, NULL);
4986 }
4987
4988 static char *get_rmode(__le16 mode)
4989 {
4990         switch(mode & RXMODE_MASK) {
4991         case RXMODE_RFMON:  return "rfmon";
4992         case RXMODE_RFMON_ANYBSS:  return "yna (any) bss rfmon";
4993         case RXMODE_LANMON:  return "lanmon";
4994         }
4995         return "ESS";
4996 }
4997
4998 static int proc_config_open(struct inode *inode, struct file *file)
4999 {
5000         struct proc_data *data;
5001         struct proc_dir_entry *dp = PDE(inode);
5002         struct net_device *dev = dp->data;
5003         struct airo_info *ai = dev->ml_priv;
5004         int i;
5005         __le16 mode;
5006
5007         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5008                 return -ENOMEM;
5009         data = (struct proc_data *)file->private_data;
5010         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
5011                 kfree (file->private_data);
5012                 return -ENOMEM;
5013         }
5014         if ((data->wbuffer = kzalloc( 2048, GFP_KERNEL )) == NULL) {
5015                 kfree (data->rbuffer);
5016                 kfree (file->private_data);
5017                 return -ENOMEM;
5018         }
5019         data->maxwritelen = 2048;
5020         data->on_close = proc_config_on_close;
5021
5022         readConfigRid(ai, 1);
5023
5024         mode = ai->config.opmode & MODE_CFG_MASK;
5025         i = sprintf( data->rbuffer,
5026                      "Mode: %s\n"
5027                      "Radio: %s\n"
5028                      "NodeName: %-16s\n"
5029                      "PowerMode: %s\n"
5030                      "DataRates: %d %d %d %d %d %d %d %d\n"
5031                      "Channel: %d\n"
5032                      "XmitPower: %d\n",
5033                      mode == MODE_STA_IBSS ? "adhoc" :
5034                      mode == MODE_STA_ESS ? get_rmode(ai->config.rmode):
5035                      mode == MODE_AP ? "AP" :
5036                      mode == MODE_AP_RPTR ? "AP RPTR" : "Error",
5037                      test_bit(FLAG_RADIO_OFF, &ai->flags) ? "off" : "on",
5038                      ai->config.nodeName,
5039                      ai->config.powerSaveMode == POWERSAVE_CAM ? "CAM" :
5040                      ai->config.powerSaveMode == POWERSAVE_PSP ? "PSP" :
5041                      ai->config.powerSaveMode == POWERSAVE_PSPCAM ? "PSPCAM" :
5042                      "Error",
5043                      (int)ai->config.rates[0],
5044                      (int)ai->config.rates[1],
5045                      (int)ai->config.rates[2],
5046                      (int)ai->config.rates[3],
5047                      (int)ai->config.rates[4],
5048                      (int)ai->config.rates[5],
5049                      (int)ai->config.rates[6],
5050                      (int)ai->config.rates[7],
5051                      le16_to_cpu(ai->config.channelSet),
5052                      le16_to_cpu(ai->config.txPower)
5053                 );
5054         sprintf( data->rbuffer + i,
5055                  "LongRetryLimit: %d\n"
5056                  "ShortRetryLimit: %d\n"
5057                  "RTSThreshold: %d\n"
5058                  "TXMSDULifetime: %d\n"
5059                  "RXMSDULifetime: %d\n"
5060                  "TXDiversity: %s\n"
5061                  "RXDiversity: %s\n"
5062                  "FragThreshold: %d\n"
5063                  "WEP: %s\n"
5064                  "Modulation: %s\n"
5065                  "Preamble: %s\n",
5066                  le16_to_cpu(ai->config.longRetryLimit),
5067                  le16_to_cpu(ai->config.shortRetryLimit),
5068                  le16_to_cpu(ai->config.rtsThres),
5069                  le16_to_cpu(ai->config.txLifetime),
5070                  le16_to_cpu(ai->config.rxLifetime),
5071                  ai->config.txDiversity == 1 ? "left" :
5072                  ai->config.txDiversity == 2 ? "right" : "both",
5073                  ai->config.rxDiversity == 1 ? "left" :
5074                  ai->config.rxDiversity == 2 ? "right" : "both",
5075                  le16_to_cpu(ai->config.fragThresh),
5076                  ai->config.authType == AUTH_ENCRYPT ? "encrypt" :
5077                  ai->config.authType == AUTH_SHAREDKEY ? "shared" : "open",
5078                  ai->config.modulation == MOD_DEFAULT ? "default" :
5079                  ai->config.modulation == MOD_CCK ? "cck" :
5080                  ai->config.modulation == MOD_MOK ? "mok" : "error",
5081                  ai->config.preamble == PREAMBLE_AUTO ? "auto" :
5082                  ai->config.preamble == PREAMBLE_LONG ? "long" :
5083                  ai->config.preamble == PREAMBLE_SHORT ? "short" : "error"
5084                 );
5085         data->readlen = strlen( data->rbuffer );
5086         return 0;
5087 }
5088
5089 static void proc_SSID_on_close(struct inode *inode, struct file *file)
5090 {
5091         struct proc_data *data = (struct proc_data *)file->private_data;
5092         struct proc_dir_entry *dp = PDE(inode);
5093         struct net_device *dev = dp->data;
5094         struct airo_info *ai = dev->ml_priv;
5095         SsidRid SSID_rid;
5096         int i;
5097         char *p = data->wbuffer;
5098         char *end = p + data->writelen;
5099
5100         if (!data->writelen)
5101                 return;
5102
5103         *end = '\n'; /* sentinel; we have space for it */
5104
5105         memset(&SSID_rid, 0, sizeof(SSID_rid));
5106
5107         for (i = 0; i < 3 && p < end; i++) {
5108                 int j = 0;
5109                 /* copy up to 32 characters from this line */
5110                 while (*p != '\n' && j < 32)
5111                         SSID_rid.ssids[i].ssid[j++] = *p++;
5112                 if (j == 0)
5113                         break;
5114                 SSID_rid.ssids[i].len = cpu_to_le16(j);
5115                 /* skip to the beginning of the next line */
5116                 while (*p++ != '\n')
5117                         ;
5118         }
5119         if (i)
5120                 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5121         disable_MAC(ai, 1);
5122         writeSsidRid(ai, &SSID_rid, 1);
5123         enable_MAC(ai, 1);
5124 }
5125
5126 static inline u8 hexVal(char c) {
5127         if (c>='0' && c<='9') return c -= '0';
5128         if (c>='a' && c<='f') return c -= 'a'-10;
5129         if (c>='A' && c<='F') return c -= 'A'-10;
5130         return 0;
5131 }
5132
5133 static void proc_APList_on_close( struct inode *inode, struct file *file ) {
5134         struct proc_data *data = (struct proc_data *)file->private_data;
5135         struct proc_dir_entry *dp = PDE(inode);
5136         struct net_device *dev = dp->data;
5137         struct airo_info *ai = dev->ml_priv;
5138         APListRid APList_rid;
5139         int i;
5140
5141         if ( !data->writelen ) return;
5142
5143         memset( &APList_rid, 0, sizeof(APList_rid) );
5144         APList_rid.len = cpu_to_le16(sizeof(APList_rid));
5145
5146         for( i = 0; i < 4 && data->writelen >= (i+1)*6*3; i++ ) {
5147                 int j;
5148                 for( j = 0; j < 6*3 && data->wbuffer[j+i*6*3]; j++ ) {
5149                         switch(j%3) {
5150                         case 0:
5151                                 APList_rid.ap[i][j/3]=
5152                                         hexVal(data->wbuffer[j+i*6*3])<<4;
5153                                 break;
5154                         case 1:
5155                                 APList_rid.ap[i][j/3]|=
5156                                         hexVal(data->wbuffer[j+i*6*3]);
5157                                 break;
5158                         }
5159                 }
5160         }
5161         disable_MAC(ai, 1);
5162         writeAPListRid(ai, &APList_rid, 1);
5163         enable_MAC(ai, 1);
5164 }
5165
5166 /* This function wraps PC4500_writerid with a MAC disable */
5167 static int do_writerid( struct airo_info *ai, u16 rid, const void *rid_data,
5168                         int len, int dummy ) {
5169         int rc;
5170
5171         disable_MAC(ai, 1);
5172         rc = PC4500_writerid(ai, rid, rid_data, len, 1);
5173         enable_MAC(ai, 1);
5174         return rc;
5175 }
5176
5177 /* Returns the WEP key at the specified index, or -1 if that key does
5178  * not exist.  The buffer is assumed to be at least 16 bytes in length.
5179  */
5180 static int get_wep_key(struct airo_info *ai, u16 index, char *buf, u16 buflen)
5181 {
5182         WepKeyRid wkr;
5183         int rc;
5184         __le16 lastindex;
5185
5186         rc = readWepKeyRid(ai, &wkr, 1, 1);
5187         if (rc != SUCCESS)
5188                 return -1;
5189         do {
5190                 lastindex = wkr.kindex;
5191                 if (le16_to_cpu(wkr.kindex) == index) {
5192                         int klen = min_t(int, buflen, le16_to_cpu(wkr.klen));
5193                         memcpy(buf, wkr.key, klen);
5194                         return klen;
5195                 }
5196                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5197                 if (rc != SUCCESS)
5198                         return -1;
5199         } while (lastindex != wkr.kindex);
5200         return -1;
5201 }
5202
5203 static int get_wep_tx_idx(struct airo_info *ai)
5204 {
5205         WepKeyRid wkr;
5206         int rc;
5207         __le16 lastindex;
5208
5209         rc = readWepKeyRid(ai, &wkr, 1, 1);
5210         if (rc != SUCCESS)
5211                 return -1;
5212         do {
5213                 lastindex = wkr.kindex;
5214                 if (wkr.kindex == cpu_to_le16(0xffff))
5215                         return wkr.mac[0];
5216                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5217                 if (rc != SUCCESS)
5218                         return -1;
5219         } while (lastindex != wkr.kindex);
5220         return -1;
5221 }
5222
5223 static int set_wep_key(struct airo_info *ai, u16 index, const char *key,
5224                        u16 keylen, int perm, int lock)
5225 {
5226         static const unsigned char macaddr[ETH_ALEN] = { 0x01, 0, 0, 0, 0, 0 };
5227         WepKeyRid wkr;
5228         int rc;
5229
5230         if (keylen == 0) {
5231                 airo_print_err(ai->dev->name, "%s: key length to set was zero",
5232                                __func__);
5233                 return -1;
5234         }
5235
5236         memset(&wkr, 0, sizeof(wkr));
5237         wkr.len = cpu_to_le16(sizeof(wkr));
5238         wkr.kindex = cpu_to_le16(index);
5239         wkr.klen = cpu_to_le16(keylen);
5240         memcpy(wkr.key, key, keylen);
5241         memcpy(wkr.mac, macaddr, ETH_ALEN);
5242
5243         if (perm) disable_MAC(ai, lock);
5244         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5245         if (perm) enable_MAC(ai, lock);
5246         return rc;
5247 }
5248
5249 static int set_wep_tx_idx(struct airo_info *ai, u16 index, int perm, int lock)
5250 {
5251         WepKeyRid wkr;
5252         int rc;
5253
5254         memset(&wkr, 0, sizeof(wkr));
5255         wkr.len = cpu_to_le16(sizeof(wkr));
5256         wkr.kindex = cpu_to_le16(0xffff);
5257         wkr.mac[0] = (char)index;
5258
5259         if (perm) {
5260                 ai->defindex = (char)index;
5261                 disable_MAC(ai, lock);
5262         }
5263
5264         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5265
5266         if (perm)
5267                 enable_MAC(ai, lock);
5268         return rc;
5269 }
5270
5271 static void proc_wepkey_on_close( struct inode *inode, struct file *file ) {
5272         struct proc_data *data;
5273         struct proc_dir_entry *dp = PDE(inode);
5274         struct net_device *dev = dp->data;
5275         struct airo_info *ai = dev->ml_priv;
5276         int i, rc;
5277         char key[16];
5278         u16 index = 0;
5279         int j = 0;
5280
5281         memset(key, 0, sizeof(key));
5282
5283         data = (struct proc_data *)file->private_data;
5284         if ( !data->writelen ) return;
5285
5286         if (data->wbuffer[0] >= '0' && data->wbuffer[0] <= '3' &&
5287             (data->wbuffer[1] == ' ' || data->wbuffer[1] == '\n')) {
5288                 index = data->wbuffer[0] - '0';
5289                 if (data->wbuffer[1] == '\n') {
5290                         rc = set_wep_tx_idx(ai, index, 1, 1);
5291                         if (rc < 0) {
5292                                 airo_print_err(ai->dev->name, "failed to set "
5293                                                "WEP transmit index to %d: %d.",
5294                                                index, rc);
5295                         }
5296                         return;
5297                 }
5298                 j = 2;
5299         } else {
5300                 airo_print_err(ai->dev->name, "WepKey passed invalid key index");
5301                 return;
5302         }
5303
5304         for( i = 0; i < 16*3 && data->wbuffer[i+j]; i++ ) {
5305                 switch(i%3) {
5306                 case 0:
5307                         key[i/3] = hexVal(data->wbuffer[i+j])<<4;
5308                         break;
5309                 case 1:
5310                         key[i/3] |= hexVal(data->wbuffer[i+j]);
5311                         break;
5312                 }
5313         }
5314
5315         rc = set_wep_key(ai, index, key, i/3, 1, 1);
5316         if (rc < 0) {
5317                 airo_print_err(ai->dev->name, "failed to set WEP key at index "
5318                                "%d: %d.", index, rc);
5319         }
5320 }
5321
5322 static int proc_wepkey_open( struct inode *inode, struct file *file )
5323 {
5324         struct proc_data *data;
5325         struct proc_dir_entry *dp = PDE(inode);
5326         struct net_device *dev = dp->data;
5327         struct airo_info *ai = dev->ml_priv;
5328         char *ptr;
5329         WepKeyRid wkr;
5330         __le16 lastindex;
5331         int j=0;
5332         int rc;
5333
5334         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5335                 return -ENOMEM;
5336         memset(&wkr, 0, sizeof(wkr));
5337         data = (struct proc_data *)file->private_data;
5338         if ((data->rbuffer = kzalloc( 180, GFP_KERNEL )) == NULL) {
5339                 kfree (file->private_data);
5340                 return -ENOMEM;
5341         }
5342         data->writelen = 0;
5343         data->maxwritelen = 80;
5344         if ((data->wbuffer = kzalloc( 80, GFP_KERNEL )) == NULL) {
5345                 kfree (data->rbuffer);
5346                 kfree (file->private_data);
5347                 return -ENOMEM;
5348         }
5349         data->on_close = proc_wepkey_on_close;
5350
5351         ptr = data->rbuffer;
5352         strcpy(ptr, "No wep keys\n");
5353         rc = readWepKeyRid(ai, &wkr, 1, 1);
5354         if (rc == SUCCESS) do {
5355                 lastindex = wkr.kindex;
5356                 if (wkr.kindex == cpu_to_le16(0xffff)) {
5357                         j += sprintf(ptr+j, "Tx key = %d\n",
5358                                      (int)wkr.mac[0]);
5359                 } else {
5360                         j += sprintf(ptr+j, "Key %d set with length = %d\n",
5361                                      le16_to_cpu(wkr.kindex),
5362                                      le16_to_cpu(wkr.klen));
5363                 }
5364                 readWepKeyRid(ai, &wkr, 0, 1);
5365         } while((lastindex != wkr.kindex) && (j < 180-30));
5366
5367         data->readlen = strlen( data->rbuffer );
5368         return 0;
5369 }
5370
5371 static int proc_SSID_open(struct inode *inode, struct file *file)
5372 {
5373         struct proc_data *data;
5374         struct proc_dir_entry *dp = PDE(inode);
5375         struct net_device *dev = dp->data;
5376         struct airo_info *ai = dev->ml_priv;
5377         int i;
5378         char *ptr;
5379         SsidRid SSID_rid;
5380
5381         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5382                 return -ENOMEM;
5383         data = (struct proc_data *)file->private_data;
5384         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5385                 kfree (file->private_data);
5386                 return -ENOMEM;
5387         }
5388         data->writelen = 0;
5389         data->maxwritelen = 33*3;
5390         /* allocate maxwritelen + 1; we'll want a sentinel */
5391         if ((data->wbuffer = kzalloc(33*3 + 1, GFP_KERNEL)) == NULL) {
5392                 kfree (data->rbuffer);
5393                 kfree (file->private_data);
5394                 return -ENOMEM;
5395         }
5396         data->on_close = proc_SSID_on_close;
5397
5398         readSsidRid(ai, &SSID_rid);
5399         ptr = data->rbuffer;
5400         for (i = 0; i < 3; i++) {
5401                 int j;
5402                 size_t len = le16_to_cpu(SSID_rid.ssids[i].len);
5403                 if (!len)
5404                         break;
5405                 if (len > 32)
5406                         len = 32;
5407                 for (j = 0; j < len && SSID_rid.ssids[i].ssid[j]; j++)
5408                         *ptr++ = SSID_rid.ssids[i].ssid[j];
5409                 *ptr++ = '\n';
5410         }
5411         *ptr = '\0';
5412         data->readlen = strlen( data->rbuffer );
5413         return 0;
5414 }
5415
5416 static int proc_APList_open( struct inode *inode, struct file *file ) {
5417         struct proc_data *data;
5418         struct proc_dir_entry *dp = PDE(inode);
5419         struct net_device *dev = dp->data;
5420         struct airo_info *ai = dev->ml_priv;
5421         int i;
5422         char *ptr;
5423         APListRid APList_rid;
5424
5425         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5426                 return -ENOMEM;
5427         data = (struct proc_data *)file->private_data;
5428         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5429                 kfree (file->private_data);
5430                 return -ENOMEM;
5431         }
5432         data->writelen = 0;
5433         data->maxwritelen = 4*6*3;
5434         if ((data->wbuffer = kzalloc( data->maxwritelen, GFP_KERNEL )) == NULL) {
5435                 kfree (data->rbuffer);
5436                 kfree (file->private_data);
5437                 return -ENOMEM;
5438         }
5439         data->on_close = proc_APList_on_close;
5440
5441         readAPListRid(ai, &APList_rid);
5442         ptr = data->rbuffer;
5443         for( i = 0; i < 4; i++ ) {
5444 // We end when we find a zero MAC
5445                 if ( !*(int*)APList_rid.ap[i] &&
5446                      !*(int*)&APList_rid.ap[i][2]) break;
5447                 ptr += sprintf(ptr, "%pM\n", APList_rid.ap[i]);
5448         }
5449         if (i==0) ptr += sprintf(ptr, "Not using specific APs\n");
5450
5451         *ptr = '\0';
5452         data->readlen = strlen( data->rbuffer );
5453         return 0;
5454 }
5455
5456 static int proc_BSSList_open( struct inode *inode, struct file *file ) {
5457         struct proc_data *data;
5458         struct proc_dir_entry *dp = PDE(inode);
5459         struct net_device *dev = dp->data;
5460         struct airo_info *ai = dev->ml_priv;
5461         char *ptr;
5462         BSSListRid BSSList_rid;
5463         int rc;
5464         /* If doLoseSync is not 1, we won't do a Lose Sync */
5465         int doLoseSync = -1;
5466
5467         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5468                 return -ENOMEM;
5469         data = (struct proc_data *)file->private_data;
5470         if ((data->rbuffer = kmalloc( 1024, GFP_KERNEL )) == NULL) {
5471                 kfree (file->private_data);
5472                 return -ENOMEM;
5473         }
5474         data->writelen = 0;
5475         data->maxwritelen = 0;
5476         data->wbuffer = NULL;
5477         data->on_close = NULL;
5478
5479         if (file->f_mode & FMODE_WRITE) {
5480                 if (!(file->f_mode & FMODE_READ)) {
5481                         Cmd cmd;
5482                         Resp rsp;
5483
5484                         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
5485                         memset(&cmd, 0, sizeof(cmd));
5486                         cmd.cmd=CMD_LISTBSS;
5487                         if (down_interruptible(&ai->sem))
5488                                 return -ERESTARTSYS;
5489                         issuecommand(ai, &cmd, &rsp);
5490                         up(&ai->sem);
5491                         data->readlen = 0;
5492                         return 0;
5493                 }
5494                 doLoseSync = 1;
5495         }
5496         ptr = data->rbuffer;
5497         /* There is a race condition here if there are concurrent opens.
5498            Since it is a rare condition, we'll just live with it, otherwise
5499            we have to add a spin lock... */
5500         rc = readBSSListRid(ai, doLoseSync, &BSSList_rid);
5501         while(rc == 0 && BSSList_rid.index != cpu_to_le16(0xffff)) {
5502                 ptr += sprintf(ptr, "%pM %*s rssi = %d",
5503                                BSSList_rid.bssid,
5504                                 (int)BSSList_rid.ssidLen,
5505                                 BSSList_rid.ssid,
5506                                 le16_to_cpu(BSSList_rid.dBm));
5507                 ptr += sprintf(ptr, " channel = %d %s %s %s %s\n",
5508                                 le16_to_cpu(BSSList_rid.dsChannel),
5509                                 BSSList_rid.cap & CAP_ESS ? "ESS" : "",
5510                                 BSSList_rid.cap & CAP_IBSS ? "adhoc" : "",
5511                                 BSSList_rid.cap & CAP_PRIVACY ? "wep" : "",
5512                                 BSSList_rid.cap & CAP_SHORTHDR ? "shorthdr" : "");
5513                 rc = readBSSListRid(ai, 0, &BSSList_rid);
5514         }
5515         *ptr = '\0';
5516         data->readlen = strlen( data->rbuffer );
5517         return 0;
5518 }
5519
5520 static int proc_close( struct inode *inode, struct file *file )
5521 {
5522         struct proc_data *data = file->private_data;
5523
5524         if (data->on_close != NULL)
5525                 data->on_close(inode, file);
5526         kfree(data->rbuffer);
5527         kfree(data->wbuffer);
5528         kfree(data);
5529         return 0;
5530 }
5531
5532 /* Since the card doesn't automatically switch to the right WEP mode,
5533    we will make it do it.  If the card isn't associated, every secs we
5534    will switch WEP modes to see if that will help.  If the card is
5535    associated we will check every minute to see if anything has
5536    changed. */
5537 static void timer_func( struct net_device *dev ) {
5538         struct airo_info *apriv = dev->ml_priv;
5539
5540 /* We don't have a link so try changing the authtype */
5541         readConfigRid(apriv, 0);
5542         disable_MAC(apriv, 0);
5543         switch(apriv->config.authType) {
5544                 case AUTH_ENCRYPT:
5545 /* So drop to OPEN */
5546                         apriv->config.authType = AUTH_OPEN;
5547                         break;
5548                 case AUTH_SHAREDKEY:
5549                         if (apriv->keyindex < auto_wep) {
5550                                 set_wep_tx_idx(apriv, apriv->keyindex, 0, 0);
5551                                 apriv->config.authType = AUTH_SHAREDKEY;
5552                                 apriv->keyindex++;
5553                         } else {
5554                                 /* Drop to ENCRYPT */
5555                                 apriv->keyindex = 0;
5556                                 set_wep_tx_idx(apriv, apriv->defindex, 0, 0);
5557                                 apriv->config.authType = AUTH_ENCRYPT;
5558                         }
5559                         break;
5560                 default:  /* We'll escalate to SHAREDKEY */
5561                         apriv->config.authType = AUTH_SHAREDKEY;
5562         }
5563         set_bit (FLAG_COMMIT, &apriv->flags);
5564         writeConfigRid(apriv, 0);
5565         enable_MAC(apriv, 0);
5566         up(&apriv->sem);
5567
5568 /* Schedule check to see if the change worked */
5569         clear_bit(JOB_AUTOWEP, &apriv->jobs);
5570         apriv->expires = RUN_AT(HZ*3);
5571 }
5572
5573 #ifdef CONFIG_PCI
5574 static int __devinit airo_pci_probe(struct pci_dev *pdev,
5575                                     const struct pci_device_id *pent)
5576 {
5577         struct net_device *dev;
5578
5579         if (pci_enable_device(pdev))
5580                 return -ENODEV;
5581         pci_set_master(pdev);
5582
5583         if (pdev->device == 0x5000 || pdev->device == 0xa504)
5584                         dev = _init_airo_card(pdev->irq, pdev->resource[0].start, 0, pdev, &pdev->dev);
5585         else
5586                         dev = _init_airo_card(pdev->irq, pdev->resource[2].start, 0, pdev, &pdev->dev);
5587         if (!dev) {
5588                 pci_disable_device(pdev);
5589                 return -ENODEV;
5590         }
5591
5592         pci_set_drvdata(pdev, dev);
5593         return 0;
5594 }
5595
5596 static void __devexit airo_pci_remove(struct pci_dev *pdev)
5597 {
5598         struct net_device *dev = pci_get_drvdata(pdev);
5599
5600         airo_print_info(dev->name, "Unregistering...");
5601         stop_airo_card(dev, 1);
5602         pci_disable_device(pdev);
5603         pci_set_drvdata(pdev, NULL);
5604 }
5605
5606 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state)
5607 {
5608         struct net_device *dev = pci_get_drvdata(pdev);
5609         struct airo_info *ai = dev->ml_priv;
5610         Cmd cmd;
5611         Resp rsp;
5612
5613         if (!ai->APList)
5614                 ai->APList = kmalloc(sizeof(APListRid), GFP_KERNEL);
5615         if (!ai->APList)
5616                 return -ENOMEM;
5617         if (!ai->SSID)
5618                 ai->SSID = kmalloc(sizeof(SsidRid), GFP_KERNEL);
5619         if (!ai->SSID)
5620                 return -ENOMEM;
5621         readAPListRid(ai, ai->APList);
5622         readSsidRid(ai, ai->SSID);
5623         memset(&cmd, 0, sizeof(cmd));
5624         /* the lock will be released at the end of the resume callback */
5625         if (down_interruptible(&ai->sem))
5626                 return -EAGAIN;
5627         disable_MAC(ai, 0);
5628         netif_device_detach(dev);
5629         ai->power = state;
5630         cmd.cmd = HOSTSLEEP;
5631         issuecommand(ai, &cmd, &rsp);
5632
5633         pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
5634         pci_save_state(pdev);
5635         return pci_set_power_state(pdev, pci_choose_state(pdev, state));
5636 }
5637
5638 static int airo_pci_resume(struct pci_dev *pdev)
5639 {
5640         struct net_device *dev = pci_get_drvdata(pdev);
5641         struct airo_info *ai = dev->ml_priv;
5642         pci_power_t prev_state = pdev->current_state;
5643
5644         pci_set_power_state(pdev, PCI_D0);
5645         pci_restore_state(pdev);
5646         pci_enable_wake(pdev, PCI_D0, 0);
5647
5648         if (prev_state != PCI_D1) {
5649                 reset_card(dev, 0);
5650                 mpi_init_descriptors(ai);
5651                 setup_card(ai, dev->dev_addr, 0);
5652                 clear_bit(FLAG_RADIO_OFF, &ai->flags);
5653                 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
5654         } else {
5655                 OUT4500(ai, EVACK, EV_AWAKEN);
5656                 OUT4500(ai, EVACK, EV_AWAKEN);
5657                 msleep(100);
5658         }
5659
5660         set_bit(FLAG_COMMIT, &ai->flags);
5661         disable_MAC(ai, 0);
5662         msleep(200);
5663         if (ai->SSID) {
5664                 writeSsidRid(ai, ai->SSID, 0);
5665                 kfree(ai->SSID);
5666                 ai->SSID = NULL;
5667         }
5668         if (ai->APList) {
5669                 writeAPListRid(ai, ai->APList, 0);
5670                 kfree(ai->APList);
5671                 ai->APList = NULL;
5672         }
5673         writeConfigRid(ai, 0);
5674         enable_MAC(ai, 0);
5675         ai->power = PMSG_ON;
5676         netif_device_attach(dev);
5677         netif_wake_queue(dev);
5678         enable_interrupts(ai);
5679         up(&ai->sem);
5680         return 0;
5681 }
5682 #endif
5683
5684 static int __init airo_init_module( void )
5685 {
5686         int i;
5687
5688         airo_entry = create_proc_entry("driver/aironet",
5689                                        S_IFDIR | airo_perm,
5690                                        NULL);
5691
5692         if (airo_entry) {
5693                 airo_entry->uid = proc_uid;
5694                 airo_entry->gid = proc_gid;
5695         }
5696
5697         for (i = 0; i < 4 && io[i] && irq[i]; i++) {
5698                 airo_print_info("", "Trying to configure ISA adapter at irq=%d "
5699                         "io=0x%x", irq[i], io[i] );
5700                 if (init_airo_card( irq[i], io[i], 0, NULL ))
5701                         /* do nothing */ ;
5702         }
5703
5704 #ifdef CONFIG_PCI
5705         airo_print_info("", "Probing for PCI adapters");
5706         i = pci_register_driver(&airo_driver);
5707         airo_print_info("", "Finished probing for PCI adapters");
5708
5709         if (i) {
5710                 remove_proc_entry("driver/aironet", NULL);
5711                 return i;
5712         }
5713 #endif
5714
5715         /* Always exit with success, as we are a library module
5716          * as well as a driver module
5717          */
5718         return 0;
5719 }
5720
5721 static void __exit airo_cleanup_module( void )
5722 {
5723         struct airo_info *ai;
5724         while(!list_empty(&airo_devices)) {
5725                 ai = list_entry(airo_devices.next, struct airo_info, dev_list);
5726                 airo_print_info(ai->dev->name, "Unregistering...");
5727                 stop_airo_card(ai->dev, 1);
5728         }
5729 #ifdef CONFIG_PCI
5730         pci_unregister_driver(&airo_driver);
5731 #endif
5732         remove_proc_entry("driver/aironet", NULL);
5733 }
5734
5735 /*
5736  * Initial Wireless Extension code for Aironet driver by :
5737  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00
5738  * Conversion to new driver API by :
5739  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02
5740  * Javier also did a good amount of work here, adding some new extensions
5741  * and fixing my code. Let's just say that without him this code just
5742  * would not work at all... - Jean II
5743  */
5744
5745 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi)
5746 {
5747         if (!rssi_rid)
5748                 return 0;
5749
5750         return (0x100 - rssi_rid[rssi].rssidBm);
5751 }
5752
5753 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm)
5754 {
5755         int i;
5756
5757         if (!rssi_rid)
5758                 return 0;
5759
5760         for (i = 0; i < 256; i++)
5761                 if (rssi_rid[i].rssidBm == dbm)
5762                         return rssi_rid[i].rssipct;
5763
5764         return 0;
5765 }
5766
5767
5768 static int airo_get_quality (StatusRid *status_rid, CapabilityRid *cap_rid)
5769 {
5770         int quality = 0;
5771         u16 sq;
5772
5773         if ((status_rid->mode & cpu_to_le16(0x3f)) != cpu_to_le16(0x3f))
5774                 return 0;
5775
5776         if (!(cap_rid->hardCap & cpu_to_le16(8)))
5777                 return 0;
5778
5779         sq = le16_to_cpu(status_rid->signalQuality);
5780         if (memcmp(cap_rid->prodName, "350", 3))
5781                 if (sq > 0x20)
5782                         quality = 0;
5783                 else
5784                         quality = 0x20 - sq;
5785         else
5786                 if (sq > 0xb0)
5787                         quality = 0;
5788                 else if (sq < 0x10)
5789                         quality = 0xa0;
5790                 else
5791                         quality = 0xb0 - sq;
5792         return quality;
5793 }
5794
5795 #define airo_get_max_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x20 : 0xa0)
5796 #define airo_get_avg_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x10 : 0x50);
5797
5798 /*------------------------------------------------------------------*/
5799 /*
5800  * Wireless Handler : get protocol name
5801  */
5802 static int airo_get_name(struct net_device *dev,
5803                          struct iw_request_info *info,
5804                          char *cwrq,
5805                          char *extra)
5806 {
5807         strcpy(cwrq, "IEEE 802.11-DS");
5808         return 0;
5809 }
5810
5811 /*------------------------------------------------------------------*/
5812 /*
5813  * Wireless Handler : set frequency
5814  */
5815 static int airo_set_freq(struct net_device *dev,
5816                          struct iw_request_info *info,
5817                          struct iw_freq *fwrq,
5818                          char *extra)
5819 {
5820         struct airo_info *local = dev->ml_priv;
5821         int rc = -EINPROGRESS;          /* Call commit handler */
5822
5823         /* If setting by frequency, convert to a channel */
5824         if(fwrq->e == 1) {
5825                 int f = fwrq->m / 100000;
5826
5827                 /* Hack to fall through... */
5828                 fwrq->e = 0;
5829                 fwrq->m = ieee80211_freq_to_dsss_chan(f);
5830         }
5831         /* Setting by channel number */
5832         if((fwrq->m > 1000) || (fwrq->e > 0))
5833                 rc = -EOPNOTSUPP;
5834         else {
5835                 int channel = fwrq->m;
5836                 /* We should do a better check than that,
5837                  * based on the card capability !!! */
5838                 if((channel < 1) || (channel > 14)) {
5839                         airo_print_dbg(dev->name, "New channel value of %d is invalid!",
5840                                 fwrq->m);
5841                         rc = -EINVAL;
5842                 } else {
5843                         readConfigRid(local, 1);
5844                         /* Yes ! We can set it !!! */
5845                         local->config.channelSet = cpu_to_le16(channel);
5846                         set_bit (FLAG_COMMIT, &local->flags);
5847                 }
5848         }
5849         return rc;
5850 }
5851
5852 /*------------------------------------------------------------------*/
5853 /*
5854  * Wireless Handler : get frequency
5855  */
5856 static int airo_get_freq(struct net_device *dev,
5857                          struct iw_request_info *info,
5858                          struct iw_freq *fwrq,
5859                          char *extra)
5860 {
5861         struct airo_info *local = dev->ml_priv;
5862         StatusRid status_rid;           /* Card status info */
5863         int ch;
5864
5865         readConfigRid(local, 1);
5866         if ((local->config.opmode & MODE_CFG_MASK) == MODE_STA_ESS)
5867                 status_rid.channel = local->config.channelSet;
5868         else
5869                 readStatusRid(local, &status_rid, 1);
5870
5871         ch = le16_to_cpu(status_rid.channel);
5872         if((ch > 0) && (ch < 15)) {
5873                 fwrq->m = ieee80211_dsss_chan_to_freq(ch) * 100000;
5874                 fwrq->e = 1;
5875         } else {
5876                 fwrq->m = ch;
5877                 fwrq->e = 0;
5878         }
5879
5880         return 0;
5881 }
5882
5883 /*------------------------------------------------------------------*/
5884 /*
5885  * Wireless Handler : set ESSID
5886  */
5887 static int airo_set_essid(struct net_device *dev,
5888                           struct iw_request_info *info,
5889                           struct iw_point *dwrq,
5890                           char *extra)
5891 {
5892         struct airo_info *local = dev->ml_priv;
5893         SsidRid SSID_rid;               /* SSIDs */
5894
5895         /* Reload the list of current SSID */
5896         readSsidRid(local, &SSID_rid);
5897
5898         /* Check if we asked for `any' */
5899         if(dwrq->flags == 0) {
5900                 /* Just send an empty SSID list */
5901                 memset(&SSID_rid, 0, sizeof(SSID_rid));
5902         } else {
5903                 int     index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
5904
5905                 /* Check the size of the string */
5906                 if(dwrq->length > IW_ESSID_MAX_SIZE) {
5907                         return -E2BIG ;
5908                 }
5909                 /* Check if index is valid */
5910                 if((index < 0) || (index >= 4)) {
5911                         return -EINVAL;
5912                 }
5913
5914                 /* Set the SSID */
5915                 memset(SSID_rid.ssids[index].ssid, 0,
5916                        sizeof(SSID_rid.ssids[index].ssid));
5917                 memcpy(SSID_rid.ssids[index].ssid, extra, dwrq->length);
5918                 SSID_rid.ssids[index].len = cpu_to_le16(dwrq->length);
5919         }
5920         SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5921         /* Write it to the card */
5922         disable_MAC(local, 1);
5923         writeSsidRid(local, &SSID_rid, 1);
5924         enable_MAC(local, 1);
5925
5926         return 0;
5927 }
5928
5929 /*------------------------------------------------------------------*/
5930 /*
5931  * Wireless Handler : get ESSID
5932  */
5933 static int airo_get_essid(struct net_device *dev,
5934                           struct iw_request_info *info,
5935                           struct iw_point *dwrq,
5936                           char *extra)
5937 {
5938         struct airo_info *local = dev->ml_priv;
5939         StatusRid status_rid;           /* Card status info */
5940
5941         readStatusRid(local, &status_rid, 1);
5942
5943         /* Note : if dwrq->flags != 0, we should
5944          * get the relevant SSID from the SSID list... */
5945
5946         /* Get the current SSID */
5947         memcpy(extra, status_rid.SSID, le16_to_cpu(status_rid.SSIDlen));
5948         /* If none, we may want to get the one that was set */
5949
5950         /* Push it out ! */
5951         dwrq->length = le16_to_cpu(status_rid.SSIDlen);
5952         dwrq->flags = 1; /* active */
5953
5954         return 0;
5955 }
5956
5957 /*------------------------------------------------------------------*/
5958 /*
5959  * Wireless Handler : set AP address
5960  */
5961 static int airo_set_wap(struct net_device *dev,
5962                         struct iw_request_info *info,
5963                         struct sockaddr *awrq,
5964                         char *extra)
5965 {
5966         struct airo_info *local = dev->ml_priv;
5967         Cmd cmd;
5968         Resp rsp;
5969         APListRid APList_rid;
5970         static const u8 any[ETH_ALEN] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
5971         static const u8 off[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
5972
5973         if (awrq->sa_family != ARPHRD_ETHER)
5974                 return -EINVAL;
5975         else if (!memcmp(any, awrq->sa_data, ETH_ALEN) ||
5976                  !memcmp(off, awrq->sa_data, ETH_ALEN)) {
5977                 memset(&cmd, 0, sizeof(cmd));
5978                 cmd.cmd=CMD_LOSE_SYNC;
5979                 if (down_interruptible(&local->sem))
5980                         return -ERESTARTSYS;
5981                 issuecommand(local, &cmd, &rsp);
5982                 up(&local->sem);
5983         } else {
5984                 memset(&APList_rid, 0, sizeof(APList_rid));
5985                 APList_rid.len = cpu_to_le16(sizeof(APList_rid));
5986                 memcpy(APList_rid.ap[0], awrq->sa_data, ETH_ALEN);
5987                 disable_MAC(local, 1);
5988                 writeAPListRid(local, &APList_rid, 1);
5989                 enable_MAC(local, 1);
5990         }
5991         return 0;
5992 }
5993
5994 /*------------------------------------------------------------------*/
5995 /*
5996  * Wireless Handler : get AP address
5997  */
5998 static int airo_get_wap(struct net_device *dev,
5999                         struct iw_request_info *info,
6000                         struct sockaddr *awrq,
6001                         char *extra)
6002 {
6003         struct airo_info *local = dev->ml_priv;
6004         StatusRid status_rid;           /* Card status info */
6005
6006         readStatusRid(local, &status_rid, 1);
6007
6008         /* Tentative. This seems to work, wow, I'm lucky !!! */
6009         memcpy(awrq->sa_data, status_rid.bssid[0], ETH_ALEN);
6010         awrq->sa_family = ARPHRD_ETHER;
6011
6012         return 0;
6013 }
6014
6015 /*------------------------------------------------------------------*/
6016 /*
6017  * Wireless Handler : set Nickname
6018  */
6019 static int airo_set_nick(struct net_device *dev,
6020                          struct iw_request_info *info,
6021                          struct iw_point *dwrq,
6022                          char *extra)
6023 {
6024         struct airo_info *local = dev->ml_priv;
6025
6026         /* Check the size of the string */
6027         if(dwrq->length > 16) {
6028                 return -E2BIG;
6029         }
6030         readConfigRid(local, 1);
6031         memset(local->config.nodeName, 0, sizeof(local->config.nodeName));
6032         memcpy(local->config.nodeName, extra, dwrq->length);
6033         set_bit (FLAG_COMMIT, &local->flags);
6034
6035         return -EINPROGRESS;            /* Call commit handler */
6036 }
6037
6038 /*------------------------------------------------------------------*/
6039 /*
6040  * Wireless Handler : get Nickname
6041  */
6042 static int airo_get_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         readConfigRid(local, 1);
6050         strncpy(extra, local->config.nodeName, 16);
6051         extra[16] = '\0';
6052         dwrq->length = strlen(extra);
6053
6054         return 0;
6055 }
6056
6057 /*------------------------------------------------------------------*/
6058 /*
6059  * Wireless Handler : set Bit-Rate
6060  */
6061 static int airo_set_rate(struct net_device *dev,
6062                          struct iw_request_info *info,
6063                          struct iw_param *vwrq,
6064                          char *extra)
6065 {
6066         struct airo_info *local = dev->ml_priv;
6067         CapabilityRid cap_rid;          /* Card capability info */
6068         u8      brate = 0;
6069         int     i;
6070
6071         /* First : get a valid bit rate value */
6072         readCapabilityRid(local, &cap_rid, 1);
6073
6074         /* Which type of value ? */
6075         if((vwrq->value < 8) && (vwrq->value >= 0)) {
6076                 /* Setting by rate index */
6077                 /* Find value in the magic rate table */
6078                 brate = cap_rid.supportedRates[vwrq->value];
6079         } else {
6080                 /* Setting by frequency value */
6081                 u8      normvalue = (u8) (vwrq->value/500000);
6082
6083                 /* Check if rate is valid */
6084                 for(i = 0 ; i < 8 ; i++) {
6085                         if(normvalue == cap_rid.supportedRates[i]) {
6086                                 brate = normvalue;
6087                                 break;
6088                         }
6089                 }
6090         }
6091         /* -1 designed the max rate (mostly auto mode) */
6092         if(vwrq->value == -1) {
6093                 /* Get the highest available rate */
6094                 for(i = 0 ; i < 8 ; i++) {
6095                         if(cap_rid.supportedRates[i] == 0)
6096                                 break;
6097                 }
6098                 if(i != 0)
6099                         brate = cap_rid.supportedRates[i - 1];
6100         }
6101         /* Check that it is valid */
6102         if(brate == 0) {
6103                 return -EINVAL;
6104         }
6105
6106         readConfigRid(local, 1);
6107         /* Now, check if we want a fixed or auto value */
6108         if(vwrq->fixed == 0) {
6109                 /* Fill all the rates up to this max rate */
6110                 memset(local->config.rates, 0, 8);
6111                 for(i = 0 ; i < 8 ; i++) {
6112                         local->config.rates[i] = cap_rid.supportedRates[i];
6113                         if(local->config.rates[i] == brate)
6114                                 break;
6115                 }
6116         } else {
6117                 /* Fixed mode */
6118                 /* One rate, fixed */
6119                 memset(local->config.rates, 0, 8);
6120                 local->config.rates[0] = brate;
6121         }
6122         set_bit (FLAG_COMMIT, &local->flags);
6123
6124         return -EINPROGRESS;            /* Call commit handler */
6125 }
6126
6127 /*------------------------------------------------------------------*/
6128 /*
6129  * Wireless Handler : get Bit-Rate
6130  */
6131 static int airo_get_rate(struct net_device *dev,
6132                          struct iw_request_info *info,
6133                          struct iw_param *vwrq,
6134                          char *extra)
6135 {
6136         struct airo_info *local = dev->ml_priv;
6137         StatusRid status_rid;           /* Card status info */
6138
6139         readStatusRid(local, &status_rid, 1);
6140
6141         vwrq->value = le16_to_cpu(status_rid.currentXmitRate) * 500000;
6142         /* If more than one rate, set auto */
6143         readConfigRid(local, 1);
6144         vwrq->fixed = (local->config.rates[1] == 0);
6145
6146         return 0;
6147 }
6148
6149 /*------------------------------------------------------------------*/
6150 /*
6151  * Wireless Handler : set RTS threshold
6152  */
6153 static int airo_set_rts(struct net_device *dev,
6154                         struct iw_request_info *info,
6155                         struct iw_param *vwrq,
6156                         char *extra)
6157 {
6158         struct airo_info *local = dev->ml_priv;
6159         int rthr = vwrq->value;
6160
6161         if(vwrq->disabled)
6162                 rthr = AIRO_DEF_MTU;
6163         if((rthr < 0) || (rthr > AIRO_DEF_MTU)) {
6164                 return -EINVAL;
6165         }
6166         readConfigRid(local, 1);
6167         local->config.rtsThres = cpu_to_le16(rthr);
6168         set_bit (FLAG_COMMIT, &local->flags);
6169
6170         return -EINPROGRESS;            /* Call commit handler */
6171 }
6172
6173 /*------------------------------------------------------------------*/
6174 /*
6175  * Wireless Handler : get RTS threshold
6176  */
6177 static int airo_get_rts(struct net_device *dev,
6178                         struct iw_request_info *info,
6179                         struct iw_param *vwrq,
6180                         char *extra)
6181 {
6182         struct airo_info *local = dev->ml_priv;
6183
6184         readConfigRid(local, 1);
6185         vwrq->value = le16_to_cpu(local->config.rtsThres);
6186         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6187         vwrq->fixed = 1;
6188
6189         return 0;
6190 }
6191
6192 /*------------------------------------------------------------------*/
6193 /*
6194  * Wireless Handler : set Fragmentation threshold
6195  */
6196 static int airo_set_frag(struct net_device *dev,
6197                          struct iw_request_info *info,
6198                          struct iw_param *vwrq,
6199                          char *extra)
6200 {
6201         struct airo_info *local = dev->ml_priv;
6202         int fthr = vwrq->value;
6203
6204         if(vwrq->disabled)
6205                 fthr = AIRO_DEF_MTU;
6206         if((fthr < 256) || (fthr > AIRO_DEF_MTU)) {
6207                 return -EINVAL;
6208         }
6209         fthr &= ~0x1;   /* Get an even value - is it really needed ??? */
6210         readConfigRid(local, 1);
6211         local->config.fragThresh = cpu_to_le16(fthr);
6212         set_bit (FLAG_COMMIT, &local->flags);
6213
6214         return -EINPROGRESS;            /* Call commit handler */
6215 }
6216
6217 /*------------------------------------------------------------------*/
6218 /*
6219  * Wireless Handler : get Fragmentation threshold
6220  */
6221 static int airo_get_frag(struct net_device *dev,
6222                          struct iw_request_info *info,
6223                          struct iw_param *vwrq,
6224                          char *extra)
6225 {
6226         struct airo_info *local = dev->ml_priv;
6227
6228         readConfigRid(local, 1);
6229         vwrq->value = le16_to_cpu(local->config.fragThresh);
6230         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6231         vwrq->fixed = 1;
6232
6233         return 0;
6234 }
6235
6236 /*------------------------------------------------------------------*/
6237 /*
6238  * Wireless Handler : set Mode of Operation
6239  */
6240 static int airo_set_mode(struct net_device *dev,
6241                          struct iw_request_info *info,
6242                          __u32 *uwrq,
6243                          char *extra)
6244 {
6245         struct airo_info *local = dev->ml_priv;
6246         int reset = 0;
6247
6248         readConfigRid(local, 1);
6249         if (sniffing_mode(local))
6250                 reset = 1;
6251
6252         switch(*uwrq) {
6253                 case IW_MODE_ADHOC:
6254                         local->config.opmode &= ~MODE_CFG_MASK;
6255                         local->config.opmode |= MODE_STA_IBSS;
6256                         local->config.rmode &= ~RXMODE_FULL_MASK;
6257                         local->config.scanMode = SCANMODE_ACTIVE;
6258                         clear_bit (FLAG_802_11, &local->flags);
6259                         break;
6260                 case IW_MODE_INFRA:
6261                         local->config.opmode &= ~MODE_CFG_MASK;
6262                         local->config.opmode |= MODE_STA_ESS;
6263                         local->config.rmode &= ~RXMODE_FULL_MASK;
6264                         local->config.scanMode = SCANMODE_ACTIVE;
6265                         clear_bit (FLAG_802_11, &local->flags);
6266                         break;
6267                 case IW_MODE_MASTER:
6268                         local->config.opmode &= ~MODE_CFG_MASK;
6269                         local->config.opmode |= MODE_AP;
6270                         local->config.rmode &= ~RXMODE_FULL_MASK;
6271                         local->config.scanMode = SCANMODE_ACTIVE;
6272                         clear_bit (FLAG_802_11, &local->flags);
6273                         break;
6274                 case IW_MODE_REPEAT:
6275                         local->config.opmode &= ~MODE_CFG_MASK;
6276                         local->config.opmode |= MODE_AP_RPTR;
6277                         local->config.rmode &= ~RXMODE_FULL_MASK;
6278                         local->config.scanMode = SCANMODE_ACTIVE;
6279                         clear_bit (FLAG_802_11, &local->flags);
6280                         break;
6281                 case IW_MODE_MONITOR:
6282                         local->config.opmode &= ~MODE_CFG_MASK;
6283                         local->config.opmode |= MODE_STA_ESS;
6284                         local->config.rmode &= ~RXMODE_FULL_MASK;
6285                         local->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
6286                         local->config.scanMode = SCANMODE_PASSIVE;
6287                         set_bit (FLAG_802_11, &local->flags);
6288                         break;
6289                 default:
6290                         return -EINVAL;
6291         }
6292         if (reset)
6293                 set_bit (FLAG_RESET, &local->flags);
6294         set_bit (FLAG_COMMIT, &local->flags);
6295
6296         return -EINPROGRESS;            /* Call commit handler */
6297 }
6298
6299 /*------------------------------------------------------------------*/
6300 /*
6301  * Wireless Handler : get Mode of Operation
6302  */
6303 static int airo_get_mode(struct net_device *dev,
6304                          struct iw_request_info *info,
6305                          __u32 *uwrq,
6306                          char *extra)
6307 {
6308         struct airo_info *local = dev->ml_priv;
6309
6310         readConfigRid(local, 1);
6311         /* If not managed, assume it's ad-hoc */
6312         switch (local->config.opmode & MODE_CFG_MASK) {
6313                 case MODE_STA_ESS:
6314                         *uwrq = IW_MODE_INFRA;
6315                         break;
6316                 case MODE_AP:
6317                         *uwrq = IW_MODE_MASTER;
6318                         break;
6319                 case MODE_AP_RPTR:
6320                         *uwrq = IW_MODE_REPEAT;
6321                         break;
6322                 default:
6323                         *uwrq = IW_MODE_ADHOC;
6324         }
6325
6326         return 0;
6327 }
6328
6329 static inline int valid_index(struct airo_info *ai, int index)
6330 {
6331         return (index >= 0) && (index <= ai->max_wep_idx);
6332 }
6333
6334 /*------------------------------------------------------------------*/
6335 /*
6336  * Wireless Handler : set Encryption Key
6337  */
6338 static int airo_set_encode(struct net_device *dev,
6339                            struct iw_request_info *info,
6340                            struct iw_point *dwrq,
6341                            char *extra)
6342 {
6343         struct airo_info *local = dev->ml_priv;
6344         int perm = (dwrq->flags & IW_ENCODE_TEMP ? 0 : 1);
6345         __le16 currentAuthType = local->config.authType;
6346         int rc = 0;
6347
6348         if (!local->wep_capable)
6349                 return -EOPNOTSUPP;
6350
6351         readConfigRid(local, 1);
6352
6353         /* Basic checking: do we have a key to set ?
6354          * Note : with the new API, it's impossible to get a NULL pointer.
6355          * Therefore, we need to check a key size == 0 instead.
6356          * New version of iwconfig properly set the IW_ENCODE_NOKEY flag
6357          * when no key is present (only change flags), but older versions
6358          * don't do it. - Jean II */
6359         if (dwrq->length > 0) {
6360                 wep_key_t key;
6361                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6362                 int current_index;
6363
6364                 /* Check the size of the key */
6365                 if (dwrq->length > MAX_KEY_SIZE) {
6366                         return -EINVAL;
6367                 }
6368
6369                 current_index = get_wep_tx_idx(local);
6370                 if (current_index < 0)
6371                         current_index = 0;
6372
6373                 /* Check the index (none -> use current) */
6374                 if (!valid_index(local, index))
6375                         index = current_index;
6376
6377                 /* Set the length */
6378                 if (dwrq->length > MIN_KEY_SIZE)
6379                         key.len = MAX_KEY_SIZE;
6380                 else
6381                         if (dwrq->length > 0)
6382                                 key.len = MIN_KEY_SIZE;
6383                         else
6384                                 /* Disable the key */
6385                                 key.len = 0;
6386                 /* Check if the key is not marked as invalid */
6387                 if(!(dwrq->flags & IW_ENCODE_NOKEY)) {
6388                         /* Cleanup */
6389                         memset(key.key, 0, MAX_KEY_SIZE);
6390                         /* Copy the key in the driver */
6391                         memcpy(key.key, extra, dwrq->length);
6392                         /* Send the key to the card */
6393                         rc = set_wep_key(local, index, key.key, key.len, perm, 1);
6394                         if (rc < 0) {
6395                                 airo_print_err(local->dev->name, "failed to set"
6396                                                " WEP key at index %d: %d.",
6397                                                index, rc);
6398                                 return rc;
6399                         }
6400                 }
6401                 /* WE specify that if a valid key is set, encryption
6402                  * should be enabled (user may turn it off later)
6403                  * This is also how "iwconfig ethX key on" works */
6404                 if((index == current_index) && (key.len > 0) &&
6405                    (local->config.authType == AUTH_OPEN)) {
6406                         local->config.authType = AUTH_ENCRYPT;
6407                 }
6408         } else {
6409                 /* Do we want to just set the transmit key index ? */
6410                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6411                 if (valid_index(local, index)) {
6412                         rc = set_wep_tx_idx(local, index, perm, 1);
6413                         if (rc < 0) {
6414                                 airo_print_err(local->dev->name, "failed to set"
6415                                                " WEP transmit index to %d: %d.",
6416                                                index, rc);
6417                                 return rc;
6418                         }
6419                 } else {
6420                         /* Don't complain if only change the mode */
6421                         if (!(dwrq->flags & IW_ENCODE_MODE))
6422                                 return -EINVAL;
6423                 }
6424         }
6425         /* Read the flags */
6426         if(dwrq->flags & IW_ENCODE_DISABLED)
6427                 local->config.authType = AUTH_OPEN;     // disable encryption
6428         if(dwrq->flags & IW_ENCODE_RESTRICTED)
6429                 local->config.authType = AUTH_SHAREDKEY;        // Only Both
6430         if(dwrq->flags & IW_ENCODE_OPEN)
6431                 local->config.authType = AUTH_ENCRYPT;  // Only Wep
6432         /* Commit the changes to flags if needed */
6433         if (local->config.authType != currentAuthType)
6434                 set_bit (FLAG_COMMIT, &local->flags);
6435         return -EINPROGRESS;            /* Call commit handler */
6436 }
6437
6438 /*------------------------------------------------------------------*/
6439 /*
6440  * Wireless Handler : get Encryption Key
6441  */
6442 static int airo_get_encode(struct net_device *dev,
6443                            struct iw_request_info *info,
6444                            struct iw_point *dwrq,
6445                            char *extra)
6446 {
6447         struct airo_info *local = dev->ml_priv;
6448         int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6449         u8 buf[16];
6450
6451         if (!local->wep_capable)
6452                 return -EOPNOTSUPP;
6453
6454         readConfigRid(local, 1);
6455
6456         /* Check encryption mode */
6457         switch(local->config.authType)  {
6458                 case AUTH_ENCRYPT:
6459                         dwrq->flags = IW_ENCODE_OPEN;
6460                         break;
6461                 case AUTH_SHAREDKEY:
6462                         dwrq->flags = IW_ENCODE_RESTRICTED;
6463                         break;
6464                 default:
6465                 case AUTH_OPEN:
6466                         dwrq->flags = IW_ENCODE_DISABLED;
6467                         break;
6468         }
6469         /* We can't return the key, so set the proper flag and return zero */
6470         dwrq->flags |= IW_ENCODE_NOKEY;
6471         memset(extra, 0, 16);
6472
6473         /* Which key do we want ? -1 -> tx index */
6474         if (!valid_index(local, index)) {
6475                 index = get_wep_tx_idx(local);
6476                 if (index < 0)
6477                         index = 0;
6478         }
6479         dwrq->flags |= index + 1;
6480
6481         /* Copy the key to the user buffer */
6482         dwrq->length = get_wep_key(local, index, &buf[0], sizeof(buf));
6483         memcpy(extra, buf, dwrq->length);
6484
6485         return 0;
6486 }
6487
6488 /*------------------------------------------------------------------*/
6489 /*
6490  * Wireless Handler : set extended Encryption parameters
6491  */
6492 static int airo_set_encodeext(struct net_device *dev,
6493                            struct iw_request_info *info,
6494                             union iwreq_data *wrqu,
6495                             char *extra)
6496 {
6497         struct airo_info *local = dev->ml_priv;
6498         struct iw_point *encoding = &wrqu->encoding;
6499         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6500         int perm = ( encoding->flags & IW_ENCODE_TEMP ? 0 : 1 );
6501         __le16 currentAuthType = local->config.authType;
6502         int idx, key_len, alg = ext->alg, set_key = 1, rc;
6503         wep_key_t key;
6504
6505         if (!local->wep_capable)
6506                 return -EOPNOTSUPP;
6507
6508         readConfigRid(local, 1);
6509
6510         /* Determine and validate the key index */
6511         idx = encoding->flags & IW_ENCODE_INDEX;
6512         if (idx) {
6513                 if (!valid_index(local, idx - 1))
6514                         return -EINVAL;
6515                 idx--;
6516         } else {
6517                 idx = get_wep_tx_idx(local);
6518                 if (idx < 0)
6519                         idx = 0;
6520         }
6521
6522         if (encoding->flags & IW_ENCODE_DISABLED)
6523                 alg = IW_ENCODE_ALG_NONE;
6524
6525         if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
6526                 /* Only set transmit key index here, actual
6527                  * key is set below if needed.
6528                  */
6529                 rc = set_wep_tx_idx(local, idx, perm, 1);
6530                 if (rc < 0) {
6531                         airo_print_err(local->dev->name, "failed to set "
6532                                        "WEP transmit index to %d: %d.",
6533                                        idx, rc);
6534                         return rc;
6535                 }
6536                 set_key = ext->key_len > 0 ? 1 : 0;
6537         }
6538
6539         if (set_key) {
6540                 /* Set the requested key first */
6541                 memset(key.key, 0, MAX_KEY_SIZE);
6542                 switch (alg) {
6543                 case IW_ENCODE_ALG_NONE:
6544                         key.len = 0;
6545                         break;
6546                 case IW_ENCODE_ALG_WEP:
6547                         if (ext->key_len > MIN_KEY_SIZE) {
6548                                 key.len = MAX_KEY_SIZE;
6549                         } else if (ext->key_len > 0) {
6550                                 key.len = MIN_KEY_SIZE;
6551                         } else {
6552                                 return -EINVAL;
6553                         }
6554                         key_len = min (ext->key_len, key.len);
6555                         memcpy(key.key, ext->key, key_len);
6556                         break;
6557                 default:
6558                         return -EINVAL;
6559                 }
6560                 /* Send the key to the card */
6561                 rc = set_wep_key(local, idx, key.key, key.len, perm, 1);
6562                 if (rc < 0) {
6563                         airo_print_err(local->dev->name, "failed to set WEP key"
6564                                        " at index %d: %d.", idx, rc);
6565                         return rc;
6566                 }
6567         }
6568
6569         /* Read the flags */
6570         if(encoding->flags & IW_ENCODE_DISABLED)
6571                 local->config.authType = AUTH_OPEN;     // disable encryption
6572         if(encoding->flags & IW_ENCODE_RESTRICTED)
6573                 local->config.authType = AUTH_SHAREDKEY;        // Only Both
6574         if(encoding->flags & IW_ENCODE_OPEN)
6575                 local->config.authType = AUTH_ENCRYPT;  // Only Wep
6576         /* Commit the changes to flags if needed */
6577         if (local->config.authType != currentAuthType)
6578                 set_bit (FLAG_COMMIT, &local->flags);
6579
6580         return -EINPROGRESS;
6581 }
6582
6583
6584 /*------------------------------------------------------------------*/
6585 /*
6586  * Wireless Handler : get extended Encryption parameters
6587  */
6588 static int airo_get_encodeext(struct net_device *dev,
6589                             struct iw_request_info *info,
6590                             union iwreq_data *wrqu,
6591                             char *extra)
6592 {
6593         struct airo_info *local = dev->ml_priv;
6594         struct iw_point *encoding = &wrqu->encoding;
6595         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6596         int idx, max_key_len;
6597         u8 buf[16];
6598
6599         if (!local->wep_capable)
6600                 return -EOPNOTSUPP;
6601
6602         readConfigRid(local, 1);
6603
6604         max_key_len = encoding->length - sizeof(*ext);
6605         if (max_key_len < 0)
6606                 return -EINVAL;
6607
6608         idx = encoding->flags & IW_ENCODE_INDEX;
6609         if (idx) {
6610                 if (!valid_index(local, idx - 1))
6611                         return -EINVAL;
6612                 idx--;
6613         } else {
6614                 idx = get_wep_tx_idx(local);
6615                 if (idx < 0)
6616                         idx = 0;
6617         }
6618
6619         encoding->flags = idx + 1;
6620         memset(ext, 0, sizeof(*ext));
6621
6622         /* Check encryption mode */
6623         switch(local->config.authType) {
6624                 case AUTH_ENCRYPT:
6625                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6626                         break;
6627                 case AUTH_SHAREDKEY:
6628                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6629                         break;
6630                 default:
6631                 case AUTH_OPEN:
6632                         encoding->flags = IW_ENCODE_ALG_NONE | IW_ENCODE_DISABLED;
6633                         break;
6634         }
6635         /* We can't return the key, so set the proper flag and return zero */
6636         encoding->flags |= IW_ENCODE_NOKEY;
6637         memset(extra, 0, 16);
6638
6639         /* Copy the key to the user buffer */
6640         ext->key_len = get_wep_key(local, idx, &buf[0], sizeof(buf));
6641         memcpy(extra, buf, ext->key_len);
6642
6643         return 0;
6644 }
6645
6646
6647 /*------------------------------------------------------------------*/
6648 /*
6649  * Wireless Handler : set extended authentication parameters
6650  */
6651 static int airo_set_auth(struct net_device *dev,
6652                                struct iw_request_info *info,
6653                                union iwreq_data *wrqu, char *extra)
6654 {
6655         struct airo_info *local = dev->ml_priv;
6656         struct iw_param *param = &wrqu->param;
6657         __le16 currentAuthType = local->config.authType;
6658
6659         switch (param->flags & IW_AUTH_INDEX) {
6660         case IW_AUTH_WPA_VERSION:
6661         case IW_AUTH_CIPHER_PAIRWISE:
6662         case IW_AUTH_CIPHER_GROUP:
6663         case IW_AUTH_KEY_MGMT:
6664         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6665         case IW_AUTH_PRIVACY_INVOKED:
6666                 /*
6667                  * airo does not use these parameters
6668                  */
6669                 break;
6670
6671         case IW_AUTH_DROP_UNENCRYPTED:
6672                 if (param->value) {
6673                         /* Only change auth type if unencrypted */
6674                         if (currentAuthType == AUTH_OPEN)
6675                                 local->config.authType = AUTH_ENCRYPT;
6676                 } else {
6677                         local->config.authType = AUTH_OPEN;
6678                 }
6679
6680                 /* Commit the changes to flags if needed */
6681                 if (local->config.authType != currentAuthType)
6682                         set_bit (FLAG_COMMIT, &local->flags);
6683                 break;
6684
6685         case IW_AUTH_80211_AUTH_ALG: {
6686                         /* FIXME: What about AUTH_OPEN?  This API seems to
6687                          * disallow setting our auth to AUTH_OPEN.
6688                          */
6689                         if (param->value & IW_AUTH_ALG_SHARED_KEY) {
6690                                 local->config.authType = AUTH_SHAREDKEY;
6691                         } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
6692                                 local->config.authType = AUTH_ENCRYPT;
6693                         } else
6694                                 return -EINVAL;
6695                         break;
6696
6697                         /* Commit the changes to flags if needed */
6698                         if (local->config.authType != currentAuthType)
6699                                 set_bit (FLAG_COMMIT, &local->flags);
6700                 }
6701
6702         case IW_AUTH_WPA_ENABLED:
6703                 /* Silently accept disable of WPA */
6704                 if (param->value > 0)
6705                         return -EOPNOTSUPP;
6706                 break;
6707
6708         default:
6709                 return -EOPNOTSUPP;
6710         }
6711         return -EINPROGRESS;
6712 }
6713
6714
6715 /*------------------------------------------------------------------*/
6716 /*
6717  * Wireless Handler : get extended authentication parameters
6718  */
6719 static int airo_get_auth(struct net_device *dev,
6720                                struct iw_request_info *info,
6721                                union iwreq_data *wrqu, char *extra)
6722 {
6723         struct airo_info *local = dev->ml_priv;
6724         struct iw_param *param = &wrqu->param;
6725         __le16 currentAuthType = local->config.authType;
6726
6727         switch (param->flags & IW_AUTH_INDEX) {
6728         case IW_AUTH_DROP_UNENCRYPTED:
6729                 switch (currentAuthType) {
6730                 case AUTH_SHAREDKEY:
6731                 case AUTH_ENCRYPT:
6732                         param->value = 1;
6733                         break;
6734                 default:
6735                         param->value = 0;
6736                         break;
6737                 }
6738                 break;
6739
6740         case IW_AUTH_80211_AUTH_ALG:
6741                 switch (currentAuthType) {
6742                 case AUTH_SHAREDKEY:
6743                         param->value = IW_AUTH_ALG_SHARED_KEY;
6744                         break;
6745                 case AUTH_ENCRYPT:
6746                 default:
6747                         param->value = IW_AUTH_ALG_OPEN_SYSTEM;
6748                         break;
6749                 }
6750                 break;
6751
6752         case IW_AUTH_WPA_ENABLED:
6753                 param->value = 0;
6754                 break;
6755
6756         default:
6757                 return -EOPNOTSUPP;
6758         }
6759         return 0;
6760 }
6761
6762
6763 /*------------------------------------------------------------------*/
6764 /*
6765  * Wireless Handler : set Tx-Power
6766  */
6767 static int airo_set_txpow(struct net_device *dev,
6768                           struct iw_request_info *info,
6769                           struct iw_param *vwrq,
6770                           char *extra)
6771 {
6772         struct airo_info *local = dev->ml_priv;
6773         CapabilityRid cap_rid;          /* Card capability info */
6774         int i;
6775         int rc = -EINVAL;
6776         __le16 v = cpu_to_le16(vwrq->value);
6777
6778         readCapabilityRid(local, &cap_rid, 1);
6779
6780         if (vwrq->disabled) {
6781                 set_bit (FLAG_RADIO_OFF, &local->flags);
6782                 set_bit (FLAG_COMMIT, &local->flags);
6783                 return -EINPROGRESS;            /* Call commit handler */
6784         }
6785         if (vwrq->flags != IW_TXPOW_MWATT) {
6786                 return -EINVAL;
6787         }
6788         clear_bit (FLAG_RADIO_OFF, &local->flags);
6789         for (i = 0; cap_rid.txPowerLevels[i] && (i < 8); i++)
6790                 if (v == cap_rid.txPowerLevels[i]) {
6791                         readConfigRid(local, 1);
6792                         local->config.txPower = v;
6793                         set_bit (FLAG_COMMIT, &local->flags);
6794                         rc = -EINPROGRESS;      /* Call commit handler */
6795                         break;
6796                 }
6797         return rc;
6798 }
6799
6800 /*------------------------------------------------------------------*/
6801 /*
6802  * Wireless Handler : get Tx-Power
6803  */
6804 static int airo_get_txpow(struct net_device *dev,
6805                           struct iw_request_info *info,
6806                           struct iw_param *vwrq,
6807                           char *extra)
6808 {
6809         struct airo_info *local = dev->ml_priv;
6810
6811         readConfigRid(local, 1);
6812         vwrq->value = le16_to_cpu(local->config.txPower);
6813         vwrq->fixed = 1;        /* No power control */
6814         vwrq->disabled = test_bit(FLAG_RADIO_OFF, &local->flags);
6815         vwrq->flags = IW_TXPOW_MWATT;
6816
6817         return 0;
6818 }
6819
6820 /*------------------------------------------------------------------*/
6821 /*
6822  * Wireless Handler : set Retry limits
6823  */
6824 static int airo_set_retry(struct net_device *dev,
6825                           struct iw_request_info *info,
6826                           struct iw_param *vwrq,
6827                           char *extra)
6828 {
6829         struct airo_info *local = dev->ml_priv;
6830         int rc = -EINVAL;
6831
6832         if(vwrq->disabled) {
6833                 return -EINVAL;
6834         }
6835         readConfigRid(local, 1);
6836         if(vwrq->flags & IW_RETRY_LIMIT) {
6837                 __le16 v = cpu_to_le16(vwrq->value);
6838                 if(vwrq->flags & IW_RETRY_LONG)
6839                         local->config.longRetryLimit = v;
6840                 else if (vwrq->flags & IW_RETRY_SHORT)
6841                         local->config.shortRetryLimit = v;
6842                 else {
6843                         /* No modifier : set both */
6844                         local->config.longRetryLimit = v;
6845                         local->config.shortRetryLimit = v;
6846                 }
6847                 set_bit (FLAG_COMMIT, &local->flags);
6848                 rc = -EINPROGRESS;              /* Call commit handler */
6849         }
6850         if(vwrq->flags & IW_RETRY_LIFETIME) {
6851                 local->config.txLifetime = cpu_to_le16(vwrq->value / 1024);
6852                 set_bit (FLAG_COMMIT, &local->flags);
6853                 rc = -EINPROGRESS;              /* Call commit handler */
6854         }
6855         return rc;
6856 }
6857
6858 /*------------------------------------------------------------------*/
6859 /*
6860  * Wireless Handler : get Retry limits
6861  */
6862 static int airo_get_retry(struct net_device *dev,
6863                           struct iw_request_info *info,
6864                           struct iw_param *vwrq,
6865                           char *extra)
6866 {
6867         struct airo_info *local = dev->ml_priv;
6868
6869         vwrq->disabled = 0;      /* Can't be disabled */
6870
6871         readConfigRid(local, 1);
6872         /* Note : by default, display the min retry number */
6873         if((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
6874                 vwrq->flags = IW_RETRY_LIFETIME;
6875                 vwrq->value = le16_to_cpu(local->config.txLifetime) * 1024;
6876         } else if((vwrq->flags & IW_RETRY_LONG)) {
6877                 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
6878                 vwrq->value = le16_to_cpu(local->config.longRetryLimit);
6879         } else {
6880                 vwrq->flags = IW_RETRY_LIMIT;
6881                 vwrq->value = le16_to_cpu(local->config.shortRetryLimit);
6882                 if(local->config.shortRetryLimit != local->config.longRetryLimit)
6883                         vwrq->flags |= IW_RETRY_SHORT;
6884         }
6885
6886         return 0;
6887 }
6888
6889 /*------------------------------------------------------------------*/
6890 /*
6891  * Wireless Handler : get range info
6892  */
6893 static int airo_get_range(struct net_device *dev,
6894                           struct iw_request_info *info,
6895                           struct iw_point *dwrq,
6896                           char *extra)
6897 {
6898         struct airo_info *local = dev->ml_priv;
6899         struct iw_range *range = (struct iw_range *) extra;
6900         CapabilityRid cap_rid;          /* Card capability info */
6901         int             i;
6902         int             k;
6903
6904         readCapabilityRid(local, &cap_rid, 1);
6905
6906         dwrq->length = sizeof(struct iw_range);
6907         memset(range, 0, sizeof(*range));
6908         range->min_nwid = 0x0000;
6909         range->max_nwid = 0x0000;
6910         range->num_channels = 14;
6911         /* Should be based on cap_rid.country to give only
6912          * what the current card support */
6913         k = 0;
6914         for(i = 0; i < 14; i++) {
6915                 range->freq[k].i = i + 1; /* List index */
6916                 range->freq[k].m = ieee80211_dsss_chan_to_freq(i + 1) * 100000;
6917                 range->freq[k++].e = 1; /* Values in MHz -> * 10^5 * 10 */
6918         }
6919         range->num_frequency = k;
6920
6921         range->sensitivity = 65535;
6922
6923         /* Hum... Should put the right values there */
6924         if (local->rssi)
6925                 range->max_qual.qual = 100;     /* % */
6926         else
6927                 range->max_qual.qual = airo_get_max_quality(&cap_rid);
6928         range->max_qual.level = 0x100 - 120;    /* -120 dBm */
6929         range->max_qual.noise = 0x100 - 120;    /* -120 dBm */
6930
6931         /* Experimental measurements - boundary 11/5.5 Mb/s */
6932         /* Note : with or without the (local->rssi), results
6933          * are somewhat different. - Jean II */
6934         if (local->rssi) {
6935                 range->avg_qual.qual = 50;              /* % */
6936                 range->avg_qual.level = 0x100 - 70;     /* -70 dBm */
6937         } else {
6938                 range->avg_qual.qual = airo_get_avg_quality(&cap_rid);
6939                 range->avg_qual.level = 0x100 - 80;     /* -80 dBm */
6940         }
6941         range->avg_qual.noise = 0x100 - 85;             /* -85 dBm */
6942
6943         for(i = 0 ; i < 8 ; i++) {
6944                 range->bitrate[i] = cap_rid.supportedRates[i] * 500000;
6945                 if(range->bitrate[i] == 0)
6946                         break;
6947         }
6948         range->num_bitrates = i;
6949
6950         /* Set an indication of the max TCP throughput
6951          * in bit/s that we can expect using this interface.
6952          * May be use for QoS stuff... Jean II */
6953         if(i > 2)
6954                 range->throughput = 5000 * 1000;
6955         else
6956                 range->throughput = 1500 * 1000;
6957
6958         range->min_rts = 0;
6959         range->max_rts = AIRO_DEF_MTU;
6960         range->min_frag = 256;
6961         range->max_frag = AIRO_DEF_MTU;
6962
6963         if(cap_rid.softCap & cpu_to_le16(2)) {
6964                 // WEP: RC4 40 bits
6965                 range->encoding_size[0] = 5;
6966                 // RC4 ~128 bits
6967                 if (cap_rid.softCap & cpu_to_le16(0x100)) {
6968                         range->encoding_size[1] = 13;
6969                         range->num_encoding_sizes = 2;
6970                 } else
6971                         range->num_encoding_sizes = 1;
6972                 range->max_encoding_tokens =
6973                         cap_rid.softCap & cpu_to_le16(0x80) ? 4 : 1;
6974         } else {
6975                 range->num_encoding_sizes = 0;
6976                 range->max_encoding_tokens = 0;
6977         }
6978         range->min_pmp = 0;
6979         range->max_pmp = 5000000;       /* 5 secs */
6980         range->min_pmt = 0;
6981         range->max_pmt = 65535 * 1024;  /* ??? */
6982         range->pmp_flags = IW_POWER_PERIOD;
6983         range->pmt_flags = IW_POWER_TIMEOUT;
6984         range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
6985
6986         /* Transmit Power - values are in mW */
6987         for(i = 0 ; i < 8 ; i++) {
6988                 range->txpower[i] = le16_to_cpu(cap_rid.txPowerLevels[i]);
6989                 if(range->txpower[i] == 0)
6990                         break;
6991         }
6992         range->num_txpower = i;
6993         range->txpower_capa = IW_TXPOW_MWATT;
6994         range->we_version_source = 19;
6995         range->we_version_compiled = WIRELESS_EXT;
6996         range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
6997         range->retry_flags = IW_RETRY_LIMIT;
6998         range->r_time_flags = IW_RETRY_LIFETIME;
6999         range->min_retry = 1;
7000         range->max_retry = 65535;
7001         range->min_r_time = 1024;
7002         range->max_r_time = 65535 * 1024;
7003
7004         /* Event capability (kernel + driver) */
7005         range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
7006                                 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
7007                                 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
7008                                 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
7009         range->event_capa[1] = IW_EVENT_CAPA_K_1;
7010         range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVTXDROP);
7011         return 0;
7012 }
7013
7014 /*------------------------------------------------------------------*/
7015 /*
7016  * Wireless Handler : set Power Management
7017  */
7018 static int airo_set_power(struct net_device *dev,
7019                           struct iw_request_info *info,
7020                           struct iw_param *vwrq,
7021                           char *extra)
7022 {
7023         struct airo_info *local = dev->ml_priv;
7024
7025         readConfigRid(local, 1);
7026         if (vwrq->disabled) {
7027                 if (sniffing_mode(local))
7028                         return -EINVAL;
7029                 local->config.powerSaveMode = POWERSAVE_CAM;
7030                 local->config.rmode &= ~RXMODE_MASK;
7031                 local->config.rmode |= RXMODE_BC_MC_ADDR;
7032                 set_bit (FLAG_COMMIT, &local->flags);
7033                 return -EINPROGRESS;            /* Call commit handler */
7034         }
7035         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7036                 local->config.fastListenDelay = cpu_to_le16((vwrq->value + 500) / 1024);
7037                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7038                 set_bit (FLAG_COMMIT, &local->flags);
7039         } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
7040                 local->config.fastListenInterval =
7041                 local->config.listenInterval =
7042                         cpu_to_le16((vwrq->value + 500) / 1024);
7043                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7044                 set_bit (FLAG_COMMIT, &local->flags);
7045         }
7046         switch (vwrq->flags & IW_POWER_MODE) {
7047                 case IW_POWER_UNICAST_R:
7048                         if (sniffing_mode(local))
7049                                 return -EINVAL;
7050                         local->config.rmode &= ~RXMODE_MASK;
7051                         local->config.rmode |= RXMODE_ADDR;
7052                         set_bit (FLAG_COMMIT, &local->flags);
7053                         break;
7054                 case IW_POWER_ALL_R:
7055                         if (sniffing_mode(local))
7056                                 return -EINVAL;
7057                         local->config.rmode &= ~RXMODE_MASK;
7058                         local->config.rmode |= RXMODE_BC_MC_ADDR;
7059                         set_bit (FLAG_COMMIT, &local->flags);
7060                 case IW_POWER_ON:
7061                         /* This is broken, fixme ;-) */
7062                         break;
7063                 default:
7064                         return -EINVAL;
7065         }
7066         // Note : we may want to factor local->need_commit here
7067         // Note2 : may also want to factor RXMODE_RFMON test
7068         return -EINPROGRESS;            /* Call commit handler */
7069 }
7070
7071 /*------------------------------------------------------------------*/
7072 /*
7073  * Wireless Handler : get Power Management
7074  */
7075 static int airo_get_power(struct net_device *dev,
7076                           struct iw_request_info *info,
7077                           struct iw_param *vwrq,
7078                           char *extra)
7079 {
7080         struct airo_info *local = dev->ml_priv;
7081         __le16 mode;
7082
7083         readConfigRid(local, 1);
7084         mode = local->config.powerSaveMode;
7085         if ((vwrq->disabled = (mode == POWERSAVE_CAM)))
7086                 return 0;
7087         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7088                 vwrq->value = le16_to_cpu(local->config.fastListenDelay) * 1024;
7089                 vwrq->flags = IW_POWER_TIMEOUT;
7090         } else {
7091                 vwrq->value = le16_to_cpu(local->config.fastListenInterval) * 1024;
7092                 vwrq->flags = IW_POWER_PERIOD;
7093         }
7094         if ((local->config.rmode & RXMODE_MASK) == RXMODE_ADDR)
7095                 vwrq->flags |= IW_POWER_UNICAST_R;
7096         else
7097                 vwrq->flags |= IW_POWER_ALL_R;
7098
7099         return 0;
7100 }
7101
7102 /*------------------------------------------------------------------*/
7103 /*
7104  * Wireless Handler : set Sensitivity
7105  */
7106 static int airo_set_sens(struct net_device *dev,
7107                          struct iw_request_info *info,
7108                          struct iw_param *vwrq,
7109                          char *extra)
7110 {
7111         struct airo_info *local = dev->ml_priv;
7112
7113         readConfigRid(local, 1);
7114         local->config.rssiThreshold =
7115                 cpu_to_le16(vwrq->disabled ? RSSI_DEFAULT : vwrq->value);
7116         set_bit (FLAG_COMMIT, &local->flags);
7117
7118         return -EINPROGRESS;            /* Call commit handler */
7119 }
7120
7121 /*------------------------------------------------------------------*/
7122 /*
7123  * Wireless Handler : get Sensitivity
7124  */
7125 static int airo_get_sens(struct net_device *dev,
7126                          struct iw_request_info *info,
7127                          struct iw_param *vwrq,
7128                          char *extra)
7129 {
7130         struct airo_info *local = dev->ml_priv;
7131
7132         readConfigRid(local, 1);
7133         vwrq->value = le16_to_cpu(local->config.rssiThreshold);
7134         vwrq->disabled = (vwrq->value == 0);
7135         vwrq->fixed = 1;
7136
7137         return 0;
7138 }
7139
7140 /*------------------------------------------------------------------*/
7141 /*
7142  * Wireless Handler : get AP List
7143  * Note : this is deprecated in favor of IWSCAN
7144  */
7145 static int airo_get_aplist(struct net_device *dev,
7146                            struct iw_request_info *info,
7147                            struct iw_point *dwrq,
7148                            char *extra)
7149 {
7150         struct airo_info *local = dev->ml_priv;
7151         struct sockaddr *address = (struct sockaddr *) extra;
7152         struct iw_quality qual[IW_MAX_AP];
7153         BSSListRid BSSList;
7154         int i;
7155         int loseSync = capable(CAP_NET_ADMIN) ? 1: -1;
7156
7157         for (i = 0; i < IW_MAX_AP; i++) {
7158                 u16 dBm;
7159                 if (readBSSListRid(local, loseSync, &BSSList))
7160                         break;
7161                 loseSync = 0;
7162                 memcpy(address[i].sa_data, BSSList.bssid, ETH_ALEN);
7163                 address[i].sa_family = ARPHRD_ETHER;
7164                 dBm = le16_to_cpu(BSSList.dBm);
7165                 if (local->rssi) {
7166                         qual[i].level = 0x100 - dBm;
7167                         qual[i].qual = airo_dbm_to_pct(local->rssi, dBm);
7168                         qual[i].updated = IW_QUAL_QUAL_UPDATED
7169                                         | IW_QUAL_LEVEL_UPDATED
7170                                         | IW_QUAL_DBM;
7171                 } else {
7172                         qual[i].level = (dBm + 321) / 2;
7173                         qual[i].qual = 0;
7174                         qual[i].updated = IW_QUAL_QUAL_INVALID
7175                                         | IW_QUAL_LEVEL_UPDATED
7176                                         | IW_QUAL_DBM;
7177                 }
7178                 qual[i].noise = local->wstats.qual.noise;
7179                 if (BSSList.index == cpu_to_le16(0xffff))
7180                         break;
7181         }
7182         if (!i) {
7183                 StatusRid status_rid;           /* Card status info */
7184                 readStatusRid(local, &status_rid, 1);
7185                 for (i = 0;
7186                      i < min(IW_MAX_AP, 4) &&
7187                              (status_rid.bssid[i][0]
7188                               & status_rid.bssid[i][1]
7189                               & status_rid.bssid[i][2]
7190                               & status_rid.bssid[i][3]
7191                               & status_rid.bssid[i][4]
7192                               & status_rid.bssid[i][5])!=0xff &&
7193                              (status_rid.bssid[i][0]
7194                               | status_rid.bssid[i][1]
7195                               | status_rid.bssid[i][2]
7196                               | status_rid.bssid[i][3]
7197                               | status_rid.bssid[i][4]
7198                               | status_rid.bssid[i][5]);
7199                      i++) {
7200                         memcpy(address[i].sa_data,
7201                                status_rid.bssid[i], ETH_ALEN);
7202                         address[i].sa_family = ARPHRD_ETHER;
7203                 }
7204         } else {
7205                 dwrq->flags = 1; /* Should be define'd */
7206                 memcpy(extra + sizeof(struct sockaddr)*i,
7207                        &qual,  sizeof(struct iw_quality)*i);
7208         }
7209         dwrq->length = i;
7210
7211         return 0;
7212 }
7213
7214 /*------------------------------------------------------------------*/
7215 /*
7216  * Wireless Handler : Initiate Scan
7217  */
7218 static int airo_set_scan(struct net_device *dev,
7219                          struct iw_request_info *info,
7220                          struct iw_point *dwrq,
7221                          char *extra)
7222 {
7223         struct airo_info *ai = dev->ml_priv;
7224         Cmd cmd;
7225         Resp rsp;
7226         int wake = 0;
7227
7228         /* Note : you may have realised that, as this is a SET operation,
7229          * this is privileged and therefore a normal user can't
7230          * perform scanning.
7231          * This is not an error, while the device perform scanning,
7232          * traffic doesn't flow, so it's a perfect DoS...
7233          * Jean II */
7234         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
7235
7236         if (down_interruptible(&ai->sem))
7237                 return -ERESTARTSYS;
7238
7239         /* If there's already a scan in progress, don't
7240          * trigger another one. */
7241         if (ai->scan_timeout > 0)
7242                 goto out;
7243
7244         /* Initiate a scan command */
7245         ai->scan_timeout = RUN_AT(3*HZ);
7246         memset(&cmd, 0, sizeof(cmd));
7247         cmd.cmd=CMD_LISTBSS;
7248         issuecommand(ai, &cmd, &rsp);
7249         wake = 1;
7250
7251 out:
7252         up(&ai->sem);
7253         if (wake)
7254                 wake_up_interruptible(&ai->thr_wait);
7255         return 0;
7256 }
7257
7258 /*------------------------------------------------------------------*/
7259 /*
7260  * Translate scan data returned from the card to a card independent
7261  * format that the Wireless Tools will understand - Jean II
7262  */
7263 static inline char *airo_translate_scan(struct net_device *dev,
7264                                         struct iw_request_info *info,
7265                                         char *current_ev,
7266                                         char *end_buf,
7267                                         BSSListRid *bss)
7268 {
7269         struct airo_info *ai = dev->ml_priv;
7270         struct iw_event         iwe;            /* Temporary buffer */
7271         __le16                  capabilities;
7272         char *                  current_val;    /* For rates */
7273         int                     i;
7274         char *          buf;
7275         u16 dBm;
7276
7277         /* First entry *MUST* be the AP MAC address */
7278         iwe.cmd = SIOCGIWAP;
7279         iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
7280         memcpy(iwe.u.ap_addr.sa_data, bss->bssid, ETH_ALEN);
7281         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7282                                           &iwe, IW_EV_ADDR_LEN);
7283
7284         /* Other entries will be displayed in the order we give them */
7285
7286         /* Add the ESSID */
7287         iwe.u.data.length = bss->ssidLen;
7288         if(iwe.u.data.length > 32)
7289                 iwe.u.data.length = 32;
7290         iwe.cmd = SIOCGIWESSID;
7291         iwe.u.data.flags = 1;
7292         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7293                                           &iwe, bss->ssid);
7294
7295         /* Add mode */
7296         iwe.cmd = SIOCGIWMODE;
7297         capabilities = bss->cap;
7298         if(capabilities & (CAP_ESS | CAP_IBSS)) {
7299                 if(capabilities & CAP_ESS)
7300                         iwe.u.mode = IW_MODE_MASTER;
7301                 else
7302                         iwe.u.mode = IW_MODE_ADHOC;
7303                 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7304                                                   &iwe, IW_EV_UINT_LEN);
7305         }
7306
7307         /* Add frequency */
7308         iwe.cmd = SIOCGIWFREQ;
7309         iwe.u.freq.m = le16_to_cpu(bss->dsChannel);
7310         iwe.u.freq.m = ieee80211_dsss_chan_to_freq(iwe.u.freq.m) * 100000;
7311         iwe.u.freq.e = 1;
7312         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7313                                           &iwe, IW_EV_FREQ_LEN);
7314
7315         dBm = le16_to_cpu(bss->dBm);
7316
7317         /* Add quality statistics */
7318         iwe.cmd = IWEVQUAL;
7319         if (ai->rssi) {
7320                 iwe.u.qual.level = 0x100 - dBm;
7321                 iwe.u.qual.qual = airo_dbm_to_pct(ai->rssi, dBm);
7322                 iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED
7323                                 | IW_QUAL_LEVEL_UPDATED
7324                                 | IW_QUAL_DBM;
7325         } else {
7326                 iwe.u.qual.level = (dBm + 321) / 2;
7327                 iwe.u.qual.qual = 0;
7328                 iwe.u.qual.updated = IW_QUAL_QUAL_INVALID
7329                                 | IW_QUAL_LEVEL_UPDATED
7330                                 | IW_QUAL_DBM;
7331         }
7332         iwe.u.qual.noise = ai->wstats.qual.noise;
7333         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7334                                           &iwe, IW_EV_QUAL_LEN);
7335
7336         /* Add encryption capability */
7337         iwe.cmd = SIOCGIWENCODE;
7338         if(capabilities & CAP_PRIVACY)
7339                 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
7340         else
7341                 iwe.u.data.flags = IW_ENCODE_DISABLED;
7342         iwe.u.data.length = 0;
7343         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7344                                           &iwe, bss->ssid);
7345
7346         /* Rate : stuffing multiple values in a single event require a bit
7347          * more of magic - Jean II */
7348         current_val = current_ev + iwe_stream_lcp_len(info);
7349
7350         iwe.cmd = SIOCGIWRATE;
7351         /* Those two flags are ignored... */
7352         iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
7353         /* Max 8 values */
7354         for(i = 0 ; i < 8 ; i++) {
7355                 /* NULL terminated */
7356                 if(bss->rates[i] == 0)
7357                         break;
7358                 /* Bit rate given in 500 kb/s units (+ 0x80) */
7359                 iwe.u.bitrate.value = ((bss->rates[i] & 0x7f) * 500000);
7360                 /* Add new value to event */
7361                 current_val = iwe_stream_add_value(info, current_ev,
7362                                                    current_val, end_buf,
7363                                                    &iwe, IW_EV_PARAM_LEN);
7364         }
7365         /* Check if we added any event */
7366         if ((current_val - current_ev) > iwe_stream_lcp_len(info))
7367                 current_ev = current_val;
7368
7369         /* Beacon interval */
7370         buf = kmalloc(30, GFP_KERNEL);
7371         if (buf) {
7372                 iwe.cmd = IWEVCUSTOM;
7373                 sprintf(buf, "bcn_int=%d", bss->beaconInterval);
7374                 iwe.u.data.length = strlen(buf);
7375                 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7376                                                   &iwe, buf);
7377                 kfree(buf);
7378         }
7379
7380         /* Put WPA/RSN Information Elements into the event stream */
7381         if (test_bit(FLAG_WPA_CAPABLE, &ai->flags)) {
7382                 unsigned int num_null_ies = 0;
7383                 u16 length = sizeof (bss->extra.iep);
7384                 u8 *ie = (void *)&bss->extra.iep;
7385
7386                 while ((length >= 2) && (num_null_ies < 2)) {
7387                         if (2 + ie[1] > length) {
7388                                 /* Invalid element, don't continue parsing IE */
7389                                 break;
7390                         }
7391
7392                         switch (ie[0]) {
7393                         case WLAN_EID_SSID:
7394                                 /* Two zero-length SSID elements
7395                                  * mean we're done parsing elements */
7396                                 if (!ie[1])
7397                                         num_null_ies++;
7398                                 break;
7399
7400                         case WLAN_EID_GENERIC:
7401                                 if (ie[1] >= 4 &&
7402                                     ie[2] == 0x00 &&
7403                                     ie[3] == 0x50 &&
7404                                     ie[4] == 0xf2 &&
7405                                     ie[5] == 0x01) {
7406                                         iwe.cmd = IWEVGENIE;
7407                                         /* 64 is an arbitrary cut-off */
7408                                         iwe.u.data.length = min(ie[1] + 2,
7409                                                                 64);
7410                                         current_ev = iwe_stream_add_point(
7411                                                         info, current_ev,
7412                                                         end_buf, &iwe, ie);
7413                                 }
7414                                 break;
7415
7416                         case WLAN_EID_RSN:
7417                                 iwe.cmd = IWEVGENIE;
7418                                 /* 64 is an arbitrary cut-off */
7419                                 iwe.u.data.length = min(ie[1] + 2, 64);
7420                                 current_ev = iwe_stream_add_point(
7421                                         info, current_ev, end_buf,
7422                                         &iwe, ie);
7423                                 break;
7424
7425                         default:
7426                                 break;
7427                         }
7428
7429                         length -= 2 + ie[1];
7430                         ie += 2 + ie[1];
7431                 }
7432         }
7433         return current_ev;
7434 }
7435
7436 /*------------------------------------------------------------------*/
7437 /*
7438  * Wireless Handler : Read Scan Results
7439  */
7440 static int airo_get_scan(struct net_device *dev,
7441                          struct iw_request_info *info,
7442                          struct iw_point *dwrq,
7443                          char *extra)
7444 {
7445         struct airo_info *ai = dev->ml_priv;
7446         BSSListElement *net;
7447         int err = 0;
7448         char *current_ev = extra;
7449
7450         /* If a scan is in-progress, return -EAGAIN */
7451         if (ai->scan_timeout > 0)
7452                 return -EAGAIN;
7453
7454         if (down_interruptible(&ai->sem))
7455                 return -EAGAIN;
7456
7457         list_for_each_entry (net, &ai->network_list, list) {
7458                 /* Translate to WE format this entry */
7459                 current_ev = airo_translate_scan(dev, info, current_ev,
7460                                                  extra + dwrq->length,
7461                                                  &net->bss);
7462
7463                 /* Check if there is space for one more entry */
7464                 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
7465                         /* Ask user space to try again with a bigger buffer */
7466                         err = -E2BIG;
7467                         goto out;
7468                 }
7469         }
7470
7471         /* Length of data */
7472         dwrq->length = (current_ev - extra);
7473         dwrq->flags = 0;        /* todo */
7474
7475 out:
7476         up(&ai->sem);
7477         return err;
7478 }
7479
7480 /*------------------------------------------------------------------*/
7481 /*
7482  * Commit handler : called after a bunch of SET operations
7483  */
7484 static int airo_config_commit(struct net_device *dev,
7485                               struct iw_request_info *info,     /* NULL */
7486                               void *zwrq,                       /* NULL */
7487                               char *extra)                      /* NULL */
7488 {
7489         struct airo_info *local = dev->ml_priv;
7490
7491         if (!test_bit (FLAG_COMMIT, &local->flags))
7492                 return 0;
7493
7494         /* Some of the "SET" function may have modified some of the
7495          * parameters. It's now time to commit them in the card */
7496         disable_MAC(local, 1);
7497         if (test_bit (FLAG_RESET, &local->flags)) {
7498                 APListRid APList_rid;
7499                 SsidRid SSID_rid;
7500
7501                 readAPListRid(local, &APList_rid);
7502                 readSsidRid(local, &SSID_rid);
7503                 if (test_bit(FLAG_MPI,&local->flags))
7504                         setup_card(local, dev->dev_addr, 1 );
7505                 else
7506                         reset_airo_card(dev);
7507                 disable_MAC(local, 1);
7508                 writeSsidRid(local, &SSID_rid, 1);
7509                 writeAPListRid(local, &APList_rid, 1);
7510         }
7511         if (down_interruptible(&local->sem))
7512                 return -ERESTARTSYS;
7513         writeConfigRid(local, 0);
7514         enable_MAC(local, 0);
7515         if (test_bit (FLAG_RESET, &local->flags))
7516                 airo_set_promisc(local);
7517         else
7518                 up(&local->sem);
7519
7520         return 0;
7521 }
7522
7523 /*------------------------------------------------------------------*/
7524 /*
7525  * Structures to export the Wireless Handlers
7526  */
7527
7528 static const struct iw_priv_args airo_private_args[] = {
7529 /*{ cmd,         set_args,                            get_args, name } */
7530   { AIROIOCTL, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7531     IW_PRIV_TYPE_BYTE | 2047, "airoioctl" },
7532   { AIROIDIFC, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7533     IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "airoidifc" },
7534 };
7535
7536 static const iw_handler         airo_handler[] =
7537 {
7538         (iw_handler) airo_config_commit,        /* SIOCSIWCOMMIT */
7539         (iw_handler) airo_get_name,             /* SIOCGIWNAME */
7540         (iw_handler) NULL,                      /* SIOCSIWNWID */
7541         (iw_handler) NULL,                      /* SIOCGIWNWID */
7542         (iw_handler) airo_set_freq,             /* SIOCSIWFREQ */
7543         (iw_handler) airo_get_freq,             /* SIOCGIWFREQ */
7544         (iw_handler) airo_set_mode,             /* SIOCSIWMODE */
7545         (iw_handler) airo_get_mode,             /* SIOCGIWMODE */
7546         (iw_handler) airo_set_sens,             /* SIOCSIWSENS */
7547         (iw_handler) airo_get_sens,             /* SIOCGIWSENS */
7548         (iw_handler) NULL,                      /* SIOCSIWRANGE */
7549         (iw_handler) airo_get_range,            /* SIOCGIWRANGE */
7550         (iw_handler) NULL,                      /* SIOCSIWPRIV */
7551         (iw_handler) NULL,                      /* SIOCGIWPRIV */
7552         (iw_handler) NULL,                      /* SIOCSIWSTATS */
7553         (iw_handler) NULL,                      /* SIOCGIWSTATS */
7554         iw_handler_set_spy,                     /* SIOCSIWSPY */
7555         iw_handler_get_spy,                     /* SIOCGIWSPY */
7556         iw_handler_set_thrspy,                  /* SIOCSIWTHRSPY */
7557         iw_handler_get_thrspy,                  /* SIOCGIWTHRSPY */
7558         (iw_handler) airo_set_wap,              /* SIOCSIWAP */
7559         (iw_handler) airo_get_wap,              /* SIOCGIWAP */
7560         (iw_handler) NULL,                      /* -- hole -- */
7561         (iw_handler) airo_get_aplist,           /* SIOCGIWAPLIST */
7562         (iw_handler) airo_set_scan,             /* SIOCSIWSCAN */
7563         (iw_handler) airo_get_scan,             /* SIOCGIWSCAN */
7564         (iw_handler) airo_set_essid,            /* SIOCSIWESSID */
7565         (iw_handler) airo_get_essid,            /* SIOCGIWESSID */
7566         (iw_handler) airo_set_nick,             /* SIOCSIWNICKN */
7567         (iw_handler) airo_get_nick,             /* SIOCGIWNICKN */
7568         (iw_handler) NULL,                      /* -- hole -- */
7569         (iw_handler) NULL,                      /* -- hole -- */
7570         (iw_handler) airo_set_rate,             /* SIOCSIWRATE */
7571         (iw_handler) airo_get_rate,             /* SIOCGIWRATE */
7572         (iw_handler) airo_set_rts,              /* SIOCSIWRTS */
7573         (iw_handler) airo_get_rts,              /* SIOCGIWRTS */
7574         (iw_handler) airo_set_frag,             /* SIOCSIWFRAG */
7575         (iw_handler) airo_get_frag,             /* SIOCGIWFRAG */
7576         (iw_handler) airo_set_txpow,            /* SIOCSIWTXPOW */
7577         (iw_handler) airo_get_txpow,            /* SIOCGIWTXPOW */
7578         (iw_handler) airo_set_retry,            /* SIOCSIWRETRY */
7579         (iw_handler) airo_get_retry,            /* SIOCGIWRETRY */
7580         (iw_handler) airo_set_encode,           /* SIOCSIWENCODE */
7581         (iw_handler) airo_get_encode,           /* SIOCGIWENCODE */
7582         (iw_handler) airo_set_power,            /* SIOCSIWPOWER */
7583         (iw_handler) airo_get_power,            /* SIOCGIWPOWER */
7584         (iw_handler) NULL,                      /* -- hole -- */
7585         (iw_handler) NULL,                      /* -- hole -- */
7586         (iw_handler) NULL,                      /* SIOCSIWGENIE */
7587         (iw_handler) NULL,                      /* SIOCGIWGENIE */
7588         (iw_handler) airo_set_auth,             /* SIOCSIWAUTH */
7589         (iw_handler) airo_get_auth,             /* SIOCGIWAUTH */
7590         (iw_handler) airo_set_encodeext,        /* SIOCSIWENCODEEXT */
7591         (iw_handler) airo_get_encodeext,        /* SIOCGIWENCODEEXT */
7592         (iw_handler) NULL,                      /* SIOCSIWPMKSA */
7593 };
7594
7595 /* Note : don't describe AIROIDIFC and AIROOLDIDIFC in here.
7596  * We want to force the use of the ioctl code, because those can't be
7597  * won't work the iw_handler code (because they simultaneously read
7598  * and write data and iw_handler can't do that).
7599  * Note that it's perfectly legal to read/write on a single ioctl command,
7600  * you just can't use iwpriv and need to force it via the ioctl handler.
7601  * Jean II */
7602 static const iw_handler         airo_private_handler[] =
7603 {
7604         NULL,                           /* SIOCIWFIRSTPRIV */
7605 };
7606
7607 static const struct iw_handler_def      airo_handler_def =
7608 {
7609         .num_standard   = ARRAY_SIZE(airo_handler),
7610         .num_private    = ARRAY_SIZE(airo_private_handler),
7611         .num_private_args = ARRAY_SIZE(airo_private_args),
7612         .standard       = airo_handler,
7613         .private        = airo_private_handler,
7614         .private_args   = airo_private_args,
7615         .get_wireless_stats = airo_get_wireless_stats,
7616 };
7617
7618 /*
7619  * This defines the configuration part of the Wireless Extensions
7620  * Note : irq and spinlock protection will occur in the subroutines
7621  *
7622  * TODO :
7623  *      o Check input value more carefully and fill correct values in range
7624  *      o Test and shakeout the bugs (if any)
7625  *
7626  * Jean II
7627  *
7628  * Javier Achirica did a great job of merging code from the unnamed CISCO
7629  * developer that added support for flashing the card.
7630  */
7631 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
7632 {
7633         int rc = 0;
7634         struct airo_info *ai = dev->ml_priv;
7635
7636         if (ai->power.event)
7637                 return 0;
7638
7639         switch (cmd) {
7640 #ifdef CISCO_EXT
7641         case AIROIDIFC:
7642 #ifdef AIROOLDIDIFC
7643         case AIROOLDIDIFC:
7644 #endif
7645         {
7646                 int val = AIROMAGIC;
7647                 aironet_ioctl com;
7648                 if (copy_from_user(&com,rq->ifr_data,sizeof(com)))
7649                         rc = -EFAULT;
7650                 else if (copy_to_user(com.data,(char *)&val,sizeof(val)))
7651                         rc = -EFAULT;
7652         }
7653         break;
7654
7655         case AIROIOCTL:
7656 #ifdef AIROOLDIOCTL
7657         case AIROOLDIOCTL:
7658 #endif
7659                 /* Get the command struct and hand it off for evaluation by
7660                  * the proper subfunction
7661                  */
7662         {
7663                 aironet_ioctl com;
7664                 if (copy_from_user(&com,rq->ifr_data,sizeof(com))) {
7665                         rc = -EFAULT;
7666                         break;
7667                 }
7668
7669                 /* Separate R/W functions bracket legality here
7670                  */
7671                 if ( com.command == AIRORSWVERSION ) {
7672                         if (copy_to_user(com.data, swversion, sizeof(swversion)))
7673                                 rc = -EFAULT;
7674                         else
7675                                 rc = 0;
7676                 }
7677                 else if ( com.command <= AIRORRID)
7678                         rc = readrids(dev,&com);
7679                 else if ( com.command >= AIROPCAP && com.command <= (AIROPLEAPUSR+2) )
7680                         rc = writerids(dev,&com);
7681                 else if ( com.command >= AIROFLSHRST && com.command <= AIRORESTART )
7682                         rc = flashcard(dev,&com);
7683                 else
7684                         rc = -EINVAL;      /* Bad command in ioctl */
7685         }
7686         break;
7687 #endif /* CISCO_EXT */
7688
7689         // All other calls are currently unsupported
7690         default:
7691                 rc = -EOPNOTSUPP;
7692         }
7693         return rc;
7694 }
7695
7696 /*
7697  * Get the Wireless stats out of the driver
7698  * Note : irq and spinlock protection will occur in the subroutines
7699  *
7700  * TODO :
7701  *      o Check if work in Ad-Hoc mode (otherwise, use SPY, as in wvlan_cs)
7702  *
7703  * Jean
7704  */
7705 static void airo_read_wireless_stats(struct airo_info *local)
7706 {
7707         StatusRid status_rid;
7708         StatsRid stats_rid;
7709         CapabilityRid cap_rid;
7710         __le32 *vals = stats_rid.vals;
7711
7712         /* Get stats out of the card */
7713         clear_bit(JOB_WSTATS, &local->jobs);
7714         if (local->power.event) {
7715                 up(&local->sem);
7716                 return;
7717         }
7718         readCapabilityRid(local, &cap_rid, 0);
7719         readStatusRid(local, &status_rid, 0);
7720         readStatsRid(local, &stats_rid, RID_STATS, 0);
7721         up(&local->sem);
7722
7723         /* The status */
7724         local->wstats.status = le16_to_cpu(status_rid.mode);
7725
7726         /* Signal quality and co */
7727         if (local->rssi) {
7728                 local->wstats.qual.level =
7729                         airo_rssi_to_dbm(local->rssi,
7730                                          le16_to_cpu(status_rid.sigQuality));
7731                 /* normalizedSignalStrength appears to be a percentage */
7732                 local->wstats.qual.qual =
7733                         le16_to_cpu(status_rid.normalizedSignalStrength);
7734         } else {
7735                 local->wstats.qual.level =
7736                         (le16_to_cpu(status_rid.normalizedSignalStrength) + 321) / 2;
7737                 local->wstats.qual.qual = airo_get_quality(&status_rid, &cap_rid);
7738         }
7739         if (le16_to_cpu(status_rid.len) >= 124) {
7740                 local->wstats.qual.noise = 0x100 - status_rid.noisedBm;
7741                 local->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
7742         } else {
7743                 local->wstats.qual.noise = 0;
7744                 local->wstats.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID | IW_QUAL_DBM;
7745         }
7746
7747         /* Packets discarded in the wireless adapter due to wireless
7748          * specific problems */
7749         local->wstats.discard.nwid = le32_to_cpu(vals[56]) +
7750                                      le32_to_cpu(vals[57]) +
7751                                      le32_to_cpu(vals[58]); /* SSID Mismatch */
7752         local->wstats.discard.code = le32_to_cpu(vals[6]);/* RxWepErr */
7753         local->wstats.discard.fragment = le32_to_cpu(vals[30]);
7754         local->wstats.discard.retries = le32_to_cpu(vals[10]);
7755         local->wstats.discard.misc = le32_to_cpu(vals[1]) +
7756                                      le32_to_cpu(vals[32]);
7757         local->wstats.miss.beacon = le32_to_cpu(vals[34]);
7758 }
7759
7760 static struct iw_statistics *airo_get_wireless_stats(struct net_device *dev)
7761 {
7762         struct airo_info *local =  dev->ml_priv;
7763
7764         if (!test_bit(JOB_WSTATS, &local->jobs)) {
7765                 /* Get stats out of the card if available */
7766                 if (down_trylock(&local->sem) != 0) {
7767                         set_bit(JOB_WSTATS, &local->jobs);
7768                         wake_up_interruptible(&local->thr_wait);
7769                 } else
7770                         airo_read_wireless_stats(local);
7771         }
7772
7773         return &local->wstats;
7774 }
7775
7776 #ifdef CISCO_EXT
7777 /*
7778  * This just translates from driver IOCTL codes to the command codes to
7779  * feed to the radio's host interface. Things can be added/deleted
7780  * as needed.  This represents the READ side of control I/O to
7781  * the card
7782  */
7783 static int readrids(struct net_device *dev, aironet_ioctl *comp) {
7784         unsigned short ridcode;
7785         unsigned char *iobuf;
7786         int len;
7787         struct airo_info *ai = dev->ml_priv;
7788
7789         if (test_bit(FLAG_FLASHING, &ai->flags))
7790                 return -EIO;
7791
7792         switch(comp->command)
7793         {
7794         case AIROGCAP:      ridcode = RID_CAPABILITIES; break;
7795         case AIROGCFG:      ridcode = RID_CONFIG;
7796                 if (test_bit(FLAG_COMMIT, &ai->flags)) {
7797                         disable_MAC (ai, 1);
7798                         writeConfigRid (ai, 1);
7799                         enable_MAC(ai, 1);
7800                 }
7801                 break;
7802         case AIROGSLIST:    ridcode = RID_SSID;         break;
7803         case AIROGVLIST:    ridcode = RID_APLIST;       break;
7804         case AIROGDRVNAM:   ridcode = RID_DRVNAME;      break;
7805         case AIROGEHTENC:   ridcode = RID_ETHERENCAP;   break;
7806         case AIROGWEPKTMP:  ridcode = RID_WEP_TEMP;
7807                 /* Only super-user can read WEP keys */
7808                 if (!capable(CAP_NET_ADMIN))
7809                         return -EPERM;
7810                 break;
7811         case AIROGWEPKNV:   ridcode = RID_WEP_PERM;
7812                 /* Only super-user can read WEP keys */
7813                 if (!capable(CAP_NET_ADMIN))
7814                         return -EPERM;
7815                 break;
7816         case AIROGSTAT:     ridcode = RID_STATUS;       break;
7817         case AIROGSTATSD32: ridcode = RID_STATSDELTA;   break;
7818         case AIROGSTATSC32: ridcode = RID_STATS;        break;
7819         case AIROGMICSTATS:
7820                 if (copy_to_user(comp->data, &ai->micstats,
7821                                  min((int)comp->len,(int)sizeof(ai->micstats))))
7822                         return -EFAULT;
7823                 return 0;
7824         case AIRORRID:      ridcode = comp->ridnum;     break;
7825         default:
7826                 return -EINVAL;
7827                 break;
7828         }
7829
7830         if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7831                 return -ENOMEM;
7832
7833         PC4500_readrid(ai,ridcode,iobuf,RIDSIZE, 1);
7834         /* get the count of bytes in the rid  docs say 1st 2 bytes is it.
7835          * then return it to the user
7836          * 9/22/2000 Honor user given length
7837          */
7838         len = comp->len;
7839
7840         if (copy_to_user(comp->data, iobuf, min(len, (int)RIDSIZE))) {
7841                 kfree (iobuf);
7842                 return -EFAULT;
7843         }
7844         kfree (iobuf);
7845         return 0;
7846 }
7847
7848 /*
7849  * Danger Will Robinson write the rids here
7850  */
7851
7852 static int writerids(struct net_device *dev, aironet_ioctl *comp) {
7853         struct airo_info *ai = dev->ml_priv;
7854         int  ridcode;
7855         int  enabled;
7856         static int (* writer)(struct airo_info *, u16 rid, const void *, int, int);
7857         unsigned char *iobuf;
7858
7859         /* Only super-user can write RIDs */
7860         if (!capable(CAP_NET_ADMIN))
7861                 return -EPERM;
7862
7863         if (test_bit(FLAG_FLASHING, &ai->flags))
7864                 return -EIO;
7865
7866         ridcode = 0;
7867         writer = do_writerid;
7868
7869         switch(comp->command)
7870         {
7871         case AIROPSIDS:     ridcode = RID_SSID;         break;
7872         case AIROPCAP:      ridcode = RID_CAPABILITIES; break;
7873         case AIROPAPLIST:   ridcode = RID_APLIST;       break;
7874         case AIROPCFG: ai->config.len = 0;
7875                             clear_bit(FLAG_COMMIT, &ai->flags);
7876                             ridcode = RID_CONFIG;       break;
7877         case AIROPWEPKEYNV: ridcode = RID_WEP_PERM;     break;
7878         case AIROPLEAPUSR:  ridcode = RID_LEAPUSERNAME; break;
7879         case AIROPLEAPPWD:  ridcode = RID_LEAPPASSWORD; break;
7880         case AIROPWEPKEY:   ridcode = RID_WEP_TEMP; writer = PC4500_writerid;
7881                 break;
7882         case AIROPLEAPUSR+1: ridcode = 0xFF2A;          break;
7883         case AIROPLEAPUSR+2: ridcode = 0xFF2B;          break;
7884
7885                 /* this is not really a rid but a command given to the card
7886                  * same with MAC off
7887                  */
7888         case AIROPMACON:
7889                 if (enable_MAC(ai, 1) != 0)
7890                         return -EIO;
7891                 return 0;
7892
7893                 /*
7894                  * Evidently this code in the airo driver does not get a symbol
7895                  * as disable_MAC. it's probably so short the compiler does not gen one.
7896                  */
7897         case AIROPMACOFF:
7898                 disable_MAC(ai, 1);
7899                 return 0;
7900
7901                 /* This command merely clears the counts does not actually store any data
7902                  * only reads rid. But as it changes the cards state, I put it in the
7903                  * writerid routines.
7904                  */
7905         case AIROPSTCLR:
7906                 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7907                         return -ENOMEM;
7908
7909                 PC4500_readrid(ai,RID_STATSDELTACLEAR,iobuf,RIDSIZE, 1);
7910
7911                 enabled = ai->micstats.enabled;
7912                 memset(&ai->micstats,0,sizeof(ai->micstats));
7913                 ai->micstats.enabled = enabled;
7914
7915                 if (copy_to_user(comp->data, iobuf,
7916                                  min((int)comp->len, (int)RIDSIZE))) {
7917                         kfree (iobuf);
7918                         return -EFAULT;
7919                 }
7920                 kfree (iobuf);
7921                 return 0;
7922
7923         default:
7924                 return -EOPNOTSUPP;     /* Blarg! */
7925         }
7926         if(comp->len > RIDSIZE)
7927                 return -EINVAL;
7928
7929         if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7930                 return -ENOMEM;
7931
7932         if (copy_from_user(iobuf,comp->data,comp->len)) {
7933                 kfree (iobuf);
7934                 return -EFAULT;
7935         }
7936
7937         if (comp->command == AIROPCFG) {
7938                 ConfigRid *cfg = (ConfigRid *)iobuf;
7939
7940                 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags))
7941                         cfg->opmode |= MODE_MIC;
7942
7943                 if ((cfg->opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
7944                         set_bit (FLAG_ADHOC, &ai->flags);
7945                 else
7946                         clear_bit (FLAG_ADHOC, &ai->flags);
7947         }
7948
7949         if((*writer)(ai, ridcode, iobuf,comp->len,1)) {
7950                 kfree (iobuf);
7951                 return -EIO;
7952         }
7953         kfree (iobuf);
7954         return 0;
7955 }
7956
7957 /*****************************************************************************
7958  * Ancillary flash / mod functions much black magic lurkes here              *
7959  *****************************************************************************
7960  */
7961
7962 /*
7963  * Flash command switch table
7964  */
7965
7966 static int flashcard(struct net_device *dev, aironet_ioctl *comp) {
7967         int z;
7968
7969         /* Only super-user can modify flash */
7970         if (!capable(CAP_NET_ADMIN))
7971                 return -EPERM;
7972
7973         switch(comp->command)
7974         {
7975         case AIROFLSHRST:
7976                 return cmdreset((struct airo_info *)dev->ml_priv);
7977
7978         case AIROFLSHSTFL:
7979                 if (!AIRO_FLASH(dev) &&
7980                     (AIRO_FLASH(dev) = kmalloc(FLASHSIZE, GFP_KERNEL)) == NULL)
7981                         return -ENOMEM;
7982                 return setflashmode((struct airo_info *)dev->ml_priv);
7983
7984         case AIROFLSHGCHR: /* Get char from aux */
7985                 if(comp->len != sizeof(int))
7986                         return -EINVAL;
7987                 if (copy_from_user(&z,comp->data,comp->len))
7988                         return -EFAULT;
7989                 return flashgchar((struct airo_info *)dev->ml_priv, z, 8000);
7990
7991         case AIROFLSHPCHR: /* Send char to card. */
7992                 if(comp->len != sizeof(int))
7993                         return -EINVAL;
7994                 if (copy_from_user(&z,comp->data,comp->len))
7995                         return -EFAULT;
7996                 return flashpchar((struct airo_info *)dev->ml_priv, z, 8000);
7997
7998         case AIROFLPUTBUF: /* Send 32k to card */
7999                 if (!AIRO_FLASH(dev))
8000                         return -ENOMEM;
8001                 if(comp->len > FLASHSIZE)
8002                         return -EINVAL;
8003                 if (copy_from_user(AIRO_FLASH(dev), comp->data, comp->len))
8004                         return -EFAULT;
8005
8006                 flashputbuf((struct airo_info *)dev->ml_priv);
8007                 return 0;
8008
8009         case AIRORESTART:
8010                 if (flashrestart((struct airo_info *)dev->ml_priv, dev))
8011                         return -EIO;
8012                 return 0;
8013         }
8014         return -EINVAL;
8015 }
8016
8017 #define FLASH_COMMAND  0x7e7e
8018
8019 /*
8020  * STEP 1)
8021  * Disable MAC and do soft reset on
8022  * card.
8023  */
8024
8025 static int cmdreset(struct airo_info *ai) {
8026         disable_MAC(ai, 1);
8027
8028         if(!waitbusy (ai)){
8029                 airo_print_info(ai->dev->name, "Waitbusy hang before RESET");
8030                 return -EBUSY;
8031         }
8032
8033         OUT4500(ai,COMMAND,CMD_SOFTRESET);
8034
8035         ssleep(1);                      /* WAS 600 12/7/00 */
8036
8037         if(!waitbusy (ai)){
8038                 airo_print_info(ai->dev->name, "Waitbusy hang AFTER RESET");
8039                 return -EBUSY;
8040         }
8041         return 0;
8042 }
8043
8044 /* STEP 2)
8045  * Put the card in legendary flash
8046  * mode
8047  */
8048
8049 static int setflashmode (struct airo_info *ai) {
8050         set_bit (FLAG_FLASHING, &ai->flags);
8051
8052         OUT4500(ai, SWS0, FLASH_COMMAND);
8053         OUT4500(ai, SWS1, FLASH_COMMAND);
8054         if (probe) {
8055                 OUT4500(ai, SWS0, FLASH_COMMAND);
8056                 OUT4500(ai, COMMAND,0x10);
8057         } else {
8058                 OUT4500(ai, SWS2, FLASH_COMMAND);
8059                 OUT4500(ai, SWS3, FLASH_COMMAND);
8060                 OUT4500(ai, COMMAND,0);
8061         }
8062         msleep(500);            /* 500ms delay */
8063
8064         if(!waitbusy(ai)) {
8065                 clear_bit (FLAG_FLASHING, &ai->flags);
8066                 airo_print_info(ai->dev->name, "Waitbusy hang after setflash mode");
8067                 return -EIO;
8068         }
8069         return 0;
8070 }
8071
8072 /* Put character to SWS0 wait for dwelltime
8073  * x 50us for  echo .
8074  */
8075
8076 static int flashpchar(struct airo_info *ai,int byte,int dwelltime) {
8077         int echo;
8078         int waittime;
8079
8080         byte |= 0x8000;
8081
8082         if(dwelltime == 0 )
8083                 dwelltime = 200;
8084
8085         waittime=dwelltime;
8086
8087         /* Wait for busy bit d15 to go false indicating buffer empty */
8088         while ((IN4500 (ai, SWS0) & 0x8000) && waittime > 0) {
8089                 udelay (50);
8090                 waittime -= 50;
8091         }
8092
8093         /* timeout for busy clear wait */
8094         if(waittime <= 0 ){
8095                 airo_print_info(ai->dev->name, "flash putchar busywait timeout!");
8096                 return -EBUSY;
8097         }
8098
8099         /* Port is clear now write byte and wait for it to echo back */
8100         do {
8101                 OUT4500(ai,SWS0,byte);
8102                 udelay(50);
8103                 dwelltime -= 50;
8104                 echo = IN4500(ai,SWS1);
8105         } while (dwelltime >= 0 && echo != byte);
8106
8107         OUT4500(ai,SWS1,0);
8108
8109         return (echo == byte) ? 0 : -EIO;
8110 }
8111
8112 /*
8113  * Get a character from the card matching matchbyte
8114  * Step 3)
8115  */
8116 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime){
8117         int           rchar;
8118         unsigned char rbyte=0;
8119
8120         do {
8121                 rchar = IN4500(ai,SWS1);
8122
8123                 if(dwelltime && !(0x8000 & rchar)){
8124                         dwelltime -= 10;
8125                         mdelay(10);
8126                         continue;
8127                 }
8128                 rbyte = 0xff & rchar;
8129
8130                 if( (rbyte == matchbyte) && (0x8000 & rchar) ){
8131                         OUT4500(ai,SWS1,0);
8132                         return 0;
8133                 }
8134                 if( rbyte == 0x81 || rbyte == 0x82 || rbyte == 0x83 || rbyte == 0x1a || 0xffff == rchar)
8135                         break;
8136                 OUT4500(ai,SWS1,0);
8137
8138         }while(dwelltime > 0);
8139         return -EIO;
8140 }
8141
8142 /*
8143  * Transfer 32k of firmware data from user buffer to our buffer and
8144  * send to the card
8145  */
8146
8147 static int flashputbuf(struct airo_info *ai){
8148         int            nwords;
8149
8150         /* Write stuff */
8151         if (test_bit(FLAG_MPI,&ai->flags))
8152                 memcpy_toio(ai->pciaux + 0x8000, ai->flash, FLASHSIZE);
8153         else {
8154                 OUT4500(ai,AUXPAGE,0x100);
8155                 OUT4500(ai,AUXOFF,0);
8156
8157                 for(nwords=0;nwords != FLASHSIZE / 2;nwords++){
8158                         OUT4500(ai,AUXDATA,ai->flash[nwords] & 0xffff);
8159                 }
8160         }
8161         OUT4500(ai,SWS0,0x8000);
8162
8163         return 0;
8164 }
8165
8166 /*
8167  *
8168  */
8169 static int flashrestart(struct airo_info *ai,struct net_device *dev){
8170         int    i,status;
8171
8172         ssleep(1);                      /* Added 12/7/00 */
8173         clear_bit (FLAG_FLASHING, &ai->flags);
8174         if (test_bit(FLAG_MPI, &ai->flags)) {
8175                 status = mpi_init_descriptors(ai);
8176                 if (status != SUCCESS)
8177                         return status;
8178         }
8179         status = setup_card(ai, dev->dev_addr, 1);
8180
8181         if (!test_bit(FLAG_MPI,&ai->flags))
8182                 for( i = 0; i < MAX_FIDS; i++ ) {
8183                         ai->fids[i] = transmit_allocate
8184                                 ( ai, AIRO_DEF_MTU, i >= MAX_FIDS / 2 );
8185                 }
8186
8187         ssleep(1);                      /* Added 12/7/00 */
8188         return status;
8189 }
8190 #endif /* CISCO_EXT */
8191
8192 /*
8193     This program is free software; you can redistribute it and/or
8194     modify it under the terms of the GNU General Public License
8195     as published by the Free Software Foundation; either version 2
8196     of the License, or (at your option) any later version.
8197
8198     This program is distributed in the hope that it will be useful,
8199     but WITHOUT ANY WARRANTY; without even the implied warranty of
8200     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
8201     GNU General Public License for more details.
8202
8203     In addition:
8204
8205     Redistribution and use in source and binary forms, with or without
8206     modification, are permitted provided that the following conditions
8207     are met:
8208
8209     1. Redistributions of source code must retain the above copyright
8210        notice, this list of conditions and the following disclaimer.
8211     2. Redistributions in binary form must reproduce the above copyright
8212        notice, this list of conditions and the following disclaimer in the
8213        documentation and/or other materials provided with the distribution.
8214     3. The name of the author may not be used to endorse or promote
8215        products derived from this software without specific prior written
8216        permission.
8217
8218     THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
8219     IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
8220     WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
8221     ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
8222     INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
8223     (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
8224     SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
8225     HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
8226     STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
8227     IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
8228     POSSIBILITY OF SUCH DAMAGE.
8229 */
8230
8231 module_init(airo_init_module);
8232 module_exit(airo_cleanup_module);