SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/net/wireless/airo.c

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