drivers/net/wireless/orinoco.c

   1 /* orinoco.c - (formerly known as dldwd_cs.c and orinoco_cs.c)
   2  *
   3  * A driver for Hermes or Prism 2 chipset based PCMCIA wireless
   4  * adaptors, with Lucent/Agere, Intersil or Symbol firmware.
   5  *
   6  * Current maintainers (as of 29 September 2003) are:
   7  *      Pavel Roskin <proski AT gnu.org>
   8  * and  David Gibson <hermes AT gibson.dropbear.id.au>
   9  *
  10  * (C) Copyright David Gibson, IBM Corporation 2001-2003.
  11  * Copyright (C) 2000 David Gibson, Linuxcare Australia.
  12  *      With some help from :
  13  * Copyright (C) 2001 Jean Tourrilhes, HP Labs
  14  * Copyright (C) 2001 Benjamin Herrenschmidt
  15  *
  16  * Based on dummy_cs.c 1.27 2000/06/12 21:27:25
  17  *
  18  * Portions based on wvlan_cs.c 1.0.6, Copyright Andreas Neuhaus <andy
  19  * AT fasta.fh-dortmund.de>
  20  *      http://www.stud.fh-dortmund.de/~andy/wvlan/
  21  *
  22  * The contents of this file are subject to the Mozilla Public License
  23  * Version 1.1 (the "License"); you may not use this file except in
  24  * compliance with the License. You may obtain a copy of the License
  25  * at http://www.mozilla.org/MPL/
  26  *
  27  * Software distributed under the License is distributed on an "AS IS"
  28  * basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See
  29  * the License for the specific language governing rights and
  30  * limitations under the License.
  31  *
  32  * The initial developer of the original code is David A. Hinds
  33  * <dahinds AT users.sourceforge.net>.  Portions created by David
  34  * A. Hinds are Copyright (C) 1999 David A. Hinds.  All Rights
  35  * Reserved.
  36  *
  37  * Alternatively, the contents of this file may be used under the
  38  * terms of the GNU General Public License version 2 (the "GPL"), in
  39  * which case the provisions of the GPL are applicable instead of the
  40  * above.  If you wish to allow the use of your version of this file
  41  * only under the terms of the GPL and not to allow others to use your
  42  * version of this file under the MPL, indicate your decision by
  43  * deleting the provisions above and replace them with the notice and
  44  * other provisions required by the GPL.  If you do not delete the
  45  * provisions above, a recipient may use your version of this file
  46  * under either the MPL or the GPL.  */
  47
  48 /*
  49  * v0.01 -> v0.02 - 21/3/2001 - Jean II
  50  *      o Allow to use regular ethX device name instead of dldwdX
  51  *      o Warning on IBSS with ESSID=any for firmware 6.06
  52  *      o Put proper range.throughput values (optimistic)
  53  *      o IWSPY support (IOCTL and stat gather in Rx path)
  54  *      o Allow setting frequency in Ad-Hoc mode
  55  *      o Disable WEP setting if !has_wep to work on old firmware
  56  *      o Fix txpower range
  57  *      o Start adding support for Samsung/Compaq firmware
  58  *
  59  * v0.02 -> v0.03 - 23/3/2001 - Jean II
  60  *      o Start adding Symbol support - need to check all that
  61  *      o Fix Prism2/Symbol WEP to accept 128 bits keys
  62  *      o Add Symbol WEP (add authentication type)
  63  *      o Add Prism2/Symbol rate
  64  *      o Add PM timeout (holdover duration)
  65  *      o Enable "iwconfig eth0 key off" and friends (toggle flags)
  66  *      o Enable "iwconfig eth0 power unicast/all" (toggle flags)
  67  *      o Try with an Intel card. It report firmware 1.01, behave like
  68  *        an antiquated firmware, however on windows it says 2.00. Yuck !
  69  *      o Workaround firmware bug in allocate buffer (Intel 1.01)
  70  *      o Finish external renaming to orinoco...
  71  *      o Testing with various Wavelan firmwares
  72  *
  73  * v0.03 -> v0.04 - 30/3/2001 - Jean II
  74  *      o Update to Wireless 11 -> add retry limit/lifetime support
  75  *      o Tested with a D-Link DWL 650 card, fill in firmware support
  76  *      o Warning on Vcc mismatch (D-Link 3.3v card in Lucent 5v only slot)
  77  *      o Fixed the Prism2 WEP bugs that I introduced in v0.03 :-(
  78  *        It works on D-Link *only* after a tcpdump. Weird...
  79  *        And still doesn't work on Intel card. Grrrr...
  80  *      o Update the mode after a setport3
  81  *      o Add preamble setting for Symbol cards (not yet enabled)
  82  *      o Don't complain as much about Symbol cards...
  83  *
  84  * v0.04 -> v0.04b - 22/4/2001 - David Gibson
  85  *      o Removed the 'eth' parameter - always use ethXX as the
  86  *        interface name instead of dldwdXX.  The other was racy
  87  *        anyway.
  88  *      o Clean up RID definitions in hermes.h, other cleanups
  89  *
  90  * v0.04b -> v0.04c - 24/4/2001 - Jean II
  91  *      o Tim Hurley <timster AT seiki.bliztech.com> reported a D-Link card
  92  *        with vendor 02 and firmware 0.08. Added in the capabilities...
  93  *      o Tested Lucent firmware 7.28, everything works...
  94  *
  95  * v0.04c -> v0.05 - 3/5/2001 - Benjamin Herrenschmidt
  96  *      o Spin-off Pcmcia code. This file is renamed orinoco.c,
  97  *        and orinoco_cs.c now contains only the Pcmcia specific stuff
  98  *      o Add Airport driver support on top of orinoco.c (see airport.c)
  99  *
 100  * v0.05 -> v0.05a - 4/5/2001 - Jean II
 101  *      o Revert to old Pcmcia code to fix breakage of Ben's changes...
 102  *
 103  * v0.05a -> v0.05b - 4/5/2001 - Jean II
 104  *      o add module parameter 'ignore_cis_vcc' for D-Link @ 5V
 105  *      o D-Link firmware doesn't support multicast. We just print a few
 106  *        error messages, but otherwise everything works...
 107  *      o For David : set/getport3 works fine, just upgrade iwpriv...
 108  *
 109  * v0.05b -> v0.05c - 5/5/2001 - Benjamin Herrenschmidt
 110  *      o Adapt airport.c to latest changes in orinoco.c
 111  *      o Remove deferred power enabling code
 112  *
 113  * v0.05c -> v0.05d - 5/5/2001 - Jean II
 114  *      o Workaround to SNAP decapsulate frame from Linksys AP
 115  *        original patch from : Dong Liu <dliu AT research.bell-labs.com>
 116  *        (note : the memcmp bug was mine - fixed)
 117  *      o Remove set_retry stuff, no firmware support it (bloat--).
 118  *
 119  * v0.05d -> v0.06 - 25/5/2001 - Jean II
 120  *              Original patch from "Hong Lin" <alin AT redhat.com>,
 121  *              "Ian Kinner" <ikinner AT redhat.com>
 122  *              and "David Smith" <dsmith AT redhat.com>
 123  *      o Init of priv->tx_rate_ctrl in firmware specific section.
 124  *      o Prism2/Symbol rate, upto should be 0xF and not 0x15. Doh !
 125  *      o Spectrum card always need cor_reset (for every reset)
 126  *      o Fix cor_reset to not lose bit 7 in the register
 127  *      o flush_stale_links to remove zombie Pcmcia instances
 128  *      o Ack previous hermes event before reset
 129  *              Me (with my little hands)
 130  *      o Allow orinoco.c to call cor_reset via priv->card_reset_handler
 131  *      o Add priv->need_card_reset to toggle this feature
 132  *      o Fix various buglets when setting WEP in Symbol firmware
 133  *        Now, encryption is fully functional on Symbol cards. Youpi !
 134  *
 135  * v0.06 -> v0.06b - 25/5/2001 - Jean II
 136  *      o IBSS on Symbol use port_mode = 4. Please don't ask...
 137  *
 138  * v0.06b -> v0.06c - 29/5/2001 - Jean II
 139  *      o Show first spy address in /proc/net/wireless for IBSS mode as well
 140  *
 141  * v0.06c -> v0.06d - 6/7/2001 - David Gibson
 142  *      o Change a bunch of KERN_INFO messages to KERN_DEBUG, as per Linus'
 143  *        wishes to reduce the number of unnecessary messages.
 144  *      o Removed bogus message on CRC error.
 145  *      o Merged fixes for v0.08 Prism 2 firmware from William Waghorn
 146  *        <willwaghorn AT yahoo.co.uk>
 147  *      o Slight cleanup/re-arrangement of firmware detection code.
 148  *
 149  * v0.06d -> v0.06e - 1/8/2001 - David Gibson
 150  *      o Removed some redundant global initializers (orinoco_cs.c).
 151  *      o Added some module metadata
 152  *
 153  * v0.06e -> v0.06f - 14/8/2001 - David Gibson
 154  *      o Wording fix to license
 155  *      o Added a 'use_alternate_encaps' module parameter for APs which need an
 156  *        oui of 00:00:00.  We really need a better way of handling this, but
 157  *        the module flag is better than nothing for now.
 158  *
 159  * v0.06f -> v0.07 - 20/8/2001 - David Gibson
 160  *      o Removed BAP error retries from hermes_bap_seek().  For Tx we now
 161  *        let the upper layers handle the retry, we retry explicitly in the
 162  *        Rx path, but don't make as much noise about it.
 163  *      o Firmware detection cleanups.
 164  *
 165  * v0.07 -> v0.07a - 1/10/3001 - Jean II
 166  *      o Add code to read Symbol firmware revision, inspired by latest code
 167  *        in Spectrum24 by Lee John Keyser-Allen - Thanks Lee !
 168  *      o Thanks to Jared Valentine <hidden AT xmission.com> for "providing" me
 169  *        a 3Com card with a recent firmware, fill out Symbol firmware
 170  *        capabilities of latest rev (2.20), as well as older Symbol cards.
 171  *      o Disable Power Management in newer Symbol firmware, the API
 172  *        has changed (documentation needed).
 173  *
 174  * v0.07a -> v0.08 - 3/10/2001 - David Gibson
 175  *      o Fixed a possible buffer overrun found by the Stanford checker (in
 176  *        dldwd_ioctl_setiwencode()).  Can only be called by root anyway, so not
 177  *        a big problem.
 178  *      o Turned has_big_wep on for Intersil cards.  That's not true for all of
 179  *        them but we should at least let the capable ones try.
 180  *      o Wait for BUSY to clear at the beginning of hermes_bap_seek().  I
 181  *        realized that my assumption that the driver's serialization
 182  *        would prevent the BAP being busy on entry was possibly false, because
 183  *        things other than seeks may make the BAP busy.
 184  *      o Use "alternate" (oui 00:00:00) encapsulation by default.
 185  *        Setting use_old_encaps will mimic the old behaviour, but I think we
 186  *        will be able to eliminate this.
 187  *      o Don't try to make __initdata const (the version string).  This can't
 188  *        work because of the way the __initdata sectioning works.
 189  *      o Added MODULE_LICENSE tags.
 190  *      o Support for PLX (transparent PCMCIA->PCI bridge) cards.
 191  *      o Changed to using the new type-fascist min/max.
 192  *
 193  * v0.08 -> v0.08a - 9/10/2001 - David Gibson
 194  *      o Inserted some missing acknowledgements/info into the Changelog.
 195  *      o Fixed some bugs in the normalization of signal level reporting.
 196  *      o Fixed bad bug in WEP key handling on Intersil and Symbol firmware,
 197  *        which led to an instant crash on big-endian machines.
 198  *
 199  * v0.08a -> v0.08b - 20/11/2001 - David Gibson
 200  *      o Lots of cleanup and bugfixes in orinoco_plx.c
 201  *      o Cleanup to handling of Tx rate setting.
 202  *      o Removed support for old encapsulation method.
 203  *      o Removed old "dldwd" names.
 204  *      o Split RID constants into a new file hermes_rid.h
 205  *      o Renamed RID constants to match linux-wlan-ng and prism2.o
 206  *      o Bugfixes in hermes.c
 207  *      o Poke the PLX's INTCSR register, so it actually starts
 208  *        generating interrupts.  These cards might actually work now.
 209  *      o Update to wireless extensions v12 (Jean II)
 210  *      o Support for tallies and inquire command (Jean II)
 211  *      o Airport updates for newer PPC kernels (BenH)
 212  *
 213  * v0.08b -> v0.09 - 21/12/2001 - David Gibson
 214  *      o Some new PCI IDs for PLX cards.
 215  *      o Removed broken attempt to do ALLMULTI reception.  Just use
 216  *        promiscuous mode instead
 217  *      o Preliminary work for list-AP (Jean II)
 218  *      o Airport updates from (BenH)
 219  *      o Eliminated racy hw_ready stuff
 220  *      o Fixed generation of fake events in irq handler.  This should
 221  *        finally kill the EIO problems (Jean II & dgibson)
 222  *      o Fixed breakage of bitrate set/get on Agere firmware (Jean II)
 223  *
 224  * v0.09 -> v0.09a - 2/1/2002 - David Gibson
 225  *      o Fixed stupid mistake in multicast list handling, triggering
 226  *        a BUG()
 227  *
 228  * v0.09a -> v0.09b - 16/1/2002 - David Gibson
 229  *      o Fixed even stupider mistake in new interrupt handling, which
 230  *        seriously broke things on big-endian machines.
 231  *      o Removed a bunch of redundant includes and exports.
 232  *      o Removed a redundant MOD_{INC,DEC}_USE_COUNT pair in airport.c
 233  *      o Don't attempt to do hardware level multicast reception on
 234  *        Intersil firmware, just go promisc instead.
 235  *      o Typo fixed in hermes_issue_cmd()
 236  *      o Eliminated WIRELESS_SPY #ifdefs
 237  *      o Status code reported on Tx exceptions
 238  *      o Moved netif_wake_queue() from ALLOC interrupts to TX and TXEXC
 239  *        interrupts, which should fix the timeouts we're seeing.
 240  *
 241  * v0.09b -> v0.10 - 25 Feb 2002 - David Gibson
 242  *      o Removed nested structures used for header parsing, so the
 243  *        driver should now work without hackery on ARM
 244  *      o Fix for WEP handling on Intersil (Hawk Newton)
 245  *      o Eliminated the /proc/hermes/ethXX/regs debugging file.  It
 246  *        was never very useful.
 247  *      o Make Rx errors less noisy.
 248  *
 249  * v0.10 -> v0.11 - 5 Apr 2002 - David Gibson
 250  *      o Laid the groundwork in hermes.[ch] for devices which map
 251  *        into PCI memory space rather than IO space.
 252  *      o Fixed bug in multicast handling (cleared multicast list when
 253  *        leaving promiscuous mode).
 254  *      o Relegated Tx error messages to debug.
 255  *      o Cleaned up / corrected handling of allocation lengths.
 256  *      o Set OWNSSID in IBSS mode for WinXP interoperability (jimc).
 257  *      o Change to using alloc_etherdev() for structure allocations.
 258  *      o Check for and drop undersized packets.
 259  *      o Fixed a race in stopping/waking the queue.  This should fix
 260  *        the timeout problems (Pavel Roskin)
 261  *      o Reverted to netif_wake_queue() on the ALLOC event.
 262  *      o Fixes for recent Symbol firmwares which lack AP density
 263  *        (Pavel Roskin).
 264  *
 265  * v0.11 -> v0.11a - 29 Apr 2002 - David Gibson
 266  *      o Handle different register spacing, necessary for Prism 2.5
 267  *        PCI adaptors (Steve Hill).
 268  *      o Cleaned up initialization of card structures in orinoco_cs
 269  *        and airport.  Removed card->priv field.
 270  *      o Make response structure optional for hermes_docmd_wait()
 271  *        Pavel Roskin)
 272  *      o Added PCI id for Nortel emobility to orinoco_plx.c.
 273  *      o Cleanup to handling of Symbol's allocation bug. (Pavel Roskin)
 274  *      o Cleanups to firmware capability detection.
 275  *      o Arrange for orinoco_pci.c to override firmware detection.
 276  *        We should be able to support the PCI Intersil cards now.
 277  *      o Cleanup handling of reset_cor and hard_reset (Pavel Roskin).
 278  *      o Remove erroneous use of USER_BAP in the TxExc handler (Jouni
 279  *        Malinen).
 280  *      o Makefile changes for better integration into David Hinds
 281  *        pcmcia-cs package.
 282  *
 283  * v0.11a -> v0.11b - 1 May 2002 - David Gibson
 284  *      o Better error reporting in orinoco_plx_init_one()
 285  *      o Fixed multiple bad kfree() bugs introduced by the
 286  *        alloc_orinocodev() changes.
 287  *
 288  * v0.11b -> v0.12 - 19 Jun 2002 - David Gibson
 289  *      o Support changing the MAC address.
 290  *      o Correct display of Intersil firmware revision numbers.
 291  *      o Entirely revised locking scheme.  Should be both simpler and
 292  *         better.
 293  *      o Merged some common code in orinoco_plx, orinoco_pci and
 294  *        airport by creating orinoco_default_{open,stop,reset}()
 295  *        which are used as the dev->open, dev->stop, priv->reset
 296  *        callbacks if none are specified when alloc_orinocodev() is
 297  *        called.
 298  *      o Removed orinoco_plx_interrupt() and orinoco_pci_interrupt().
 299  *        They didn't do anything.
 300  *
 301  * v0.12 -> v0.12a - 4 Jul 2002 - David Gibson
 302  *      o Some rearrangement of code.
 303  *      o Numerous fixups to locking and rest handling, particularly
 304  *        for PCMCIA.
 305  *      o This allows open and stop net_device methods to be in
 306  *        orinoco.c now, rather than in the init modules.
 307  *      o In orinoco_cs.c link->priv now points to the struct
 308  *        net_device not to the struct orinoco_private.
 309  *      o Added a check for undersized SNAP frames, which could cause
 310  *        crashes.
 311  *
 312  * v0.12a -> v0.12b - 11 Jul 2002 - David Gibson
 313  *      o Fix hw->num_init testing code, so num_init is actually
 314  *        incremented.
 315  *      o Fix very stupid bug in orinoco_cs which broke compile with
 316  *        CONFIG_SMP.
 317  *      o Squashed a warning.
 318  *
 319  * v0.12b -> v0.12c - 26 Jul 2002 - David Gibson
 320  *      o Change to C9X style designated initializers.
 321  *      o Add support for 3Com AirConnect PCI.
 322  *      o No longer ignore the hard_reset argument to
 323  *        alloc_orinocodev().  Oops.
 324  *
 325  * v0.12c -> v0.13beta1 - 13 Sep 2002 - David Gibson
 326  *      o Revert the broken 0.12* locking scheme and go to a new yet
 327  *        simpler scheme.
 328  *      o Do firmware resets only in orinoco_init() and when waking
 329  *        the card from hard sleep.
 330  *
 331  * v0.13beta1 -> v0.13 - 27 Sep 2002 - David Gibson
 332  *      o Re-introduced full resets (via schedule_task()) on Tx
 333  *        timeout.
 334  *
 335  * v0.13 -> v0.13a - 30 Sep 2002 - David Gibson
 336  *      o Minor cleanups to info frame handling.  Add basic support
 337  *        for linkstatus info frames.
 338  *      o Include required kernel headers in orinoco.h, to avoid
 339  *        compile problems.
 340  *
 341  * v0.13a -> v0.13b - 10 Feb 2003 - David Gibson
 342  *      o Implemented hard reset for Airport cards
 343  *      o Experimental suspend/resume implementation for orinoco_pci
 344  *      o Abolished /proc debugging support, replaced with a debugging
 345  *        iwpriv.  Now it's ugly and simple instead of ugly and complex.
 346  *      o Bugfix in hermes.c if the firmware returned a record length
 347  *        of 0, we could go clobbering memory.
 348  *      o Bugfix in orinoco_stop() - it used to fail if hw_unavailable
 349  *        was set, which was usually true on PCMCIA hot removes.
 350  *      o Track LINKSTATUS messages, silently drop Tx packets before
 351  *        we are connected (avoids confusing the firmware), and only
 352  *        give LINKSTATUS printk()s if the status has changed.
 353  *
 354  * v0.13b -> v0.13c - 11 Mar 2003 - David Gibson
 355  *      o Cleanup: use dev instead of priv in various places.
 356  *      o Bug fix: Don't ReleaseConfiguration on RESET_PHYSICAL event
 357  *        if we're in the middle of a (driver initiated) hard reset.
 358  *      o Bug fix: ETH_ZLEN is supposed to include the header
 359  *        (Dionysus Blazakis & Manish Karir)
 360  *      o Convert to using workqueues instead of taskqueues (and
 361  *        backwards compatibility macros for pre 2.5.41 kernels).
 362  *      o Drop redundant (I think...) MOD_{INC,DEC}_USE_COUNT in
 363  *        airport.c
 364  *      o New orinoco_tmd.c init module from Joerg Dorchain for
 365  *        TMD7160 based PCI to PCMCIA bridges (similar to
 366  *        orinoco_plx.c).
 367  *
 368  * v0.13c -> v0.13d - 22 Apr 2003 - David Gibson
 369  *      o Make hw_unavailable a counter, rather than just a flag, this
 370  *        is necessary to avoid some races (such as a card being
 371  *        removed in the middle of orinoco_reset().
 372  *      o Restore Release/RequestConfiguration in the PCMCIA event handler
 373  *        when dealing with a driver initiated hard reset.  This is
 374  *        necessary to prevent hangs due to a spurious interrupt while
 375  *        the reset is in progress.
 376  *      o Clear the 802.11 header when transmitting, even though we
 377  *        don't use it.  This fixes a long standing bug on some
 378  *        firmwares, which seem to get confused if that isn't done.
 379  *      o Be less eager to de-encapsulate SNAP frames, only do so if
 380  *        the OUI is 00:00:00 or 00:00:f8, leave others alone.  The old
 381  *        behaviour broke CDP (Cisco Discovery Protocol).
 382  *      o Use dev instead of priv for free_irq() as well as
 383  *        request_irq() (oops).
 384  *      o Attempt to reset rather than giving up if we get too many
 385  *        IRQs.
 386  *      o Changed semantics of __orinoco_down() so it can be called
 387  *        safely with hw_unavailable set.  It also now clears the
 388  *        linkstatus (since we're going to have to reassociate).
 389  *
 390  * v0.13d -> v0.13e - 12 May 2003 - David Gibson
 391  *      o Support for post-2.5.68 return values from irq handler.
 392  *      o Fixed bug where underlength packets would be double counted
 393  *        in the rx_dropped statistics.
 394  *      o Provided a module parameter to suppress linkstatus messages.
 395  *
 396  * v0.13e -> v0.14alpha1 - 30 Sep 2003 - David Gibson
 397  *      o Replaced priv->connected logic with netif_carrier_on/off()
 398  *        calls.
 399  *      o Remove has_ibss_any and never set the CREATEIBSS RID when
 400  *        the ESSID is empty.  Too many firmwares break if we do.
 401  *      o 2.6 merges: Replace pdev->slot_name with pci_name(), remove
 402  *        __devinitdata from PCI ID tables, use free_netdev().
 403  *      o Enabled shared-key authentication for Agere firmware (from
 404  *        Robert J. Moore <Robert.J.Moore AT allanbank.com>
 405  *      o Move netif_wake_queue() (back) to the Tx completion from the
 406  *        ALLOC event.  This seems to prevent/mitigate the rolling
 407  *        error -110 problems at least on some Intersil firmwares.
 408  *        Theoretically reduces performance, but I can't measure it.
 409  *        Patch from Andrew Tridgell <tridge AT samba.org>
 410  *
 411  * v0.14alpha1 -> v0.14alpha2 - 20 Oct 2003 - David Gibson
 412  *      o Correctly turn off shared-key authentication when requested
 413  *        (bugfix from Robert J. Moore).
 414  *      o Correct airport sleep interfaces for current 2.6 kernels.
 415  *      o Add code for key change without disabling/enabling the MAC
 416  *        port.  This is supposed to allow 802.1x to work sanely, but
 417  *        doesn't seem to yet.
 418  *
 419  * TODO
 420  *      o New wireless extensions API (patch from Moustafa
 421  *        Youssef, updated by Jim Carter and Pavel Roskin).
 422  *      o Handle de-encapsulation within network layer, provide 802.11
 423  *        headers (patch from Thomas 'Dent' Mirlacher)
 424  *      o RF monitor mode support
 425  *      o Fix possible races in SPY handling.
 426  *      o Disconnect wireless extensions from fundamental configuration.
 427  *      o (maybe) Software WEP support (patch from Stano Meduna).
 428  *      o (maybe) Use multiple Tx buffers - driver handling queue
 429  *        rather than firmware.
 430  */
 431
 432 /* Locking and synchronization:
 433  *
 434  * The basic principle is that everything is serialized through a
 435  * single spinlock, priv->lock.  The lock is used in user, bh and irq
 436  * context, so when taken outside hardirq context it should always be
 437  * taken with interrupts disabled.  The lock protects both the
 438  * hardware and the struct orinoco_private.
 439  *
 440  * Another flag, priv->hw_unavailable indicates that the hardware is
 441  * unavailable for an extended period of time (e.g. suspended, or in
 442  * the middle of a hard reset).  This flag is protected by the
 443  * spinlock.  All code which touches the hardware should check the
 444  * flag after taking the lock, and if it is set, give up on whatever
 445  * they are doing and drop the lock again.  The orinoco_lock()
 446  * function handles this (it unlocks and returns -EBUSY if
 447  * hw_unavailable is non-zero).
 448  */
 449
 450 #define DRIVER_NAME "orinoco"
 451
 452 #include <linux/config.h>
 453
 454 #include <linux/module.h>
 455 #include <linux/kernel.h>
 456 #include <linux/init.h>
 457 #include <linux/ptrace.h>
 458 #include <linux/slab.h>
 459 #include <linux/string.h>
 460 #include <linux/timer.h>
 461 #include <linux/ioport.h>
 462 #include <linux/netdevice.h>
 463 #include <linux/if_arp.h>
 464 #include <linux/etherdevice.h>
 465 #include <linux/wireless.h>
 466
 467 #include <asm/uaccess.h>
 468 #include <asm/io.h>
 469 #include <asm/system.h>
 470
 471 #include "hermes.h"
 472 #include "hermes_rid.h"
 473 #include "orinoco.h"
 474 #include "ieee802_11.h"
 475
 476 /********************************************************************/
 477 /* Module information                                               */
 478 /********************************************************************/
 479
 480 MODULE_AUTHOR("Pavel Roskin <proski@gnu.org> & David Gibson <hermes@gibson.dropbear.id.au>");
 481 MODULE_DESCRIPTION("Driver for Lucent Orinoco, Prism II based and similar wireless cards");
 482 MODULE_LICENSE("Dual MPL/GPL");
 483
 484 /* Level of debugging. Used in the macros in orinoco.h */
 485 #ifdef ORINOCO_DEBUG
 486 int orinoco_debug = ORINOCO_DEBUG;
 487 module_param(orinoco_debug, int, 0644);
 488 MODULE_PARM_DESC(orinoco_debug, "Debug level");
 489 EXPORT_SYMBOL(orinoco_debug);
 490 #endif
 491
 492 static int suppress_linkstatus; /* = 0 */
 493 module_param(suppress_linkstatus, bool, 0644);
 494 MODULE_PARM_DESC(suppress_linkstatus, "Don't log link status changes");
 495 static int ignore_disconnect; /* = 0 */
 496 module_param(ignore_disconnect, int, 0644);
 497 MODULE_PARM_DESC(ignore_disconnect, "Don't report lost link to the network layer");
 498
 499 /********************************************************************/
 500 /* Compile time configuration and compatibility stuff               */
 501 /********************************************************************/
 502
 503 /* We do this this way to avoid ifdefs in the actual code */
 504 #ifdef WIRELESS_SPY
 505 #define SPY_NUMBER(priv)        (priv->spy_number)
 506 #else
 507 #define SPY_NUMBER(priv)        0
 508 #endif /* WIRELESS_SPY */
 509
 510 /********************************************************************/
 511 /* Internal constants                                               */
 512 /********************************************************************/
 513
 514 #define ORINOCO_MIN_MTU         256
 515 #define ORINOCO_MAX_MTU         (IEEE802_11_DATA_LEN - ENCAPS_OVERHEAD)
 516
 517 #define SYMBOL_MAX_VER_LEN      (14)
 518 #define USER_BAP                0
 519 #define IRQ_BAP                 1
 520 #define MAX_IRQLOOPS_PER_IRQ    10
 521 #define MAX_IRQLOOPS_PER_JIFFY  (20000/HZ) /* Based on a guestimate of
 522                                             * how many events the
 523                                             * device could
 524                                             * legitimately generate */
 525 #define SMALL_KEY_SIZE          5
 526 #define LARGE_KEY_SIZE          13
 527 #define TX_NICBUF_SIZE_BUG      1585            /* Bug in Symbol firmware */
 528
 529 #define DUMMY_FID               0xFFFF
 530
 531 /*#define MAX_MULTICAST(priv)   (priv->firmware_type == FIRMWARE_TYPE_AGERE ? \
 532   HERMES_MAX_MULTICAST : 0)*/
 533 #define MAX_MULTICAST(priv)     (HERMES_MAX_MULTICAST)
 534
 535 #define ORINOCO_INTEN           (HERMES_EV_RX | HERMES_EV_ALLOC \
 536                                  | HERMES_EV_TX | HERMES_EV_TXEXC \
 537                                  | HERMES_EV_WTERR | HERMES_EV_INFO \
 538                                  | HERMES_EV_INFDROP )
 539
 540 /********************************************************************/
 541 /* Data tables                                                      */
 542 /********************************************************************/
 543
 544 /* The frequency of each channel in MHz */
 545 static const long channel_frequency[] = {
 546         2412, 2417, 2422, 2427, 2432, 2437, 2442,
 547         2447, 2452, 2457, 2462, 2467, 2472, 2484
 548 };
 549 #define NUM_CHANNELS ARRAY_SIZE(channel_frequency)
 550
 551 /* This tables gives the actual meanings of the bitrate IDs returned
 552  * by the firmware. */
 553 static struct {
 554         int bitrate; /* in 100s of kilobits */
 555         int automatic;
 556         u16 agere_txratectrl;
 557         u16 intersil_txratectrl;
 558 } bitrate_table[] = {
 559         {110, 1,  3, 15}, /* Entry 0 is the default */
 560         {10,  0,  1,  1},
 561         {10,  1,  1,  1},
 562         {20,  0,  2,  2},
 563         {20,  1,  6,  3},
 564         {55,  0,  4,  4},
 565         {55,  1,  7,  7},
 566         {110, 0,  5,  8},
 567 };
 568 #define BITRATE_TABLE_SIZE ARRAY_SIZE(bitrate_table)
 569
 570 /********************************************************************/
 571 /* Data types                                                       */
 572 /********************************************************************/
 573
 574 struct header_struct {
 575         /* 802.3 */
 576         u8 dest[ETH_ALEN];
 577         u8 src[ETH_ALEN];
 578         u16 len;
 579         /* 802.2 */
 580         u8 dsap;
 581         u8 ssap;
 582         u8 ctrl;
 583         /* SNAP */
 584         u8 oui[3];
 585         u16 ethertype;
 586 } __attribute__ ((packed));
 587
 588 /* 802.2 LLC/SNAP header used for Ethernet encapsulation over 802.11 */
 589 u8 encaps_hdr[] = {0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00};
 590
 591 #define ENCAPS_OVERHEAD         (sizeof(encaps_hdr) + 2)
 592
 593 struct hermes_rx_descriptor {
 594         u16 status;
 595         u32 time;
 596         u8 silence;
 597         u8 signal;
 598         u8 rate;
 599         u8 rxflow;
 600         u32 reserved;
 601 } __attribute__ ((packed));
 602
 603 /********************************************************************/
 604 /* Function prototypes                                              */
 605 /********************************************************************/
 606
 607 static int orinoco_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
 608 static int __orinoco_program_rids(struct net_device *dev);
 609 static void __orinoco_set_multicast_list(struct net_device *dev);
 610
 611 /********************************************************************/
 612 /* Internal helper functions                                        */
 613 /********************************************************************/
 614
 615 static inline void set_port_type(struct orinoco_private *priv)
 616 {
 617         switch (priv->iw_mode) {
 618         case IW_MODE_INFRA:
 619                 priv->port_type = 1;
 620                 priv->createibss = 0;
 621                 break;
 622         case IW_MODE_ADHOC:
 623                 if (priv->prefer_port3) {
 624                         priv->port_type = 3;
 625                         priv->createibss = 0;
 626                 } else {
 627                         priv->port_type = priv->ibss_port;
 628                         priv->createibss = 1;
 629                 }
 630                 break;
 631         default:
 632                 printk(KERN_ERR "%s: Invalid priv->iw_mode in set_port_type()\n",
 633                        priv->ndev->name);
 634         }
 635 }
 636
 637 /********************************************************************/
 638 /* Device methods                                                   */
 639 /********************************************************************/
 640
 641 static int orinoco_open(struct net_device *dev)
 642 {
 643         struct orinoco_private *priv = netdev_priv(dev);
 644         unsigned long flags;
 645         int err;
 646
 647         if (orinoco_lock(priv, &flags) != 0)
 648                 return -EBUSY;
 649
 650         err = __orinoco_up(dev);
 651
 652         if (! err)
 653                 priv->open = 1;
 654
 655         orinoco_unlock(priv, &flags);
 656
 657         return err;
 658 }
 659
 660 int orinoco_stop(struct net_device *dev)
 661 {
 662         struct orinoco_private *priv = netdev_priv(dev);
 663         int err = 0;
 664
 665         /* We mustn't use orinoco_lock() here, because we need to be
 666            able to close the interface even if hw_unavailable is set
 667            (e.g. as we're released after a PC Card removal) */
 668         spin_lock_irq(&priv->lock);
 669
 670         priv->open = 0;
 671
 672         err = __orinoco_down(dev);
 673
 674         spin_unlock_irq(&priv->lock);
 675
 676         return err;
 677 }
 678
 679 static struct net_device_stats *orinoco_get_stats(struct net_device *dev)
 680 {
 681         struct orinoco_private *priv = netdev_priv(dev);
 682
 683         return &priv->stats;
 684 }
 685
 686 static struct iw_statistics *orinoco_get_wireless_stats(struct net_device *dev)
 687 {
 688         struct orinoco_private *priv = netdev_priv(dev);
 689         hermes_t *hw = &priv->hw;
 690         struct iw_statistics *wstats = &priv->wstats;
 691         int err;
 692         unsigned long flags;
 693
 694         if (! netif_device_present(dev)) {
 695                 printk(KERN_WARNING "%s: get_wireless_stats() called while device not present\n",
 696                        dev->name);
 697                 return NULL; /* FIXME: Can we do better than this? */
 698         }
 699
 700         /* If busy, return the old stats.  Returning NULL may cause
 701          * the interface to disappear from /proc/net/wireless */
 702         if (orinoco_lock(priv, &flags) != 0)
 703                 return wstats;
 704
 705         /* We can't really wait for the tallies inquiry command to
 706          * complete, so we just use the previous results and trigger
 707          * a new tallies inquiry command for next time - Jean II */
 708         /* FIXME: Really we should wait for the inquiry to come back -
 709          * as it is the stats we give don't make a whole lot of sense.
 710          * Unfortunately, it's not clear how to do that within the
 711          * wireless extensions framework: I think we're in user
 712          * context, but a lock seems to be held by the time we get in
 713          * here so we're not safe to sleep here. */
 714         hermes_inquire(hw, HERMES_INQ_TALLIES);
 715
 716         if (priv->iw_mode == IW_MODE_ADHOC) {
 717                 memset(&wstats->qual, 0, sizeof(wstats->qual));
 718                 /* If a spy address is defined, we report stats of the
 719                  * first spy address - Jean II */
 720                 if (SPY_NUMBER(priv)) {
 721                         wstats->qual.qual = priv->spy_stat[0].qual;
 722                         wstats->qual.level = priv->spy_stat[0].level;
 723                         wstats->qual.noise = priv->spy_stat[0].noise;
 724                         wstats->qual.updated = priv->spy_stat[0].updated;
 725                 }
 726         } else {
 727                 struct {
 728                         u16 qual, signal, noise;
 729                 } __attribute__ ((packed)) cq;
 730
 731                 err = HERMES_READ_RECORD(hw, USER_BAP,
 732                                          HERMES_RID_COMMSQUALITY, &cq);
 733
 734                 if (!err) {
 735                         wstats->qual.qual = (int)le16_to_cpu(cq.qual);
 736                         wstats->qual.level = (int)le16_to_cpu(cq.signal) - 0x95;
 737                         wstats->qual.noise = (int)le16_to_cpu(cq.noise) - 0x95;
 738                         wstats->qual.updated = 7;
 739                 }
 740         }
 741
 742         orinoco_unlock(priv, &flags);
 743         return wstats;
 744 }
 745
 746 static void orinoco_set_multicast_list(struct net_device *dev)
 747 {
 748         struct orinoco_private *priv = netdev_priv(dev);
 749         unsigned long flags;
 750
 751         if (orinoco_lock(priv, &flags) != 0) {
 752                 printk(KERN_DEBUG "%s: orinoco_set_multicast_list() "
 753                        "called when hw_unavailable\n", dev->name);
 754                 return;
 755         }
 756
 757         __orinoco_set_multicast_list(dev);
 758         orinoco_unlock(priv, &flags);
 759 }
 760
 761 static int orinoco_change_mtu(struct net_device *dev, int new_mtu)
 762 {
 763         struct orinoco_private *priv = netdev_priv(dev);
 764
 765         if ( (new_mtu < ORINOCO_MIN_MTU) || (new_mtu > ORINOCO_MAX_MTU) )
 766                 return -EINVAL;
 767
 768         if ( (new_mtu + ENCAPS_OVERHEAD + IEEE802_11_HLEN) >
 769              (priv->nicbuf_size - ETH_HLEN) )
 770                 return -EINVAL;
 771
 772         dev->mtu = new_mtu;
 773
 774         return 0;
 775 }
 776
 777 /********************************************************************/
 778 /* Tx path                                                          */
 779 /********************************************************************/
 780
 781 static int orinoco_xmit(struct sk_buff *skb, struct net_device *dev)
 782 {
 783         struct orinoco_private *priv = netdev_priv(dev);
 784         struct net_device_stats *stats = &priv->stats;
 785         hermes_t *hw = &priv->hw;
 786         int err = 0;
 787         u16 txfid = priv->txfid;
 788         char *p;
 789         struct ethhdr *eh;
 790         int len, data_len, data_off;
 791         struct hermes_tx_descriptor desc;
 792         unsigned long flags;
 793
 794         TRACE_ENTER(dev->name);
 795
 796         if (! netif_running(dev)) {
 797                 printk(KERN_ERR "%s: Tx on stopped device!\n",
 798                        dev->name);
 799                 TRACE_EXIT(dev->name);
 800                 return 1;
 801         }
 802
 803         if (netif_queue_stopped(dev)) {
 804                 printk(KERN_DEBUG "%s: Tx while transmitter busy!\n",
 805                        dev->name);
 806                 TRACE_EXIT(dev->name);
 807                 return 1;
 808         }
 809
 810         if (orinoco_lock(priv, &flags) != 0) {
 811                 printk(KERN_ERR "%s: orinoco_xmit() called while hw_unavailable\n",
 812                        dev->name);
 813                 TRACE_EXIT(dev->name);
 814                 return 1;
 815         }
 816
 817         if (! netif_carrier_ok(dev)) {
 818                 /* Oops, the firmware hasn't established a connection,
 819                    silently drop the packet (this seems to be the
 820                    safest approach). */
 821                 stats->tx_errors++;
 822                 orinoco_unlock(priv, &flags);
 823                 dev_kfree_skb(skb);
 824                 TRACE_EXIT(dev->name);
 825                 return 0;
 826         }
 827
 828         /* Length of the packet body */
 829         /* FIXME: what if the skb is smaller than this? */
 830         len = max_t(int,skb->len - ETH_HLEN, ETH_ZLEN - ETH_HLEN);
 831
 832         eh = (struct ethhdr *)skb->data;
 833
 834         memset(&desc, 0, sizeof(desc));
 835         desc.tx_control = cpu_to_le16(HERMES_TXCTRL_TX_OK | HERMES_TXCTRL_TX_EX);
 836         err = hermes_bap_pwrite(hw, USER_BAP, &desc, sizeof(desc), txfid, 0);
 837         if (err) {
 838                 if (net_ratelimit())
 839                         printk(KERN_ERR "%s: Error %d writing Tx descriptor "
 840                                "to BAP\n", dev->name, err);
 841                 stats->tx_errors++;
 842                 goto fail;
 843         }
 844
 845         /* Clear the 802.11 header and data length fields - some
 846          * firmwares (e.g. Lucent/Agere 8.xx) appear to get confused
 847          * if this isn't done. */
 848         hermes_clear_words(hw, HERMES_DATA0,
 849                            HERMES_802_3_OFFSET - HERMES_802_11_OFFSET);
 850
 851         /* Encapsulate Ethernet-II frames */
 852         if (ntohs(eh->h_proto) > ETH_DATA_LEN) { /* Ethernet-II frame */
 853                 struct header_struct hdr;
 854                 data_len = len;
 855                 data_off = HERMES_802_3_OFFSET + sizeof(hdr);
 856                 p = skb->data + ETH_HLEN;
 857
 858                 /* 802.3 header */
 859                 memcpy(hdr.dest, eh->h_dest, ETH_ALEN);
 860                 memcpy(hdr.src, eh->h_source, ETH_ALEN);
 861                 hdr.len = htons(data_len + ENCAPS_OVERHEAD);
 862
 863                 /* 802.2 header */
 864                 memcpy(&hdr.dsap, &encaps_hdr, sizeof(encaps_hdr));
 865
 866                 hdr.ethertype = eh->h_proto;
 867                 err  = hermes_bap_pwrite(hw, USER_BAP, &hdr, sizeof(hdr),
 868                                          txfid, HERMES_802_3_OFFSET);
 869                 if (err) {
 870                         if (net_ratelimit())
 871                                 printk(KERN_ERR "%s: Error %d writing packet "
 872                                        "header to BAP\n", dev->name, err);
 873                         stats->tx_errors++;
 874                         goto fail;
 875                 }
 876         } else { /* IEEE 802.3 frame */
 877                 data_len = len + ETH_HLEN;
 878                 data_off = HERMES_802_3_OFFSET;
 879                 p = skb->data;
 880         }
 881
 882         /* Round up for odd length packets */
 883         err = hermes_bap_pwrite(hw, USER_BAP, p, ALIGN(data_len, 2),
 884                                 txfid, data_off);
 885         if (err) {
 886                 printk(KERN_ERR "%s: Error %d writing packet to BAP\n",
 887                        dev->name, err);
 888                 stats->tx_errors++;
 889                 goto fail;
 890         }
 891
 892         /* Finally, we actually initiate the send */
 893         netif_stop_queue(dev);
 894
 895         err = hermes_docmd_wait(hw, HERMES_CMD_TX | HERMES_CMD_RECL,
 896                                 txfid, NULL);
 897         if (err) {
 898                 netif_start_queue(dev);
 899                 printk(KERN_ERR "%s: Error %d transmitting packet\n",
 900                        dev->name, err);
 901                 stats->tx_errors++;
 902                 goto fail;
 903         }
 904
 905         dev->trans_start = jiffies;
 906         stats->tx_bytes += data_off + data_len;
 907
 908         orinoco_unlock(priv, &flags);
 909
 910         dev_kfree_skb(skb);
 911
 912         TRACE_EXIT(dev->name);
 913
 914         return 0;
 915  fail:
 916         TRACE_EXIT(dev->name);
 917
 918         orinoco_unlock(priv, &flags);
 919         return err;
 920 }
 921
 922 static void __orinoco_ev_alloc(struct net_device *dev, hermes_t *hw)
 923 {
 924         struct orinoco_private *priv = netdev_priv(dev);
 925         u16 fid = hermes_read_regn(hw, ALLOCFID);
 926
 927         if (fid != priv->txfid) {
 928                 if (fid != DUMMY_FID)
 929                         printk(KERN_WARNING "%s: Allocate event on unexpected fid (%04X)\n",
 930                                dev->name, fid);
 931                 return;
 932         }
 933
 934         hermes_write_regn(hw, ALLOCFID, DUMMY_FID);
 935 }
 936
 937 static void __orinoco_ev_tx(struct net_device *dev, hermes_t *hw)
 938 {
 939         struct orinoco_private *priv = netdev_priv(dev);
 940         struct net_device_stats *stats = &priv->stats;
 941
 942         stats->tx_packets++;
 943
 944         netif_wake_queue(dev);
 945
 946         hermes_write_regn(hw, TXCOMPLFID, DUMMY_FID);
 947 }
 948
 949 static void __orinoco_ev_txexc(struct net_device *dev, hermes_t *hw)
 950 {
 951         struct orinoco_private *priv = netdev_priv(dev);
 952         struct net_device_stats *stats = &priv->stats;
 953         u16 fid = hermes_read_regn(hw, TXCOMPLFID);
 954         struct hermes_tx_descriptor desc;
 955         int err = 0;
 956
 957         if (fid == DUMMY_FID)
 958                 return; /* Nothing's really happened */
 959
 960         err = hermes_bap_pread(hw, IRQ_BAP, &desc, sizeof(desc), fid, 0);
 961         if (err) {
 962                 printk(KERN_WARNING "%s: Unable to read descriptor on Tx error "
 963                        "(FID=%04X error %d)\n",
 964                        dev->name, fid, err);
 965         } else {
 966                 DEBUG(1, "%s: Tx error, status %d\n",
 967                       dev->name, le16_to_cpu(desc.status));
 968         }
 969
 970         stats->tx_errors++;
 971
 972         netif_wake_queue(dev);
 973         hermes_write_regn(hw, TXCOMPLFID, DUMMY_FID);
 974 }
 975
 976 static void orinoco_tx_timeout(struct net_device *dev)
 977 {
 978         struct orinoco_private *priv = netdev_priv(dev);
 979         struct net_device_stats *stats = &priv->stats;
 980         struct hermes *hw = &priv->hw;
 981
 982         printk(KERN_WARNING "%s: Tx timeout! "
 983                "ALLOCFID=%04x, TXCOMPLFID=%04x, EVSTAT=%04x\n",
 984                dev->name, hermes_read_regn(hw, ALLOCFID),
 985                hermes_read_regn(hw, TXCOMPLFID), hermes_read_regn(hw, EVSTAT));
 986
 987         stats->tx_errors++;
 988
 989         schedule_work(&priv->reset_work);
 990 }
 991
 992 /********************************************************************/
 993 /* Rx path (data frames)                                            */
 994 /********************************************************************/
 995
 996 /* Does the frame have a SNAP header indicating it should be
 997  * de-encapsulated to Ethernet-II? */
 998 static inline int is_ethersnap(void *_hdr)
 999 {
1000         u8 *hdr = _hdr;
1001
1002         /* We de-encapsulate all packets which, a) have SNAP headers
1003          * (i.e. SSAP=DSAP=0xaa and CTRL=0x3 in the 802.2 LLC header
1004          * and where b) the OUI of the SNAP header is 00:00:00 or
1005          * 00:00:f8 - we need both because different APs appear to use
1006          * different OUIs for some reason */
1007         return (memcmp(hdr, &encaps_hdr, 5) == 0)
1008                 && ( (hdr[5] == 0x00) || (hdr[5] == 0xf8) );
1009 }
1010
1011 static inline void orinoco_spy_gather(struct net_device *dev, u_char *mac,
1012                                       int level, int noise)
1013 {
1014         struct orinoco_private *priv = netdev_priv(dev);
1015         int i;
1016
1017         /* Gather wireless spy statistics: for each packet, compare the
1018          * source address with out list, and if match, get the stats... */
1019         for (i = 0; i < priv->spy_number; i++)
1020                 if (!memcmp(mac, priv->spy_address[i], ETH_ALEN)) {
1021                         priv->spy_stat[i].level = level - 0x95;
1022                         priv->spy_stat[i].noise = noise - 0x95;
1023                         priv->spy_stat[i].qual = (level > noise) ? (level - noise) : 0;
1024                         priv->spy_stat[i].updated = 7;
1025                 }
1026 }
1027
1028 static void orinoco_stat_gather(struct net_device *dev,
1029                                 struct sk_buff *skb,
1030                                 struct hermes_rx_descriptor *desc)
1031 {
1032         struct orinoco_private *priv = netdev_priv(dev);
1033
1034         /* Using spy support with lots of Rx packets, like in an
1035          * infrastructure (AP), will really slow down everything, because
1036          * the MAC address must be compared to each entry of the spy list.
1037          * If the user really asks for it (set some address in the
1038          * spy list), we do it, but he will pay the price.
1039          * Note that to get here, you need both WIRELESS_SPY
1040          * compiled in AND some addresses in the list !!!
1041          */
1042         /* Note : gcc will optimise the whole section away if
1043          * WIRELESS_SPY is not defined... - Jean II */
1044         if (SPY_NUMBER(priv)) {
1045                 orinoco_spy_gather(dev, skb->mac.raw + ETH_ALEN,
1046                                    desc->signal, desc->silence);
1047         }
1048 }
1049
1050 static void __orinoco_ev_rx(struct net_device *dev, hermes_t *hw)
1051 {
1052         struct orinoco_private *priv = netdev_priv(dev);
1053         struct net_device_stats *stats = &priv->stats;
1054         struct iw_statistics *wstats = &priv->wstats;
1055         struct sk_buff *skb = NULL;
1056         u16 rxfid, status;
1057         int length, data_len, data_off;
1058         char *p;
1059         struct hermes_rx_descriptor desc;
1060         struct header_struct hdr;
1061         struct ethhdr *eh;
1062         int err;
1063
1064         rxfid = hermes_read_regn(hw, RXFID);
1065
1066         err = hermes_bap_pread(hw, IRQ_BAP, &desc, sizeof(desc),
1067                                rxfid, 0);
1068         if (err) {
1069                 printk(KERN_ERR "%s: error %d reading Rx descriptor. "
1070                        "Frame dropped.\n", dev->name, err);
1071                 stats->rx_errors++;
1072                 goto drop;
1073         }
1074
1075         status = le16_to_cpu(desc.status);
1076
1077         if (status & HERMES_RXSTAT_ERR) {
1078                 if (status & HERMES_RXSTAT_UNDECRYPTABLE) {
1079                         wstats->discard.code++;
1080                         DEBUG(1, "%s: Undecryptable frame on Rx. Frame dropped.\n",
1081                                dev->name);
1082                 } else {
1083                         stats->rx_crc_errors++;
1084                         DEBUG(1, "%s: Bad CRC on Rx. Frame dropped.\n", dev->name);
1085                 }
1086                 stats->rx_errors++;
1087                 goto drop;
1088         }
1089
1090         /* For now we ignore the 802.11 header completely, assuming
1091            that the card's firmware has handled anything vital */
1092
1093         err = hermes_bap_pread(hw, IRQ_BAP, &hdr, sizeof(hdr),
1094                                rxfid, HERMES_802_3_OFFSET);
1095         if (err) {
1096                 printk(KERN_ERR "%s: error %d reading frame header. "
1097                        "Frame dropped.\n", dev->name, err);
1098                 stats->rx_errors++;
1099                 goto drop;
1100         }
1101
1102         length = ntohs(hdr.len);
1103
1104         /* Sanity checks */
1105         if (length < 3) { /* No for even an 802.2 LLC header */
1106                 /* At least on Symbol firmware with PCF we get quite a
1107                    lot of these legitimately - Poll frames with no
1108                    data. */
1109                 stats->rx_dropped++;
1110                 goto drop;
1111         }
1112         if (length > IEEE802_11_DATA_LEN) {
1113                 printk(KERN_WARNING "%s: Oversized frame received (%d bytes)\n",
1114                        dev->name, length);
1115                 stats->rx_length_errors++;
1116                 stats->rx_errors++;
1117                 goto drop;
1118         }
1119
1120         /* We need space for the packet data itself, plus an ethernet
1121            header, plus 2 bytes so we can align the IP header on a
1122            32bit boundary, plus 1 byte so we can read in odd length
1123            packets from the card, which has an IO granularity of 16
1124            bits */
1125         skb = dev_alloc_skb(length+ETH_HLEN+2+1);
1126         if (!skb) {
1127                 printk(KERN_WARNING "%s: Can't allocate skb for Rx\n",
1128                        dev->name);
1129                 goto drop;
1130         }
1131
1132         skb_reserve(skb, 2); /* This way the IP header is aligned */
1133
1134         /* Handle decapsulation
1135          * In most cases, the firmware tell us about SNAP frames.
1136          * For some reason, the SNAP frames sent by LinkSys APs
1137          * are not properly recognised by most firmwares.
1138          * So, check ourselves */
1139         if (((status & HERMES_RXSTAT_MSGTYPE) == HERMES_RXSTAT_1042) ||
1140             ((status & HERMES_RXSTAT_MSGTYPE) == HERMES_RXSTAT_TUNNEL) ||
1141             is_ethersnap(&hdr)) {
1142                 /* These indicate a SNAP within 802.2 LLC within
1143                    802.11 frame which we'll need to de-encapsulate to
1144                    the original EthernetII frame. */
1145
1146                 if (length < ENCAPS_OVERHEAD) { /* No room for full LLC+SNAP */
1147                         stats->rx_length_errors++;
1148                         goto drop;
1149                 }
1150
1151                 /* Remove SNAP header, reconstruct EthernetII frame */
1152                 data_len = length - ENCAPS_OVERHEAD;
1153                 data_off = HERMES_802_3_OFFSET + sizeof(hdr);
1154
1155                 eh = (struct ethhdr *)skb_put(skb, ETH_HLEN);
1156
1157                 memcpy(eh, &hdr, 2 * ETH_ALEN);
1158                 eh->h_proto = hdr.ethertype;
1159         } else {
1160                 /* All other cases indicate a genuine 802.3 frame.  No
1161                    decapsulation needed.  We just throw the whole
1162                    thing in, and hope the protocol layer can deal with
1163                    it as 802.3 */
1164                 data_len = length;
1165                 data_off = HERMES_802_3_OFFSET;
1166                 /* FIXME: we re-read from the card data we already read here */
1167         }
1168
1169         p = skb_put(skb, data_len);
1170         err = hermes_bap_pread(hw, IRQ_BAP, p, ALIGN(data_len, 2),
1171                                rxfid, data_off);
1172         if (err) {
1173                 printk(KERN_ERR "%s: error %d reading frame. "
1174                        "Frame dropped.\n", dev->name, err);
1175                 stats->rx_errors++;
1176                 goto drop;
1177         }
1178
1179         dev->last_rx = jiffies;
1180         skb->dev = dev;
1181         skb->protocol = eth_type_trans(skb, dev);
1182         skb->ip_summed = CHECKSUM_NONE;
1183
1184         /* Process the wireless stats if needed */
1185         orinoco_stat_gather(dev, skb, &desc);
1186
1187         /* Pass the packet to the networking stack */
1188         netif_rx(skb);
1189         stats->rx_packets++;
1190         stats->rx_bytes += length;
1191
1192         return;
1193
1194  drop:
1195         stats->rx_dropped++;
1196
1197         if (skb)
1198                 dev_kfree_skb_irq(skb);
1199         return;
1200 }
1201
1202 /********************************************************************/
1203 /* Rx path (info frames)                                            */
1204 /********************************************************************/
1205
1206 static void print_linkstatus(struct net_device *dev, u16 status)
1207 {
1208         char * s;
1209
1210         if (suppress_linkstatus)
1211                 return;
1212
1213         switch (status) {
1214         case HERMES_LINKSTATUS_NOT_CONNECTED:
1215                 s = "Not Connected";
1216                 break;
1217         case HERMES_LINKSTATUS_CONNECTED:
1218                 s = "Connected";
1219                 break;
1220         case HERMES_LINKSTATUS_DISCONNECTED:
1221                 s = "Disconnected";
1222                 break;
1223         case HERMES_LINKSTATUS_AP_CHANGE:
1224                 s = "AP Changed";
1225                 break;
1226         case HERMES_LINKSTATUS_AP_OUT_OF_RANGE:
1227                 s = "AP Out of Range";
1228                 break;
1229         case HERMES_LINKSTATUS_AP_IN_RANGE:
1230                 s = "AP In Range";
1231                 break;
1232         case HERMES_LINKSTATUS_ASSOC_FAILED:
1233                 s = "Association Failed";
1234                 break;
1235         default:
1236                 s = "UNKNOWN";
1237         }
1238
1239         printk(KERN_INFO "%s: New link status: %s (%04x)\n",
1240                dev->name, s, status);
1241 }
1242
1243 static void __orinoco_ev_info(struct net_device *dev, hermes_t *hw)
1244 {
1245         struct orinoco_private *priv = netdev_priv(dev);
1246         u16 infofid;
1247         struct {
1248                 u16 len;
1249                 u16 type;
1250         } __attribute__ ((packed)) info;
1251         int len, type;
1252         int err;
1253
1254         /* This is an answer to an INQUIRE command that we did earlier,
1255          * or an information "event" generated by the card
1256          * The controller return to us a pseudo frame containing
1257          * the information in question - Jean II */
1258         infofid = hermes_read_regn(hw, INFOFID);
1259
1260         /* Read the info frame header - don't try too hard */
1261         err = hermes_bap_pread(hw, IRQ_BAP, &info, sizeof(info),
1262                                infofid, 0);
1263         if (err) {
1264                 printk(KERN_ERR "%s: error %d reading info frame. "
1265                        "Frame dropped.\n", dev->name, err);
1266                 return;
1267         }
1268
1269         len = HERMES_RECLEN_TO_BYTES(le16_to_cpu(info.len));
1270         type = le16_to_cpu(info.type);
1271
1272         switch (type) {
1273         case HERMES_INQ_TALLIES: {
1274                 struct hermes_tallies_frame tallies;
1275                 struct iw_statistics *wstats = &priv->wstats;
1276
1277                 if (len > sizeof(tallies)) {
1278                         printk(KERN_WARNING "%s: Tallies frame too long (%d bytes)\n",
1279                                dev->name, len);
1280                         len = sizeof(tallies);
1281                 }
1282
1283                 /* Read directly the data (no seek) */
1284                 hermes_read_words(hw, HERMES_DATA1, (void *) &tallies,
1285                                   len / 2); /* FIXME: blech! */
1286
1287                 /* Increment our various counters */
1288                 /* wstats->discard.nwid - no wrong BSSID stuff */
1289                 wstats->discard.code +=
1290                         le16_to_cpu(tallies.RxWEPUndecryptable);
1291                 if (len == sizeof(tallies))
1292                         wstats->discard.code +=
1293                                 le16_to_cpu(tallies.RxDiscards_WEPICVError) +
1294                                 le16_to_cpu(tallies.RxDiscards_WEPExcluded);
1295                 wstats->discard.misc +=
1296                         le16_to_cpu(tallies.TxDiscardsWrongSA);
1297                 wstats->discard.fragment +=
1298                         le16_to_cpu(tallies.RxMsgInBadMsgFragments);
1299                 wstats->discard.retries +=
1300                         le16_to_cpu(tallies.TxRetryLimitExceeded);
1301                 /* wstats->miss.beacon - no match */
1302         }
1303         break;
1304         case HERMES_INQ_LINKSTATUS: {
1305                 struct hermes_linkstatus linkstatus;
1306                 u16 newstatus;
1307                 int connected;
1308
1309                 if (len != sizeof(linkstatus)) {
1310                         printk(KERN_WARNING "%s: Unexpected size for linkstatus frame (%d bytes)\n",
1311                                dev->name, len);
1312                         break;
1313                 }
1314
1315                 hermes_read_words(hw, HERMES_DATA1, (void *) &linkstatus,
1316                                   len / 2);
1317                 newstatus = le16_to_cpu(linkstatus.linkstatus);
1318
1319                 connected = (newstatus == HERMES_LINKSTATUS_CONNECTED)
1320                         || (newstatus == HERMES_LINKSTATUS_AP_CHANGE)
1321                         || (newstatus == HERMES_LINKSTATUS_AP_IN_RANGE);
1322
1323                 if (connected)
1324                         netif_carrier_on(dev);
1325                 else if (!ignore_disconnect)
1326                         netif_carrier_off(dev);
1327
1328                 if (newstatus != priv->last_linkstatus)
1329                         print_linkstatus(dev, newstatus);
1330
1331                 priv->last_linkstatus = newstatus;
1332         }
1333         break;
1334         default:
1335                 printk(KERN_DEBUG "%s: Unknown information frame received: "
1336                        "type 0x%04x, length %d\n", dev->name, type, len);
1337                 /* We don't actually do anything about it */
1338                 break;
1339         }
1340 }
1341
1342 static void __orinoco_ev_infdrop(struct net_device *dev, hermes_t *hw)
1343 {
1344         if (net_ratelimit())
1345                 printk(KERN_DEBUG "%s: Information frame lost.\n", dev->name);
1346 }
1347
1348 /********************************************************************/
1349 /* Internal hardware control routines                               */
1350 /********************************************************************/
1351
1352 int __orinoco_up(struct net_device *dev)
1353 {
1354         struct orinoco_private *priv = netdev_priv(dev);
1355         struct hermes *hw = &priv->hw;
1356         int err;
1357
1358         err = __orinoco_program_rids(dev);
1359         if (err) {
1360                 printk(KERN_ERR "%s: Error %d configuring card\n",
1361                        dev->name, err);
1362                 return err;
1363         }
1364
1365         /* Fire things up again */
1366         hermes_set_irqmask(hw, ORINOCO_INTEN);
1367         err = hermes_enable_port(hw, 0);
1368         if (err) {
1369                 printk(KERN_ERR "%s: Error %d enabling MAC port\n",
1370                        dev->name, err);
1371                 return err;
1372         }
1373
1374         netif_start_queue(dev);
1375
1376         return 0;
1377 }
1378
1379 int __orinoco_down(struct net_device *dev)
1380 {
1381         struct orinoco_private *priv = netdev_priv(dev);
1382         struct hermes *hw = &priv->hw;
1383         int err;
1384
1385         netif_stop_queue(dev);
1386
1387         if (! priv->hw_unavailable) {
1388                 if (! priv->broken_disableport) {
1389                         err = hermes_disable_port(hw, 0);
1390                         if (err) {
1391                                 /* Some firmwares (e.g. Intersil 1.3.x) seem
1392                                  * to have problems disabling the port, oh
1393                                  * well, too bad. */
1394                                 printk(KERN_WARNING "%s: Error %d disabling MAC port\n",
1395                                        dev->name, err);
1396                                 priv->broken_disableport = 1;
1397                         }
1398                 }
1399                 hermes_set_irqmask(hw, 0);
1400                 hermes_write_regn(hw, EVACK, 0xffff);
1401         }
1402
1403         /* firmware will have to reassociate */
1404         netif_carrier_off(dev);
1405         priv->last_linkstatus = 0xffff;
1406
1407         return 0;
1408 }
1409
1410 int orinoco_reinit_firmware(struct net_device *dev)
1411 {
1412         struct orinoco_private *priv = netdev_priv(dev);
1413         struct hermes *hw = &priv->hw;
1414         int err;
1415
1416         err = hermes_init(hw);
1417         if (err)
1418                 return err;
1419
1420         err = hermes_allocate(hw, priv->nicbuf_size, &priv->txfid);
1421         if (err == -EIO) {
1422                 /* Try workaround for old Symbol firmware bug */
1423                 printk(KERN_WARNING "%s: firmware ALLOC bug detected "
1424                        "(old Symbol firmware?). Trying to work around... ",
1425                        dev->name);
1426
1427                 priv->nicbuf_size = TX_NICBUF_SIZE_BUG;
1428                 err = hermes_allocate(hw, priv->nicbuf_size, &priv->txfid);
1429                 if (err)
1430                         printk("failed!\n");
1431                 else
1432                         printk("ok.\n");
1433         }
1434
1435         return err;
1436 }
1437
1438 static int __orinoco_hw_set_bitrate(struct orinoco_private *priv)
1439 {
1440         hermes_t *hw = &priv->hw;
1441         int err = 0;
1442
1443         if (priv->bitratemode >= BITRATE_TABLE_SIZE) {
1444                 printk(KERN_ERR "%s: BUG: Invalid bitrate mode %d\n",
1445                        priv->ndev->name, priv->bitratemode);
1446                 return -EINVAL;
1447         }
1448
1449         switch (priv->firmware_type) {
1450         case FIRMWARE_TYPE_AGERE:
1451                 err = hermes_write_wordrec(hw, USER_BAP,
1452                                            HERMES_RID_CNFTXRATECONTROL,
1453                                            bitrate_table[priv->bitratemode].agere_txratectrl);
1454                 break;
1455         case FIRMWARE_TYPE_INTERSIL:
1456         case FIRMWARE_TYPE_SYMBOL:
1457                 err = hermes_write_wordrec(hw, USER_BAP,
1458                                            HERMES_RID_CNFTXRATECONTROL,
1459                                            bitrate_table[priv->bitratemode].intersil_txratectrl);
1460                 break;
1461         default:
1462                 BUG();
1463         }
1464
1465         return err;
1466 }
1467
1468 /* Change the WEP keys and/or the current keys.  Can be called
1469  * either from __orinoco_hw_setup_wep() or directly from
1470  * orinoco_ioctl_setiwencode().  In the later case the association
1471  * with the AP is not broken (if the firmware can handle it),
1472  * which is needed for 802.1x implementations. */
1473 static int __orinoco_hw_setup_wepkeys(struct orinoco_private *priv)
1474 {
1475         hermes_t *hw = &priv->hw;
1476         int err = 0;
1477
1478         switch (priv->firmware_type) {
1479         case FIRMWARE_TYPE_AGERE:
1480                 err = HERMES_WRITE_RECORD(hw, USER_BAP,
1481                                           HERMES_RID_CNFWEPKEYS_AGERE,
1482                                           &priv->keys);
1483                 if (err)
1484                         return err;
1485                 err = hermes_write_wordrec(hw, USER_BAP,
1486                                            HERMES_RID_CNFTXKEY_AGERE,
1487                                            priv->tx_key);
1488                 if (err)
1489                         return err;
1490                 break;
1491         case FIRMWARE_TYPE_INTERSIL:
1492         case FIRMWARE_TYPE_SYMBOL:
1493                 {
1494                         int keylen;
1495                         int i;
1496
1497                         /* Force uniform key length to work around firmware bugs */
1498                         keylen = le16_to_cpu(priv->keys[priv->tx_key].len);
1499
1500                         if (keylen > LARGE_KEY_SIZE) {
1501                                 printk(KERN_ERR "%s: BUG: Key %d has oversize length %d.\n",
1502                                        priv->ndev->name, priv->tx_key, keylen);
1503                                 return -E2BIG;
1504                         }
1505
1506                         /* Write all 4 keys */
1507                         for(i = 0; i < ORINOCO_MAX_KEYS; i++) {
1508                                 err = hermes_write_ltv(hw, USER_BAP,
1509                                                        HERMES_RID_CNFDEFAULTKEY0 + i,
1510                                                        HERMES_BYTES_TO_RECLEN(keylen),
1511                                                        priv->keys[i].data);
1512                                 if (err)
1513                                         return err;
1514                         }
1515
1516                         /* Write the index of the key used in transmission */
1517                         err = hermes_write_wordrec(hw, USER_BAP,
1518                                                    HERMES_RID_CNFWEPDEFAULTKEYID,
1519                                                    priv->tx_key);
1520                         if (err)
1521                                 return err;
1522                 }
1523                 break;
1524         }
1525
1526         return 0;
1527 }
1528
1529 static int __orinoco_hw_setup_wep(struct orinoco_private *priv)
1530 {
1531         hermes_t *hw = &priv->hw;
1532         int err = 0;
1533         int master_wep_flag;
1534         int auth_flag;
1535
1536         if (priv->wep_on)
1537                 __orinoco_hw_setup_wepkeys(priv);
1538
1539         if (priv->wep_restrict)
1540                 auth_flag = HERMES_AUTH_SHARED_KEY;
1541         else
1542                 auth_flag = HERMES_AUTH_OPEN;
1543
1544         switch (priv->firmware_type) {
1545         case FIRMWARE_TYPE_AGERE: /* Agere style WEP */
1546                 if (priv->wep_on) {
1547                         /* Enable the shared-key authentication. */
1548                         err = hermes_write_wordrec(hw, USER_BAP,
1549                                                    HERMES_RID_CNFAUTHENTICATION_AGERE,
1550                                                    auth_flag);
1551                 }
1552                 err = hermes_write_wordrec(hw, USER_BAP,
1553                                            HERMES_RID_CNFWEPENABLED_AGERE,
1554                                            priv->wep_on);
1555                 if (err)
1556                         return err;
1557                 break;
1558
1559         case FIRMWARE_TYPE_INTERSIL: /* Intersil style WEP */
1560         case FIRMWARE_TYPE_SYMBOL: /* Symbol style WEP */
1561                 if (priv->wep_on) {
1562                         if (priv->wep_restrict ||
1563                             (priv->firmware_type == FIRMWARE_TYPE_SYMBOL))
1564                                 master_wep_flag = HERMES_WEP_PRIVACY_INVOKED |
1565                                                   HERMES_WEP_EXCL_UNENCRYPTED;
1566                         else
1567                                 master_wep_flag = HERMES_WEP_PRIVACY_INVOKED;
1568
1569                         err = hermes_write_wordrec(hw, USER_BAP,
1570                                                    HERMES_RID_CNFAUTHENTICATION,
1571                                                    auth_flag);
1572                         if (err)
1573                                 return err;
1574                 } else
1575                         master_wep_flag = 0;
1576
1577                 if (priv->iw_mode == IW_MODE_MONITOR)
1578                         master_wep_flag |= HERMES_WEP_HOST_DECRYPT;
1579
1580                 /* Master WEP setting : on/off */
1581                 err = hermes_write_wordrec(hw, USER_BAP,
1582                                            HERMES_RID_CNFWEPFLAGS_INTERSIL,
1583                                            master_wep_flag);
1584                 if (err)
1585                         return err;
1586
1587                 break;
1588         }
1589
1590         return 0;
1591 }
1592
1593 static int __orinoco_program_rids(struct net_device *dev)
1594 {
1595         struct orinoco_private *priv = netdev_priv(dev);
1596         hermes_t *hw = &priv->hw;
1597         int err;
1598         struct hermes_idstring idbuf;
1599
1600         /* Set the MAC address */
1601         err = hermes_write_ltv(hw, USER_BAP, HERMES_RID_CNFOWNMACADDR,
1602                                HERMES_BYTES_TO_RECLEN(ETH_ALEN), dev->dev_addr);
1603         if (err) {
1604                 printk(KERN_ERR "%s: Error %d setting MAC address\n",
1605                        dev->name, err);
1606                 return err;
1607         }
1608
1609         /* Set up the link mode */
1610         err = hermes_write_wordrec(hw, USER_BAP, HERMES_RID_CNFPORTTYPE,
1611                                    priv->port_type);
1612         if (err) {
1613                 printk(KERN_ERR "%s: Error %d setting port type\n",
1614                        dev->name, err);
1615                 return err;
1616         }
1617         /* Set the channel/frequency */
1618         if (priv->channel == 0) {
1619                 printk(KERN_DEBUG "%s: Channel is 0 in __orinoco_program_rids()\n", dev->name);
1620                 if (priv->createibss)
1621                         priv->channel = 10;
1622         }
1623         err = hermes_write_wordrec(hw, USER_BAP, HERMES_RID_CNFOWNCHANNEL,
1624                                    priv->channel);
1625         if (err) {
1626                 printk(KERN_ERR "%s: Error %d setting channel\n",
1627                        dev->name, err);
1628                 return err;
1629         }
1630
1631         if (priv->has_ibss) {
1632                 u16 createibss;
1633
1634                 if ((strlen(priv->desired_essid) == 0) && (priv->createibss)) {
1635                         printk(KERN_WARNING "%s: This firmware requires an "
1636                                "ESSID in IBSS-Ad-Hoc mode.\n", dev->name);
1637                         /* With wvlan_cs, in this case, we would crash.
1638                          * hopefully, this driver will behave better...
1639                          * Jean II */
1640                         createibss = 0;
1641                 } else {
1642                         createibss = priv->createibss;
1643                 }
1644
1645                 err = hermes_write_wordrec(hw, USER_BAP,
1646                                            HERMES_RID_CNFCREATEIBSS,
1647                                            createibss);
1648                 if (err) {
1649                         printk(KERN_ERR "%s: Error %d setting CREATEIBSS\n",
1650                                dev->name, err);
1651                         return err;
1652                 }
1653         }
1654
1655         /* Set the desired ESSID */
1656         idbuf.len = cpu_to_le16(strlen(priv->desired_essid));
1657         memcpy(&idbuf.val, priv->desired_essid, sizeof(idbuf.val));
1658         /* WinXP wants partner to configure OWNSSID even in IBSS mode. (jimc) */
1659         err = hermes_write_ltv(hw, USER_BAP, HERMES_RID_CNFOWNSSID,
1660                                HERMES_BYTES_TO_RECLEN(strlen(priv->desired_essid)+2),
1661                                &idbuf);
1662         if (err) {
1663                 printk(KERN_ERR "%s: Error %d setting OWNSSID\n",
1664                        dev->name, err);
1665                 return err;
1666         }
1667         err = hermes_write_ltv(hw, USER_BAP, HERMES_RID_CNFDESIREDSSID,
1668                                HERMES_BYTES_TO_RECLEN(strlen(priv->desired_essid)+2),
1669                                &idbuf);
1670         if (err) {
1671                 printk(KERN_ERR "%s: Error %d setting DESIREDSSID\n",
1672                        dev->name, err);
1673                 return err;
1674         }
1675
1676         /* Set the station name */
1677         idbuf.len = cpu_to_le16(strlen(priv->nick));
1678         memcpy(&idbuf.val, priv->nick, sizeof(idbuf.val));
1679         err = hermes_write_ltv(hw, USER_BAP, HERMES_RID_CNFOWNNAME,
1680                                HERMES_BYTES_TO_RECLEN(strlen(priv->nick)+2),
1681                                &idbuf);
1682         if (err) {
1683                 printk(KERN_ERR "%s: Error %d setting nickname\n",
1684                        dev->name, err);
1685                 return err;
1686         }
1687
1688         /* Set AP density */
1689         if (priv->has_sensitivity) {
1690                 err = hermes_write_wordrec(hw, USER_BAP,
1691                                            HERMES_RID_CNFSYSTEMSCALE,
1692                                            priv->ap_density);
1693                 if (err) {
1694                         printk(KERN_WARNING "%s: Error %d setting SYSTEMSCALE.  "
1695                                "Disabling sensitivity control\n",
1696                                dev->name, err);
1697
1698                         priv->has_sensitivity = 0;
1699                 }
1700         }
1701
1702         /* Set RTS threshold */
1703         err = hermes_write_wordrec(hw, USER_BAP, HERMES_RID_CNFRTSTHRESHOLD,
1704                                    priv->rts_thresh);
1705         if (err) {
1706                 printk(KERN_ERR "%s: Error %d setting RTS threshold\n",
1707                        dev->name, err);
1708                 return err;
1709         }
1710
1711         /* Set fragmentation threshold or MWO robustness */
1712         if (priv->has_mwo)
1713                 err = hermes_write_wordrec(hw, USER_BAP,
1714                                            HERMES_RID_CNFMWOROBUST_AGERE,
1715                                            priv->mwo_robust);
1716         else
1717                 err = hermes_write_wordrec(hw, USER_BAP,
1718                                            HERMES_RID_CNFFRAGMENTATIONTHRESHOLD,
1719                                            priv->frag_thresh);
1720         if (err) {
1721                 printk(KERN_ERR "%s: Error %d setting fragmentation\n",
1722                        dev->name, err);
1723                 return err;
1724         }
1725
1726         /* Set bitrate */
1727         err = __orinoco_hw_set_bitrate(priv);
1728         if (err) {
1729                 printk(KERN_ERR "%s: Error %d setting bitrate\n",
1730                        dev->name, err);
1731                 return err;
1732         }
1733
1734         /* Set power management */
1735         if (priv->has_pm) {
1736                 err = hermes_write_wordrec(hw, USER_BAP,
1737                                            HERMES_RID_CNFPMENABLED,
1738                                            priv->pm_on);
1739                 if (err) {
1740                         printk(KERN_ERR "%s: Error %d setting up PM\n",
1741                                dev->name, err);
1742                         return err;
1743                 }
1744
1745                 err = hermes_write_wordrec(hw, USER_BAP,
1746                                            HERMES_RID_CNFMULTICASTRECEIVE,
1747                                            priv->pm_mcast);
1748                 if (err) {
1749                         printk(KERN_ERR "%s: Error %d setting up PM\n",
1750                                dev->name, err);
1751                         return err;
1752                 }
1753                 err = hermes_write_wordrec(hw, USER_BAP,
1754                                            HERMES_RID_CNFMAXSLEEPDURATION,
1755                                            priv->pm_period);
1756                 if (err) {
1757                         printk(KERN_ERR "%s: Error %d setting up PM\n",
1758                                dev->name, err);
1759                         return err;
1760                 }
1761                 err = hermes_write_wordrec(hw, USER_BAP,
1762                                            HERMES_RID_CNFPMHOLDOVERDURATION,
1763                                            priv->pm_timeout);
1764                 if (err) {
1765                         printk(KERN_ERR "%s: Error %d setting up PM\n",
1766                                dev->name, err);
1767                         return err;
1768                 }
1769         }
1770
1771         /* Set preamble - only for Symbol so far... */
1772         if (priv->has_preamble) {
1773                 err = hermes_write_wordrec(hw, USER_BAP,
1774                                            HERMES_RID_CNFPREAMBLE_SYMBOL,
1775                                            priv->preamble);
1776                 if (err) {
1777                         printk(KERN_ERR "%s: Error %d setting preamble\n",
1778                                dev->name, err);
1779                         return err;
1780                 }
1781         }
1782
1783         /* Set up encryption */
1784         if (priv->has_wep) {
1785                 err = __orinoco_hw_setup_wep(priv);
1786                 if (err) {
1787                         printk(KERN_ERR "%s: Error %d activating WEP\n",
1788                                dev->name, err);
1789                         return err;
1790                 }
1791         }
1792
1793         /* Set promiscuity / multicast*/
1794         priv->promiscuous = 0;
1795         priv->mc_count = 0;
1796         __orinoco_set_multicast_list(dev); /* FIXME: what about the xmit_lock */
1797
1798         return 0;
1799 }
1800
1801 /* FIXME: return int? */
1802 static void
1803 __orinoco_set_multicast_list(struct net_device *dev)
1804 {
1805         struct orinoco_private *priv = netdev_priv(dev);
1806         hermes_t *hw = &priv->hw;
1807         int err = 0;
1808         int promisc, mc_count;
1809
1810         /* The Hermes doesn't seem to have an allmulti mode, so we go
1811          * into promiscuous mode and let the upper levels deal. */
1812         if ( (dev->flags & IFF_PROMISC) || (dev->flags & IFF_ALLMULTI) ||
1813              (dev->mc_count > MAX_MULTICAST(priv)) ) {
1814                 promisc = 1;
1815                 mc_count = 0;
1816         } else {
1817                 promisc = 0;
1818                 mc_count = dev->mc_count;
1819         }
1820
1821         if (promisc != priv->promiscuous) {
1822                 err = hermes_write_wordrec(hw, USER_BAP,
1823                                            HERMES_RID_CNFPROMISCUOUSMODE,
1824                                            promisc);
1825                 if (err) {
1826                         printk(KERN_ERR "%s: Error %d setting PROMISCUOUSMODE to 1.\n",
1827                                dev->name, err);
1828                 } else
1829                         priv->promiscuous = promisc;
1830         }
1831
1832         if (! promisc && (mc_count || priv->mc_count) ) {
1833                 struct dev_mc_list *p = dev->mc_list;
1834                 struct hermes_multicast mclist;
1835                 int i;
1836
1837                 for (i = 0; i < mc_count; i++) {
1838                         /* paranoia: is list shorter than mc_count? */
1839                         BUG_ON(! p);
1840                         /* paranoia: bad address size in list? */
1841                         BUG_ON(p->dmi_addrlen != ETH_ALEN);
1842
1843                         memcpy(mclist.addr[i], p->dmi_addr, ETH_ALEN);
1844                         p = p->next;
1845                 }
1846
1847                 if (p)
1848                         printk(KERN_WARNING "%s: Multicast list is "
1849                                "longer than mc_count\n", dev->name);
1850
1851                 err = hermes_write_ltv(hw, USER_BAP, HERMES_RID_CNFGROUPADDRESSES,
1852                                        HERMES_BYTES_TO_RECLEN(priv->mc_count * ETH_ALEN),
1853                                        &mclist);
1854                 if (err)
1855                         printk(KERN_ERR "%s: Error %d setting multicast list.\n",
1856                                dev->name, err);
1857                 else
1858                         priv->mc_count = mc_count;
1859         }
1860
1861         /* Since we can set the promiscuous flag when it wasn't asked
1862            for, make sure the net_device knows about it. */
1863         if (priv->promiscuous)
1864                 dev->flags |= IFF_PROMISC;
1865         else
1866                 dev->flags &= ~IFF_PROMISC;
1867 }
1868
1869 static int orinoco_reconfigure(struct net_device *dev)
1870 {
1871         struct orinoco_private *priv = netdev_priv(dev);
1872         struct hermes *hw = &priv->hw;
1873         unsigned long flags;
1874         int err = 0;
1875
1876         if (priv->broken_disableport) {
1877                 schedule_work(&priv->reset_work);
1878                 return 0;
1879         }
1880
1881         if (orinoco_lock(priv, &flags) != 0)
1882                 return -EBUSY;
1883
1884         err = hermes_disable_port(hw, 0);
1885         if (err) {
1886                 printk(KERN_WARNING "%s: Unable to disable port while reconfiguring card\n",
1887                        dev->name);
1888                 priv->broken_disableport = 1;
1889                 goto out;
1890         }
1891
1892         err = __orinoco_program_rids(dev);
1893         if (err) {
1894                 printk(KERN_WARNING "%s: Unable to reconfigure card\n",
1895                        dev->name);
1896                 goto out;
1897         }
1898
1899         err = hermes_enable_port(hw, 0);
1900         if (err) {
1901                 printk(KERN_WARNING "%s: Unable to enable port while reconfiguring card\n",
1902                        dev->name);
1903                 goto out;
1904         }
1905
1906  out:
1907         if (err) {
1908                 printk(KERN_WARNING "%s: Resetting instead...\n", dev->name);
1909                 schedule_work(&priv->reset_work);
1910                 err = 0;
1911         }
1912
1913         orinoco_unlock(priv, &flags);
1914         return err;
1915
1916 }
1917
1918 /* This must be called from user context, without locks held - use
1919  * schedule_work() */
1920 static void orinoco_reset(struct net_device *dev)
1921 {
1922         struct orinoco_private *priv = netdev_priv(dev);
1923         struct hermes *hw = &priv->hw;
1924         int err = 0;
1925         unsigned long flags;
1926
1927         if (orinoco_lock(priv, &flags) != 0)
1928                 /* When the hardware becomes available again, whatever
1929                  * detects that is responsible for re-initializing
1930                  * it. So no need for anything further */
1931                 return;
1932
1933         netif_stop_queue(dev);
1934
1935         /* Shut off interrupts.  Depending on what state the hardware
1936          * is in, this might not work, but we'll try anyway */
1937         hermes_set_irqmask(hw, 0);
1938         hermes_write_regn(hw, EVACK, 0xffff);
1939
1940         priv->hw_unavailable++;
1941         priv->last_linkstatus = 0xffff; /* firmware will have to reassociate */
1942         netif_carrier_off(dev);
1943
1944         orinoco_unlock(priv, &flags);
1945
1946         if (priv->hard_reset)
1947                 err = (*priv->hard_reset)(priv);
1948         if (err) {
1949                 printk(KERN_ERR "%s: orinoco_reset: Error %d "
1950                        "performing  hard reset\n", dev->name, err);
1951                 /* FIXME: shutdown of some sort */
1952                 return;
1953         }
1954
1955         err = orinoco_reinit_firmware(dev);
1956         if (err) {
1957                 printk(KERN_ERR "%s: orinoco_reset: Error %d re-initializing firmware\n",
1958                        dev->name, err);
1959                 return;
1960         }
1961
1962         spin_lock_irq(&priv->lock); /* This has to be called from user context */
1963
1964         priv->hw_unavailable--;
1965
1966         /* priv->open or priv->hw_unavailable might have changed while
1967          * we dropped the lock */
1968         if (priv->open && (! priv->hw_unavailable)) {
1969                 err = __orinoco_up(dev);
1970                 if (err) {
1971                         printk(KERN_ERR "%s: orinoco_reset: Error %d reenabling card\n",
1972                                dev->name, err);
1973                 } else
1974                         dev->trans_start = jiffies;
1975         }
1976
1977         spin_unlock_irq(&priv->lock);
1978
1979         return;
1980 }
1981
1982 /********************************************************************/
1983 /* Interrupt handler                                                */
1984 /********************************************************************/
1985
1986 static void __orinoco_ev_tick(struct net_device *dev, hermes_t *hw)
1987 {
1988         printk(KERN_DEBUG "%s: TICK\n", dev->name);
1989 }
1990
1991 static void __orinoco_ev_wterr(struct net_device *dev, hermes_t *hw)
1992 {
1993         /* This seems to happen a fair bit under load, but ignoring it
1994            seems to work fine...*/
1995         printk(KERN_DEBUG "%s: MAC controller error (WTERR). Ignoring.\n",
1996                dev->name);
1997 }
1998
1999 irqreturn_t orinoco_interrupt(int irq, void *dev_id, struct pt_regs *regs)
2000 {
2001         struct net_device *dev = (struct net_device *)dev_id;
2002         struct orinoco_private *priv = netdev_priv(dev);
2003         hermes_t *hw = &priv->hw;
2004         int count = MAX_IRQLOOPS_PER_IRQ;
2005         u16 evstat, events;
2006         /* These are used to detect a runaway interrupt situation */
2007         /* If we get more than MAX_IRQLOOPS_PER_JIFFY iterations in a jiffy,
2008          * we panic and shut down the hardware */
2009         static int last_irq_jiffy = 0; /* jiffies value the last time
2010                                         * we were called */
2011         static int loops_this_jiffy = 0;
2012         unsigned long flags;
2013
2014         if (orinoco_lock(priv, &flags) != 0) {
2015                 /* If hw is unavailable - we don't know if the irq was
2016                  * for us or not */
2017                 return IRQ_HANDLED;
2018         }
2019
2020         evstat = hermes_read_regn(hw, EVSTAT);
2021         events = evstat & hw->inten;
2022         if (! events) {
2023                 orinoco_unlock(priv, &flags);
2024                 return IRQ_NONE;
2025         }
2026
2027         if (jiffies != last_irq_jiffy)
2028                 loops_this_jiffy = 0;
2029         last_irq_jiffy = jiffies;
2030
2031         while (events && count--) {
2032                 if (++loops_this_jiffy > MAX_IRQLOOPS_PER_JIFFY) {
2033                         printk(KERN_WARNING "%s: IRQ handler is looping too "
2034                                "much! Resetting.\n", dev->name);
2035                         /* Disable interrupts for now */
2036                         hermes_set_irqmask(hw, 0);
2037                         schedule_work(&priv->reset_work);
2038                         break;
2039                 }
2040
2041                 /* Check the card hasn't been removed */
2042                 if (! hermes_present(hw)) {
2043                         DEBUG(0, "orinoco_interrupt(): card removed\n");
2044                         break;
2045                 }
2046
2047                 if (events & HERMES_EV_TICK)
2048                         __orinoco_ev_tick(dev, hw);
2049                 if (events & HERMES_EV_WTERR)
2050                         __orinoco_ev_wterr(dev, hw);
2051                 if (events & HERMES_EV_INFDROP)
2052                         __orinoco_ev_infdrop(dev, hw);
2053                 if (events & HERMES_EV_INFO)
2054                         __orinoco_ev_info(dev, hw);
2055                 if (events & HERMES_EV_RX)
2056                         __orinoco_ev_rx(dev, hw);
2057                 if (events & HERMES_EV_TXEXC)
2058                         __orinoco_ev_txexc(dev, hw);
2059                 if (events & HERMES_EV_TX)
2060                         __orinoco_ev_tx(dev, hw);
2061                 if (events & HERMES_EV_ALLOC)
2062                         __orinoco_ev_alloc(dev, hw);
2063
2064                 hermes_write_regn(hw, EVACK, events);
2065
2066                 evstat = hermes_read_regn(hw, EVSTAT);
2067                 events = evstat & hw->inten;
2068         };
2069
2070         orinoco_unlock(priv, &flags);
2071         return IRQ_HANDLED;
2072 }
2073
2074 /********************************************************************/
2075 /* Initialization                                                   */
2076 /********************************************************************/
2077
2078 struct comp_id {
2079         u16 id, variant, major, minor;
2080 } __attribute__ ((packed));
2081
2082 static inline fwtype_t determine_firmware_type(struct comp_id *nic_id)
2083 {
2084         if (nic_id->id < 0x8000)
2085                 return FIRMWARE_TYPE_AGERE;
2086         else if (nic_id->id == 0x8000 && nic_id->major == 0)
2087                 return FIRMWARE_TYPE_SYMBOL;
2088         else
2089                 return FIRMWARE_TYPE_INTERSIL;
2090 }
2091
2092 /* Set priv->firmware type, determine firmware properties */
2093 static int determine_firmware(struct net_device *dev)
2094 {
2095         struct orinoco_private *priv = netdev_priv(dev);
2096         hermes_t *hw = &priv->hw;
2097         int err;
2098         struct comp_id nic_id, sta_id;
2099         unsigned int firmver;
2100         char tmp[SYMBOL_MAX_VER_LEN+1];
2101
2102         /* Get the hardware version */
2103         err = HERMES_READ_RECORD(hw, USER_BAP, HERMES_RID_NICID, &nic_id);
2104         if (err) {
2105                 printk(KERN_ERR "%s: Cannot read hardware identity: error %d\n",
2106                        dev->name, err);
2107                 return err;
2108         }
2109
2110         le16_to_cpus(&nic_id.id);
2111         le16_to_cpus(&nic_id.variant);
2112         le16_to_cpus(&nic_id.major);
2113         le16_to_cpus(&nic_id.minor);
2114         printk(KERN_DEBUG "%s: Hardware identity %04x:%04x:%04x:%04x\n",
2115                dev->name, nic_id.id, nic_id.variant,
2116                nic_id.major, nic_id.minor);
2117
2118         priv->firmware_type = determine_firmware_type(&nic_id);
2119
2120         /* Get the firmware version */
2121         err = HERMES_READ_RECORD(hw, USER_BAP, HERMES_RID_STAID, &sta_id);
2122         if (err) {
2123                 printk(KERN_ERR "%s: Cannot read station identity: error %d\n",
2124                        dev->name, err);
2125                 return err;
2126         }
2127
2128         le16_to_cpus(&sta_id.id);
2129         le16_to_cpus(&sta_id.variant);
2130         le16_to_cpus(&sta_id.major);
2131         le16_to_cpus(&sta_id.minor);
2132         printk(KERN_DEBUG "%s: Station identity  %04x:%04x:%04x:%04x\n",
2133                dev->name, sta_id.id, sta_id.variant,
2134                sta_id.major, sta_id.minor);
2135
2136         switch (sta_id.id) {
2137         case 0x15:
2138                 printk(KERN_ERR "%s: Primary firmware is active\n",
2139                        dev->name);
2140                 return -ENODEV;
2141         case 0x14b:
2142                 printk(KERN_ERR "%s: Tertiary firmware is active\n",
2143                        dev->name);
2144                 return -ENODEV;
2145         case 0x1f:      /* Intersil, Agere, Symbol Spectrum24 */
2146         case 0x21:      /* Symbol Spectrum24 Trilogy */
2147                 break;
2148         default:
2149                 printk(KERN_NOTICE "%s: Unknown station ID, please report\n",
2150                        dev->name);
2151                 break;
2152         }
2153
2154         /* Default capabilities */
2155         priv->has_sensitivity = 1;
2156         priv->has_mwo = 0;
2157         priv->has_preamble = 0;
2158         priv->has_port3 = 1;
2159         priv->has_ibss = 1;
2160         priv->has_wep = 0;
2161         priv->has_big_wep = 0;
2162
2163         /* Determine capabilities from the firmware version */
2164         switch (priv->firmware_type) {
2165         case FIRMWARE_TYPE_AGERE:
2166                 /* Lucent Wavelan IEEE, Lucent Orinoco, Cabletron RoamAbout,
2167                    ELSA, Melco, HP, IBM, Dell 1150, Compaq 110/210 */
2168                 snprintf(priv->fw_name, sizeof(priv->fw_name) - 1,
2169                          "Lucent/Agere %d.%02d", sta_id.major, sta_id.minor);
2170
2171                 firmver = ((unsigned long)sta_id.major << 16) | sta_id.minor;
2172
2173                 priv->has_ibss = (firmver >= 0x60006);
2174                 priv->has_wep = (firmver >= 0x40020);
2175                 priv->has_big_wep = 1; /* FIXME: this is wrong - how do we tell
2176                                           Gold cards from the others? */
2177                 priv->has_mwo = (firmver >= 0x60000);
2178                 priv->has_pm = (firmver >= 0x40020); /* Don't work in 7.52 ? */
2179                 priv->ibss_port = 1;
2180
2181                 /* Tested with Agere firmware :
2182                  *      1.16 ; 4.08 ; 4.52 ; 6.04 ; 6.16 ; 7.28 => Jean II
2183                  * Tested CableTron firmware : 4.32 => Anton */
2184                 break;
2185         case FIRMWARE_TYPE_SYMBOL:
2186                 /* Symbol , 3Com AirConnect, Intel, Ericsson WLAN */
2187                 /* Intel MAC : 00:02:B3:* */
2188                 /* 3Com MAC : 00:50:DA:* */
2189                 memset(tmp, 0, sizeof(tmp));
2190                 /* Get the Symbol firmware version */
2191                 err = hermes_read_ltv(hw, USER_BAP,
2192                                       HERMES_RID_SECONDARYVERSION_SYMBOL,
2193                                       SYMBOL_MAX_VER_LEN, NULL, &tmp);
2194                 if (err) {
2195                         printk(KERN_WARNING
2196                                "%s: Error %d reading Symbol firmware info. Wildly guessing capabilities...\n",
2197                                dev->name, err);
2198                         firmver = 0;
2199                         tmp[0] = '\0';
2200                 } else {
2201                         /* The firmware revision is a string, the format is
2202                          * something like : "V2.20-01".
2203                          * Quick and dirty parsing... - Jean II
2204                          */
2205                         firmver = ((tmp[1] - '0') << 16) | ((tmp[3] - '0') << 12)
2206                                 | ((tmp[4] - '0') << 8) | ((tmp[6] - '0') << 4)
2207                                 | (tmp[7] - '0');
2208
2209                         tmp[SYMBOL_MAX_VER_LEN] = '\0';
2210                 }
2211
2212                 snprintf(priv->fw_name, sizeof(priv->fw_name) - 1,
2213                          "Symbol %s", tmp);
2214
2215                 priv->has_ibss = (firmver >= 0x20000);
2216                 priv->has_wep = (firmver >= 0x15012);
2217                 priv->has_big_wep = (firmver >= 0x20000);
2218                 priv->has_pm = (firmver >= 0x20000 && firmver < 0x22000) ||
2219                                (firmver >= 0x29000 && firmver < 0x30000) ||
2220                                firmver >= 0x31000;
2221                 priv->has_preamble = (firmver >= 0x20000);
2222                 priv->ibss_port = 4;
2223                 /* Tested with Intel firmware : 0x20015 => Jean II */
2224                 /* Tested with 3Com firmware : 0x15012 & 0x22001 => Jean II */
2225                 break;
2226         case FIRMWARE_TYPE_INTERSIL:
2227                 /* D-Link, Linksys, Adtron, ZoomAir, and many others...
2228                  * Samsung, Compaq 100/200 and Proxim are slightly
2229                  * different and less well tested */
2230                 /* D-Link MAC : 00:40:05:* */
2231                 /* Addtron MAC : 00:90:D1:* */
2232                 snprintf(priv->fw_name, sizeof(priv->fw_name) - 1,
2233                          "Intersil %d.%d.%d", sta_id.major, sta_id.minor,
2234                          sta_id.variant);
2235
2236                 firmver = ((unsigned long)sta_id.major << 16) |
2237                         ((unsigned long)sta_id.minor << 8) | sta_id.variant;
2238
2239                 priv->has_ibss = (firmver >= 0x000700); /* FIXME */
2240                 priv->has_big_wep = priv->has_wep = (firmver >= 0x000800);
2241                 priv->has_pm = (firmver >= 0x000700);
2242
2243                 if (firmver >= 0x000800)
2244                         priv->ibss_port = 0;
2245                 else {
2246                         printk(KERN_NOTICE "%s: Intersil firmware earlier "
2247                                "than v0.8.x - several features not supported\n",
2248                                dev->name);
2249                         priv->ibss_port = 1;
2250                 }
2251                 break;
2252         }
2253         printk(KERN_DEBUG "%s: Firmware determined as %s\n", dev->name,
2254                priv->fw_name);
2255
2256         return 0;
2257 }
2258
2259 static int orinoco_init(struct net_device *dev)
2260 {
2261         struct orinoco_private *priv = netdev_priv(dev);
2262         hermes_t *hw = &priv->hw;
2263         int err = 0;
2264         struct hermes_idstring nickbuf;
2265         u16 reclen;
2266         int len;
2267
2268         TRACE_ENTER(dev->name);
2269
2270         /* No need to lock, the hw_unavailable flag is already set in
2271          * alloc_orinocodev() */
2272         priv->nicbuf_size = IEEE802_11_FRAME_LEN + ETH_HLEN;
2273
2274         /* Initialize the firmware */
2275         err = hermes_init(hw);
2276         if (err != 0) {
2277                 printk(KERN_ERR "%s: failed to initialize firmware (err = %d)\n",
2278                        dev->name, err);
2279                 goto out;
2280         }
2281
2282         err = determine_firmware(dev);
2283         if (err != 0) {
2284                 printk(KERN_ERR "%s: Incompatible firmware, aborting\n",
2285                        dev->name);
2286                 goto out;
2287         }
2288
2289         if (priv->has_port3)
2290                 printk(KERN_DEBUG "%s: Ad-hoc demo mode supported\n", dev->name);
2291         if (priv->has_ibss)
2292                 printk(KERN_DEBUG "%s: IEEE standard IBSS ad-hoc mode supported\n",
2293                        dev->name);
2294         if (priv->has_wep) {
2295                 printk(KERN_DEBUG "%s: WEP supported, ", dev->name);
2296                 if (priv->has_big_wep)
2297                         printk("104-bit key\n");
2298                 else
2299                         printk("40-bit key\n");
2300         }
2301
2302         /* Get the MAC address */
2303         err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_CNFOWNMACADDR,
2304                               ETH_ALEN, NULL, dev->dev_addr);
2305         if (err) {
2306                 printk(KERN_WARNING "%s: failed to read MAC address!\n",
2307                        dev->name);
2308                 goto out;
2309         }
2310
2311         printk(KERN_DEBUG "%s: MAC address %02X:%02X:%02X:%02X:%02X:%02X\n",
2312                dev->name, dev->dev_addr[0], dev->dev_addr[1],
2313                dev->dev_addr[2], dev->dev_addr[3], dev->dev_addr[4],
2314                dev->dev_addr[5]);
2315
2316         /* Get the station name */
2317         err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_CNFOWNNAME,
2318                               sizeof(nickbuf), &reclen, &nickbuf);
2319         if (err) {
2320                 printk(KERN_ERR "%s: failed to read station name\n",
2321                        dev->name);
2322                 goto out;
2323         }
2324         if (nickbuf.len)
2325                 len = min(IW_ESSID_MAX_SIZE, (int)le16_to_cpu(nickbuf.len));
2326         else
2327                 len = min(IW_ESSID_MAX_SIZE, 2 * reclen);
2328         memcpy(priv->nick, &nickbuf.val, len);
2329         priv->nick[len] = '\0';
2330
2331         printk(KERN_DEBUG "%s: Station name \"%s\"\n", dev->name, priv->nick);
2332
2333         /* Get allowed channels */
2334         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CHANNELLIST,
2335                                   &priv->channel_mask);
2336         if (err) {
2337                 printk(KERN_ERR "%s: failed to read channel list!\n",
2338                        dev->name);
2339                 goto out;
2340         }
2341
2342         /* Get initial AP density */
2343         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CNFSYSTEMSCALE,
2344                                   &priv->ap_density);
2345         if (err || priv->ap_density < 1 || priv->ap_density > 3) {
2346                 priv->has_sensitivity = 0;
2347         }
2348
2349         /* Get initial RTS threshold */
2350         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CNFRTSTHRESHOLD,
2351                                   &priv->rts_thresh);
2352         if (err) {
2353                 printk(KERN_ERR "%s: failed to read RTS threshold!\n",
2354                        dev->name);
2355                 goto out;
2356         }
2357
2358         /* Get initial fragmentation settings */
2359         if (priv->has_mwo)
2360                 err = hermes_read_wordrec(hw, USER_BAP,
2361                                           HERMES_RID_CNFMWOROBUST_AGERE,
2362                                           &priv->mwo_robust);
2363         else
2364                 err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CNFFRAGMENTATIONTHRESHOLD,
2365                                           &priv->frag_thresh);
2366         if (err) {
2367                 printk(KERN_ERR "%s: failed to read fragmentation settings!\n",
2368                        dev->name);
2369                 goto out;
2370         }
2371
2372         /* Power management setup */
2373         if (priv->has_pm) {
2374                 priv->pm_on = 0;
2375                 priv->pm_mcast = 1;
2376                 err = hermes_read_wordrec(hw, USER_BAP,
2377                                           HERMES_RID_CNFMAXSLEEPDURATION,
2378                                           &priv->pm_period);
2379                 if (err) {
2380                         printk(KERN_ERR "%s: failed to read power management period!\n",
2381                                dev->name);
2382                         goto out;
2383                 }
2384                 err = hermes_read_wordrec(hw, USER_BAP,
2385                                           HERMES_RID_CNFPMHOLDOVERDURATION,
2386                                           &priv->pm_timeout);
2387                 if (err) {
2388                         printk(KERN_ERR "%s: failed to read power management timeout!\n",
2389                                dev->name);
2390                         goto out;
2391                 }
2392         }
2393
2394         /* Preamble setup */
2395         if (priv->has_preamble) {
2396                 err = hermes_read_wordrec(hw, USER_BAP,
2397                                           HERMES_RID_CNFPREAMBLE_SYMBOL,
2398                                           &priv->preamble);
2399                 if (err)
2400                         goto out;
2401         }
2402
2403         /* Set up the default configuration */
2404         priv->iw_mode = IW_MODE_INFRA;
2405         /* By default use IEEE/IBSS ad-hoc mode if we have it */
2406         priv->prefer_port3 = priv->has_port3 && (! priv->has_ibss);
2407         set_port_type(priv);
2408         priv->channel = 10; /* default channel, more-or-less arbitrary */
2409
2410         priv->promiscuous = 0;
2411         priv->wep_on = 0;
2412         priv->tx_key = 0;
2413
2414         err = hermes_allocate(hw, priv->nicbuf_size, &priv->txfid);
2415         if (err == -EIO) {
2416                 /* Try workaround for old Symbol firmware bug */
2417                 printk(KERN_WARNING "%s: firmware ALLOC bug detected "
2418                        "(old Symbol firmware?). Trying to work around... ",
2419                        dev->name);
2420
2421                 priv->nicbuf_size = TX_NICBUF_SIZE_BUG;
2422                 err = hermes_allocate(hw, priv->nicbuf_size, &priv->txfid);
2423                 if (err)
2424                         printk("failed!\n");
2425                 else
2426                         printk("ok.\n");
2427         }
2428         if (err) {
2429                 printk("%s: Error %d allocating Tx buffer\n", dev->name, err);
2430                 goto out;
2431         }
2432
2433         /* Make the hardware available, as long as it hasn't been
2434          * removed elsewhere (e.g. by PCMCIA hot unplug) */
2435         spin_lock_irq(&priv->lock);
2436         priv->hw_unavailable--;
2437         spin_unlock_irq(&priv->lock);
2438
2439         printk(KERN_DEBUG "%s: ready\n", dev->name);
2440
2441  out:
2442         TRACE_EXIT(dev->name);
2443         return err;
2444 }
2445
2446 struct net_device *alloc_orinocodev(int sizeof_card,
2447                                     int (*hard_reset)(struct orinoco_private *))
2448 {
2449         struct net_device *dev;
2450         struct orinoco_private *priv;
2451
2452         dev = alloc_etherdev(sizeof(struct orinoco_private) + sizeof_card);
2453         if (! dev)
2454                 return NULL;
2455         priv = netdev_priv(dev);
2456         priv->ndev = dev;
2457         if (sizeof_card)
2458                 priv->card = (void *)((unsigned long)netdev_priv(dev)
2459                                       + sizeof(struct orinoco_private));
2460         else
2461                 priv->card = NULL;
2462
2463         /* Setup / override net_device fields */
2464         dev->init = orinoco_init;
2465         dev->hard_start_xmit = orinoco_xmit;
2466         dev->tx_timeout = orinoco_tx_timeout;
2467         dev->watchdog_timeo = HZ; /* 1 second timeout */
2468         dev->get_stats = orinoco_get_stats;
2469         dev->get_wireless_stats = orinoco_get_wireless_stats;
2470         dev->do_ioctl = orinoco_ioctl;
2471         dev->change_mtu = orinoco_change_mtu;
2472         dev->set_multicast_list = orinoco_set_multicast_list;
2473         /* we use the default eth_mac_addr for setting the MAC addr */
2474
2475         /* Set up default callbacks */
2476         dev->open = orinoco_open;
2477         dev->stop = orinoco_stop;
2478         priv->hard_reset = hard_reset;
2479
2480         spin_lock_init(&priv->lock);
2481         priv->open = 0;
2482         priv->hw_unavailable = 1; /* orinoco_init() must clear this
2483                                    * before anything else touches the
2484                                    * hardware */
2485         INIT_WORK(&priv->reset_work, (void (*)(void *))orinoco_reset, dev);
2486
2487         netif_carrier_off(dev);
2488         priv->last_linkstatus = 0xffff;
2489
2490         return dev;
2491
2492 }
2493
2494 void free_orinocodev(struct net_device *dev)
2495 {
2496         free_netdev(dev);
2497 }
2498
2499 /********************************************************************/
2500 /* Wireless extensions                                              */
2501 /********************************************************************/
2502
2503 static int orinoco_hw_get_bssid(struct orinoco_private *priv,
2504                                 char buf[ETH_ALEN])
2505 {
2506         hermes_t *hw = &priv->hw;
2507         int err = 0;
2508         unsigned long flags;
2509
2510         if (orinoco_lock(priv, &flags) != 0)
2511                 return -EBUSY;
2512
2513         err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_CURRENTBSSID,
2514                               ETH_ALEN, NULL, buf);
2515
2516         orinoco_unlock(priv, &flags);
2517
2518         return err;
2519 }
2520
2521 static int orinoco_hw_get_essid(struct orinoco_private *priv, int *active,
2522                                 char buf[IW_ESSID_MAX_SIZE+1])
2523 {
2524         hermes_t *hw = &priv->hw;
2525         int err = 0;
2526         struct hermes_idstring essidbuf;
2527         char *p = (char *)(&essidbuf.val);
2528         int len;
2529         unsigned long flags;
2530
2531         if (orinoco_lock(priv, &flags) != 0)
2532                 return -EBUSY;
2533
2534         if (strlen(priv->desired_essid) > 0) {
2535                 /* We read the desired SSID from the hardware rather
2536                    than from priv->desired_essid, just in case the
2537                    firmware is allowed to change it on us. I'm not
2538                    sure about this */
2539                 /* My guess is that the OWNSSID should always be whatever
2540                  * we set to the card, whereas CURRENT_SSID is the one that
2541                  * may change... - Jean II */
2542                 u16 rid;
2543
2544                 *active = 1;
2545
2546                 rid = (priv->port_type == 3) ? HERMES_RID_CNFOWNSSID :
2547                         HERMES_RID_CNFDESIREDSSID;
2548
2549                 err = hermes_read_ltv(hw, USER_BAP, rid, sizeof(essidbuf),
2550                                       NULL, &essidbuf);
2551                 if (err)
2552                         goto fail_unlock;
2553         } else {
2554                 *active = 0;
2555
2556                 err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_CURRENTSSID,
2557                                       sizeof(essidbuf), NULL, &essidbuf);
2558                 if (err)
2559                         goto fail_unlock;
2560         }
2561
2562         len = le16_to_cpu(essidbuf.len);
2563
2564         memset(buf, 0, IW_ESSID_MAX_SIZE+1);
2565         memcpy(buf, p, len);
2566         buf[len] = '\0';
2567
2568  fail_unlock:
2569         orinoco_unlock(priv, &flags);
2570
2571         return err;
2572 }
2573
2574 static long orinoco_hw_get_freq(struct orinoco_private *priv)
2575 {
2576
2577         hermes_t *hw = &priv->hw;
2578         int err = 0;
2579         u16 channel;
2580         long freq = 0;
2581         unsigned long flags;
2582
2583         if (orinoco_lock(priv, &flags) != 0)
2584                 return -EBUSY;
2585
2586         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CURRENTCHANNEL, &channel);
2587         if (err)
2588                 goto out;
2589
2590         /* Intersil firmware 1.3.5 returns 0 when the interface is down */
2591         if (channel == 0) {
2592                 err = -EBUSY;
2593                 goto out;
2594         }
2595
2596         if ( (channel < 1) || (channel > NUM_CHANNELS) ) {
2597                 printk(KERN_WARNING "%s: Channel out of range (%d)!\n",
2598                        priv->ndev->name, channel);
2599                 err = -EBUSY;
2600                 goto out;
2601
2602         }
2603         freq = channel_frequency[channel-1] * 100000;
2604
2605  out:
2606         orinoco_unlock(priv, &flags);
2607
2608         if (err > 0)
2609                 err = -EBUSY;
2610         return err ? err : freq;
2611 }
2612
2613 static int orinoco_hw_get_bitratelist(struct orinoco_private *priv,
2614                                       int *numrates, s32 *rates, int max)
2615 {
2616         hermes_t *hw = &priv->hw;
2617         struct hermes_idstring list;
2618         unsigned char *p = (unsigned char *)&list.val;
2619         int err = 0;
2620         int num;
2621         int i;
2622         unsigned long flags;
2623
2624         if (orinoco_lock(priv, &flags) != 0)
2625                 return -EBUSY;
2626
2627         err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_SUPPORTEDDATARATES,
2628                               sizeof(list), NULL, &list);
2629         orinoco_unlock(priv, &flags);
2630
2631         if (err)
2632                 return err;
2633
2634         num = le16_to_cpu(list.len);
2635         *numrates = num;
2636         num = min(num, max);
2637
2638         for (i = 0; i < num; i++) {
2639                 rates[i] = (p[i] & 0x7f) * 500000; /* convert to bps */
2640         }
2641
2642         return 0;
2643 }
2644
2645 static int orinoco_ioctl_getiwrange(struct net_device *dev, struct iw_point *rrq)
2646 {
2647         struct orinoco_private *priv = netdev_priv(dev);
2648         int err = 0;
2649         int mode;
2650         struct iw_range range;
2651         int numrates;
2652         int i, k;
2653         unsigned long flags;
2654
2655         TRACE_ENTER(dev->name);
2656
2657         if (!access_ok(VERIFY_WRITE, rrq->pointer, sizeof(range)))
2658                 return -EFAULT;
2659
2660         rrq->length = sizeof(range);
2661
2662         if (orinoco_lock(priv, &flags) != 0)
2663                 return -EBUSY;
2664
2665         mode = priv->iw_mode;
2666         orinoco_unlock(priv, &flags);
2667
2668         memset(&range, 0, sizeof(range));
2669
2670         /* Much of this shamelessly taken from wvlan_cs.c. No idea
2671          * what it all means -dgibson */
2672         range.we_version_compiled = WIRELESS_EXT;
2673         range.we_version_source = 11;
2674
2675         range.min_nwid = range.max_nwid = 0; /* We don't use nwids */
2676
2677         /* Set available channels/frequencies */
2678         range.num_channels = NUM_CHANNELS;
2679         k = 0;
2680         for (i = 0; i < NUM_CHANNELS; i++) {
2681                 if (priv->channel_mask & (1 << i)) {
2682                         range.freq[k].i = i + 1;
2683                         range.freq[k].m = channel_frequency[i] * 100000;
2684                         range.freq[k].e = 1;
2685                         k++;
2686                 }
2687
2688                 if (k >= IW_MAX_FREQUENCIES)
2689                         break;
2690         }
2691         range.num_frequency = k;
2692
2693         range.sensitivity = 3;
2694
2695         if ((mode == IW_MODE_ADHOC) && (priv->spy_number == 0)){
2696                 /* Quality stats meaningless in ad-hoc mode */
2697                 range.max_qual.qual = 0;
2698                 range.max_qual.level = 0;
2699                 range.max_qual.noise = 0;
2700                 range.avg_qual.qual = 0;
2701                 range.avg_qual.level = 0;
2702                 range.avg_qual.noise = 0;
2703         } else {
2704                 range.max_qual.qual = 0x8b - 0x2f;
2705                 range.max_qual.level = 0x2f - 0x95 - 1;
2706                 range.max_qual.noise = 0x2f - 0x95 - 1;
2707                 /* Need to get better values */
2708                 range.avg_qual.qual = 0x24;
2709                 range.avg_qual.level = 0xC2;
2710                 range.avg_qual.noise = 0x9E;
2711         }
2712
2713         err = orinoco_hw_get_bitratelist(priv, &numrates,
2714                                          range.bitrate, IW_MAX_BITRATES);
2715         if (err)
2716                 return err;
2717         range.num_bitrates = numrates;
2718
2719         /* Set an indication of the max TCP throughput in bit/s that we can
2720          * expect using this interface. May be use for QoS stuff...
2721          * Jean II */
2722         if(numrates > 2)
2723                 range.throughput = 5 * 1000 * 1000;     /* ~5 Mb/s */
2724         else
2725                 range.throughput = 1.5 * 1000 * 1000;   /* ~1.5 Mb/s */
2726
2727         range.min_rts = 0;
2728         range.max_rts = 2347;
2729         range.min_frag = 256;
2730         range.max_frag = 2346;
2731
2732         if (orinoco_lock(priv, &flags) != 0)
2733                 return -EBUSY;
2734         if (priv->has_wep) {
2735                 range.max_encoding_tokens = ORINOCO_MAX_KEYS;
2736
2737                 range.encoding_size[0] = SMALL_KEY_SIZE;
2738                 range.num_encoding_sizes = 1;
2739
2740                 if (priv->has_big_wep) {
2741                         range.encoding_size[1] = LARGE_KEY_SIZE;
2742                         range.num_encoding_sizes = 2;
2743                 }
2744         } else {
2745                 range.num_encoding_sizes = 0;
2746                 range.max_encoding_tokens = 0;
2747         }
2748         orinoco_unlock(priv, &flags);
2749
2750         range.min_pmp = 0;
2751         range.max_pmp = 65535000;
2752         range.min_pmt = 0;
2753         range.max_pmt = 65535 * 1000;   /* ??? */
2754         range.pmp_flags = IW_POWER_PERIOD;
2755         range.pmt_flags = IW_POWER_TIMEOUT;
2756         range.pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_UNICAST_R;
2757
2758         range.num_txpower = 1;
2759         range.txpower[0] = 15; /* 15dBm */
2760         range.txpower_capa = IW_TXPOW_DBM;
2761
2762         range.retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
2763         range.retry_flags = IW_RETRY_LIMIT;
2764         range.r_time_flags = IW_RETRY_LIFETIME;
2765         range.min_retry = 0;
2766         range.max_retry = 65535;        /* ??? */
2767         range.min_r_time = 0;
2768         range.max_r_time = 65535 * 1000;        /* ??? */
2769
2770         if (copy_to_user(rrq->pointer, &range, sizeof(range)))
2771                 return -EFAULT;
2772
2773         TRACE_EXIT(dev->name);
2774
2775         return 0;
2776 }
2777
2778 static int orinoco_ioctl_setiwencode(struct net_device *dev, struct iw_point *erq)
2779 {
2780         struct orinoco_private *priv = netdev_priv(dev);
2781         int index = (erq->flags & IW_ENCODE_INDEX) - 1;
2782         int setindex = priv->tx_key;
2783         int enable = priv->wep_on;
2784         int restricted = priv->wep_restrict;
2785         u16 xlen = 0;
2786         int err = 0;
2787         char keybuf[ORINOCO_MAX_KEY_SIZE];
2788         unsigned long flags;
2789
2790         if (! priv->has_wep)
2791                 return -EOPNOTSUPP;
2792
2793         if (erq->pointer) {
2794                 /* We actually have a key to set - check its length */
2795                 if (erq->length > LARGE_KEY_SIZE)
2796                         return -E2BIG;
2797
2798                 if ( (erq->length > SMALL_KEY_SIZE) && !priv->has_big_wep )
2799                         return -E2BIG;
2800
2801                 if (copy_from_user(keybuf, erq->pointer, erq->length))
2802                         return -EFAULT;
2803         }
2804
2805         if (orinoco_lock(priv, &flags) != 0)
2806                 return -EBUSY;
2807
2808         if (erq->pointer) {
2809                 if ((index < 0) || (index >= ORINOCO_MAX_KEYS))
2810                         index = priv->tx_key;
2811
2812                 /* Adjust key length to a supported value */
2813                 if (erq->length > SMALL_KEY_SIZE) {
2814                         xlen = LARGE_KEY_SIZE;
2815                 } else if (erq->length > 0) {
2816                         xlen = SMALL_KEY_SIZE;
2817                 } else
2818                         xlen = 0;
2819
2820                 /* Switch on WEP if off */
2821                 if ((!enable) && (xlen > 0)) {
2822                         setindex = index;
2823                         enable = 1;
2824                 }
2825         } else {
2826                 /* Important note : if the user do "iwconfig eth0 enc off",
2827                  * we will arrive there with an index of -1. This is valid
2828                  * but need to be taken care off... Jean II */
2829                 if ((index < 0) || (index >= ORINOCO_MAX_KEYS)) {
2830                         if((index != -1) || (erq->flags == 0)) {
2831                                 err = -EINVAL;
2832                                 goto out;
2833                         }
2834                 } else {
2835                         /* Set the index : Check that the key is valid */
2836                         if(priv->keys[index].len == 0) {
2837                                 err = -EINVAL;
2838                                 goto out;
2839                         }
2840                         setindex = index;
2841                 }
2842         }
2843
2844         if (erq->flags & IW_ENCODE_DISABLED)
2845                 enable = 0;
2846         if (erq->flags & IW_ENCODE_OPEN)
2847                 restricted = 0;
2848         if (erq->flags & IW_ENCODE_RESTRICTED)
2849                 restricted = 1;
2850
2851         if (erq->pointer) {
2852                 priv->keys[index].len = cpu_to_le16(xlen);
2853                 memset(priv->keys[index].data, 0,
2854                        sizeof(priv->keys[index].data));
2855                 memcpy(priv->keys[index].data, keybuf, erq->length);
2856         }
2857         priv->tx_key = setindex;
2858
2859         /* Try fast key change if connected and only keys are changed */
2860         if (priv->wep_on && enable && (priv->wep_restrict == restricted) &&
2861             netif_carrier_ok(dev)) {
2862                 err = __orinoco_hw_setup_wepkeys(priv);
2863                 /* No need to commit if successful */
2864                 goto out;
2865         }
2866
2867         priv->wep_on = enable;
2868         priv->wep_restrict = restricted;
2869
2870  out:
2871         orinoco_unlock(priv, &flags);
2872
2873         return err;
2874 }
2875
2876 static int orinoco_ioctl_getiwencode(struct net_device *dev, struct iw_point *erq)
2877 {
2878         struct orinoco_private *priv = netdev_priv(dev);
2879         int index = (erq->flags & IW_ENCODE_INDEX) - 1;
2880         u16 xlen = 0;
2881         char keybuf[ORINOCO_MAX_KEY_SIZE];
2882         unsigned long flags;
2883
2884         if (! priv->has_wep)
2885                 return -EOPNOTSUPP;
2886
2887         if (orinoco_lock(priv, &flags) != 0)
2888                 return -EBUSY;
2889
2890         if ((index < 0) || (index >= ORINOCO_MAX_KEYS))
2891                 index = priv->tx_key;
2892
2893         erq->flags = 0;
2894         if (! priv->wep_on)
2895                 erq->flags |= IW_ENCODE_DISABLED;
2896         erq->flags |= index + 1;
2897
2898         if (priv->wep_restrict)
2899                 erq->flags |= IW_ENCODE_RESTRICTED;
2900         else
2901                 erq->flags |= IW_ENCODE_OPEN;
2902
2903         xlen = le16_to_cpu(priv->keys[index].len);
2904
2905         erq->length = xlen;
2906
2907         memcpy(keybuf, priv->keys[index].data, ORINOCO_MAX_KEY_SIZE);
2908
2909         orinoco_unlock(priv, &flags);
2910
2911         if (erq->pointer) {
2912                 if (copy_to_user(erq->pointer, keybuf, xlen))
2913                         return -EFAULT;
2914         }
2915
2916         return 0;
2917 }
2918
2919 static int orinoco_ioctl_setessid(struct net_device *dev, struct iw_point *erq)
2920 {
2921         struct orinoco_private *priv = netdev_priv(dev);
2922         char essidbuf[IW_ESSID_MAX_SIZE+1];
2923         unsigned long flags;
2924
2925         /* Note : ESSID is ignored in Ad-Hoc demo mode, but we can set it
2926          * anyway... - Jean II */
2927
2928         memset(&essidbuf, 0, sizeof(essidbuf));
2929
2930         if (erq->flags) {
2931                 if (erq->length > IW_ESSID_MAX_SIZE)
2932                         return -E2BIG;
2933
2934                 if (copy_from_user(&essidbuf, erq->pointer, erq->length))
2935                         return -EFAULT;
2936
2937                 essidbuf[erq->length] = '\0';
2938         }
2939
2940         if (orinoco_lock(priv, &flags) != 0)
2941                 return -EBUSY;
2942
2943         memcpy(priv->desired_essid, essidbuf, sizeof(priv->desired_essid));
2944
2945         orinoco_unlock(priv, &flags);
2946
2947         return 0;
2948 }
2949
2950 static int orinoco_ioctl_getessid(struct net_device *dev, struct iw_point *erq)
2951 {
2952         struct orinoco_private *priv = netdev_priv(dev);
2953         char essidbuf[IW_ESSID_MAX_SIZE+1];
2954         int active;
2955         int err = 0;
2956         unsigned long flags;
2957
2958         TRACE_ENTER(dev->name);
2959
2960         if (netif_running(dev)) {
2961                 err = orinoco_hw_get_essid(priv, &active, essidbuf);
2962                 if (err)
2963                         return err;
2964         } else {
2965                 if (orinoco_lock(priv, &flags) != 0)
2966                         return -EBUSY;
2967                 memcpy(essidbuf, priv->desired_essid, sizeof(essidbuf));
2968                 orinoco_unlock(priv, &flags);
2969         }
2970
2971         erq->flags = 1;
2972         erq->length = strlen(essidbuf) + 1;
2973         if (erq->pointer)
2974                 if (copy_to_user(erq->pointer, essidbuf, erq->length))
2975                         return -EFAULT;
2976
2977         TRACE_EXIT(dev->name);
2978
2979         return 0;
2980 }
2981
2982 static int orinoco_ioctl_setnick(struct net_device *dev, struct iw_point *nrq)
2983 {
2984         struct orinoco_private *priv = netdev_priv(dev);
2985         char nickbuf[IW_ESSID_MAX_SIZE+1];
2986         unsigned long flags;
2987
2988         if (nrq->length > IW_ESSID_MAX_SIZE)
2989                 return -E2BIG;
2990
2991         memset(nickbuf, 0, sizeof(nickbuf));
2992
2993         if (copy_from_user(nickbuf, nrq->pointer, nrq->length))
2994                 return -EFAULT;
2995
2996         nickbuf[nrq->length] = '\0';
2997
2998         if (orinoco_lock(priv, &flags) != 0)
2999                 return -EBUSY;
3000
3001         memcpy(priv->nick, nickbuf, sizeof(priv->nick));
3002
3003         orinoco_unlock(priv, &flags);
3004
3005         return 0;
3006 }
3007
3008 static int orinoco_ioctl_getnick(struct net_device *dev, struct iw_point *nrq)
3009 {
3010         struct orinoco_private *priv = netdev_priv(dev);
3011         char nickbuf[IW_ESSID_MAX_SIZE+1];
3012         unsigned long flags;
3013
3014         if (orinoco_lock(priv, &flags) != 0)
3015                 return -EBUSY;
3016
3017         memcpy(nickbuf, priv->nick, IW_ESSID_MAX_SIZE+1);
3018         orinoco_unlock(priv, &flags);
3019
3020         nrq->length = strlen(nickbuf)+1;
3021
3022         if (copy_to_user(nrq->pointer, nickbuf, sizeof(nickbuf)))
3023                 return -EFAULT;
3024
3025         return 0;
3026 }
3027
3028 static int orinoco_ioctl_setfreq(struct net_device *dev, struct iw_freq *frq)
3029 {
3030         struct orinoco_private *priv = netdev_priv(dev);
3031         int chan = -1;
3032         unsigned long flags;
3033
3034         /* We can only use this in Ad-Hoc demo mode to set the operating
3035          * frequency, or in IBSS mode to set the frequency where the IBSS
3036          * will be created - Jean II */
3037         if (priv->iw_mode != IW_MODE_ADHOC)
3038                 return -EOPNOTSUPP;
3039
3040         if ( (frq->e == 0) && (frq->m <= 1000) ) {
3041                 /* Setting by channel number */
3042                 chan = frq->m;
3043         } else {
3044                 /* Setting by frequency - search the table */
3045                 int mult = 1;
3046                 int i;
3047
3048                 for (i = 0; i < (6 - frq->e); i++)
3049                         mult *= 10;
3050
3051                 for (i = 0; i < NUM_CHANNELS; i++)
3052                         if (frq->m == (channel_frequency[i] * mult))
3053                                 chan = i+1;
3054         }
3055
3056         if ( (chan < 1) || (chan > NUM_CHANNELS) ||
3057              ! (priv->channel_mask & (1 << (chan-1)) ) )
3058                 return -EINVAL;
3059
3060         if (orinoco_lock(priv, &flags) != 0)
3061                 return -EBUSY;
3062         priv->channel = chan;
3063         orinoco_unlock(priv, &flags);
3064
3065         return 0;
3066 }
3067
3068 static int orinoco_ioctl_getsens(struct net_device *dev, struct iw_param *srq)
3069 {
3070         struct orinoco_private *priv = netdev_priv(dev);
3071         hermes_t *hw = &priv->hw;
3072         u16 val;
3073         int err;
3074         unsigned long flags;
3075
3076         if (!priv->has_sensitivity)
3077                 return -EOPNOTSUPP;
3078
3079         if (orinoco_lock(priv, &flags) != 0)
3080                 return -EBUSY;
3081         err = hermes_read_wordrec(hw, USER_BAP,
3082                                   HERMES_RID_CNFSYSTEMSCALE, &val);
3083         orinoco_unlock(priv, &flags);
3084
3085         if (err)
3086                 return err;
3087
3088         srq->value = val;
3089         srq->fixed = 0; /* auto */
3090
3091         return 0;
3092 }
3093
3094 static int orinoco_ioctl_setsens(struct net_device *dev, struct iw_param *srq)
3095 {
3096         struct orinoco_private *priv = netdev_priv(dev);
3097         int val = srq->value;
3098         unsigned long flags;
3099
3100         if (!priv->has_sensitivity)
3101                 return -EOPNOTSUPP;
3102
3103         if ((val < 1) || (val > 3))
3104                 return -EINVAL;
3105
3106         if (orinoco_lock(priv, &flags) != 0)
3107                 return -EBUSY;
3108         priv->ap_density = val;
3109         orinoco_unlock(priv, &flags);
3110
3111         return 0;
3112 }
3113
3114 static int orinoco_ioctl_setrts(struct net_device *dev, struct iw_param *rrq)
3115 {
3116         struct orinoco_private *priv = netdev_priv(dev);
3117         int val = rrq->value;
3118         unsigned long flags;
3119
3120         if (rrq->disabled)
3121                 val = 2347;
3122
3123         if ( (val < 0) || (val > 2347) )
3124                 return -EINVAL;
3125
3126         if (orinoco_lock(priv, &flags) != 0)
3127                 return -EBUSY;
3128
3129         priv->rts_thresh = val;
3130         orinoco_unlock(priv, &flags);
3131
3132         return 0;
3133 }
3134
3135 static int orinoco_ioctl_setfrag(struct net_device *dev, struct iw_param *frq)
3136 {
3137         struct orinoco_private *priv = netdev_priv(dev);
3138         int err = 0;
3139         unsigned long flags;
3140
3141         if (orinoco_lock(priv, &flags) != 0)
3142                 return -EBUSY;
3143
3144         if (priv->has_mwo) {
3145                 if (frq->disabled)
3146                         priv->mwo_robust = 0;
3147                 else {
3148                         if (frq->fixed)
3149                                 printk(KERN_WARNING "%s: Fixed fragmentation is "
3150                                        "not supported on this firmware. "
3151                                        "Using MWO robust instead.\n", dev->name);
3152                         priv->mwo_robust = 1;
3153                 }
3154         } else {
3155                 if (frq->disabled)
3156                         priv->frag_thresh = 2346;
3157                 else {
3158                         if ( (frq->value < 256) || (frq->value > 2346) )
3159                                 err = -EINVAL;
3160                         else
3161                                 priv->frag_thresh = frq->value & ~0x1; /* must be even */
3162                 }
3163         }
3164
3165         orinoco_unlock(priv, &flags);
3166
3167         return err;
3168 }
3169
3170 static int orinoco_ioctl_getfrag(struct net_device *dev, struct iw_param *frq)
3171 {
3172         struct orinoco_private *priv = netdev_priv(dev);
3173         hermes_t *hw = &priv->hw;
3174         int err = 0;
3175         u16 val;
3176         unsigned long flags;
3177
3178         if (orinoco_lock(priv, &flags) != 0)
3179                 return -EBUSY;
3180
3181         if (priv->has_mwo) {
3182                 err = hermes_read_wordrec(hw, USER_BAP,
3183                                           HERMES_RID_CNFMWOROBUST_AGERE,
3184                                           &val);
3185                 if (err)
3186                         val = 0;
3187
3188                 frq->value = val ? 2347 : 0;
3189                 frq->disabled = ! val;
3190                 frq->fixed = 0;
3191         } else {
3192                 err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CNFFRAGMENTATIONTHRESHOLD,
3193                                           &val);
3194                 if (err)
3195                         val = 0;
3196
3197                 frq->value = val;
3198                 frq->disabled = (val >= 2346);
3199                 frq->fixed = 1;
3200         }
3201
3202         orinoco_unlock(priv, &flags);
3203
3204         return err;
3205 }
3206
3207 static int orinoco_ioctl_setrate(struct net_device *dev, struct iw_param *rrq)
3208 {
3209         struct orinoco_private *priv = netdev_priv(dev);
3210         int err = 0;
3211         int ratemode = -1;
3212         int bitrate; /* 100s of kilobits */
3213         int i;
3214         unsigned long flags;
3215
3216         /* As the user space doesn't know our highest rate, it uses -1
3217          * to ask us to set the highest rate.  Test it using "iwconfig
3218          * ethX rate auto" - Jean II */
3219         if (rrq->value == -1)
3220                 bitrate = 110;
3221         else {
3222                 if (rrq->value % 100000)
3223                         return -EINVAL;
3224                 bitrate = rrq->value / 100000;
3225         }
3226
3227         if ( (bitrate != 10) && (bitrate != 20) &&
3228              (bitrate != 55) && (bitrate != 110) )
3229                 return -EINVAL;
3230
3231         for (i = 0; i < BITRATE_TABLE_SIZE; i++)
3232                 if ( (bitrate_table[i].bitrate == bitrate) &&
3233                      (bitrate_table[i].automatic == ! rrq->fixed) ) {
3234                         ratemode = i;
3235                         break;
3236                 }
3237
3238         if (ratemode == -1)
3239                 return -EINVAL;
3240
3241         if (orinoco_lock(priv, &flags) != 0)
3242                 return -EBUSY;
3243         priv->bitratemode = ratemode;
3244         orinoco_unlock(priv, &flags);
3245
3246         return err;
3247 }
3248
3249 static int orinoco_ioctl_getrate(struct net_device *dev, struct iw_param *rrq)
3250 {
3251         struct orinoco_private *priv = netdev_priv(dev);
3252         hermes_t *hw = &priv->hw;
3253         int err = 0;
3254         int ratemode;
3255         int i;
3256         u16 val;
3257         unsigned long flags;
3258
3259         if (orinoco_lock(priv, &flags) != 0)
3260                 return -EBUSY;
3261
3262         ratemode = priv->bitratemode;
3263
3264         BUG_ON((ratemode < 0) || (ratemode >= BITRATE_TABLE_SIZE));
3265
3266         rrq->value = bitrate_table[ratemode].bitrate * 100000;
3267         rrq->fixed = ! bitrate_table[ratemode].automatic;
3268         rrq->disabled = 0;
3269
3270         /* If the interface is running we try to find more about the
3271            current mode */
3272         if (netif_running(dev)) {
3273                 err = hermes_read_wordrec(hw, USER_BAP,
3274                                           HERMES_RID_CURRENTTXRATE, &val);
3275                 if (err)
3276                         goto out;
3277
3278                 switch (priv->firmware_type) {
3279                 case FIRMWARE_TYPE_AGERE: /* Lucent style rate */
3280                         /* Note : in Lucent firmware, the return value of
3281                          * HERMES_RID_CURRENTTXRATE is the bitrate in Mb/s,
3282                          * and therefore is totally different from the
3283                          * encoding of HERMES_RID_CNFTXRATECONTROL.
3284                          * Don't forget that 6Mb/s is really 5.5Mb/s */
3285                         if (val == 6)
3286                                 rrq->value = 5500000;
3287                         else
3288                                 rrq->value = val * 1000000;
3289                         break;
3290                 case FIRMWARE_TYPE_INTERSIL: /* Intersil style rate */
3291                 case FIRMWARE_TYPE_SYMBOL: /* Symbol style rate */
3292                         for (i = 0; i < BITRATE_TABLE_SIZE; i++)
3293                                 if (bitrate_table[i].intersil_txratectrl == val) {
3294                                         ratemode = i;
3295                                         break;
3296                                 }
3297                         if (i >= BITRATE_TABLE_SIZE)
3298                                 printk(KERN_INFO "%s: Unable to determine current bitrate (0x%04hx)\n",
3299                                        dev->name, val);
3300
3301                         rrq->value = bitrate_table[ratemode].bitrate * 100000;
3302                         break;
3303                 default:
3304                         BUG();
3305                 }
3306         }
3307
3308  out:
3309         orinoco_unlock(priv, &flags);
3310
3311         return err;
3312 }
3313
3314 static int orinoco_ioctl_setpower(struct net_device *dev, struct iw_param *prq)
3315 {
3316         struct orinoco_private *priv = netdev_priv(dev);
3317         int err = 0;
3318         unsigned long flags;
3319
3320         if (orinoco_lock(priv, &flags) != 0)
3321                 return -EBUSY;
3322
3323         if (prq->disabled) {
3324                 priv->pm_on = 0;
3325         } else {
3326                 switch (prq->flags & IW_POWER_MODE) {
3327                 case IW_POWER_UNICAST_R:
3328                         priv->pm_mcast = 0;
3329                         priv->pm_on = 1;
3330                         break;
3331                 case IW_POWER_ALL_R:
3332                         priv->pm_mcast = 1;
3333                         priv->pm_on = 1;
3334                         break;
3335                 case IW_POWER_ON:
3336                         /* No flags : but we may have a value - Jean II */
3337                         break;
3338                 default:
3339                         err = -EINVAL;
3340                 }
3341                 if (err)
3342                         goto out;
3343
3344                 if (prq->flags & IW_POWER_TIMEOUT) {
3345                         priv->pm_on = 1;
3346                         priv->pm_timeout = prq->value / 1000;
3347                 }
3348                 if (prq->flags & IW_POWER_PERIOD) {
3349                         priv->pm_on = 1;
3350                         priv->pm_period = prq->value / 1000;
3351                 }
3352                 /* It's valid to not have a value if we are just toggling
3353                  * the flags... Jean II */
3354                 if(!priv->pm_on) {
3355                         err = -EINVAL;
3356                         goto out;
3357                 }
3358         }
3359
3360  out:
3361         orinoco_unlock(priv, &flags);
3362
3363         return err;
3364 }
3365
3366 static int orinoco_ioctl_getpower(struct net_device *dev, struct iw_param *prq)
3367 {
3368         struct orinoco_private *priv = netdev_priv(dev);
3369         hermes_t *hw = &priv->hw;
3370         int err = 0;
3371         u16 enable, period, timeout, mcast;
3372         unsigned long flags;
3373
3374         if (orinoco_lock(priv, &flags) != 0)
3375                 return -EBUSY;
3376
3377         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CNFPMENABLED, &enable);
3378         if (err)
3379                 goto out;
3380
3381         err = hermes_read_wordrec(hw, USER_BAP,
3382                                   HERMES_RID_CNFMAXSLEEPDURATION, &period);
3383         if (err)
3384                 goto out;
3385
3386         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CNFPMHOLDOVERDURATION, &timeout);
3387         if (err)
3388                 goto out;
3389
3390         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CNFMULTICASTRECEIVE, &mcast);
3391         if (err)
3392                 goto out;
3393
3394         prq->disabled = !enable;
3395         /* Note : by default, display the period */
3396         if ((prq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
3397                 prq->flags = IW_POWER_TIMEOUT;
3398                 prq->value = timeout * 1000;
3399         } else {
3400                 prq->flags = IW_POWER_PERIOD;
3401                 prq->value = period * 1000;
3402         }
3403         if (mcast)
3404                 prq->flags |= IW_POWER_ALL_R;
3405         else
3406                 prq->flags |= IW_POWER_UNICAST_R;
3407
3408  out:
3409         orinoco_unlock(priv, &flags);
3410
3411         return err;
3412 }
3413
3414 static int orinoco_ioctl_getretry(struct net_device *dev, struct iw_param *rrq)
3415 {
3416         struct orinoco_private *priv = netdev_priv(dev);
3417         hermes_t *hw = &priv->hw;
3418         int err = 0;
3419         u16 short_limit, long_limit, lifetime;
3420         unsigned long flags;
3421
3422         if (orinoco_lock(priv, &flags) != 0)
3423                 return -EBUSY;
3424
3425         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_SHORTRETRYLIMIT,
3426                                   &short_limit);
3427         if (err)
3428                 goto out;
3429
3430         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_LONGRETRYLIMIT,
3431                                   &long_limit);
3432         if (err)
3433                 goto out;
3434
3435         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_MAXTRANSMITLIFETIME,
3436                                   &lifetime);
3437         if (err)
3438                 goto out;
3439
3440         rrq->disabled = 0;              /* Can't be disabled */
3441
3442         /* Note : by default, display the retry number */
3443         if ((rrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
3444                 rrq->flags = IW_RETRY_LIFETIME;
3445                 rrq->value = lifetime * 1000;   /* ??? */
3446         } else {
3447                 /* By default, display the min number */
3448                 if ((rrq->flags & IW_RETRY_MAX)) {
3449                         rrq->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
3450                         rrq->value = long_limit;
3451                 } else {
3452                         rrq->flags = IW_RETRY_LIMIT;
3453                         rrq->value = short_limit;
3454                         if(short_limit != long_limit)
3455                                 rrq->flags |= IW_RETRY_MIN;
3456                 }
3457         }
3458
3459  out:
3460         orinoco_unlock(priv, &flags);
3461
3462         return err;
3463 }
3464
3465 static int orinoco_ioctl_setibssport(struct net_device *dev, struct iwreq *wrq)
3466 {
3467         struct orinoco_private *priv = netdev_priv(dev);
3468         int val = *( (int *) wrq->u.name );
3469         unsigned long flags;
3470
3471         if (orinoco_lock(priv, &flags) != 0)
3472                 return -EBUSY;
3473
3474         priv->ibss_port = val ;
3475
3476         /* Actually update the mode we are using */
3477         set_port_type(priv);
3478
3479         orinoco_unlock(priv, &flags);
3480         return 0;
3481 }
3482
3483 static int orinoco_ioctl_getibssport(struct net_device *dev, struct iwreq *wrq)
3484 {
3485         struct orinoco_private *priv = netdev_priv(dev);
3486         int *val = (int *)wrq->u.name;
3487         unsigned long flags;
3488
3489         if (orinoco_lock(priv, &flags) != 0)
3490                 return -EBUSY;
3491
3492         *val = priv->ibss_port;
3493         orinoco_unlock(priv, &flags);
3494
3495         return 0;
3496 }
3497
3498 static int orinoco_ioctl_setport3(struct net_device *dev, struct iwreq *wrq)
3499 {
3500         struct orinoco_private *priv = netdev_priv(dev);
3501         int val = *( (int *) wrq->u.name );
3502         int err = 0;
3503         unsigned long flags;
3504
3505         if (orinoco_lock(priv, &flags) != 0)
3506                 return -EBUSY;
3507
3508         switch (val) {
3509         case 0: /* Try to do IEEE ad-hoc mode */
3510                 if (! priv->has_ibss) {
3511                         err = -EINVAL;
3512                         break;
3513                 }
3514                 priv->prefer_port3 = 0;
3515
3516                 break;
3517
3518         case 1: /* Try to do Lucent proprietary ad-hoc mode */
3519                 if (! priv->has_port3) {
3520                         err = -EINVAL;
3521                         break;
3522                 }
3523                 priv->prefer_port3 = 1;
3524                 break;
3525
3526         default:
3527                 err = -EINVAL;
3528         }
3529
3530         if (! err)
3531                 /* Actually update the mode we are using */
3532                 set_port_type(priv);
3533
3534         orinoco_unlock(priv, &flags);
3535
3536         return err;
3537 }
3538
3539 static int orinoco_ioctl_getport3(struct net_device *dev, struct iwreq *wrq)
3540 {
3541         struct orinoco_private *priv = netdev_priv(dev);
3542         int *val = (int *)wrq->u.name;
3543         unsigned long flags;
3544
3545         if (orinoco_lock(priv, &flags) != 0)
3546                 return -EBUSY;
3547
3548         *val = priv->prefer_port3;
3549         orinoco_unlock(priv, &flags);
3550         return 0;
3551 }
3552
3553 /* Spy is used for link quality/strength measurements in Ad-Hoc mode
3554  * Jean II */
3555 static int orinoco_ioctl_setspy(struct net_device *dev, struct iw_point *srq)
3556 {
3557         struct orinoco_private *priv = netdev_priv(dev);
3558         struct sockaddr address[IW_MAX_SPY];
3559         int number = srq->length;
3560         int i;
3561         int err = 0;
3562         unsigned long flags;
3563
3564         /* Check the number of addresses */
3565         if (number > IW_MAX_SPY)
3566                 return -E2BIG;
3567
3568         /* Get the data in the driver */
3569         if (srq->pointer) {
3570                 if (copy_from_user(address, srq->pointer,
3571                                    sizeof(struct sockaddr) * number))
3572                         return -EFAULT;
3573         }
3574
3575         /* Make sure nobody mess with the structure while we do */
3576         if (orinoco_lock(priv, &flags) != 0)
3577                 return -EBUSY;
3578
3579         /* orinoco_lock() doesn't disable interrupts, so make sure the
3580          * interrupt rx path don't get confused while we copy */
3581         priv->spy_number = 0;
3582
3583         if (number > 0) {
3584                 /* Extract the addresses */
3585                 for (i = 0; i < number; i++)
3586                         memcpy(priv->spy_address[i], address[i].sa_data,
3587                                ETH_ALEN);
3588                 /* Reset stats */
3589                 memset(priv->spy_stat, 0,
3590                        sizeof(struct iw_quality) * IW_MAX_SPY);
3591                 /* Set number of addresses */
3592                 priv->spy_number = number;
3593         }
3594
3595         /* Now, let the others play */
3596         orinoco_unlock(priv, &flags);
3597
3598         return err;
3599 }
3600
3601 static int orinoco_ioctl_getspy(struct net_device *dev, struct iw_point *srq)
3602 {
3603         struct orinoco_private *priv = netdev_priv(dev);
3604         struct sockaddr address[IW_MAX_SPY];
3605         struct iw_quality spy_stat[IW_MAX_SPY];
3606         int number;
3607         int i;
3608         unsigned long flags;
3609
3610         if (orinoco_lock(priv, &flags) != 0)
3611                 return -EBUSY;
3612
3613         number = priv->spy_number;
3614         if ((number > 0) && (srq->pointer)) {
3615                 /* Create address struct */
3616                 for (i = 0; i < number; i++) {
3617                         memcpy(address[i].sa_data, priv->spy_address[i],
3618                                ETH_ALEN);
3619                         address[i].sa_family = AF_UNIX;
3620                 }
3621                 /* Copy stats */
3622                 /* In theory, we should disable irqs while copying the stats
3623                  * because the rx path might update it in the middle...
3624                  * Bah, who care ? - Jean II */
3625                 memcpy(&spy_stat, priv->spy_stat,
3626                        sizeof(struct iw_quality) * IW_MAX_SPY);
3627                 for (i=0; i < number; i++)
3628                         priv->spy_stat[i].updated = 0;
3629         }
3630
3631         orinoco_unlock(priv, &flags);
3632
3633         /* Push stuff to user space */
3634         srq->length = number;
3635         if(copy_to_user(srq->pointer, address,
3636                          sizeof(struct sockaddr) * number))
3637                 return -EFAULT;
3638         if(copy_to_user(srq->pointer + (sizeof(struct sockaddr)*number),
3639                         &spy_stat, sizeof(struct iw_quality) * number))
3640                 return -EFAULT;
3641
3642         return 0;
3643 }
3644
3645 static int
3646 orinoco_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
3647 {
3648         struct orinoco_private *priv = netdev_priv(dev);
3649         struct iwreq *wrq = (struct iwreq *)rq;
3650         int err = 0;
3651         int tmp;
3652         int changed = 0;
3653         unsigned long flags;
3654
3655         TRACE_ENTER(dev->name);
3656
3657         /* In theory, we could allow most of the the SET stuff to be
3658          * done. In practice, the lapse of time at startup when the
3659          * card is not ready is very short, so why bother...  Note
3660          * that netif_device_present is different from up/down
3661          * (ifconfig), when the device is not yet up, it is usually
3662          * already ready...  Jean II */
3663         if (! netif_device_present(dev))
3664                 return -ENODEV;
3665
3666         switch (cmd) {
3667         case SIOCGIWNAME:
3668                 strcpy(wrq->u.name, "IEEE 802.11-DS");
3669                 break;
3670
3671         case SIOCGIWAP:
3672                 wrq->u.ap_addr.sa_family = ARPHRD_ETHER;
3673                 err = orinoco_hw_get_bssid(priv, wrq->u.ap_addr.sa_data);
3674                 break;
3675
3676         case SIOCGIWRANGE:
3677                 err = orinoco_ioctl_getiwrange(dev, &wrq->u.data);
3678                 break;
3679
3680         case SIOCSIWMODE:
3681                 if (orinoco_lock(priv, &flags) != 0)
3682                         return -EBUSY;
3683                 switch (wrq->u.mode) {
3684                 case IW_MODE_ADHOC:
3685                         if (! (priv->has_ibss || priv->has_port3) )
3686                                 err = -EINVAL;
3687                         else {
3688                                 priv->iw_mode = IW_MODE_ADHOC;
3689                                 changed = 1;
3690                         }
3691                         break;
3692
3693                 case IW_MODE_INFRA:
3694                         priv->iw_mode = IW_MODE_INFRA;
3695                         changed = 1;
3696                         break;
3697
3698                 default:
3699                         err = -EINVAL;
3700                         break;
3701                 }
3702                 set_port_type(priv);
3703                 orinoco_unlock(priv, &flags);
3704                 break;
3705
3706         case SIOCGIWMODE:
3707                 if (orinoco_lock(priv, &flags) != 0)
3708                         return -EBUSY;
3709                 wrq->u.mode = priv->iw_mode;
3710                 orinoco_unlock(priv, &flags);
3711                 break;
3712
3713         case SIOCSIWENCODE:
3714                 err = orinoco_ioctl_setiwencode(dev, &wrq->u.encoding);
3715                 if (! err)
3716                         changed = 1;
3717                 break;
3718
3719         case SIOCGIWENCODE:
3720                 if (! capable(CAP_NET_ADMIN)) {
3721                         err = -EPERM;
3722                         break;
3723                 }
3724
3725                 err = orinoco_ioctl_getiwencode(dev, &wrq->u.encoding);
3726                 break;
3727
3728         case SIOCSIWESSID:
3729                 err = orinoco_ioctl_setessid(dev, &wrq->u.essid);
3730                 if (! err)
3731                         changed = 1;
3732                 break;
3733
3734         case SIOCGIWESSID:
3735                 err = orinoco_ioctl_getessid(dev, &wrq->u.essid);
3736                 break;
3737
3738         case SIOCSIWNICKN:
3739                 err = orinoco_ioctl_setnick(dev, &wrq->u.data);
3740                 if (! err)
3741                         changed = 1;
3742                 break;
3743
3744         case SIOCGIWNICKN:
3745                 err = orinoco_ioctl_getnick(dev, &wrq->u.data);
3746                 break;
3747
3748         case SIOCGIWFREQ:
3749                 tmp = orinoco_hw_get_freq(priv);
3750                 if (tmp < 0) {
3751                         err = tmp;
3752                 } else {
3753                         wrq->u.freq.m = tmp;
3754                         wrq->u.freq.e = 1;
3755                 }
3756                 break;
3757
3758         case SIOCSIWFREQ:
3759                 err = orinoco_ioctl_setfreq(dev, &wrq->u.freq);
3760                 if (! err)
3761                         changed = 1;
3762                 break;
3763
3764         case SIOCGIWSENS:
3765                 err = orinoco_ioctl_getsens(dev, &wrq->u.sens);
3766                 break;
3767
3768         case SIOCSIWSENS:
3769                 err = orinoco_ioctl_setsens(dev, &wrq->u.sens);
3770                 if (! err)
3771                         changed = 1;
3772                 break;
3773
3774         case SIOCGIWRTS:
3775                 wrq->u.rts.value = priv->rts_thresh;
3776                 wrq->u.rts.disabled = (wrq->u.rts.value == 2347);
3777                 wrq->u.rts.fixed = 1;
3778                 break;
3779
3780         case SIOCSIWRTS:
3781                 err = orinoco_ioctl_setrts(dev, &wrq->u.rts);
3782                 if (! err)
3783                         changed = 1;
3784                 break;
3785
3786         case SIOCSIWFRAG:
3787                 err = orinoco_ioctl_setfrag(dev, &wrq->u.frag);
3788                 if (! err)
3789                         changed = 1;
3790                 break;
3791
3792         case SIOCGIWFRAG:
3793                 err = orinoco_ioctl_getfrag(dev, &wrq->u.frag);
3794                 break;
3795
3796         case SIOCSIWRATE:
3797                 err = orinoco_ioctl_setrate(dev, &wrq->u.bitrate);
3798                 if (! err)
3799                         changed = 1;
3800                 break;
3801
3802         case SIOCGIWRATE:
3803                 err = orinoco_ioctl_getrate(dev, &wrq->u.bitrate);
3804                 break;
3805
3806         case SIOCSIWPOWER:
3807                 err = orinoco_ioctl_setpower(dev, &wrq->u.power);
3808                 if (! err)
3809                         changed = 1;
3810                 break;
3811
3812         case SIOCGIWPOWER:
3813                 err = orinoco_ioctl_getpower(dev, &wrq->u.power);
3814                 break;
3815
3816         case SIOCGIWTXPOW:
3817                 /* The card only supports one tx power, so this is easy */
3818                 wrq->u.txpower.value = 15; /* dBm */
3819                 wrq->u.txpower.fixed = 1;
3820                 wrq->u.txpower.disabled = 0;
3821                 wrq->u.txpower.flags = IW_TXPOW_DBM;
3822                 break;
3823
3824         case SIOCSIWRETRY:
3825                 err = -EOPNOTSUPP;
3826                 break;
3827
3828         case SIOCGIWRETRY:
3829                 err = orinoco_ioctl_getretry(dev, &wrq->u.retry);
3830                 break;
3831
3832         case SIOCSIWSPY:
3833                 err = orinoco_ioctl_setspy(dev, &wrq->u.data);
3834                 break;
3835
3836         case SIOCGIWSPY:
3837                 err = orinoco_ioctl_getspy(dev, &wrq->u.data);
3838                 break;
3839
3840         case SIOCGIWPRIV:
3841                 if (wrq->u.data.pointer) {
3842                         struct iw_priv_args privtab[] = {
3843                                 { SIOCIWFIRSTPRIV + 0x0, 0, 0, "force_reset" },
3844                                 { SIOCIWFIRSTPRIV + 0x1, 0, 0, "card_reset" },
3845                                 { SIOCIWFIRSTPRIV + 0x2,
3846                                   IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3847                                   0, "set_port3" },
3848                                 { SIOCIWFIRSTPRIV + 0x3, 0,
3849                                   IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3850                                   "get_port3" },
3851                                 { SIOCIWFIRSTPRIV + 0x4,
3852                                   IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3853                                   0, "set_preamble" },
3854                                 { SIOCIWFIRSTPRIV + 0x5, 0,
3855                                   IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3856                                   "get_preamble" },
3857                                 { SIOCIWFIRSTPRIV + 0x6,
3858                                   IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3859                                   0, "set_ibssport" },
3860                                 { SIOCIWFIRSTPRIV + 0x7, 0,
3861                                   IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3862                                   "get_ibssport" },
3863                         };
3864
3865                         wrq->u.data.length = sizeof(privtab) / sizeof(privtab[0]);
3866                         if (copy_to_user(wrq->u.data.pointer, privtab, sizeof(privtab)))
3867                                 err = -EFAULT;
3868                 }
3869                 break;
3870
3871         case SIOCIWFIRSTPRIV + 0x0: /* force_reset */
3872         case SIOCIWFIRSTPRIV + 0x1: /* card_reset */
3873                 if (! capable(CAP_NET_ADMIN)) {
3874                         err = -EPERM;
3875                         break;
3876                 }
3877
3878                 printk(KERN_DEBUG "%s: Force scheduling reset!\n", dev->name);
3879
3880                 schedule_work(&priv->reset_work);
3881                 break;
3882
3883         case SIOCIWFIRSTPRIV + 0x2: /* set_port3 */
3884                 if (! capable(CAP_NET_ADMIN)) {
3885                         err = -EPERM;
3886                         break;
3887                 }
3888
3889                 err = orinoco_ioctl_setport3(dev, wrq);
3890                 if (! err)
3891                         changed = 1;
3892                 break;
3893
3894         case SIOCIWFIRSTPRIV + 0x3: /* get_port3 */
3895                 err = orinoco_ioctl_getport3(dev, wrq);
3896                 break;
3897
3898         case SIOCIWFIRSTPRIV + 0x4: /* set_preamble */
3899                 if (! capable(CAP_NET_ADMIN)) {
3900                         err = -EPERM;
3901                         break;
3902                 }
3903
3904                 /* 802.11b has recently defined some short preamble.
3905                  * Basically, the Phy header has been reduced in size.
3906                  * This increase performance, especially at high rates
3907                  * (the preamble is transmitted at 1Mb/s), unfortunately
3908                  * this give compatibility troubles... - Jean II */
3909                 if(priv->has_preamble) {
3910                         int val = *( (int *) wrq->u.name );
3911
3912                         if (orinoco_lock(priv, &flags) != 0)
3913                                 return -EBUSY;
3914                         if (val)
3915                                 priv->preamble = 1;
3916                         else
3917                                 priv->preamble = 0;
3918                         orinoco_unlock(priv, &flags);
3919                         changed = 1;
3920                 } else
3921                         err = -EOPNOTSUPP;
3922                 break;
3923
3924         case SIOCIWFIRSTPRIV + 0x5: /* get_preamble */
3925                 if(priv->has_preamble) {
3926                         int *val = (int *)wrq->u.name;
3927
3928                         if (orinoco_lock(priv, &flags) != 0)
3929                                 return -EBUSY;
3930                         *val = priv->preamble;
3931                         orinoco_unlock(priv, &flags);
3932                 } else
3933                         err = -EOPNOTSUPP;
3934                 break;
3935         case SIOCIWFIRSTPRIV + 0x6: /* set_ibssport */
3936                 if (! capable(CAP_NET_ADMIN)) {
3937                         err = -EPERM;
3938                         break;
3939                 }
3940
3941                 err = orinoco_ioctl_setibssport(dev, wrq);
3942                 if (! err)
3943                         changed = 1;
3944                 break;
3945
3946         case SIOCIWFIRSTPRIV + 0x7: /* get_ibssport */
3947                 err = orinoco_ioctl_getibssport(dev, wrq);
3948                 break;
3949
3950         default:
3951                 err = -EOPNOTSUPP;
3952         }
3953
3954         if (! err && changed && netif_running(dev)) {
3955                 err = orinoco_reconfigure(dev);
3956         }
3957
3958         TRACE_EXIT(dev->name);
3959
3960         return err;
3961 }
3962
3963
3964 /********************************************************************/
3965 /* Debugging                                                        */
3966 /********************************************************************/
3967
3968 #if 0
3969 static void show_rx_frame(struct orinoco_rxframe_hdr *frame)
3970 {
3971         printk(KERN_DEBUG "RX descriptor:\n");
3972         printk(KERN_DEBUG "  status      = 0x%04x\n", frame->desc.status);
3973         printk(KERN_DEBUG "  time        = 0x%08x\n", frame->desc.time);
3974         printk(KERN_DEBUG "  silence     = 0x%02x\n", frame->desc.silence);
3975         printk(KERN_DEBUG "  signal      = 0x%02x\n", frame->desc.signal);
3976         printk(KERN_DEBUG "  rate        = 0x%02x\n", frame->desc.rate);
3977         printk(KERN_DEBUG "  rxflow      = 0x%02x\n", frame->desc.rxflow);
3978         printk(KERN_DEBUG "  reserved    = 0x%08x\n", frame->desc.reserved);
3979
3980         printk(KERN_DEBUG "IEEE 802.11 header:\n");
3981         printk(KERN_DEBUG "  frame_ctl   = 0x%04x\n",
3982                frame->p80211.frame_ctl);
3983         printk(KERN_DEBUG "  duration_id = 0x%04x\n",
3984                frame->p80211.duration_id);
3985         printk(KERN_DEBUG "  addr1       = %02x:%02x:%02x:%02x:%02x:%02x\n",
3986                frame->p80211.addr1[0], frame->p80211.addr1[1],
3987                frame->p80211.addr1[2], frame->p80211.addr1[3],
3988                frame->p80211.addr1[4], frame->p80211.addr1[5]);
3989         printk(KERN_DEBUG "  addr2       = %02x:%02x:%02x:%02x:%02x:%02x\n",
3990                frame->p80211.addr2[0], frame->p80211.addr2[1],
3991                frame->p80211.addr2[2], frame->p80211.addr2[3],
3992                frame->p80211.addr2[4], frame->p80211.addr2[5]);
3993         printk(KERN_DEBUG "  addr3       = %02x:%02x:%02x:%02x:%02x:%02x\n",
3994                frame->p80211.addr3[0], frame->p80211.addr3[1],
3995                frame->p80211.addr3[2], frame->p80211.addr3[3],
3996                frame->p80211.addr3[4], frame->p80211.addr3[5]);
3997         printk(KERN_DEBUG "  seq_ctl     = 0x%04x\n",
3998                frame->p80211.seq_ctl);
3999         printk(KERN_DEBUG "  addr4       = %02x:%02x:%02x:%02x:%02x:%02x\n",
4000                frame->p80211.addr4[0], frame->p80211.addr4[1],
4001                frame->p80211.addr4[2], frame->p80211.addr4[3],
4002                frame->p80211.addr4[4], frame->p80211.addr4[5]);
4003         printk(KERN_DEBUG "  data_len    = 0x%04x\n",
4004                frame->p80211.data_len);
4005
4006         printk(KERN_DEBUG "IEEE 802.3 header:\n");
4007         printk(KERN_DEBUG "  dest        = %02x:%02x:%02x:%02x:%02x:%02x\n",
4008                frame->p8023.h_dest[0], frame->p8023.h_dest[1],
4009                frame->p8023.h_dest[2], frame->p8023.h_dest[3],
4010                frame->p8023.h_dest[4], frame->p8023.h_dest[5]);
4011         printk(KERN_DEBUG "  src         = %02x:%02x:%02x:%02x:%02x:%02x\n",
4012                frame->p8023.h_source[0], frame->p8023.h_source[1],
4013                frame->p8023.h_source[2], frame->p8023.h_source[3],
4014                frame->p8023.h_source[4], frame->p8023.h_source[5]);
4015         printk(KERN_DEBUG "  len         = 0x%04x\n", frame->p8023.h_proto);
4016
4017         printk(KERN_DEBUG "IEEE 802.2 LLC/SNAP header:\n");
4018         printk(KERN_DEBUG "  DSAP        = 0x%02x\n", frame->p8022.dsap);
4019         printk(KERN_DEBUG "  SSAP        = 0x%02x\n", frame->p8022.ssap);
4020         printk(KERN_DEBUG "  ctrl        = 0x%02x\n", frame->p8022.ctrl);
4021         printk(KERN_DEBUG "  OUI         = %02x:%02x:%02x\n",
4022                frame->p8022.oui[0], frame->p8022.oui[1], frame->p8022.oui[2]);
4023         printk(KERN_DEBUG "  ethertype  = 0x%04x\n", frame->ethertype);
4024 }
4025 #endif /* 0 */
4026
4027 /********************************************************************/
4028 /* Module initialization                                            */
4029 /********************************************************************/
4030
4031 EXPORT_SYMBOL(alloc_orinocodev);
4032 EXPORT_SYMBOL(free_orinocodev);
4033
4034 EXPORT_SYMBOL(__orinoco_up);
4035 EXPORT_SYMBOL(__orinoco_down);
4036 EXPORT_SYMBOL(orinoco_stop);
4037 EXPORT_SYMBOL(orinoco_reinit_firmware);
4038
4039 EXPORT_SYMBOL(orinoco_interrupt);
4040
4041 /* Can't be declared "const" or the whole __initdata section will
4042  * become const */
4043 static char version[] __initdata = DRIVER_NAME " " DRIVER_VERSION
4044         " (David Gibson <hermes@gibson.dropbear.id.au>, "
4045         "Pavel Roskin <proski@gnu.org>, et al)";
4046
4047 static int __init init_orinoco(void)
4048 {
4049         printk(KERN_DEBUG "%s\n", version);
4050         return 0;
4051 }
4052
4053 static void __exit exit_orinoco(void)
4054 {
4055 }
4056
4057 module_init(init_orinoco);
4058 module_exit(exit_orinoco);