drivers/net/wireless/airo.c

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