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