drivers/net/wireless/airo.c

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