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