/******************************************************************************

  Copyright(c) 2003 - 2006 Intel Corporation. All rights reserved.

  This program is free software; you can redistribute it and/or modify it
  under the terms of version 2 of the GNU General Public License as
  published by the Free Software Foundation.

  This program is distributed in the hope that it will be useful, but WITHOUT
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  more details.

  You should have received a copy of the GNU General Public License along with
  this program; if not, write to the Free Software Foundation, Inc., 59
  Temple Place - Suite 330, Boston, MA  02111-1307, USA.

  The full GNU General Public License is included in this distribution in the
  file called LICENSE.

  Contact Information:
  Intel Linux Wireless <ilw@linux.intel.com>
  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497

  Portions of this file are based on the sample_* files provided by Wireless
  Extensions 0.26 package and copyright (c) 1997-2003 Jean Tourrilhes
  <jt@hpl.hp.com>

  Portions of this file are based on the Host AP project,
  Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen
    <j@w1.fi>
  Copyright (c) 2002-2003, Jouni Malinen <j@w1.fi>

  Portions of ipw2100_mod_firmware_load, ipw2100_do_mod_firmware_load, and
  ipw2100_fw_load are loosely based on drivers/sound/sound_firmware.c
  available in the 2.4.25 kernel sources, and are copyright (c) Alan Cox

******************************************************************************/
/*

 Initial driver on which this is based was developed by Janusz Gorycki,
 Maciej Urbaniak, and Maciej Sosnowski.

 Promiscuous mode support added by Jacek Wysoczynski and Maciej Urbaniak.

Theory of Operation

Tx - Commands and Data

Firmware and host share a circular queue of Transmit Buffer Descriptors (TBDs)
Each TBD contains a pointer to the physical (dma_addr_t) address of data being
sent to the firmware as well as the length of the data.

The host writes to the TBD queue at the WRITE index.  The WRITE index points
to the _next_ packet to be written and is advanced when after the TBD has been
filled.

The firmware pulls from the TBD queue at the READ index.  The READ index points
to the currently being read entry, and is advanced once the firmware is
done with a packet.

When data is sent to the firmware, the first TBD is used to indicate to the
firmware if a Command or Data is being sent.  If it is Command, all of the
command information is contained within the physical address referred to by the
TBD.  If it is Data, the first TBD indicates the type of data packet, number
of fragments, etc.  The next TBD then refers to the actual packet location.

The Tx flow cycle is as follows:

1) ipw2100_tx() is called by kernel with SKB to transmit
2) Packet is move from the tx_free_list and appended to the transmit pending
   list (tx_pend_list)
3) work is scheduled to move pending packets into the shared circular queue.
4) when placing packet in the circular queue, the incoming SKB is DMA mapped
   to a physical address.  That address is entered into a TBD.  Two TBDs are
   filled out.  The first indicating a data packet, the second referring to the
   actual payload data.
5) the packet is removed from tx_pend_list and placed on the end of the
   firmware pending list (fw_pend_list)
6) firmware is notified that the WRITE index has
7) Once the firmware has processed the TBD, INTA is triggered.
8) For each Tx interrupt received from the firmware, the READ index is checked
   to see which TBDs are done being processed.
9) For each TBD that has been processed, the ISR pulls the oldest packet
   from the fw_pend_list.
10)The packet structure contained in the fw_pend_list is then used
   to unmap the DMA address and to free the SKB originally passed to the driver
   from the kernel.
11)The packet structure is placed onto the tx_free_list

The above steps are the same for commands, only the msg_free_list/msg_pend_list
are used instead of tx_free_list/tx_pend_list

...

Critical Sections / Locking :

There are two locks utilized.  The first is the low level lock (priv->low_lock)
that protects the following:

- Access to the Tx/Rx queue lists via priv->low_lock. The lists are as follows:

  tx_free_list : Holds pre-allocated Tx buffers.
    TAIL modified in __ipw2100_tx_process()
    HEAD modified in ipw2100_tx()

  tx_pend_list : Holds used Tx buffers waiting to go into the TBD ring
    TAIL modified ipw2100_tx()
    HEAD modified by ipw2100_tx_send_data()

  msg_free_list : Holds pre-allocated Msg (Command) buffers
    TAIL modified in __ipw2100_tx_process()
    HEAD modified in ipw2100_hw_send_command()

  msg_pend_list : Holds used Msg buffers waiting to go into the TBD ring
    TAIL modified in ipw2100_hw_send_command()
    HEAD modified in ipw2100_tx_send_commands()

  The flow of data on the TX side is as follows:

  MSG_FREE_LIST + COMMAND => MSG_PEND_LIST => TBD => MSG_FREE_LIST
  TX_FREE_LIST + DATA => TX_PEND_LIST => TBD => TX_FREE_LIST

  The methods that work on the TBD ring are protected via priv->low_lock.

- The internal data state of the device itself
- Access to the firmware read/write indexes for the BD queues
  and associated logic

All external entry functions are locked with the priv->action_lock to ensure
that only one external action is invoked at a time.


*/

#include <linux/compiler.h>
#include <linux/errno.h>
#include <linux/if_arp.h>
#include <linux/in6.h>
#include <linux/in.h>
#include <linux/ip.h>
#include <linux/kernel.h>
#include <linux/kmod.h>
#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/ethtool.h>
#include <linux/pci.h>
#include <linux/dma-mapping.h>
#include <linux/proc_fs.h>
#include <linux/skbuff.h>
#include <linux/uaccess.h>
#include <asm/io.h>
#include <linux/fs.h>
#include <linux/mm.h>
#include <linux/slab.h>
#include <linux/unistd.h>
#include <linux/stringify.h>
#include <linux/tcp.h>
#include <linux/types.h>
#include <linux/time.h>
#include <linux/firmware.h>
#include <linux/acpi.h>
#include <linux/ctype.h>
#include <linux/pm_qos.h>

#include <net/lib80211.h>

#include "ipw2100.h"
#include "ipw.h"

#define IPW2100_VERSION "git-1.2.2"

#define DRV_NAME        "ipw2100"
#define DRV_VERSION     IPW2100_VERSION
#define DRV_DESCRIPTION "Intel(R) PRO/Wireless 2100 Network Driver"
#define DRV_COPYRIGHT   "Copyright(c) 2003-2006 Intel Corporation"

static struct pm_qos_request ipw2100_pm_qos_req;

/* Debugging stuff */
#ifdef CONFIG_IPW2100_DEBUG
#define IPW2100_RX_DEBUG        /* Reception debugging */
#endif

MODULE_DESCRIPTION(DRV_DESCRIPTION);
MODULE_VERSION(DRV_VERSION);
MODULE_AUTHOR(DRV_COPYRIGHT);
MODULE_LICENSE("GPL");

static int debug = 0;
static int network_mode = 0;
static int channel = 0;
static int associate = 0;
static int disable = 0;
#ifdef CONFIG_PM
static struct ipw2100_fw ipw2100_firmware;
#endif

#include <linux/moduleparam.h>
module_param(debug, int, 0444);
module_param_named(mode, network_mode, int, 0444);
module_param(channel, int, 0444);
module_param(associate, int, 0444);
module_param(disable, int, 0444);

MODULE_PARM_DESC(debug, "debug level");
MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
MODULE_PARM_DESC(channel, "channel");
MODULE_PARM_DESC(associate, "auto associate when scanning (default off)");
MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");

static u32 ipw2100_debug_level = IPW_DL_NONE;

#ifdef CONFIG_IPW2100_DEBUG
#define IPW_DEBUG(level, message...) \
do { \
        if (ipw2100_debug_level & (level)) { \
                printk(KERN_DEBUG "ipw2100: %c %s ", \
                       in_interrupt() ? 'I' : 'U',  __func__); \
                printk(message); \
        } \
} while (0)
#else
#define IPW_DEBUG(level, message...) do {} while (0)
#endif                          /* CONFIG_IPW2100_DEBUG */

#ifdef CONFIG_IPW2100_DEBUG
static const char *command_types[] = {
        "undefined",
        "unused",               /* HOST_ATTENTION */
        "HOST_COMPLETE",
        "unused",               /* SLEEP */
        "unused",               /* HOST_POWER_DOWN */
        "unused",
        "SYSTEM_CONFIG",
        "unused",               /* SET_IMR */
        "SSID",
        "MANDATORY_BSSID",
        "AUTHENTICATION_TYPE",
        "ADAPTER_ADDRESS",
        "PORT_TYPE",
        "INTERNATIONAL_MODE",
        "CHANNEL",
        "RTS_THRESHOLD",
        "FRAG_THRESHOLD",
        "POWER_MODE",
        "TX_RATES",
        "BASIC_TX_RATES",
        "WEP_KEY_INFO",
        "unused",
        "unused",
        "unused",
        "unused",
        "WEP_KEY_INDEX",
        "WEP_FLAGS",
        "ADD_MULTICAST",
        "CLEAR_ALL_MULTICAST",
        "BEACON_INTERVAL",
        "ATIM_WINDOW",
        "CLEAR_STATISTICS",
        "undefined",
        "undefined",
        "undefined",
        "undefined",
        "TX_POWER_INDEX",
        "undefined",
        "undefined",
        "undefined",
        "undefined",
        "undefined",
        "undefined",
        "BROADCAST_SCAN",
        "CARD_DISABLE",
        "PREFERRED_BSSID",
        "SET_SCAN_OPTIONS",
        "SCAN_DWELL_TIME",
        "SWEEP_TABLE",
        "AP_OR_STATION_TABLE",
        "GROUP_ORDINALS",
        "SHORT_RETRY_LIMIT",
        "LONG_RETRY_LIMIT",
        "unused",               /* SAVE_CALIBRATION */
        "unused",               /* RESTORE_CALIBRATION */
        "undefined",
        "undefined",
        "undefined",
        "HOST_PRE_POWER_DOWN",
        "unused",               /* HOST_INTERRUPT_COALESCING */
        "undefined",
        "CARD_DISABLE_PHY_OFF",
        "MSDU_TX_RATES",
        "undefined",
        "SET_STATION_STAT_BITS",
        "CLEAR_STATIONS_STAT_BITS",
        "LEAP_ROGUE_MODE",
        "SET_SECURITY_INFORMATION",
        "DISASSOCIATION_BSSID",
        "SET_WPA_ASS_IE"
};
#endif

static const long ipw2100_frequencies[] = {
        2412, 2417, 2422, 2427,
        2432, 2437, 2442, 2447,
        2452, 2457, 2462, 2467,
        2472, 2484
};

#define FREQ_COUNT      ARRAY_SIZE(ipw2100_frequencies)

static struct ieee80211_rate ipw2100_bg_rates[] = {
        { .bitrate = 10 },
        { .bitrate = 20, .flags = IEEE80211_RATE_SHORT_PREAMBLE },
        { .bitrate = 55, .flags = IEEE80211_RATE_SHORT_PREAMBLE },
        { .bitrate = 110, .flags = IEEE80211_RATE_SHORT_PREAMBLE },
};

#define RATE_COUNT ARRAY_SIZE(ipw2100_bg_rates)

/* Pre-decl until we get the code solid and then we can clean it up */
static void ipw2100_tx_send_commands(struct ipw2100_priv *priv);
static void ipw2100_tx_send_data(struct ipw2100_priv *priv);
static int ipw2100_adapter_setup(struct ipw2100_priv *priv);

static void ipw2100_queues_initialize(struct ipw2100_priv *priv);
static void ipw2100_queues_free(struct ipw2100_priv *priv);
static int ipw2100_queues_allocate(struct ipw2100_priv *priv);

static int ipw2100_fw_download(struct ipw2100_priv *priv,
                               struct ipw2100_fw *fw);
static int ipw2100_get_firmware(struct ipw2100_priv *priv,
                                struct ipw2100_fw *fw);
static int ipw2100_get_fwversion(struct ipw2100_priv *priv, char *buf,
                                 size_t max);
static int ipw2100_get_ucodeversion(struct ipw2100_priv *priv, char *buf,
                                    size_t max);
static void ipw2100_release_firmware(struct ipw2100_priv *priv,
                                     struct ipw2100_fw *fw);
static int ipw2100_ucode_download(struct ipw2100_priv *priv,
                                  struct ipw2100_fw *fw);
static void ipw2100_wx_event_work(struct work_struct *work);
static struct iw_statistics *ipw2100_wx_wireless_stats(struct net_device *dev);
static const struct iw_handler_def ipw2100_wx_handler_def;

static inline void read_register(struct net_device *dev, u32 reg, u32 * val)
{
        struct ipw2100_priv *priv = libipw_priv(dev);

        *val = ioread32(priv->ioaddr + reg);
        IPW_DEBUG_IO("r: 0x%08X => 0x%08X\n", reg, *val);
}

static inline void write_register(struct net_device *dev, u32 reg, u32 val)
{
        struct ipw2100_priv *priv = libipw_priv(dev);

        iowrite32(val, priv->ioaddr + reg);
        IPW_DEBUG_IO("w: 0x%08X <= 0x%08X\n", reg, val);
}

static inline void read_register_word(struct net_device *dev, u32 reg,
                                      u16 * val)
{
        struct ipw2100_priv *priv = libipw_priv(dev);

        *val = ioread16(priv->ioaddr + reg);
        IPW_DEBUG_IO("r: 0x%08X => %04X\n", reg, *val);
}

static inline void read_register_byte(struct net_device *dev, u32 reg, u8 * val)
{
        struct ipw2100_priv *priv = libipw_priv(dev);

        *val = ioread8(priv->ioaddr + reg);
        IPW_DEBUG_IO("r: 0x%08X => %02X\n", reg, *val);
}

static inline void write_register_word(struct net_device *dev, u32 reg, u16 val)
{
        struct ipw2100_priv *priv = libipw_priv(dev);

        iowrite16(val, priv->ioaddr + reg);
        IPW_DEBUG_IO("w: 0x%08X <= %04X\n", reg, val);
}

static inline void write_register_byte(struct net_device *dev, u32 reg, u8 val)
{
        struct ipw2100_priv *priv = libipw_priv(dev);

        iowrite8(val, priv->ioaddr + reg);
        IPW_DEBUG_IO("w: 0x%08X =< %02X\n", reg, val);
}

static inline void read_nic_dword(struct net_device *dev, u32 addr, u32 * val)
{
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                       addr & IPW_REG_INDIRECT_ADDR_MASK);
        read_register(dev, IPW_REG_INDIRECT_ACCESS_DATA, val);
}

static inline void write_nic_dword(struct net_device *dev, u32 addr, u32 val)
{
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                       addr & IPW_REG_INDIRECT_ADDR_MASK);
        write_register(dev, IPW_REG_INDIRECT_ACCESS_DATA, val);
}

static inline void read_nic_word(struct net_device *dev, u32 addr, u16 * val)
{
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                       addr & IPW_REG_INDIRECT_ADDR_MASK);
        read_register_word(dev, IPW_REG_INDIRECT_ACCESS_DATA, val);
}

static inline void write_nic_word(struct net_device *dev, u32 addr, u16 val)
{
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                       addr & IPW_REG_INDIRECT_ADDR_MASK);
        write_register_word(dev, IPW_REG_INDIRECT_ACCESS_DATA, val);
}

static inline void read_nic_byte(struct net_device *dev, u32 addr, u8 * val)
{
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                       addr & IPW_REG_INDIRECT_ADDR_MASK);
        read_register_byte(dev, IPW_REG_INDIRECT_ACCESS_DATA, val);
}

static inline void write_nic_byte(struct net_device *dev, u32 addr, u8 val)
{
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                       addr & IPW_REG_INDIRECT_ADDR_MASK);
        write_register_byte(dev, IPW_REG_INDIRECT_ACCESS_DATA, val);
}

static inline void write_nic_auto_inc_address(struct net_device *dev, u32 addr)
{
        write_register(dev, IPW_REG_AUTOINCREMENT_ADDRESS,
                       addr & IPW_REG_INDIRECT_ADDR_MASK);
}

static inline void write_nic_dword_auto_inc(struct net_device *dev, u32 val)
{
        write_register(dev, IPW_REG_AUTOINCREMENT_DATA, val);
}

static void write_nic_memory(struct net_device *dev, u32 addr, u32 len,
                                    const u8 * buf)
{
        u32 aligned_addr;
        u32 aligned_len;
        u32 dif_len;
        u32 i;

        /* read first nibble byte by byte */
        aligned_addr = addr & (~0x3);
        dif_len = addr - aligned_addr;
        if (dif_len) {
                /* Start reading at aligned_addr + dif_len */
                write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                               aligned_addr);
                for (i = dif_len; i < 4; i++, buf++)
                        write_register_byte(dev,
                                            IPW_REG_INDIRECT_ACCESS_DATA + i,
                                            *buf);

                len -= dif_len;
                aligned_addr += 4;
        }

        /* read DWs through autoincrement registers */
        write_register(dev, IPW_REG_AUTOINCREMENT_ADDRESS, aligned_addr);
        aligned_len = len & (~0x3);
        for (i = 0; i < aligned_len; i += 4, buf += 4, aligned_addr += 4)
                write_register(dev, IPW_REG_AUTOINCREMENT_DATA, *(u32 *) buf);

        /* copy the last nibble */
        dif_len = len - aligned_len;
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS, aligned_addr);
        for (i = 0; i < dif_len; i++, buf++)
                write_register_byte(dev, IPW_REG_INDIRECT_ACCESS_DATA + i,
                                    *buf);
}

static void read_nic_memory(struct net_device *dev, u32 addr, u32 len,
                                   u8 * buf)
{
        u32 aligned_addr;
        u32 aligned_len;
        u32 dif_len;
        u32 i;

        /* read first nibble byte by byte */
        aligned_addr = addr & (~0x3);
        dif_len = addr - aligned_addr;
        if (dif_len) {
                /* Start reading at aligned_addr + dif_len */
                write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS,
                               aligned_addr);
                for (i = dif_len; i < 4; i++, buf++)
                        read_register_byte(dev,
                                           IPW_REG_INDIRECT_ACCESS_DATA + i,
                                           buf);

                len -= dif_len;
                aligned_addr += 4;
        }

        /* read DWs through autoincrement registers */
        write_register(dev, IPW_REG_AUTOINCREMENT_ADDRESS, aligned_addr);
        aligned_len = len & (~0x3);
        for (i = 0; i < aligned_len; i += 4, buf += 4, aligned_addr += 4)
                read_register(dev, IPW_REG_AUTOINCREMENT_DATA, (u32 *) buf);

        /* copy the last nibble */
        dif_len = len - aligned_len;
        write_register(dev, IPW_REG_INDIRECT_ACCESS_ADDRESS, aligned_addr);
        for (i = 0; i < dif_len; i++, buf++)
                read_register_byte(dev, IPW_REG_INDIRECT_ACCESS_DATA + i, buf);
}

static bool ipw2100_hw_is_adapter_in_system(struct net_device *dev)
{
        u32 dbg;

        read_register(dev, IPW_REG_DOA_DEBUG_AREA_START, &dbg);

        return dbg == IPW_DATA_DOA_DEBUG_VALUE;
}

static int ipw2100_get_ordinal(struct ipw2100_priv *priv, u32 ord,
                               void *val, u32 * len)
{
        struct ipw2100_ordinals *ordinals = &priv->ordinals;
        u32 addr;
        u32 field_info;
        u16 field_len;
        u16 field_count;
        u32 total_length;

        if (ordinals->table1_addr == 0) {
                printk(KERN_WARNING DRV_NAME ": attempt to use fw ordinals "
                       "before they have been loaded.\n");
                return -EINVAL;
        }

        if (IS_ORDINAL_TABLE_ONE(ordinals, ord)) {
                if (*len < IPW_ORD_TAB_1_ENTRY_SIZE) {
                        *len = IPW_ORD_TAB_1_ENTRY_SIZE;

                        printk(KERN_WARNING DRV_NAME
                               ": ordinal buffer length too small, need %zd\n",
                               IPW_ORD_TAB_1_ENTRY_SIZE);

                        return -EINVAL;
                }

                read_nic_dword(priv->net_dev,
                               ordinals->table1_addr + (ord << 2), &addr);
                read_nic_dword(priv->net_dev, addr, val);

                *len = IPW_ORD_TAB_1_ENTRY_SIZE;

                return 0;
        }

        if (IS_ORDINAL_TABLE_TWO(ordinals, ord)) {

                ord -= IPW_START_ORD_TAB_2;

                /* get the address of statistic */
                read_nic_dword(priv->net_dev,
                               ordinals->table2_addr + (ord << 3), &addr);

                /* get the second DW of statistics ;
                 * two 16-bit words - first is length, second is count */
                read_nic_dword(priv->net_dev,
                               ordinals->table2_addr + (ord << 3) + sizeof(u32),
                               &field_info);

                /* get each entry length */
                field_len = *((u16 *) & field_info);

                /* get number of entries */
                field_count = *(((u16 *) & field_info) + 1);

                /* abort if no enough memory */
                total_length = field_len * field_count;
                if (total_length > *len) {
                        *len = total_length;
                        return -EINVAL;
                }

                *len = total_length;
                if (!total_length)
                        return 0;

                /* read the ordinal data from the SRAM */
                read_nic_memory(priv->net_dev, addr, total_length, val);

                return 0;
        }

        printk(KERN_WARNING DRV_NAME ": ordinal %d neither in table 1 nor "
               "in table 2\n", ord);

        return -EINVAL;
}

static int ipw2100_set_ordinal(struct ipw2100_priv *priv, u32 ord, u32 * val,
                               u32 * len)
{
        struct ipw2100_ordinals *ordinals = &priv->ordinals;
        u32 addr;

        if (IS_ORDINAL_TABLE_ONE(ordinals, ord)) {
                if (*len != IPW_ORD_TAB_1_ENTRY_SIZE) {
                        *len = IPW_ORD_TAB_1_ENTRY_SIZE;
                        IPW_DEBUG_INFO("wrong size\n");
                        return -EINVAL;
                }

                read_nic_dword(priv->net_dev,
                               ordinals->table1_addr + (ord << 2), &addr);

                write_nic_dword(priv->net_dev, addr, *val);

                *len = IPW_ORD_TAB_1_ENTRY_SIZE;

                return 0;
        }

        IPW_DEBUG_INFO("wrong table\n");
        if (IS_ORDINAL_TABLE_TWO(ordinals, ord))
                return -EINVAL;

        return -EINVAL;
}

static char *snprint_line(char *buf, size_t count,
                          const u8 * data, u32 len, u32 ofs)
{
        int out, i, j, l;
        char c;

        out = snprintf(buf, count, "%08X", ofs);

        for (l = 0, i = 0; i < 2; i++) {
                out += snprintf(buf + out, count - out, " ");
                for (j = 0; j < 8 && l < len; j++, l++)
                        out += snprintf(buf + out, count - out, "%02X ",
                                        data[(i * 8 + j)]);
                for (; j < 8; j++)
                        out += snprintf(buf + out, count - out, "   ");
        }

        out += snprintf(buf + out, count - out, " ");
        for (l = 0, i = 0; i < 2; i++) {
                out += snprintf(buf + out, count - out, " ");
                for (j = 0; j < 8 && l < len; j++, l++) {
                        c = data[(i * 8 + j)];
                        if (!isascii(c) || !isprint(c))
                                c = '.';

                        out += snprintf(buf + out, count - out, "%c", c);
                }

                for (; j < 8; j++)
                        out += snprintf(buf + out, count - out, " ");
        }

        return buf;
}

static void printk_buf(int level, const u8 * data, u32 len)
{
        char line[81];
        u32 ofs = 0;
        if (!(ipw2100_debug_level & level))
                return;

        while (len) {
                printk(KERN_DEBUG "%s\n",
                       snprint_line(line, sizeof(line), &data[ofs],
                                    min(len, 16U), ofs));
                ofs += 16;
                len -= min(len, 16U);
        }
}

#define MAX_RESET_BACKOFF 10

static void schedule_reset(struct ipw2100_priv *priv)
{
        unsigned long now = get_seconds();

        /* If we haven't received a reset request within the backoff period,
         * then we can reset the backoff interval so this reset occurs
         * immediately */
        if (priv->reset_backoff &&
            (now - priv->last_reset > priv->reset_backoff))
                priv->reset_backoff = 0;

        priv->last_reset = get_seconds();

        if (!(priv->status & STATUS_RESET_PENDING)) {
                IPW_DEBUG_INFO("%s: Scheduling firmware restart (%ds).\n",
                               priv->net_dev->name, priv->reset_backoff);
                netif_carrier_off(priv->net_dev);
                netif_stop_queue(priv->net_dev);
                priv->status |= STATUS_RESET_PENDING;
                if (priv->reset_backoff)
                        schedule_delayed_work(&priv->reset_work,
                                              priv->reset_backoff * HZ);
                else
                        schedule_delayed_work(&priv->reset_work, 0);

                if (priv->reset_backoff < MAX_RESET_BACKOFF)
                        priv->reset_backoff++;

                wake_up_interruptible(&priv->wait_command_queue);
        } else
                IPW_DEBUG_INFO("%s: Firmware restart already in progress.\n",
                               priv->net_dev->name);

}

#define HOST_COMPLETE_TIMEOUT (2 * HZ)
static int ipw2100_hw_send_command(struct ipw2100_priv *priv,
                                   struct host_command *cmd)
{
        struct list_head *element;
        struct ipw2100_tx_packet *packet;
        unsigned long flags;
        int err = 0;

        IPW_DEBUG_HC("Sending %s command (#%d), %d bytes\n",
                     command_types[cmd->host_command], cmd->host_command,
                     cmd->host_command_length);
        printk_buf(IPW_DL_HC, (u8 *) cmd->host_command_parameters,
                   cmd->host_command_length);

        spin_lock_irqsave(&priv->low_lock, flags);

        if (priv->fatal_error) {
                IPW_DEBUG_INFO
                    ("Attempt to send command while hardware in fatal error condition.\n");
                err = -EIO;
                goto fail_unlock;
        }

        if (!(priv->status & STATUS_RUNNING)) {
                IPW_DEBUG_INFO
                    ("Attempt to send command while hardware is not running.\n");
                err = -EIO;
                goto fail_unlock;
        }

        if (priv->status & STATUS_CMD_ACTIVE) {
                IPW_DEBUG_INFO
                    ("Attempt to send command while another command is pending.\n");
                err = -EBUSY;
                goto fail_unlock;
        }

        if (list_empty(&priv->msg_free_list)) {
                IPW_DEBUG_INFO("no available msg buffers\n");
                goto fail_unlock;
        }

        priv->status |= STATUS_CMD_ACTIVE;
        priv->messages_sent++;

        element = priv->msg_free_list.next;

        packet = list_entry(element, struct ipw2100_tx_packet, list);
        packet->jiffy_start = jiffies;

        /* initialize the firmware command packet */
        packet->info.c_struct.cmd->host_command_reg = cmd->host_command;
        packet->info.c_struct.cmd->host_command_reg1 = cmd->host_command1;
        packet->info.c_struct.cmd->host_command_len_reg =
            cmd->host_command_length;
        packet->info.c_struct.cmd->sequence = cmd->host_command_sequence;

        memcpy(packet->info.c_struct.cmd->host_command_params_reg,
               cmd->host_command_parameters,
               sizeof(packet->info.c_struct.cmd->host_command_params_reg));

        list_del(element);
        DEC_STAT(&priv->msg_free_stat);

        list_add_tail(element, &priv->msg_pend_list);
        INC_STAT(&priv->msg_pend_stat);

        ipw2100_tx_send_commands(priv);
        ipw2100_tx_send_data(priv);

        spin_unlock_irqrestore(&priv->low_lock, flags);

        /*
         * We must wait for this command to complete before another
         * command can be sent...  but if we wait more than 3 seconds
         * then there is a problem.
         */

        err =
            wait_event_interruptible_timeout(priv->wait_command_queue,
                                             !(priv->
                                               status & STATUS_CMD_ACTIVE),
                                             HOST_COMPLETE_TIMEOUT);

        if (err == 0) {
                IPW_DEBUG_INFO("Command completion failed out after %dms.\n",
                               1000 * (HOST_COMPLETE_TIMEOUT / HZ));
                priv->fatal_error = IPW2100_ERR_MSG_TIMEOUT;
                priv->status &= ~STATUS_CMD_ACTIVE;
                schedule_reset(priv);
                return -EIO;
        }

        if (priv->fatal_error) {
                printk(KERN_WARNING DRV_NAME ": %s: firmware fatal error\n",
                       priv->net_dev->name);
                return -EIO;
        }

        /* !!!!! HACK TEST !!!!!
         * When lots of debug trace statements are enabled, the driver
         * doesn't seem to have as many firmware restart cycles...
         *
         * As a test, we're sticking in a 1/100s delay here */
        schedule_timeout_uninterruptible(msecs_to_jiffies(10));

        return 0;

      fail_unlock:
        spin_unlock_irqrestore(&priv->low_lock, flags);

        return err;
}

/*
 * Verify the values and data access of the hardware
 * No locks needed or used.  No functions called.
 */
static int ipw2100_verify(struct ipw2100_priv *priv)
{
        u32 data1, data2;
        u32 address;

        u32 val1 = 0x76543210;
        u32 val2 = 0xFEDCBA98;

        /* Domain 0 check - all values should be DOA_DEBUG */
        for (address = IPW_REG_DOA_DEBUG_AREA_START;
             address < IPW_REG_DOA_DEBUG_AREA_END; address += sizeof(u32)) {
                read_register(priv->net_dev, address, &data1);
                if (data1 != IPW_DATA_DOA_DEBUG_VALUE)
                        return -EIO;
        }

        /* Domain 1 check - use arbitrary read/write compare  */
        for (address = 0; address < 5; address++) {
                /* The memory area is not used now */
                write_register(priv->net_dev, IPW_REG_DOMAIN_1_OFFSET + 0x32,
                               val1);
                write_register(priv->net_dev, IPW_REG_DOMAIN_1_OFFSET + 0x36,
                               val2);
                read_register(priv->net_dev, IPW_REG_DOMAIN_1_OFFSET + 0x32,
                              &data1);
                read_register(priv->net_dev, IPW_REG_DOMAIN_1_OFFSET + 0x36,
                              &data2);
                if (val1 == data1 && val2 == data2)
                        return 0;
        }

        return -EIO;
}

/*
 *
 * Loop until the CARD_DISABLED bit is the same value as the
 * supplied parameter
 *
 * TODO: See if it would be more efficient to do a wait/wake
 *       cycle and have the completion event trigger the wakeup
 *
 */
#define IPW_CARD_DISABLE_COMPLETE_WAIT              100 // 100 milli
static int ipw2100_wait_for_card_state(struct ipw2100_priv *priv, int state)
{
        int i;
        u32 card_state;
        u32 len = sizeof(card_state);
        int err;

        for (i = 0; i <= IPW_CARD_DISABLE_COMPLETE_WAIT * 1000; i += 50) {
                err = ipw2100_get_ordinal(priv, IPW_ORD_CARD_DISABLED,
                                          &card_state, &len);
                if (err) {
                        IPW_DEBUG_INFO("Query of CARD_DISABLED ordinal "
                                       "failed.\n");
                        return 0;
                }

                /* We'll break out if either the HW state says it is
                 * in the state we want, or if HOST_COMPLETE command
                 * finishes */
                if ((card_state == state) ||
                    ((priv->status & STATUS_ENABLED) ?
                     IPW_HW_STATE_ENABLED : IPW_HW_STATE_DISABLED) == state) {
                        if (state == IPW_HW_STATE_ENABLED)
                                priv->status |= STATUS_ENABLED;
                        else
                                priv->status &= ~STATUS_ENABLED;

                        return 0;
                }

                udelay(50);
        }

        IPW_DEBUG_INFO("ipw2100_wait_for_card_state to %s state timed out\n",
                       state ? "DISABLED" : "ENABLED");
        return -EIO;
}

/*********************************************************************
    Procedure   :   sw_reset_and_clock
    Purpose     :   Asserts s/w reset, asserts clock initialization
                    and waits for clock stabilization
 ********************************************************************/
static int sw_reset_and_clock(struct ipw2100_priv *priv)
{
        int i;
        u32 r;

        // assert s/w reset
        write_register(priv->net_dev, IPW_REG_RESET_REG,
                       IPW_AUX_HOST_RESET_REG_SW_RESET);

        // wait for clock stabilization
        for (i = 0; i < 1000; i++) {
                udelay(IPW_WAIT_RESET_ARC_COMPLETE_DELAY);

                // check clock ready bit
                read_register(priv->net_dev, IPW_REG_RESET_REG, &r);
                if (r & IPW_AUX_HOST_RESET_REG_PRINCETON_RESET)
                        break;
        }

        if (i == 1000)
                return -EIO;    // TODO: better error value

        /* set "initialization complete" bit to move adapter to
         * D0 state */
        write_register(priv->net_dev, IPW_REG_GP_CNTRL,
                       IPW_AUX_HOST_GP_CNTRL_BIT_INIT_DONE);

        /* wait for clock stabilization */
        for (i = 0; i < 10000; i++) {
                udelay(IPW_WAIT_CLOCK_STABILIZATION_DELAY * 4);

                /* check clock ready bit */
                read_register(priv->net_dev, IPW_REG_GP_CNTRL, &r);
                if (r & IPW_AUX_HOST_GP_CNTRL_BIT_CLOCK_READY)
                        break;
        }

        if (i == 10000)
                return -EIO;    /* TODO: better error value */

        /* set D0 standby bit */
        read_register(priv->net_dev, IPW_REG_GP_CNTRL, &r);
        write_register(priv->net_dev, IPW_REG_GP_CNTRL,
                       r | IPW_AUX_HOST_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);

        return 0;
}

/*********************************************************************
    Procedure   :   ipw2100_download_firmware
    Purpose     :   Initiaze adapter after power on.
                    The sequence is:
                    1. assert s/w reset first!
                    2. awake clocks & wait for clock stabilization
                    3. hold ARC (don't ask me why...)
                    4. load Dino ucode and reset/clock init again
                    5. zero-out shared mem
                    6. download f/w
 *******************************************************************/
static int ipw2100_download_firmware(struct ipw2100_priv *priv)
{
        u32 address;
        int err;

#ifndef CONFIG_PM
        /* Fetch the firmware and microcode */
        struct ipw2100_fw ipw2100_firmware;

#endif

        if (priv->fatal_error) {
                IPW_DEBUG_ERROR("%s: ipw2100_download_firmware called after "
                                "fatal error %d.  Interface must be brought down.\n",
                                priv->net_dev->name, priv->fatal_error);
                return -EINVAL;
        }
#ifdef CONFIG_PM
        if (!ipw2100_firmware.version) {
                err = ipw2100_get_firmware(priv, &ipw2100_firmware);
                if (err) {
                        IPW_DEBUG_ERROR("%s: ipw2100_get_firmware failed: %d\n",
                                        priv->net_dev->name, err);
                        priv->fatal_error = IPW2100_ERR_FW_LOAD;
                        goto fail;
                }
        }
#else
        err = ipw2100_get_firmware(priv, &ipw2100_firmware);
        if (err) {
                IPW_DEBUG_ERROR("%s: ipw2100_get_firmware failed: %d\n",
                                priv->net_dev->name, err);
                priv->fatal_error = IPW2100_ERR_FW_LOAD;
                goto fail;
        }
#endif
        priv->firmware_version = ipw2100_firmware.version;

        /* s/w reset and clock stabilization */
        err = sw_reset_and_clock(priv);
        if (err) {
                IPW_DEBUG_ERROR("%s: sw_reset_and_clock failed: %d\n",
                                priv->net_dev->name, err);
                goto fail;
        }

        err = ipw2100_verify(priv);
        if (err) {
                IPW_DEBUG_ERROR("%s: ipw2100_verify failed: %d\n",
                                priv->net_dev->name, err);
                goto fail;
        }

        /* Hold ARC */
        write_nic_dword(priv->net_dev,
                        IPW_INTERNAL_REGISTER_HALT_AND_RESET, 0x80000000);

        /* allow ARC to run */
        write_register(priv->net_dev, IPW_REG_RESET_REG, 0);

        /* load microcode */
        err = ipw2100_ucode_download(priv, &ipw2100_firmware);
        if (err) {
                printk(KERN_ERR DRV_NAME ": %s: Error loading microcode: %d\n",
                       priv->net_dev->name, err);
                goto fail;
        }

        /* release ARC */
        write_nic_dword(priv->net_dev,
                        IPW_INTERNAL_REGISTER_HALT_AND_RESET, 0x00000000);

        /* s/w reset and clock stabilization (again!!!) */
        err = sw_reset_and_clock(priv);
        if (err) {
                printk(KERN_ERR DRV_NAME
                       ": %s: sw_reset_and_clock failed: %d\n",
                       priv->net_dev->name, err);
                goto fail;
        }

        /* load f/w */
        err = ipw2100_fw_download(priv, &ipw2100_firmware);
        if (err) {
                IPW_DEBUG_ERROR("%s: Error loading firmware: %d\n",
                                priv->net_dev->name, err);
                goto fail;
        }
#ifndef CONFIG_PM
        /*
         * When the .resume method of the driver is called, the other
         * part of the system, i.e. the ide driver could still stay in
         * the suspend stage. This prevents us from loading the firmware
         * from the disk.  --YZ
         */

        /* free any storage allocated for firmware image */
        ipw2100_release_firmware(priv, &ipw2100_firmware);
#endif

        /* zero out Domain 1 area indirectly (Si requirement) */
        for (address = IPW_HOST_FW_SHARED_AREA0;
             address < IPW_HOST_FW_SHARED_AREA0_END; address += 4)
                write_nic_dword(priv->net_dev, address, 0);
        for (address = IPW_HOST_FW_SHARED_AREA1;
             address < IPW_HOST_FW_SHARED_AREA1_END; address += 4)
                write_nic_dword(priv->net_dev, address, 0);
        for (address = IPW_HOST_FW_SHARED_AREA2;
             address < IPW_HOST_FW_SHARED_AREA2_END; address += 4)
                write_nic_dword(priv->net_dev, address, 0);
        for (address = IPW_HOST_FW_SHARED_AREA3;
             address < IPW_HOST_FW_SHARED_AREA3_END; address += 4)
                write_nic_dword(priv->net_dev, address, 0);
        for (address = IPW_HOST_FW_INTERRUPT_AREA;
             address < IPW_HOST_FW_INTERRUPT_AREA_END; address += 4)
                write_nic_dword(priv->net_dev, address, 0);

        return 0;

      fail:
        ipw2100_release_firmware(priv, &ipw2100_firmware);
        return err;
}

static inline void ipw2100_enable_interrupts(struct ipw2100_priv *priv)
{
        if (priv->status & STATUS_INT_ENABLED)
                return;
        priv->status |= STATUS_INT_ENABLED;
        write_register(priv->net_dev, IPW_REG_INTA_MASK, IPW_INTERRUPT_MASK);
}

static inline void ipw2100_disable_interrupts(struct ipw2100_priv *priv)
{
        if (!(priv->status & STATUS_INT_ENABLED))
                return;
        priv->status &= ~STATUS_INT_ENABLED;
        write_register(priv->net_dev, IPW_REG_INTA_MASK, 0x0);
}

static void ipw2100_initialize_ordinals(struct ipw2100_priv *priv)
{
        struct ipw2100_ordinals *ord = &priv->ordinals;

        IPW_DEBUG_INFO("enter\n");

        read_register(priv->net_dev, IPW_MEM_HOST_SHARED_ORDINALS_TABLE_1,
                      &ord->table1_addr);

        read_register(priv->net_dev, IPW_MEM_HOST_SHARED_ORDINALS_TABLE_2,
                      &ord->table2_addr);

        read_nic_dword(priv->net_dev, ord->table1_addr, &ord->table1_size);
        read_nic_dword(priv->net_dev, ord->table2_addr, &ord->table2_size);

        ord->table2_size &= 0x0000FFFF;

        IPW_DEBUG_INFO("table 1 size: %d\n", ord->table1_size);
        IPW_DEBUG_INFO("table 2 size: %d\n", ord->table2_size);
        IPW_DEBUG_INFO("exit\n");
}

static inline void ipw2100_hw_set_gpio(struct ipw2100_priv *priv)
{
        u32 reg = 0;
        /*
         * Set GPIO 3 writable by FW; GPIO 1 writable
         * by driver and enable clock
         */
        reg = (IPW_BIT_GPIO_GPIO3_MASK | IPW_BIT_GPIO_GPIO1_ENABLE |
               IPW_BIT_GPIO_LED_OFF);
        write_register(priv->net_dev, IPW_REG_GPIO, reg);
}

static int rf_kill_active(struct ipw2100_priv *priv)
{
#define MAX_RF_KILL_CHECKS 5
#define RF_KILL_CHECK_DELAY 40

        unsigned short value = 0;
        u32 reg = 0;
        int i;

        if (!(priv->hw_features & HW_FEATURE_RFKILL)) {
                wiphy_rfkill_set_hw_state(priv->ieee->wdev.wiphy, false);
                priv->status &= ~STATUS_RF_KILL_HW;
                return 0;
        }

        for (i = 0; i < MAX_RF_KILL_CHECKS; i++) {
                udelay(RF_KILL_CHECK_DELAY);
                read_register(priv->net_dev, IPW_REG_GPIO, &reg);
                value = (value << 1) | ((reg & IPW_BIT_GPIO_RF_KILL) ? 0 : 1);
        }

        if (value == 0) {
                wiphy_rfkill_set_hw_state(priv->ieee->wdev.wiphy, true);
                priv->status |= STATUS_RF_KILL_HW;
        } else {
                wiphy_rfkill_set_hw_state(priv->ieee->wdev.wiphy, false);
                priv->status &= ~STATUS_RF_KILL_HW;
        }

        return (value == 0);
}

static int ipw2100_get_hw_features(struct ipw2100_priv *priv)
{
        u32 addr, len;
        u32 val;

        /*
         * EEPROM_SRAM_DB_START_ADDRESS using ordinal in ordinal table 1
         */
        len = sizeof(addr);
        if (ipw2100_get_ordinal
            (priv, IPW_ORD_EEPROM_SRAM_DB_BLOCK_START_ADDRESS, &addr, &len)) {
                IPW_DEBUG_INFO("failed querying ordinals at line %d\n",
                               __LINE__);
                return -EIO;
        }

        IPW_DEBUG_INFO("EEPROM address: %08X\n", addr);

        /*
         * EEPROM version is the byte at offset 0xfd in firmware
         * We read 4 bytes, then shift out the byte we actually want */
        read_nic_dword(priv->net_dev, addr + 0xFC, &val);
        priv->eeprom_version = (val >> 24) & 0xFF;
        IPW_DEBUG_INFO("EEPROM version: %d\n", priv->eeprom_version);

        /*
         *  HW RF Kill enable is bit 0 in byte at offset 0x21 in firmware
         *
         *  notice that the EEPROM bit is reverse polarity, i.e.
         *     bit = 0  signifies HW RF kill switch is supported
         *     bit = 1  signifies HW RF kill switch is NOT supported
         */
        read_nic_dword(priv->net_dev, addr + 0x20, &val);
        if (!((val >> 24) & 0x01))
                priv->hw_features |= HW_FEATURE_RFKILL;

        IPW_DEBUG_INFO("HW RF Kill: %ssupported.\n",
                       (priv->hw_features & HW_FEATURE_RFKILL) ? "" : "not ");

        return 0;
}

/*
 * Start firmware execution after power on and initialization
 * The sequence is:
 *  1. Release ARC
 *  2. Wait for f/w initialization completes;
 */
static int ipw2100_start_adapter(struct ipw2100_priv *priv)
{
        int i;
        u32 inta, inta_mask, gpio;

        IPW_DEBUG_INFO("enter\n");

        if (priv->status & STATUS_RUNNING)
                return 0;

        /*
         * Initialize the hw - drive adapter to DO state by setting
         * init_done bit. Wait for clk_ready bit and Download
         * fw & dino ucode
         */
        if (ipw2100_download_firmware(priv)) {
                printk(KERN_ERR DRV_NAME
                       ": %s: Failed to power on the adapter.\n",
                       priv->net_dev->name);
                return -EIO;
        }

        /* Clear the Tx, Rx and Msg queues and the r/w indexes
         * in the firmware RBD and TBD ring queue */
        ipw2100_queues_initialize(priv);

        ipw2100_hw_set_gpio(priv);

        /* TODO -- Look at disabling interrupts here to make sure none
         * get fired during FW initialization */

        /* Release ARC - clear reset bit */
        write_register(priv->net_dev, IPW_REG_RESET_REG, 0);

        /* wait for f/w initialization complete */
        IPW_DEBUG_FW("Waiting for f/w initialization to complete...\n");
        i = 5000;
        do {
                schedule_timeout_uninterruptible(msecs_to_jiffies(40));
                /* Todo... wait for sync command ... */

                read_register(priv->net_dev, IPW_REG_INTA, &inta);

                /* check "init done" bit */
                if (inta & IPW2100_INTA_FW_INIT_DONE) {
                        /* reset "init done" bit */
                        write_register(priv->net_dev, IPW_REG_INTA,
                                       IPW2100_INTA_FW_INIT_DONE);
                        break;
                }

                /* check error conditions : we check these after the firmware
                 * check so that if there is an error, the interrupt handler
                 * will see it and the adapter will be reset */
                if (inta &
                    (IPW2100_INTA_FATAL_ERROR | IPW2100_INTA_PARITY_ERROR)) {
                        /* clear error conditions */
                        write_register(priv->net_dev, IPW_REG_INTA,
                                       IPW2100_INTA_FATAL_ERROR |
                                       IPW2100_INTA_PARITY_ERROR);
                }
        } while (--i);

        /* Clear out any pending INTAs since we aren't supposed to have
         * interrupts enabled at this point... */
        read_register(priv->net_dev, IPW_REG_INTA, &inta);
        read_register(priv->net_dev, IPW_REG_INTA_MASK, &inta_mask);
        inta &= IPW_INTERRUPT_MASK;
        /* Clear out any pending interrupts */
        if (inta & inta_mask)
                write_register(priv->net_dev, IPW_REG_INTA, inta);

        IPW_DEBUG_FW("f/w initialization complete: %s\n",
                     i ? "SUCCESS" : "FAILED");

        if (!i) {
                printk(KERN_WARNING DRV_NAME
                       ": %s: Firmware did not initialize.\n",
                       priv->net_dev->name);
                return -EIO;
        }

        /* allow firmware to write to GPIO1 & GPIO3 */
        read_register(priv->net_dev, IPW_REG_GPIO, &gpio);

        gpio |= (IPW_BIT_GPIO_GPIO1_MASK | IPW_BIT_GPIO_GPIO3_MASK);

        write_register(priv->net_dev, IPW_REG_GPIO, gpio);

        /* Ready to receive commands */
        priv->status |= STATUS_RUNNING;

        /* The adapter has been reset; we are not associated */
        priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);

        IPW_DEBUG_INFO("exit\n");

        return 0;
}

static inline void ipw2100_reset_fatalerror(struct ipw2100_priv *priv)
{
        if (!priv->fatal_error)
                return;

        priv->fatal_errors[priv->fatal_index++] = priv->fatal_error;
        priv->fatal_index %= IPW2100_ERROR_QUEUE;
        priv->fatal_error = 0;
}

/* NOTE: Our interrupt is disabled when this method is called */
static int ipw2100_power_cycle_adapter(struct ipw2100_priv *priv)
{
        u32 reg;
        int i;

        IPW_DEBUG_INFO("Power cycling the hardware.\n");

        ipw2100_hw_set_gpio(priv);

        /* Step 1. Stop Master Assert */
        write_register(priv->net_dev, IPW_REG_RESET_REG,
                       IPW_AUX_HOST_RESET_REG_STOP_MASTER);

        /* Step 2. Wait for stop Master Assert
         *         (not more than 50us, otherwise ret error */
        i = 5;
        do {
                udelay(IPW_WAIT_RESET_MASTER_ASSERT_COMPLETE_DELAY);
                read_register(priv->net_dev, IPW_REG_RESET_REG, &reg);

                if (reg & IPW_AUX_HOST_RESET_REG_MASTER_DISABLED)
                        break;
        } while (--i);

        priv->status &= ~STATUS_RESET_PENDING;

        if (!i) {
                IPW_DEBUG_INFO
                    ("exit - waited too long for master assert stop\n");
                return -EIO;
        }

        write_register(priv->net_dev, IPW_REG_RESET_REG,
                       IPW_AUX_HOST_RESET_REG_SW_RESET);

        /* Reset any fatal_error conditions */
        ipw2100_reset_fatalerror(priv);

        /* At this point, the adapter is now stopped and disabled */
        priv->status &= ~(STATUS_RUNNING | STATUS_ASSOCIATING |
                          STATUS_ASSOCIATED | STATUS_ENABLED);

        return 0;
}

/*
 * Send the CARD_DISABLE_PHY_OFF command to the card to disable it
 *
 * After disabling, if the card was associated, a STATUS_ASSN_LOST will be sent.
 *
 * STATUS_CARD_DISABLE_NOTIFICATION will be sent regardless of
 * if STATUS_ASSN_LOST is sent.
 */
static int ipw2100_hw_phy_off(struct ipw2100_priv *priv)
{

#define HW_PHY_OFF_LOOP_DELAY (msecs_to_jiffies(50))

        struct host_command cmd = {
                .host_command = CARD_DISABLE_PHY_OFF,
                .host_command_sequence = 0,
                .host_command_length = 0,
        };
        int err, i;
        u32 val1, val2;

        IPW_DEBUG_HC("CARD_DISABLE_PHY_OFF\n");

        /* Turn off the radio */
        err = ipw2100_hw_send_command(priv, &cmd);
        if (err)
                return err;

        for (i = 0; i < 2500; i++) {
                read_nic_dword(priv->net_dev, IPW2100_CONTROL_REG, &val1);
                read_nic_dword(priv->net_dev, IPW2100_COMMAND, &val2);

                if ((val1 & IPW2100_CONTROL_PHY_OFF) &&
                    (val2 & IPW2100_COMMAND_PHY_OFF))
                        return 0;

                schedule_timeout_uninterruptible(HW_PHY_OFF_LOOP_DELAY);
        }

        return -EIO;
}

static int ipw2100_enable_adapter(struct ipw2100_priv *priv)
{
        struct host_command cmd = {
                .host_command = HOST_COMPLETE,
                .host_command_sequence = 0,
                .host_command_length = 0
        };
        int err = 0;

        IPW_DEBUG_HC("HOST_COMPLETE\n");

        if (priv->status & STATUS_ENABLED)
                return 0;

        mutex_lock(&priv->adapter_mutex);

        if (rf_kill_active(priv)) {
                IPW_DEBUG_HC("Command aborted due to RF kill active.\n");
                goto fail_up;
        }

        err = ipw2100_hw_send_command(priv, &cmd);
        if (err) {
                IPW_DEBUG_INFO("Failed to send HOST_COMPLETE command\n");
                goto fail_up;
        }

        err = ipw2100_wait_for_card_state(priv, IPW_HW_STATE_ENABLED);
        if (err) {
                IPW_DEBUG_INFO("%s: card not responding to init command.\n",
                               priv->net_dev->name);
                goto fail_up;
        }

        if (priv->stop_hang_check) {
                priv->stop_hang_check = 0;
                schedule_delayed_work(&priv->hang_check, HZ / 2);
        }

      fail_up:
        mutex_unlock(&priv->adapter_mutex);
        return err;
}

static int ipw2100_hw_stop_adapter(struct ipw2100_priv *priv)
{
#define HW_POWER_DOWN_DELAY (msecs_to_jiffies(100))

        struct host_command cmd = {
                .host_command = HOST_PRE_POWER_DOWN,
                .host_command_sequence = 0,
                .host_command_length = 0,
        };
        int err, i;
        u32 reg;

        if (!(priv->status & STATUS_RUNNING))
                return 0;

        priv->status |= STATUS_STOPPING;

        /* We can only shut down the card if the firmware is operational.  So,
         * if we haven't reset since a fatal_error, then we can not send the
         * shutdown commands. */
        if (!priv->fatal_error) {
                /* First, make sure the adapter is enabled so that the PHY_OFF
                 * command can shut it down */
                ipw2100_enable_adapter(priv);

                err = ipw2100_hw_phy_off(priv);
                if (err)
                        printk(KERN_WARNING DRV_NAME
                               ": Error disabling radio %d\n", err);

                /*
                 * If in D0-standby mode going directly to D3 may cause a
                 * PCI bus violation.  Therefore we must change out of the D0
                 * state.
                 *
                 * Sending the PREPARE_FOR_POWER_DOWN will restrict the
                 * hardware from going into standby mode and will transition
                 * out of D0-standby if it is already in that state.
                 *
                 * STATUS_PREPARE_POWER_DOWN_COMPLETE will be sent by the
                 * driver upon completion.  Once received, the driver can
                 * proceed to the D3 state.
                 *
                 * Prepare for power down command to fw.  This command would
                 * take HW out of D0-standby and prepare it for D3 state.
                 *
                 * Currently FW does not support event notification for this
                 * event. Therefore, skip waiting for it.  Just wait a fixed
                 * 100ms
                 */
                IPW_DEBUG_HC("HOST_PRE_POWER_DOWN\n");

                err = ipw2100_hw_send_command(priv, &cmd);
                if (err)
                        printk(KERN_WARNING DRV_NAME ": "
                               "%s: Power down command failed: Error %d\n",
                               priv->net_dev->name, err);
                else
                        schedule_timeout_uninterruptible(HW_POWER_DOWN_DELAY);
        }

        priv->status &= ~STATUS_ENABLED;

        /*
         * Set GPIO 3 writable by FW; GPIO 1 writable
         * by driver and enable clock
         */
        ipw2100_hw_set_gpio(priv);

        /*
         * Power down adapter.  Sequence:
         * 1. Stop master assert (RESET_REG[9]=1)
         * 2. Wait for stop master (RESET_REG[8]==1)
         * 3. S/w reset assert (RESET_REG[7] = 1)
         */

        /* Stop master assert */
        write_register(priv->net_dev, IPW_REG_RESET_REG,
                       IPW_AUX_HOST_RESET_REG_STOP_MASTER);

        /* wait stop master not more than 50 usec.
         * Otherwise return error. */
        for (i = 5; i > 0; i--) {
                udelay(10);

                /* Check master stop bit */
                read_register(priv->net_dev, IPW_REG_RESET_REG, &reg);

                if (reg & IPW_AUX_HOST_RESET_REG_MASTER_DISABLED)
                        break;
        }

        if (i == 0)
                printk(KERN_WARNING DRV_NAME
                       ": %s: Could now power down adapter.\n",
                       priv->net_dev->name);

        /* assert s/w reset */
        write_register(priv->net_dev, IPW_REG_RESET_REG,
                       IPW_AUX_HOST_RESET_REG_SW_RESET);

        priv->status &= ~(STATUS_RUNNING | STATUS_STOPPING);

        return 0;
}

static int ipw2100_disable_adapter(struct ipw2100_priv *priv)
{
        struct host_command cmd = {
                .host_command = CARD_DISABLE,
                .host_command_sequence = 0,
                .host_command_length = 0
        };
        int err = 0;

        IPW_DEBUG_HC("CARD_DISABLE\n");

        if (!(priv->status & STATUS_ENABLED))
                return 0;

        /* Make sure we clear the associated state */
        priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);

        if (!priv->stop_hang_check) {
                priv->stop_hang_check = 1;
                cancel_delayed_work(&priv->hang_check);
        }

        mutex_lock(&priv->adapter_mutex);

        err = ipw2100_hw_send_command(priv, &cmd);
        if (err) {
                printk(KERN_WARNING DRV_NAME
                       ": exit - failed to send CARD_DISABLE command\n");
                goto fail_up;
        }

        err = ipw2100_wait_for_card_state(priv, IPW_HW_STATE_DISABLED);
        if (err) {
                printk(KERN_WARNING DRV_NAME
                       ": exit - card failed to change to DISABLED\n");
                goto fail_up;
        }

        IPW_DEBUG_INFO("TODO: implement scan state machine\n");

      fail_up:
        mutex_unlock(&priv->adapter_mutex);
        return err;
}

static int ipw2100_set_scan_options(struct ipw2100_priv *priv)
{
        struct host_command cmd = {
                .host_command = SET_SCAN_OPTIONS,
                .host_command_sequence = 0,
                .host_command_length = 8
        };
        int err;

        IPW_DEBUG_INFO("enter\n");

        IPW_DEBUG_SCAN("setting scan options\n");

        cmd.host_command_parameters[0] = 0;

        if (!(priv->config & CFG_ASSOCIATE))
                cmd.host_command_parameters[0] |= IPW_SCAN_NOASSOCIATE;
        if ((priv->ieee->sec.flags & SEC_ENABLED) && priv->ieee->sec.enabled)
                cmd.host_command_parameters[0] |= IPW_SCAN_MIXED_CELL;
        if (priv->config & CFG_PASSIVE_SCAN)
                cmd.host_command_parameters[0] |= IPW_SCAN_PASSIVE;

        cmd.host_command_parameters[1] = priv->channel_mask;

        err = ipw2100_hw_send_command(priv, &cmd);

        IPW_DEBUG_HC("SET_SCAN_OPTIONS 0x%04X\n",
                     cmd.host_command_parameters[0]);

        return err;
}

static int ipw2100_start_scan(struct ipw2100_priv *priv)
{
        struct host_command cmd = {
                .host_command = BROADCAST_SCAN,
                .host_command_sequence = 0,
                .host_command_length = 4
        };
        int err;

        IPW_DEBUG_HC("START_SCAN\n");

        cmd.host_command_parameters[0] = 0;

        /* No scanning if in monitor mode */
        if (priv->ieee->iw_mode == IW_MODE_MONITOR)
                return 1;

        if (priv->status & STATUS_SCANNING) {
                IPW_DEBUG_SCAN("Scan requested while already in scan...\n");
                return 0;
        }

        IPW_DEBUG_INFO("enter\n");

        /* Not clearing here; doing so makes iwlist always return nothing...
         *
         * We should modify the table logic to use aging tables vs. clearing
         * the table on each scan start.
         */
        IPW_DEBUG_SCAN("starting scan\n");

        priv->status |= STATUS_SCANNING;
        err = ipw2100_hw_send_command(priv, &cmd);
        if (err)
                priv->status &= ~STATUS_SCANNING;

        IPW_DEBUG_INFO("exit\n");

        return err;
}

static const struct libipw_geo ipw_geos[] = {
        {                       /* Restricted */
         "---",
         .bg_channels = 14,
         .bg = {{2412, 1}, {2417, 2}, {2422, 3},
                {2427, 4}, {2432, 5}, {2437, 6},
                {2442, 7}, {2447, 8}, {2452, 9},
                {2457, 10}, {2462, 11}, {2467, 12},
                {2472, 13}, {2484, 14}},
         },
};

static int ipw2100_up(struct ipw2100_priv *priv, int deferred)
{
        unsigned long flags;
        int err = 0;
        u32 lock;
        u32 ord_len = sizeof(lock);

        /* Age scan list entries found before suspend */
        if (priv->suspend_time) {
                libipw_networks_age(priv->ieee, priv->suspend_time);
                priv->suspend_time = 0;
        }

        /* Quiet if manually disabled. */
        if (priv->status & STATUS_RF_KILL_SW) {
                IPW_DEBUG_INFO("%s: Radio is disabled by Manual Disable "
                               "switch\n", priv->net_dev->name);
                return 0;
        }

        /* the ipw2100 hardware really doesn't want power management delays
         * longer than 175usec
         */
        pm_qos_update_request(&ipw2100_pm_qos_req, 175);

        /* If the interrupt is enabled, turn it off... */
        spin_lock_irqsave(&priv->low_lock, flags);
        ipw2100_disable_interrupts(priv);

        /* Reset any fatal_error conditions */
        ipw2100_reset_fatalerror(priv);
        spin_unlock_irqrestore(&priv->low_lock, flags);

        if (priv->status & STATUS_POWERED ||
            (priv->status & STATUS_RESET_PENDING)) {
                /* Power cycle the card ... */
                err = ipw2100_power_cycle_adapter(priv);
                if (err) {
                        printk(KERN_WARNING DRV_NAME
                               ": %s: Could not cycle adapter.\n",
                               priv->net_dev->name);
                        goto exit;
                }
        } else
                priv->status |= STATUS_POWERED;

        /* Load the firmware, start the clocks, etc. */
        err = ipw2100_start_adapter(priv);
        if (err) {
                printk(KERN_ERR DRV_NAME
                       ": %s: Failed to start the firmware.\n",
                       priv->net_dev->name);
                goto exit;
        }

        ipw2100_initialize_ordinals(priv);

        /* Determine capabilities of this particular HW configuration */
        err = ipw2100_get_hw_features(priv);
        if (err) {
                printk(KERN_ERR DRV_NAME
                       ": %s: Failed to determine HW features.\n",
                       priv->net_dev->name);
                goto exit;
        }

        /* Initialize the geo */
        libipw_set_geo(priv->ieee, &ipw_geos[0]);
        priv->ieee->freq_band = LIBIPW_24GHZ_BAND;

        lock = LOCK_NONE;
        err = ipw2100_set_ordinal(priv, IPW_ORD_PERS_DB_LOCK, &lock, &ord_len);
        if (err) {
                printk(KERN_ERR DRV_NAME
                       ": %s: Failed to clear ordinal lock.\n",
                       priv->net_dev->name);
                goto exit;
        }

        priv->status &= ~STATUS_SCANNING;

        if (rf_kill_active(priv)) {
                printk(KERN_INFO "%s: Radio is disabled by RF switch.\n",
                       priv->net_dev->name);

                if (priv->stop_rf_kill) {
                        priv->stop_rf_kill = 0;
                        schedule_delayed_work(&priv->rf_kill,
                                              round_jiffies_relative(HZ));
                }

                deferred = 1;
        }

        /* Turn on the interrupt so that commands can be processed */
        ipw2100_enable_interrupts(priv);

        /* Send all of the commands that must be sent prior to
         * HOST_COMPLETE */
        err = ipw2100_adapter_setup(priv);
        if (err) {
                printk(KERN_ERR DRV_NAME ": %s: Failed to start the card.\n",
                       priv->net_dev->name);
                goto exit;
        }

        if (!deferred) {
                /* Enable the adapter - sends HOST_COMPLETE */
                err = ipw2100_enable_adapter(priv);
                if (err) {
                        printk(KERN_ERR DRV_NAME ": "
                               "%s: failed in call to enable adapter.\n",
                               priv->net_dev->name);
                        ipw2100_hw_stop_adapter(priv);
                        goto exit;
                }

                /* Start a scan . . . */
                ipw2100_set_scan_options(priv);
                ipw2100_start_scan(priv);
        }

      exit:
        return err;
}

static void ipw2100_down(struct ipw2100_priv *priv)
{
        unsigned long flags;
        union iwreq_data wrqu = {
                .ap_addr = {
                            .sa_family = ARPHRD_ETHER}
        };
        int associated = priv->status & STATUS_ASSOCIATED;

        /* Kill the RF switch timer */
        if (!priv->stop_rf_kill) {
                priv->stop_rf_kill = 1;
                cancel_delayed_work(&priv->rf_kill);
        }

        /* Kill the firmware hang check timer */
        if (!priv->stop_hang_check) {
                priv->stop_hang_check = 1;
                cancel_delayed_work(&priv->hang_check);
        }

        /* Kill any pending resets */
        if (priv->status & STATUS_RESET_PENDING)
                cancel_delayed_work(&priv->reset_work);

        /* Make sure the interrupt is on so that FW commands will be
         * processed correctly */
        spin_lock_irqsave(&priv->low_lock, flags);
        ipw2100_enable_interrupts(priv);
        spin_unlock_irqrestore(&priv->low_lock, flags);

        if (ipw2100_hw_stop_adapter(priv))
                printk(KERN_ERR DRV_NAME ": %s: Error stopping adapter.\n",
                       priv->net_dev->name);

        /* Do not disable the interrupt until _after_ we disable
         * the adaptor.  Otherwise the CARD_DISABLE command will never
         * be ack'd by the firmware */
        spin_lock_irqsave(&priv->low_lock, flags);
        ipw2100_disable_interrupts(priv);
        spin_unlock_irqrestore(&priv->low_lock, flags);

        pm_qos_update_request(&ipw2100_pm_qos_req, PM_QOS_DEFAULT_VALUE);

        /* We have to signal any supplicant if we are disassociating */
        if (associated)
                wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);

        priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
        netif_carrier_off(priv->net_dev);
        netif_stop_queue(priv->net_dev);
}

static int ipw2100_wdev_init(struct net_device *dev)
{
        struct ipw2100_priv *priv = libipw_priv(dev);
        const struct libipw_geo *geo = libipw_get_geo(priv->ieee);
        struct wireless_dev *wdev = &priv->ieee->wdev;
        int i;

        memcpy(wdev->wiphy->perm_addr, priv->mac_addr, ETH_ALEN);

        /* fill-out priv->ieee->bg_band */
        if (geo->bg_channels) {
                struct ieee80211_supported_band *bg_band = &priv->ieee->bg_band;

                bg_band->band = NL80211_BAND_2GHZ;
                bg_band->n_channels = geo->bg_channels;
                bg_band->channels = kcalloc(geo->bg_channels,
                                            sizeof(struct ieee80211_channel),
                                            GFP_KERNEL);
                if (!bg_band->channels) {
                        ipw2100_down(priv);
                        return -ENOMEM;
                }
                /* translate geo->bg to bg_band.channels */
                for (i = 0; i < geo->bg_channels; i++) {
                        bg_band->channels[i].band = NL80211_BAND_2GHZ;
                        bg_band->channels[i].center_freq = geo->bg[i].freq;
                        bg_band->channels[i].hw_value = geo->bg[i].channel;
                        bg_band->channels[i].max_power = geo->bg[i].max_power;
                        if (geo->bg[i].flags & LIBIPW_CH_PASSIVE_ONLY)
                                bg_band->channels[i].flags |=
                                        IEEE80211_CHAN_NO_IR;
                        if (geo->bg[i].flags & LIBIPW_CH_NO_IBSS)
                                bg_band->channels[i].flags |=
                                        IEEE80211_CHAN_NO_IR;
                        if (geo->bg[i].flags & LIBIPW_CH_RADAR_DETECT)
                                bg_band->channels[i].flags |=
                                        IEEE80211_CHAN_RADAR;
                        /* No equivalent for LIBIPW_CH_80211H_RULES,
                           LIBIPW_CH_UNIFORM_SPREADING, or
                           LIBIPW_CH_B_ONLY... */
                }
                /* point at bitrate info */
                bg_band->bitrates = ipw2100_bg_rates;
                bg_band->n_bitrates = RATE_COUNT;

                wdev->wiphy->bands[NL80211_BAND_2GHZ] = bg_band;
        }

        wdev->wiphy->cipher_suites = ipw_cipher_suites;
        wdev->wiphy->n_cipher_suites = ARRAY_SIZE(ipw_cipher_suites);

        set_wiphy_dev(wdev->wiphy, &priv->pci_dev->dev);
        if (wiphy_register(wdev->wiphy))
                return -EIO;
        return 0;
}

static void ipw2100_reset_adapter(struct work_struct *work)
{
        struct ipw2100_priv *priv =
                container_of(work, struct ipw2100_priv, reset_work.work);
        unsigned long flags;
        union iwreq_data wrqu = {
                .ap_addr = {
                            .sa_family = ARPHRD_ETHER}
        };
        int associated = priv->status & STATUS_ASSOCIATED;

        spin_lock_irqsave(&priv->low_lock, flags);
        IPW_DEBUG_INFO(": %s: Restarting adapter.\n", priv->net_dev->name);
        priv->resets++;
        priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
        priv->status |= STATUS_SECURITY_UPDATED;

        /* Force a power cycle even if interface hasn't been opened
         * yet */
        cancel_delayed_work(&priv->reset_work);
        priv->status |= STATUS_RESET_PENDING;
        spin_unlock_irqrestore(&priv->low_lock, flags);

        mutex_lock(&priv->action_mutex);
        /* stop timed checks so that they don't interfere with reset */
        priv->stop_hang_check = 1;
        cancel_delayed_work(&priv->hang_check);

        /* We have to signal any supplicant if we are disassociating */
        if (associated)
                wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);

        ipw2100_up(priv, 0);
        mutex_unlock(&priv->action_mutex);

}

static void isr_indicate_associated(struct ipw2100_priv *priv, u32 status)
{

#define MAC_ASSOCIATION_READ_DELAY (HZ)

        int ret;
        unsigned int len, essid_len;
        char essid[IW_ESSID_MAX_SIZE];
        u32 txrate;
        u32 chan;
        char *txratename;
        u8 bssid[ETH_ALEN];

        /*
         * TBD: BSSID is usually 00:00:00:00:00:00 here and not
         *      an actual MAC of the AP. Seems like FW sets this
         *      address too late. Read it later and expose through
         *      /proc or schedule a later task to query and update
         */

        essid_len = IW_ESSID_MAX_SIZE;
        ret = ipw2100_get_ordinal(priv, IPW_ORD_STAT_ASSN_SSID,
                                  essid, &essid_len);
        if (ret) {
                IPW_DEBUG_INFO("failed querying ordinals at line %d\n",
                               __LINE__);
                return;
        }

        len = sizeof(u32);
        ret = ipw2100_get_ordinal(priv, IPW_ORD_CURRENT_TX_RATE, &txrate, &len);
        if (ret) {
                IPW_DEBUG_INFO("failed querying ordinals at line %d\n",
                               __LINE__);
                return;
        }

        len = sizeof(u32);
        ret = ipw2100_get_ordinal(priv, IPW_ORD_OUR_FREQ, &chan, &len);
        if (ret) {
                IPW_DEBUG_INFO("failed querying ordinals at line %d\n",
                               __LINE__);
                return;
        }
        len = ETH_ALEN;
        ret = ipw2100_get_ordinal(priv, IPW_ORD_STAT_ASSN_AP_BSSID, bssid,
                                  &len);
        if (ret) {
                IPW_DEBUG_INFO("failed querying ordinals at line %d\n",
                               __LINE__);
                return;
        }
        memcpy(priv->ieee->bssid, bssid, ETH_ALEN);

        switch (txrate) {
        case TX_RATE_1_MBIT:
                txratename = "1Mbps";
                break;
        case TX_RATE_2_MBIT:
                txratename = "2Mbsp";
                break;
        case TX_RATE_5_5_MBIT:
                txratename = "5.5Mbps";
                break;
        case TX_RATE_11_MBIT:
                txratename = "11Mbps";
                break;
        default:
                IPW_DEBUG_INFO("Unknown rate: %d\n", txrate);
                txratename = "unknown rate";
                break;
        }

        IPW_DEBUG_INFO("%s: Associated with '%*pE' at %s, channel %d (BSSID=%pM)\n",
                       priv->net_dev->name, essid_len, essid,
                       txratename, chan, bssid);

        /* now we copy read ssid into dev */
        if (!(priv->config & CFG_STATIC_ESSID)) {
                priv->essid_len = min((u8) essid_len, (u8) IW_ESSID_MAX_SIZE);
                memcpy(priv->essid, essid, priv->essid_len);
        }
        priv->channel = chan;
        memcpy(priv->bssid, bssid, ETH_ALEN);

        priv->status |= STATUS_ASSOCIATING;
        priv->connect_start = get_seconds();

        schedule_delayed_work(&priv->wx_event_work, HZ / 10);
}

static int ipw2100_set_essid(struct ipw2100_priv *priv, char *essid,
                             int length, int batch_mode)
{
        int ssid_len = min(length, IW_ESSID_MAX_SIZE);
        struct host_command cmd = {
                .host_command = SSID,
                .host_command_sequence = 0,
                .host_command_length = ssid_len
        };
        int err;

        IPW_DEBUG_HC("SSID: '%*pE'\n", ssid_len, essid);

        if (ssid_len)
                memcpy(cmd.host_command_parameters, essid, ssid_len);

        if (!batch_mode) {
                err = ipw2100_disable_adapter(priv);
                if (err)
                        return err;
        }

        /* Bug in FW currently doesn't honor bit 0 in SET_SCAN_OPTIONS to
         * disable auto association -- so we cheat by setting a bogus SSID */
        if (!ssid_len && !(priv->config & CFG_ASSOCIATE)) {
                int i;
                u8 *bogus = (u8 *) cmd.host_command_parameters;
                for (i = 0; i < IW_ESSID_MAX_SIZE; i++)
                        bogus[i] = 0x18 + i;
                cmd.host_command_length = IW_ESSID_MAX_SIZE;
        }

        /* NOTE:  We always send the SSID command even if the provided ESSID is
         * the same as what we currently think is set. */

        err = ipw2100_hw_send_command(priv, &cmd);
        if (!err) {
                memset(priv->essid + ssid_len, 0, IW_ESSID_MAX_SIZE - ssid_len);
                memcpy(priv->essid, essid, ssid_len);
                priv->essid_len = ssid_len;
        }

        if (!batch_mode) {
                if (ipw2100_enable_adapter(priv))
                        err = -EIO;
        }

        return err;
}

static void isr_indicate_association_lost(struct ipw2100_priv *priv, u32 status)
{
        IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE | IPW_DL_ASSOC,
                  "disassociated: '%*pE' %pM\n", priv->essid_len, priv->essid,
                  priv->bssid);

        priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);

        if (priv->status & STATUS_STOPPING) {
                IPW_DEBUG_INFO("Card is stopping itself, discard ASSN_LOST.\n");
                return;
        }

        eth_zero_addr(priv->bssid);
        eth_zero_addr(priv->ieee->bssid);

        netif_carrier_off(priv->net_dev);
        netif_stop_queue(priv->net_dev);

        if (!(priv->status & STATUS_RUNNING))
                return;

        if (priv->status & STATUS_SECURITY_UPDATED)
                schedule_delayed_work(&priv->security_work, 0);

        schedule_delayed_work(&priv->wx_event_work, 0);
}

static void isr_indicate_rf_kill(struct ipw2100_priv *priv, u32 status)
{
        IPW_DEBUG_INFO("%s: RF Kill state changed to radio OFF.\n",
                       priv->net_dev->name);

        /* RF_KILL is now enabled (else we wouldn't be here) */
        wiphy_rfkill_set_hw_state(priv->ieee->wdev.wiphy, true);
        priv->status |= STATUS_RF_KILL_HW;

        /* Make sure the RF Kill check timer is running */
        priv->stop_rf_kill = 0;
        mod_delayed_work(system_wq, &priv->rf_kill, round_jiffies_relative(HZ));
}

static void ipw2100_scan_event(struct work_struct *work)
{
        struct ipw2100_priv *priv = container_of(work, struct ipw2100_priv,
                                                 scan_event.work);
        union iwreq_data wrqu;

        wrqu.data.length = 0;
        wrqu.data.flags = 0;
        wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
}

static void isr_scan_complete(struct ipw2100_priv *priv, u32 status)
{
        IPW_DEBUG_SCAN("scan complete\n");
        /* Age the scan results... */
        priv->ieee->scans++;
        priv->status &= ~STATUS_SCANNING;

        /* Only userspace-requested scan completion events go out immediately */
        if (!priv->user_requested_scan) {
                schedule_delayed_work(&priv->scan_event,
                                      round_jiffies_relative(msecs_to_jiffies(4000)));
        } else {
                priv->user_requested_scan = 0;
                mod_delayed_work(system_wq, &priv->scan_event, 0);
        }
}

#ifdef CONFIG_IPW2100_DEBUG
#define IPW2100_HANDLER(v, f) { v, f, # v }
struct ipw2100_status_indicator {
        int status;
        void (*cb) (struct ipw2100_priv * priv, u32 status);
        char *name;
};
#else
#define IPW2100_HANDLER(v, f) { v, f }
struct ipw2100_status_indicator {
        int status;
        void (*cb) (struct ipw2100_priv * priv, u32 status);
};
#endif                          /* CONFIG_IPW2100_DEBUG */

static void isr_indicate_scanning(struct ipw2100_priv *priv, u32 status)
{
        IPW_DEBUG_SCAN("Scanning...\n");
        priv->status |= STATUS_SCANNING;
}

static const struct ipw2100_status_indicator status_handlers[] = {
        IPW2100_HANDLER(IPW_STATE_INITIALIZED, NULL),
        IPW2100_HANDLER(IPW_STATE_COUNTRY_FOUND, NULL),
        IPW2100_HANDLER(IPW_STATE_ASSOCIATED, isr_indicate_associated),
        IPW2100_HANDLER(IPW_STATE_ASSN_LOST, isr_indicate_association_lost),
        IPW2100_HANDLER(IPW_STATE_ASSN_CHANGED, NULL),
        IPW2100_HANDLER(IPW_STATE_SCAN_COMPLETE, isr_scan_complete),
        IPW2100_HANDLER(IPW_STATE_ENTERED_PSP, NULL),
        IPW2100_HANDLER(IPW_STATE_LEFT_PSP, NULL),
        IPW2100_HANDLER(IPW_STATE_RF_KILL, isr_indicate_rf_kill),
        IPW2100_HANDLER(IPW_STATE_DISABLED, NULL),
        IPW2100_HANDLER(IPW_STATE_POWER_DOWN, NULL),
        IPW2100_HANDLER(IPW_STATE_SCANNING, isr_indicate_scanning),
        IPW2100_HANDLER(-1, NULL)
};

static void isr_status_change(struct ipw2100_priv *priv, int status)
{
        int i;

        if (status == IPW_STATE_SCANNING &&
            priv->status & STATUS_ASSOCIATED &&
            !(priv->status & STATUS_SCANNING)) {
                IPW_DEBUG_INFO("Scan detected while associated, with "
                               "no scan request.  Restarting firmware.\n");

                /* Wake up any sleeping jobs */
                schedule_reset(priv);
        }

        for (i = 0; status_handlers[i].status != -1; i++) {
                if (status == status_handlers[i].status) {
                        IPW_DEBUG_NOTIF("Status change: %s\n",
                                        status_handlers[i].name);
                        if (status_handlers[i].cb)
                                status_handlers[i].cb(priv, status);
                        priv->wstats.status = status;
                        return;
                }
        }

        IPW_DEBUG_NOTIF("unknown status received: %04x\n", status);
}

static void isr_rx_complete_command(struct ipw2100_priv *priv,
                                    struct ipw2100_cmd_header *cmd)
{
#ifdef CONFIG_IPW2100_DEBUG
        if (cmd->host_command_reg < ARRAY_SIZE(command_types)) {
                IPW_DEBUG_HC("Command completed '%s (%d)'\n",
                             command_types[cmd->host_command_reg],
                             cmd->host_command_reg);
        }
#endif
        if (cmd->host_command_reg == HOST_COMPLETE)
                priv->status |= STATUS_ENABLED;

        if (cmd->host_command_reg == CARD_DISABLE)
                priv->status &= ~STATUS_ENABLED;

        priv->status &= ~STATUS_CMD_ACTIVE;

        wake_up_interruptible(&priv->wait_command_queue);
}

#ifdef CONFIG_IPW2100_DEBUG
static const char *frame_types[] = {
        "COMMAND_STATUS_VAL",
        "STATUS_CHANGE_VAL",
        "P80211_DATA_VAL",
        "P8023_DATA_VAL",
        "HOST_NOTIFICATION_VAL"
};
#endif

static int ipw2100_alloc_skb(struct ipw2100_priv *priv,
                                    struct ipw2100_rx_packet *packet)
{
        packet->skb = dev_alloc_skb(sizeof(struct ipw2100_rx));
        if (!packet->skb)
                return -ENOMEM;

        packet->rxp = (struct ipw2100_rx *)packet->skb->data;
        packet->dma_addr = pci_map_single(priv->pci_dev, packet->skb->data,
                                          sizeof(struct ipw2100_rx),
                                          PCI_DMA_FROMDEVICE);
        if (pci_dma_mapping_error(priv->pci_dev, packet->dma_addr)) {
                dev_kfree_skb(packet->skb);
                return -ENOMEM;
        }

        return 0;
}

#define SEARCH_ERROR   0xffffffff
#define SEARCH_FAIL    0xfffffffe
#define SEARCH_SUCCESS 0xfffffff0
#define SEARCH_DISCARD 0
#define SEARCH_SNAPSHOT 1

#define SNAPSHOT_ADDR(ofs) (priv->snapshot[((ofs) >> 12) & 0xff] + ((ofs) & 0xfff))
static void ipw2100_snapshot_free(struct ipw2100_priv *priv)
{
        int i;
        if (!priv->snapshot[0])
                return;
        for (i = 0; i < 0x30; i++)
                kfree(priv->snapshot[i]);
        priv->snapshot[0] = NULL;
}

#ifdef IPW2100_DEBUG_C3
static int ipw2100_snapshot_alloc(struct ipw2100_priv *priv)
{
        int i;
        if (priv->snapshot[0])
                return 1;
        for (i = 0; i < 0x30; i++) {
                priv->snapshot[i] = kmalloc(0x1000, GFP_ATOMIC);
                if (!priv->snapshot[i]) {
                        IPW_DEBUG_INFO("%s: Error allocating snapshot "
                                       "buffer %d\n", priv->net_dev->name, i);
                        while (i > 0)
                                kfree(priv->snapshot[--i]);
                        priv->snapshot[0] = NULL;
                        return 0;
                }
        }

        return 1;
}

static u32 ipw2100_match_buf(struct ipw2100_priv *priv, u8 * in_buf,
                                    size_t len, int mode)
{
        u32 i, j;
        u32 tmp;
        u8 *s, *d;
        u32 ret;

        s = in_buf;
        if (mode == SEARCH_SNAPSHOT) {
                if (!ipw2100_snapshot_alloc(priv))
                        mode = SEARCH_DISCARD;
        }

        for (ret = SEARCH_FAIL, i = 0; i < 0x30000; i += 4) {
                read_nic_dword(priv->net_dev, i, &tmp);
                if (mode == SEARCH_SNAPSHOT)
                        *(u32 *) SNAPSHOT_ADDR(i) = tmp;
                if (ret == SEARCH_FAIL) {
                        d = (u8 *) & tmp;
                        for (j = 0; j < 4; j++) {
                                if (*s != *d) {
                                        s = in_buf;
                                        continue;
                                }

                                s++;
                                d++;

                                if ((s - in_buf) == len)
                                        ret = (i + j) - len + 1;
                        }
                } else if (mode == SEARCH_DISCARD)
                        return ret;
        }

        return ret;
}
#endif

/*
 *
 * 0) Disconnect the SKB from the firmware (just unmap)
 * 1) Pack the ETH header into the SKB
 * 2) Pass the SKB to the network stack
 *
 * When packet is provided by the firmware, it contains the following:
 *
 * .  libipw_hdr
 * .  libipw_snap_hdr
 *
 * The size of the constructed ethernet
 *
 */
#ifdef IPW2100_RX_DEBUG
static u8 packet_data[IPW_RX_NIC_BUFFER_LENGTH];
#endif

static void ipw2100_corruption_detected(struct ipw2100_priv *priv, int i)
{
#ifdef IPW2100_DEBUG_C3
        struct ipw2100_status *status = &priv->status_queue.drv[i];
        u32 match, reg;
        int j;
#endif

        IPW_DEBUG_INFO(": PCI latency error detected at 0x%04zX.\n",
                       i * sizeof(struct ipw2100_status));

#ifdef IPW2100_DEBUG_C3
        /* Halt the firmware so we can get a good image */
        write_register(priv->net_dev, IPW_REG_RESET_REG,
                       IPW_AUX_HOST_RESET_REG_STOP_MASTER);
        j = 5;
        do {
                udelay(IPW_WAIT_RESET_MASTER_ASSERT_COMPLETE_DELAY);
                read_register(priv->net_dev, IPW_REG_RESET_REG, &reg);

                if (reg & IPW_AUX_HOST_RESET_REG_MASTER_DISABLED)
                        break;
        } while (j--);

        match = ipw2100_match_buf(priv, (u8 *) status,
                                  sizeof(struct ipw2100_status),
                                  SEARCH_SNAPSHOT);
        if (match < SEARCH_SUCCESS)
                IPW_DEBUG_INFO("%s: DMA status match in Firmware at "
                               "offset 0x%06X, length %d:\n",
                               priv->net_dev->name, match,
                               sizeof(struct ipw2100_status));
        else
                IPW_DEBUG_INFO("%s: No DMA status match in "
                               "Firmware.\n", priv->net_dev->name);

        printk_buf((u8 *) priv->status_queue.drv,
                   sizeof(struct ipw2100_status) * RX_QUEUE_LENGTH);
#endif

        priv->fatal_error = IPW2100_ERR_C3_CORRUPTION;
        priv->net_dev->stats.rx_errors++;
        schedule_reset(priv);
}

static void isr_rx(struct ipw2100_priv *priv, int i,
                          struct libipw_rx_stats *stats)
{
        struct net_device *dev = priv->net_dev;
        struct ipw2100_status *status = &priv->status_queue.drv[i];
        struct ipw2100_rx_packet *packet = &priv->rx_buffers[i];

        IPW_DEBUG_RX("Handler...\n");

        if (unlikely(status->frame_size > skb_tailroom(packet->skb))) {
                IPW_DEBUG_INFO("%s: frame_size (%u) > skb_tailroom (%u)!"
                               "  Dropping.\n",
                               dev->name,
                               status->frame_size, skb_tailroom(packet->skb));
                dev->stats.rx_errors++;
                return;
        }

        if (unlikely(!netif_running(dev))) {
                dev->stats.rx_errors++;
                priv->wstats.discard.misc++;
                IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
                return;
        }

        if (unlikely(priv->ieee->iw_mode != IW_MODE_MONITOR &&
                     !(priv->status & STATUS_ASSOCIATED))) {
                IPW_DEBUG_DROP("Dropping packet while not associated.\n");
                priv->wstats.discard.misc++;
                return;
        }

        pci_unmap_single(priv->pci_dev,
                         packet->dma_addr,
                         sizeof(struct ipw2100_rx), PCI_DMA_FROMDEVICE);

        skb_put(packet->skb, status->frame_size);

#ifdef IPW2100_RX_DEBUG
        /* Make a copy of the frame so we can dump it to the logs if
         * libipw_rx fails */
        skb_copy_from_linear_data(packet->skb, packet_data,
                                  min_t(u32, status->frame_size,
                                             IPW_RX_NIC_BUFFER_LENGTH));
#endif

        if (!libipw_rx(priv->ieee, packet->skb, stats)) {
#ifdef IPW2100_RX_DEBUG
                IPW_DEBUG_DROP("%s: Non consumed packet:\n",
                               dev->name);
                printk_buf(IPW_DL_DROP, packet_data, status->frame_size);
#endif
                dev->stats.rx_errors++;

                /* libipw_rx failed, so it didn't free the SKB */
                dev_kfree_skb_any(packet->skb);
                packet->skb = NULL;
        }

        /* We need to allocate a new SKB and attach it to the RDB. */
        if (unlikely(ipw2100_alloc_skb(priv, packet))) {
                printk(KERN_WARNING DRV_NAME ": "
                       "%s: Unable to allocate SKB onto RBD ring - disabling "
                       "adapter.\n", dev->name);
                /* TODO: schedule adapter shutdown */
                IPW_DEBUG_INFO("TODO: Shutdown adapter...\n");
        }

        /* Update the RDB entry */
        priv->rx_queue.drv[i].host_addr = packet->dma_addr;
}

#ifdef CONFIG_IPW2100_MONITOR

static void isr_rx_monitor(struct ipw2100_priv *priv, int i,
                   struct libipw_rx_stats *stats)
{
        struct net_device *dev = priv->net_dev;
        struct ipw2100_status *status = &priv->status_queue.drv[i];
        struct ipw2100_rx_packet *packet = &priv->rx_buffers[i];

        /* Magic struct that slots into the radiotap header -- no reason
         * to build this manually element by element, we can write it much
         * more efficiently than we can parse it. ORDER MATTERS HERE */
        struct ipw_rt_hdr {
                struct ieee80211_radiotap_header rt_hdr;
                s8 rt_dbmsignal; /* signal in dbM, kluged to signed */
        } *ipw_rt;

        IPW_DEBUG_RX("Handler...\n");

        if (unlikely(status->frame_size > skb_tailroom(packet->skb) -
                                sizeof(struct ipw_rt_hdr))) {
                IPW_DEBUG_INFO("%s: frame_size (%u) > skb_tailroom (%u)!"
                               "  Dropping.\n",
                               dev->name,
                               status->frame_size,
                               skb_tailroom(packet->skb));
                dev->stats.rx_errors++;
                return;
        }

        if (unlikely(!netif_running(dev))) {
                dev->stats.rx_errors++;
                priv->wstats.discard.misc++;
                IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
                return;
        }

        if (unlikely(priv->config & CFG_CRC_CHECK &&
                     status->flags & IPW_STATUS_FLAG_CRC_ERROR)) {
                IPW_DEBUG_RX("CRC error in packet.  Dropping.\n");
                dev->stats.rx_errors++;
                return;
        }

        pci_unmap_single(priv->pci_dev, packet->dma_addr,
                         sizeof(struct ipw2100_rx), PCI_DMA_FROMDEVICE);
        memmove(packet->skb->data + sizeof(struct ipw_rt_hdr),
                packet->skb->data, status->frame_size);

        ipw_rt = (struct ipw_rt_hdr *) packet->skb->data;

        ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
        ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
        ipw_rt->rt_hdr.it_len = cpu_to_le16(sizeof(struct ipw_rt_hdr)); /* total hdr+data */

        ipw_rt->rt_hdr.it_present = cpu_to_le32(1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL);

        ipw_rt->rt_dbmsignal = status->rssi + IPW2100_RSSI_TO_DBM;

        skb_put(packet->skb, status->frame_size + sizeof(struct ipw_rt_hdr));

        if (!libipw_rx(priv->ieee, packet->skb, stats)) {
                dev->stats.rx_errors++;

                /* libipw_rx failed, so it didn't free the SKB */
                dev_kfree_skb_any(packet->skb);
                packet->skb = NULL;
        }

        /* We need to allocate a new SKB and attach it to the RDB. */
        if (unlikely(ipw2100_alloc_skb(priv, packet))) {
                IPW_DEBUG_WARNING(
                        "%s: Unable to allocate SKB onto RBD ring - disabling "
                        "adapter.\n", dev->name);
                /* TODO: schedule adapter shutdown */
                IPW_DEBUG_INFO("TODO: Shutdown adapter...\n");
        }

        /* Update the RDB entry */
        priv->rx_queue.drv[i].host_addr = packet->dma_addr;
}

#endif

static int ipw2100_corruption_check(struct ipw2100_priv *priv, int i)
{
        struct ipw2100_status *status = &priv->status_queue.drv[i];
        struct ipw2100_rx *u = priv->rx_buffers[i].rxp;
        u16 frame_type = status->status_fields & STATUS_TYPE_MASK;

        switch (frame_type) {
        case COMMAND_STATUS_VAL:
                return (status->frame_size != sizeof(u->rx_data.command));
        case STATUS_CHANGE_VAL:
                return (status->frame_size != sizeof(u->rx_data.status));
        case HOST_NOTIFICATION_VAL:
                return (status->frame_size < sizeof(u->rx_data.notification));
        case P80211_DATA_VAL:
        case P8023_DATA_VAL:
#ifdef CONFIG_IPW2100_MONITOR
                return 0;
#else
                switch (WLAN_FC_GET_TYPE(le16_to_cpu(u->rx_data.header.frame_ctl))) {
                case IEEE80211_FTYPE_MGMT:
                case IEEE80211_FTYPE_CTL:
                        return 0;
                case IEEE80211_FTYPE_DATA:
                        return (status->frame_size >
                                IPW_MAX_802_11_PAYLOAD_LENGTH);
                }
#endif
        }

        return 1;
}

/*
 * ipw2100 interrupts are disabled at this point, and the ISR
 * is the only code that calls this method.  So, we do not need
 * to play with any locks.
 *
 * RX Queue works as follows:
 *
 * Read index - firmware places packet in entry identified by the
 *              Read index and advances Read index.  In this manner,
 *              Read index will always point to the next packet to
 *              be filled--but not yet valid.
 *
 * Write index - driver fills this entry with an unused RBD entry.
 *               This entry has not filled by the firmware yet.
 *
 * In between the W and R indexes are the RBDs that have been received
 * but not yet processed.
 *
 * The process of handling packets will start at WRITE + 1 and advance
 * until it reaches the READ index.
 *
 * The WRITE index is cached in the variable 'priv->rx_queue.next'.
 *
 */
static void __ipw2100_rx_process(struct ipw2100_priv *priv)
{
        struct ipw2100_bd_queue *rxq = &priv->rx_queue;
        struct ipw2100_status_queue *sq = &priv->status_queue;
        struct ipw2100_rx_packet *packet;
        u16 frame_type;
        u32 r, w, i, s;
        struct ipw2100_rx *u;
        struct libipw_rx_stats stats = {
                .mac_time = jiffies,
        };

        read_register(priv->net_dev, IPW_MEM_HOST_SHARED_RX_READ_INDEX, &r);
        read_register(priv->net_dev, IPW_MEM_HOST_SHARED_RX_WRITE_INDEX, &w);

        if (r >= rxq->entries) {
                IPW_DEBUG_RX("exit - bad read index\n");
                return;
        }

        i = (rxq->next + 1) % rxq->entries;
        s = i;
        while (i != r) {
                /* IPW_DEBUG_RX("r = %d : w = %d : processing = %d\n",
                   r, rxq->next, i); */

                packet = &priv->rx_buffers[i];

                /* Sync the DMA for the RX buffer so CPU is sure to get
                 * the correct values */
                pci_dma_sync_single_for_cpu(priv->pci_dev, packet->dma_addr,
                                            sizeof(struct ipw2100_rx),
                                            PCI_DMA_FROMDEVICE);

                if (unlikely(ipw2100_corruption_check(priv, i))) {
                        ipw2100_corruption_detected(priv, i);
                        goto increment;
                }

                u = packet->rxp;
                frame_type = sq->drv[i].status_fields & STATUS_TYPE_MASK;
                stats.rssi = sq->drv[i].rssi + IPW2100_RSSI_TO_DBM;
                stats.len = sq->drv[i].frame_size;

                stats.mask = 0;
                if (stats.rssi != 0)
                        stats.mask |= LIBIPW_STATMASK_RSSI;
                stats.freq = LIBIPW_24GHZ_BAND;

                IPW_DEBUG_RX("%s: '%s' frame type received (%d).\n",
                             priv->net_dev->name, frame_types[frame_type],
                             stats.len);

                switch (frame_type) {
                case COMMAND_STATUS_VAL:
                        /* Reset Rx watchdog */
                        isr_rx_complete_command(priv, &u->rx_data.command);
                        break;

                case STATUS_CHANGE_VAL:
                        isr_status_change(priv, u->rx_data.status);
                        break;

                case P80211_DATA_VAL:
                case P8023_DATA_VAL:
#ifdef CONFIG_IPW2100_MONITOR
                        if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
                                isr_rx_monitor(priv, i, &stats);
                                break;
                        }
#endif
                        if (stats.len < sizeof(struct libipw_hdr_3addr))
                                break;
                        switch (WLAN_FC_GET_TYPE(le16_to_cpu(u->rx_data.header.frame_ctl))) {
                        case IEEE80211_FTYPE_MGMT:
                                libipw_rx_mgt(priv->ieee,
                                                 &u->rx_data.header, &stats);
                                break;

                        case IEEE80211_FTYPE_CTL:
                                break;

                        case IEEE80211_FTYPE_DATA:
                                isr_rx(priv, i, &stats);
                                break;

                        }
                        break;
                }

              increment:
                /* clear status field associated with this RBD */
                rxq->drv[i].status.info.field = 0;

                i = (i + 1) % rxq->entries;
        }

        if (i != s) {
                /* backtrack one entry, wrapping to end if at 0 */
                rxq->next = (i ? i : rxq->entries) - 1;

                write_register(priv->net_dev,
                               IPW_MEM_HOST_SHARED_RX_WRITE_INDEX, rxq->next);
        }
}

/*
 * __ipw2100_tx_process
 *
 * This routine will determine whether the next packet on
 * the fw_pend_list has been processed by the firmware yet.
 *
 * If not, then it does nothing and returns.
 *
 * If so, then it removes the item from the fw_pend_list, frees
 * any associated storage, and places the item back on the
 * free list of its source (either msg_free_list or tx_free_list)
 *
 * TX Queue works as follows:
 *
 * Read index - points to the next TBD that the firmware will
 *              process.  The firmware will read the data, and once
 *              done processing, it will advance the Read index.
 *
 * Write index - driver fills this entry with an constructed TBD
 *               entry.  The Write index is not advanced until the
 *               packet has been configured.
 *
 * In between the W and R indexes are the TBDs that have NOT been
 * processed.  Lagging behind the R index are packets that have
 * been processed but have not been freed by the driver.
 *
 * In order to free old storage, an internal index will be maintained
 * that points to the next packet to be freed.  When all used
 * packets have been freed, the oldest index will be the same as the
 * firmware's read index.
 *
 * The OLDEST index is cached in the variable 'priv->tx_queue.oldest'
 *
 * Because the TBD structure can not contain arbitrary data, the
 * driver must keep an internal queue of cached allocations such that
 * it can put that data back into the tx_free_list and msg_free_list
 * for use by future command and data packets.
 *
 */
static int __ipw2100_tx_process(struct ipw2100_priv *priv)
{
        struct ipw2100_bd_queue *txq = &priv->tx_queue;
        struct ipw2100_bd *tbd;
        struct list_head *element;
        struct ipw2100_tx_packet *packet;
        int descriptors_used;
        int e, i;
        u32 r, w, frag_num = 0;

        if (list_empty(&priv->fw_pend_list))
                return 0;

        element = priv->fw_pend_list.next;

        packet = list_entry(element, struct ipw2100_tx_packet, list);
        tbd = &txq->drv[packet->index];

        /* Determine how many TBD entries must be finished... */
        switch (packet->type) {
        case COMMAND:
                /* COMMAND uses only one slot; don't advance */
                descriptors_used = 1;
                e = txq->oldest;
                break;

        case DATA:
                /* DATA uses two slots; advance and loop position. */
                descriptors_used = tbd->num_fragments;
                frag_num = tbd->num_fragments - 1;
                e = txq->oldest + frag_num;
                e %= txq->entries;
                break;

        default:
                printk(KERN_WARNING DRV_NAME ": %s: Bad fw_pend_list entry!\n",
                       priv->net_dev->name);
                return 0;
        }

        /* if the last TBD is not done by NIC yet, then packet is
         * not ready to be released.
         *
         */
        read_register(priv->net_dev, IPW_MEM_HOST_SHARED_TX_QUEUE_READ_INDEX,
                      &r);
        read_register(priv->net_dev, IPW_MEM_HOST_SHARED_TX_QUEUE_WRITE_INDEX,
                      &w);
        if (w != txq->next)
                printk(KERN_WARNING DRV_NAME ": %s: write index mismatch\n",
                       priv->net_dev->name);

        /*
         * txq->next is the index of the last packet written txq->oldest is
         * the index of the r is the index of the next packet to be read by
         * firmware
         */

        /*
         * Quick graphic to help you visualize the following
         * if / else statement
         *
         * ===>|                     s---->|===============
         *                               e>|
         * | a | b | c | d | e | f | g | h | i | j | k | l
         *       r---->|
         *               w
         *
         * w - updated by driver
         * r - updated by firmware
         * s - start of oldest BD entry (txq->oldest)
         * e - end of oldest BD entry
         *
         */
        if (!((r <= w && (e < r || e >= w)) || (e < r && e >= w))) {
                IPW_DEBUG_TX("exit - no processed packets ready to release.\n");
                return 0;
        }

        list_del(element);
        DEC_STAT(&priv->fw_pend_stat);

#ifdef CONFIG_IPW2100_DEBUG
        {
                i = txq->oldest;
                IPW_DEBUG_TX("TX%d V=%p P=%04X T=%04X L=%d\n", i,
                             &txq->drv[i],
                             (u32) (txq->nic + i * sizeof(struct ipw2100_bd)),
                             txq->drv[i].host_addr, txq->drv[i].buf_length);

                if (packet->type == DATA) {
                        i = (i + 1) % txq->entries;

                        IPW_DEBUG_TX("TX%d V=%p P=%04X T=%04X L=%d\n", i,
                                     &txq->drv[i],
                                     (u32) (txq->nic + i *
                                            sizeof(struct ipw2100_bd)),
                                     (u32) txq->drv[i].host_addr,
                                     txq->drv[i].buf_length);
                }
        }
#endif

        switch (packet->type) {
        case DATA:
                if (txq->drv[txq->oldest].status.info.fields.txType != 0)
                        printk(KERN_WARNING DRV_NAME ": %s: Queue mismatch.  "
                               "Expecting DATA TBD but pulled "
                               "something else: ids %d=%d.\n",
                               priv->net_dev->name, txq->oldest, packet->index);

                /* DATA packet; we have to unmap and free the SKB */
                for (i = 0; i < frag_num; i++) {
                        tbd = &txq->drv[(packet->index + 1 + i) % txq->entries];

                        IPW_DEBUG_TX("TX%d P=%08x L=%d\n",
                                     (packet->index + 1 + i) % txq->entries,
                                     tbd->host_addr, tbd->buf_length);

                        pci_unmap_single(priv->pci_dev,
                                         tbd->host_addr,
                                         tbd->buf_length, PCI_DMA_TODEVICE);
                }

                libipw_txb_free(packet->info.d_struct.txb);
                packet->info.d_struct.txb = NULL;

                list_add_tail(element, &priv->tx_free_list);
                INC_STAT(&priv->tx_free_stat);

                /* We have a free slot in the Tx queue, so wake up the
                 * transmit layer if it is stopped. */
                if (priv->status & STATUS_ASSOCIATED)
                        netif_wake_queue(priv->net_dev);

                /* A packet was processed by the hardware, so update the
                 * watchdog */
                netif_trans_update(priv->net_dev);

                break;

        case COMMAND:
                if (txq->drv[txq->oldest].status.info.fields.txType != 1)
                        printk(KERN_WARNING DRV_NAME ": %s: Queue mismatch.  "
                               "Expecting COMMAND TBD but pulled "
                               "something else: ids %d=%d.\n",
                               priv->net_dev->name, txq->oldest, packet->index);

#ifdef CONFIG_IPW2100_DEBUG
                if (packet->info.c_struct.cmd->host_command_reg <
                    ARRAY_SIZE(command_types))
                        IPW_DEBUG_TX("Command '%s (%d)' processed: %d.\n",
                                     command_types[packet->info.c_struct.cmd->
                                                   host_command_reg],
                                     packet->info.c_struct.cmd->
                                     host_command_reg,
                                     packet->info.c_struct.cmd->cmd_status_reg);
#endif

                list_add_tail(element, &priv->msg_free_list);
                INC_STAT(&priv->msg_free_stat);
                break;
        }

        /* advance oldest used TBD pointer to start of next entry */
        txq->oldest = (e + 1) % txq->entries;
        /* increase available TBDs number */
        txq->available += descriptors_used;
        SET_STAT(&priv->txq_stat, txq->available);

        IPW_DEBUG_TX("packet latency (send to process)  %ld jiffies\n",
                     jiffies - packet->jiffy_start);

        return (!list_empty(&priv->fw_pend_list));
}

static inline void __ipw2100_tx_complete(struct ipw2100_priv *priv)
{
        int i = 0;

        while (__ipw2100_tx_process(priv) && i < 200)

                i++;

        if (i == 200) {
                printk(KERN_WARNING DRV_NAME ": "
                       "%s: Driver is running slow (%d iters).\n",
                       priv->net_dev->name, i);
        }
}

static void ipw2100_tx_send_commands(struct ipw2100_priv *priv)
{
        struct list_head *element;
        struct ipw2100_tx_packet *packet;
        struct ipw2100_bd_queue *txq = &priv->tx_queue;
        struct ipw2100_bd *tbd;
        int next = txq->next;

        while (!list_empty(&priv->msg_pend_list)) {
                /* if there isn't enough space in TBD queue, then
                 * don't stuff a new one in.
                 * NOTE: 3 are needed as a command will take one,
                 *       and there is a minimum of 2 that must be
                 *       maintained between the r and w indexes
                 */
                if (txq->available <= 3) {
                        IPW_DEBUG_TX("no room in tx_queue\n");
                        break;
                }

                element = priv->msg_pend_list.next;
                list_del(element);
                DEC_STAT(&priv->msg_pend_stat);

                packet = list_entry(element, struct ipw2100_tx_packet, list);

                IPW_DEBUG_TX("using TBD at virt=%p, phys=%04X\n",
                             &txq->drv[txq->next],
                             (u32) (txq->nic + txq->next *
                                      sizeof(struct ipw2100_bd)));

                packet->index = txq->next;

                tbd = &txq->drv[txq->next];

                /* initialize TBD */
                tbd->host_addr = packet->info.c_struct.cmd_phys;
                tbd->buf_length = sizeof(struct ipw2100_cmd_header);
                /* not marking number of fragments causes problems
                 * with f/w debug version */
                tbd->num_fragments = 1;
                tbd->status.info.field =
                    IPW_BD_STATUS_TX_FRAME_COMMAND |
                    IPW_BD_STATUS_TX_INTERRUPT_ENABLE;

                /* update TBD queue counters */
                txq->next++;
                txq->next %= txq->entries;
                txq->available--;
                DEC_STAT(&priv->txq_stat);

                list_add_tail(element, &priv->fw_pend_list);
                INC_STAT(&priv->fw_pend_stat);
        }

        if (txq->next != next) {
                /* kick off the DMA by notifying firmware the
                 * write index has moved; make sure TBD stores are sync'd */
                wmb();
                write_register(priv->net_dev,
                               IPW_MEM_HOST_SHARED_TX_QUEUE_WRITE_INDEX,
                               txq->next);
        }
}

/*
 * ipw2100_tx_send_data
 *
 */
static void ipw2100_tx_send_data(struct ipw2100_priv *priv)
{
        struct list_head *element;
        struct ipw2100_tx_packet *packet;
        struct ipw2100_bd_queue *txq = &priv->tx_queue;
        struct ipw2100_bd *tbd;
        int next = txq->next;
        int i = 0;
        struct ipw2100_data_header *ipw_hdr;
        struct libipw_hdr_3addr *hdr;

        while (!list_empty(&priv->tx_pend_list)) {
                /* if there isn't enough space in TBD queue, then
                 * don't stuff a new one in.
                 * NOTE: 4 are needed as a data will take two,
                 *       and there is a minimum of 2 that must be
                 *       maintained between the r and w indexes
                 */
                element = priv->tx_pend_list.next;
                packet = list_entry(element, struct ipw2100_tx_packet, list);

                if (unlikely(1 + packet->info.d_struct.txb->nr_frags >
                             IPW_MAX_BDS)) {
                        /* TODO: Support merging buffers if more than
                         * IPW_MAX_BDS are used */
                        IPW_DEBUG_INFO("%s: Maximum BD threshold exceeded.  "
                                       "Increase fragmentation level.\n",
                                       priv->net_dev->name);
                }

                if (txq->available <= 3 + packet->info.d_struct.txb->nr_frags) {
                        IPW_DEBUG_TX("no room in tx_queue\n");
                        break;
                }

                list_del(element);
                DEC_STAT(&priv->tx_pend_stat);

                tbd = &txq->drv[txq->next];

                packet->index = txq->next;

                ipw_hdr = packet->info.d_struct.data;
                hdr = (struct libipw_hdr_3addr *)packet->info.d_struct.txb->
                    fragments[0]->data;

                if (priv->ieee->iw_mode == IW_MODE_INFRA) {
                        /* To DS: Addr1 = BSSID, Addr2 = SA,
                           Addr3 = DA */
                        memcpy(ipw_hdr->src_addr, hdr->addr2, ETH_ALEN);
                        memcpy(ipw_hdr->dst_addr, hdr->addr3, ETH_ALEN);
                } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
                        /* not From/To DS: Addr1 = DA, Addr2 = SA,
                           Addr3 = BSSID */
                        memcpy(ipw_hdr->src_addr, hdr->addr2, ETH_ALEN);
                        memcpy(ipw_hdr->dst_addr, hdr->addr1, ETH_ALEN);
                }

                ipw_hdr->host_command_reg = SEND;
                ipw_hdr->host_command_reg1 = 0;

                /* For now we only support host based encryption */
                ipw_hdr->needs_encryption = 0;
                ipw_hdr->encrypted = packet->info.d_struct.txb->encrypted;
                if (packet->info.d_struct.txb->nr_frags > 1)
                        ipw_hdr->fragment_size =
                            packet->info.d_struct.txb->frag_size -
                            LIBIPW_3ADDR_LEN;
                else
                        ipw_hdr->fragment_size = 0;

                tbd->host_addr = packet->info.d_struct.data_phys;
                tbd->buf_length = sizeof(struct ipw2100_data_header);
                tbd->num_fragments = 1 + packet->info.d_struct.txb->nr_frags;
                tbd->status.info.field =
                    IPW_BD_STATUS_TX_FRAME_802_3 |
                    IPW_BD_STATUS_TX_FRAME_NOT_LAST_FRAGMENT;
                txq->next++;
                txq->next %= txq->entries;

                IPW_DEBUG_TX("data header tbd TX%d P=%08x L=%d\n",
                             packet->index, tbd->host_addr, tbd->buf_length);
#ifdef CONFIG_IPW2100_DEBUG
                if (packet->info.d_struct.txb->nr_frags > 1)
                        IPW_DEBUG_FRAG("fragment Tx: %d frames\n",
                                       packet->info.d_struct.txb->nr_frags);
#endif

                for (i = 0; i < packet->info.d_struct.txb->nr_frags; i++) {
                        tbd = &txq->drv[txq->next];
                        if (i == packet->info.d_struct.txb->nr_frags - 1)
                                tbd->status.info.field =
                                    IPW_BD_STATUS_TX_FRAME_802_3 |
                                    IPW_BD_STATUS_TX_INTERRUPT_ENABLE;
                        else
                                tbd->status.info.field =
                                    IPW_BD_STATUS_TX_FRAME_802_3 |
                                    IPW_BD_STATUS_TX_FRAME_NOT_LAST_FRAGMENT;

                        tbd->buf_length = packet->info.d_struct.txb->
                            fragments[i]->len - LIBIPW_3ADDR_LEN;

                        tbd->host_addr = pci_map_single(priv->pci_dev,
                                                        packet->info.d_struct.
                                                        txb->fragments[i]->
                                                        data +
                                                        LIBIPW_3ADDR_LEN,
                                                        tbd->buf_length,
                                                        PCI_DMA_TODEVICE);
                        if (pci_dma_mapping_error(priv->pci_dev,
                                                  tbd->host_addr)) {
                                IPW_DEBUG_TX("dma mapping error\n");
                                break;
                        }

                        IPW_DEBUG_TX("data frag tbd TX%d P=%08x L=%d\n",
                                     txq->next, tbd->host_addr,
                                     tbd->buf_length);

                        pci_dma_sync_single_for_device(priv->pci_dev,
                                                       tbd->host_addr,
                                                       tbd->buf_length,
                                                       PCI_DMA_TODEVICE);

                        txq->next++;
                        txq->next %= txq->entries;
                }

                txq->available -= 1 + packet->info.d_struct.txb->nr_frags;
                SET_STAT(&priv->txq_stat, txq->available);

                list_add_tail(element, &priv->fw_pend_list);
                INC_STAT(&priv->fw_pend_stat);
        }

        if (txq->next != next) {
                /* kick off the DMA by notifying firmware the
                 * write index has moved; make sure TBD stores are sync'd */
                write_register(priv->net_dev,
                               IPW_MEM_HOST_SHARED_TX_QUEUE_WRITE_INDEX,
                               txq->next);
        }
}

static void ipw2100_irq_tasklet(struct ipw2100_priv *priv)
{
        struct net_device *dev = priv->net_dev;
        unsigned long flags;
        u32 inta, tmp;

        spin_lock_irqsave(&priv->low_lock, flags);
        ipw2100_disable_interrupts(priv);

        read_register(dev, IPW_REG_INTA, &inta);

        IPW_DEBUG_ISR("enter - INTA: 0x%08lX\n",
                      (unsigned long)inta & IPW_INTERRUPT_MASK);

        priv->in_isr++;
        priv->interrupts++;

        /* We do not loop and keep polling for more interrupts as this
         * is frowned upon and doesn't play nicely with other potentially
         * chained IRQs */
        IPW_DEBUG_ISR("INTA: 0x%08lX\n",
                      (unsigned long)inta & IPW_INTERRUPT_MASK);

        if (inta & IPW2100_INTA_FATAL_ERROR) {
                printk(KERN_WARNING DRV_NAME
                       ": Fatal interrupt. Scheduling firmware restart.\n");
                priv->inta_other++;
                write_register(dev, IPW_REG_INTA, IPW2100_INTA_FATAL_ERROR);

                read_nic_dword(dev, IPW_NIC_FATAL_ERROR, &priv->fatal_error);
                IPW_DEBUG_INFO("%s: Fatal error value: 0x%08X\n",
                               priv->net_dev->name, priv->fatal_error);

                read_nic_dword(dev, IPW_ERROR_ADDR(priv->fatal_error), &tmp);
                IPW_DEBUG_INFO("%s: Fatal error address value: 0x%08X\n",
                               priv->net_dev->name, tmp);

                /* Wake up any sleeping jobs */
                schedule_reset(priv);
        }

        if (inta & IPW2100_INTA_PARITY_ERROR) {
                printk(KERN_ERR DRV_NAME
                       ": ***** PARITY ERROR INTERRUPT !!!!\n");
                priv->inta_other++;
                write_register(dev, IPW_REG_INTA, IPW2100_INTA_PARITY_ERROR);
        }

        if (inta & IPW2100_INTA_RX_TRANSFER) {
                IPW_DEBUG_ISR("RX interrupt\n");

                priv->rx_interrupts++;

                write_register(dev, IPW_REG_INTA, IPW2100_INTA_RX_TRANSFER);

                __ipw2100_rx_process(priv);
                __ipw2100_tx_complete(priv);
        }

        if (inta & IPW2100_INTA_TX_TRANSFER) {
                IPW_DEBUG_ISR("TX interrupt\n");

                priv->tx_interrupts++;

                write_register(dev, IPW_REG_INTA, IPW2100_INTA_TX_TRANSFER);

                __ipw2100_tx_complete(priv);
                ipw2100_tx_send_commands(priv);
                ipw2100_tx_send_data(priv);
        }

        if (inta & IPW2100_INTA_TX_COMPLETE) {
                IPW_DEBUG_ISR("TX complete\n");
                priv->inta_other++;
                write_register(dev, IPW_REG_INTA, IPW2100_INTA_TX_COMPLETE);

                __ipw2100_tx_complete(priv);
        }

        if (inta & IPW2100_INTA_EVENT_INTERRUPT) {
                /* ipw2100_handle_event(dev); */
                priv->inta_other++;
                write_register(dev, IPW_REG_INTA, IPW2100_INTA_EVENT_INTERRUPT);
        }

        if (inta & IPW2100_INTA_FW_INIT_DONE) {
                IPW_DEBUG_ISR("FW init done interrupt\n");
                priv->inta_other++;

                read_register(dev, IPW_REG_INTA, &tmp);
                if (tmp & (IPW2100_INTA_FATAL_ERROR |
                           IPW2100_INTA_PARITY_ERROR)) {
                        write_register(dev, IPW_REG_INTA,
                                       IPW2100_INTA_FATAL_ERROR |
                                       IPW2100_INTA_PARITY_ERROR);
                }

                write_register(dev, IPW_REG_INTA, IPW2100_INTA_FW_INIT_DONE);
        }

        if (inta & IPW2100_INTA_STATUS_CHANGE) {
                IPW_DEBUG_ISR("Status change interrupt\n");
                priv->inta_other++;
                write_register(dev, IPW_REG_INTA, IPW2100_INTA_STATUS_CHANGE);
        }

        if (inta & IPW2100_INTA_SLAVE_MODE_HOST_COMMAND_DONE) {
                IPW_DEBUG_ISR("slave host mode interrupt\n");
                priv->inta_other++;
                write_register(dev, IPW_REG_INTA,
                               IPW2100_INTA_SLAVE_MODE_HOST_COMMAND_DONE);
        }

        priv->in_isr--;
        ipw2100_enable_interrupts(priv);

        spin_unlock_irqrestore(&priv->low_lock, flags);

        IPW_DEBUG_ISR("exit\n");
}

static irqreturn_t ipw2100_interrupt(int irq, void *data)
{
        struct ipw2100_priv *priv = data;
        u32 inta, inta_mask;

        if (!data)
                return IRQ_NONE;

        spin_lock(&priv->low_lock);

        /* We check to see if we should be ignoring interrupts before
         * we touch the hardware.  During ucode load if we try and handle
         * an interrupt we can cause keyboard problems as well as cause
         * the ucode to fail to initialize */
        if (!(priv->status & STATUS_INT_ENABLED)) {
                /* Shared IRQ */
                goto none;
        }

        read_register(priv->net_dev, IPW_REG_INTA_MASK, &inta_mask);
        read_register(priv->net_dev, IPW_REG_INTA, &inta);

        if (inta == 0xFFFFFFFF) {
                /* Hardware disappeared */
                printk(KERN_WARNING DRV_NAME ": IRQ INTA == 0xFFFFFFFF\n");
                goto none;
        }

        inta &= IPW_INTERRUPT_MASK;

        if (!(inta & inta_mask)) {
                /* Shared interrupt */
                goto none;
        }

        /* We disable the hardware interrupt here just to prevent unneeded
         * calls to be made.  We disable this again within the actual
         * work tasklet, so if another part of the code re-enables the
         * interrupt, that is fine */
        ipw2100_disable_interrupts(priv);

        tasklet_schedule(&priv->irq_tasklet);
        spin_unlock(&priv->low_lock);

        return IRQ_HANDLED;
      none:
        spin_unlock(&priv->low_lock);
        return IRQ_NONE;
}

static netdev_tx_t ipw2100_tx(struct libipw_txb *txb,
                              struct net_device *dev, int pri)
{
        struct ipw2100_priv *priv = libipw_priv(dev);
        struct list_head *element;
        struct ipw2100_tx_packet *packet;
        unsigned long flags;

        spin_lock_irqsave(&priv->low_lock, flags);

        if (!(priv->status & STATUS_ASSOCIATED)) {
                IPW_DEBUG_INFO("Can not transmit when not connected.\n");
                priv->net_dev->stats.tx_carrier_errors++;
                netif_stop_queue(dev);
                goto fail_unlock;
        }

        if (list_empty(&priv->tx_free_list))
                goto fail_unlock;

        element = priv->tx_free_list.next;
        packet = list_entry(element, struct ipw2100_tx_packet, list);

        packet->info.d_struct.txb = txb;

        IPW_DEBUG_TX("Sending fragment (%d bytes):\n", txb->fragments[0]->len);
        printk_buf(IPW_DL_TX, txb->fragments[0]->data, txb->fragments[0]->len);

        packet->jiffy_start = jiffies;

        list_del(element);
        DEC_STAT(&priv->tx_free_stat);

        list_add_tail(element, &priv->tx_pend_list);
        INC_STAT(&priv->tx_pend_stat);

        ipw2100_tx_send_data(priv);

        spin_unlock_irqrestore(&priv->low_lock, flags);
        return NETDEV_TX_OK;

fail_unlock:
        netif_stop_queue(dev);
        spin_unlock_irqrestore(&priv->low_lock, flags);
        return NETDEV_TX_BUSY;
}

static int ipw2100_msg_allocate(struct ipw2100_priv *priv)
{
        int i, j, err = -EINVAL;
        void *v;
        dma_addr_t p;

        priv->msg_buffers =
            kmalloc(IPW_COMMAND_POOL_SIZE * sizeof(struct ipw2100_tx_packet),
                    GFP_KERNEL);
        if (!priv->msg_buffers)
                return -ENOMEM;

        for (i = 0; i < IPW_COMMAND_POOL_SIZE; i++) {
                v = pci_zalloc_consistent(priv->pci_dev,
                                          sizeof(struct ipw2100_cmd_header),
                                          &p);
                if (!v) {
                        printk(KERN_ERR DRV_NAME ": "
                               "%s: PCI alloc failed for msg "
                               "buffers.\n", priv->net_dev->name);
                        err = -ENOMEM;
                        break;
                }

                priv->msg_buffers[i].type = COMMAND;
                priv->msg_buffers[i].info.c_struct.cmd =
                    (struct ipw2100_cmd_header *)v;
                priv->msg_buffers[i].info.c_struct.cmd_phys = p;
        }

        if (i == IPW_COMMAND_POOL_SIZE)
                return 0;

        for (j = 0; j < i; j++) {
                pci_free_consistent(priv->pci_dev,
                                    sizeof(struct ipw2100_cmd_header),
                                    priv->msg_buffers[j].info.c_struct.cmd,
                                    priv->msg_buffers[j].info.c_struct.
                                    cmd_phys);
        }

        kfree(priv->msg_buffers);
        priv->msg_buffers = NULL;

        return err;
}

static int ipw2100_msg_initialize(struct ipw2100_priv *priv)
{
        int i;

        INIT_LIST_HEAD(&priv->msg_free_list);
        INIT_LIST_HEAD(&priv->msg_pend_list);

        for (i = 0; i < IPW_COMMAND_POOL_SIZE; i++)
                list_add_tail(&priv->msg_buffers[i].list, &priv->msg_free_list);
        SET_STAT(&priv->msg_free_stat, i);

        return 0;
}

static void ipw2100_msg_free(struct ipw2100_priv *priv)
{
        int i;

        if (!priv->msg_buffers)
                return;

        for (i = 0; i < IPW_COMMAND_POOL_SIZE; i++) {
                pci_free_consistent(priv->pci_dev,
                                    sizeof(struct ipw2100_cmd_header),
                                    priv->msg_buffers[i].info.c_struct.cmd,
                                    priv->msg_buffers[i].info.c_struct.
                                    cmd_phys);
        }

        kfree(priv->msg_buffers);
        priv->msg_buffers = NULL;
}

static ssize_t show_pci(struct device *d, struct device_attribute *attr,
                        char *buf)
{
        struct pci_dev *pci_dev = to_pci_dev(d);
        char *out = buf;
        int i, j;
        u32 val;

        for (i = 0; i < 16; i++) {
                out += sprintf(out, "[%08X] ", i * 16);
                for (j = 0; j < 16; j += 4) {
                        pci_read_config_dword(pci_dev, i * 16 + j, &val);
                        out += sprintf(out, "%08X ", val);
                }
                out += sprintf(out, "\n");
        }

        return out - buf;
}

static DEVICE_ATTR(pci, S_IRUGO, show_pci, NULL);

static ssize_t show_cfg(struct device *d, struct device_attribute *attr,
                        char *buf)
{
        struct ipw2100_priv *p = dev_get_drvdata(d);
        return sprintf(buf, "0x%08x\n", (int)p->config);
}

static DEVICE_ATTR(cfg, S_IRUGO, show_cfg, NULL);

static ssize_t show_status(struct device *d, struct device_attribute *attr,
                           char *buf)
{
        struct ipw2100_priv *p = dev_get_drvdata(d);
        return sprintf(buf, "0x%08x\n", (int)p->status);
}

static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);

static ssize_t show_capability(struct device *d, struct device_attribute *attr,
                               char *buf)
{
        struct ipw2100_priv *p = dev_get_drvdata(d);
        return sprintf(buf, "0x%08x\n", (int)p->capability);
}

static DEVICE_ATTR(capability, S_IRUGO, show_capability, NULL);

#define IPW2100_REG(x) { IPW_ ##x, #x }
static const struct {
        u32 addr;
        const char *name;
} hw_data[] = {
IPW2100_REG(REG_GP_CNTRL),
            IPW2100_REG(REG_GPIO),
            IPW2100_REG(REG_INTA),
            IPW2100_REG(REG_INTA_MASK), IPW2100_REG(REG_RESET_REG),};
#define IPW2100_NIC(x, s) { x, #x, s }
static const struct {
        u32 addr;
        const char *name;
        size_t size;
} nic_data[] = {
IPW2100_NIC(IPW2100_CONTROL_REG, 2),
            IPW2100_NIC(0x210014, 1), IPW2100_NIC(0x210000, 1),};
#define IPW2100_ORD(x, d) { IPW_ORD_ ##x, #x, d }
static const struct {
        u8 index;
        const char *name;
        const char *desc;
} ord_data[] = {
IPW2100_ORD(STAT_TX_HOST_REQUESTS, "requested Host Tx's (MSDU)"),
            IPW2100_ORD(STAT_TX_HOST_COMPLETE,
                                "successful Host Tx's (MSDU)"),
            IPW2100_ORD(STAT_TX_DIR_DATA,
                                "successful Directed Tx's (MSDU)"),
            IPW2100_ORD(STAT_TX_DIR_DATA1,
                                "successful Directed Tx's (MSDU) @ 1MB"),
            IPW2100_ORD(STAT_TX_DIR_DATA2,
                                "successful Directed Tx's (MSDU) @ 2MB"),
            IPW2100_ORD(STAT_TX_DIR_DATA5_5,
                                "successful Directed Tx's (MSDU) @ 5_5MB"),
            IPW2100_ORD(STAT_TX_DIR_DATA11,
                                "successful Directed Tx's (MSDU) @ 11MB"),
            IPW2100_ORD(STAT_TX_NODIR_DATA1,
                                "successful Non_Directed Tx's (MSDU) @ 1MB"),
            IPW2100_ORD(STAT_TX_NODIR_DATA2,
                                "successful Non_Directed Tx's (MSDU) @ 2MB"),
            IPW2100_ORD(STAT_TX_NODIR_DATA5_5,
                                "successful Non_Directed Tx's (MSDU) @ 5.5MB"),
            IPW2100_ORD(STAT_TX_NODIR_DATA11,
                                "successful Non_Directed Tx's (MSDU) @ 11MB"),
            IPW2100_ORD(STAT_NULL_DATA, "successful NULL data Tx's"),
            IPW2100_ORD(STAT_TX_RTS, "successful Tx RTS"),
            IPW2100_ORD(STAT_TX_CTS, "successful Tx CTS"),
            IPW2100_ORD(STAT_TX_ACK, "successful Tx ACK"),
            IPW2100_ORD(STAT_TX_ASSN, "successful Association Tx's"),
            IPW2100_ORD(STAT_TX_ASSN_RESP,
                                "successful Association response Tx's"),
            IPW2100_ORD(STAT_TX_REASSN,
                                "successful Reassociation Tx's"),
            IPW2100_ORD(STAT_TX_REASSN_RESP,
                                "successful Reassociation response Tx's"),
            IPW2100_ORD(STAT_TX_PROBE,
                                "probes successfully transmitted"),
            IPW2100_ORD(STAT_TX_PROBE_RESP,
                                "probe responses successfully transmitted"),
            IPW2100_ORD(STAT_TX_BEACON, "tx beacon"),
            IPW2100_ORD(STAT_TX_ATIM, "Tx ATIM"),
            IPW2100_ORD(STAT_TX_DISASSN,
                                "successful Disassociation TX"),
            IPW2100_ORD(STAT_TX_AUTH, "successful Authentication Tx"),
            IPW2100_ORD(STAT_TX_DEAUTH,
                                "successful Deauthentication TX"),
            IPW2100_ORD(STAT_TX_TOTAL_BYTES,
                                "Total successful Tx data bytes"),
            IPW2100_ORD(STAT_TX_RETRIES, "Tx retries"),
            IPW2100_ORD(STAT_TX_RETRY1, "Tx retries at 1MBPS"),
            IPW2100_ORD(STAT_TX_RETRY2, "Tx retries at 2MBPS"),
            IPW2100_ORD(STAT_TX_RETRY5_5, "Tx retries at 5.5MBPS"),
            IPW2100_ORD(STAT_TX_RETRY11, "Tx retries at 11MBPS"),
            IPW2100_ORD(STAT_TX_FAILURES, "Tx Failures"),
            IPW2100_ORD(STAT_TX_MAX_TRIES_IN_HOP,
                                "times max tries in a hop failed"),
            IPW2100_ORD(STAT_TX_DISASSN_FAIL,
                                "times disassociation failed"),
            IPW2100_ORD(STAT_TX_ERR_CTS, "missed/bad CTS frames"),
            IPW2100_ORD(STAT_TX_ERR_ACK, "tx err due to acks"),
            IPW2100_ORD(STAT_RX_HOST, "packets passed to host"),
            IPW2100_ORD(STAT_RX_DIR_DATA, "directed packets"),
            IPW2100_ORD(STAT_RX_DIR_DATA1, "directed packets at 1MB"),
            IPW2100_ORD(STAT_RX_DIR_DATA2, "directed packets at 2MB"),
            IPW2100_ORD(STAT_RX_DIR_DATA5_5,
                                "directed packets at 5.5MB"),
            IPW2100_ORD(STAT_RX_DIR_DATA11, "directed packets at 11MB"),
            IPW2100_ORD(STAT_RX_NODIR_DATA, "nondirected packets"),
            IPW2100_ORD(STAT_RX_NODIR_DATA1,
                                "nondirected packets at 1MB"),
            IPW2100_ORD(STAT_RX_NODIR_DATA2,
                                "nondirected packets at 2MB"),
            IPW2100_ORD(STAT_RX_NODIR_DATA5_5,
                                "nondirected packets at 5.5MB"),
            IPW2100_ORD(STAT_RX_NODIR_DATA11,
                                "nondirected packets at 11MB"),
            IPW2100_ORD(STAT_RX_NULL_DATA, "null data rx's"),
            IPW2100_ORD(STAT_RX_RTS, "Rx RTS"), IPW2100_ORD(STAT_RX_CTS,
                                                                    "Rx CTS"),
            IPW2100_ORD(STAT_RX_ACK, "Rx ACK"),
            IPW2100_ORD(STAT_RX_CFEND, "Rx CF End"),
            IPW2100_ORD(STAT_RX_CFEND_ACK, "Rx CF End + CF Ack"),
            IPW2100_ORD(STAT_RX_ASSN, "Association Rx's"),
            IPW2100_ORD(STAT_RX_ASSN_RESP, "Association response Rx's"),
            IPW2100_ORD(STAT_RX_REASSN, "Reassociation Rx's"),
            IPW2100_ORD(STAT_RX_REASSN_RESP,
                                "Reassociation response Rx's"),
            IPW2100_ORD(STAT_RX_PROBE, "probe Rx's"),
            IPW2100_ORD(STAT_RX_PROBE_RESP, "probe response Rx's"),
            IPW2100_ORD(STAT_RX_BEACON, "Rx beacon"),
            IPW2100_ORD(STAT_RX_ATIM, "Rx ATIM"),
            IPW2100_ORD(STAT_RX_DISASSN, "disassociation Rx"),
            IPW2100_ORD(STAT_RX_AUTH, "authentication Rx"),
            IPW2100_ORD(STAT_RX_DEAUTH, "deauthentication Rx"),
            IPW2100_ORD(STAT_RX_TOTAL_BYTES,
                                "Total rx data bytes received"),
            IPW2100_ORD(STAT_RX_ERR_CRC, "packets with Rx CRC error"),
            IPW2100_ORD(STAT_RX_ERR_CRC1, "Rx CRC errors at 1MB"),
            IPW2100_ORD(STAT_RX_ERR_CRC2, "Rx CRC errors at 2MB"),
            IPW2100_ORD(STAT_RX_ERR_CRC5_5, "Rx CRC errors at 5.5MB"),
            IPW2100_ORD(STAT_RX_ERR_CRC11, "Rx CRC errors at 11MB"),
            IPW2100_ORD(STAT_RX_DUPLICATE1,
                                "duplicate rx packets at 1MB"),
            IPW2100_ORD(STAT_RX_DUPLICATE2,
                                "duplicate rx packets at 2MB"),
            IPW2100_ORD(STAT_RX_DUPLICATE5_5,
                                "duplicate rx packets at 5.5MB"),
            IPW2100_ORD(STAT_RX_DUPLICATE11,
                                "duplicate rx packets at 11MB"),
            IPW2100_ORD(STAT_RX_DUPLICATE, "duplicate rx packets"),
            IPW2100_ORD(PERS_DB_LOCK, "locking fw permanent  db"),
            IPW2100_ORD(PERS_DB_SIZE, "size of fw permanent  db"),
            IPW2100_ORD(PERS_DB_ADDR, "address of fw permanent  db"),
            IPW2100_ORD(STAT_RX_INVALID_PROTOCOL,
                                "rx frames with invalid protocol"),
            IPW2100_ORD(SYS_BOOT_TIME, "Boot time"),
            IPW2100_ORD(STAT_RX_NO_BUFFER,
                                "rx frames rejected due to no buffer"),
            IPW2100_ORD(STAT_RX_MISSING_FRAG,
                                "rx frames dropped due to missing fragment"),
            IPW2100_ORD(STAT_RX_ORPHAN_FRAG,
                                "rx frames dropped due to non-sequential fragment"),
            IPW2100_ORD(STAT_RX_ORPHAN_FRAME,
                                "rx frames dropped due to unmatched 1st frame"),
            IPW2100_ORD(STAT_RX_FRAG_AGEOUT,
                                "rx frames dropped due to uncompleted frame"),
            IPW2100_ORD(STAT_RX_ICV_ERRORS,
                                "ICV errors during decryption"),
            IPW2100_ORD(STAT_PSP_SUSPENSION, "times adapter suspended"),
            IPW2100_ORD(STAT_PSP_BCN_TIMEOUT, "beacon timeout"),
            IPW2100_ORD(STAT_PSP_POLL_TIMEOUT,
                                "poll response timeouts"),
            IPW2100_ORD(STAT_PSP_NONDIR_TIMEOUT,
                                "timeouts waiting for last {broad,multi}cast pkt"),
            IPW2100_ORD(STAT_PSP_RX_DTIMS, "PSP DTIMs received"),
            IPW2100_ORD(STAT_PSP_RX_TIMS, "PSP TIMs received"),
            IPW2100_ORD(STAT_PSP_STATION_ID, "PSP Station ID"),
            IPW2100_ORD(LAST_ASSN_TIME, "RTC time of last association"),
            IPW2100_ORD(STAT_PERCENT_MISSED_BCNS,
                                "current calculation of % missed beacons"),
            IPW2100_ORD(STAT_PERCENT_RETRIES,
                                "current calculation of % missed tx retries"),
            IPW2100_ORD(ASSOCIATED_AP_PTR,
                                "0 if not associated, else pointer to AP table entry"),
            IPW2100_ORD(AVAILABLE_AP_CNT,
                                "AP's decsribed in the AP table"),
            IPW2100_ORD(AP_LIST_PTR, "Ptr to list of available APs"),
            IPW2100_ORD(STAT_AP_ASSNS, "associations"),
            IPW2100_ORD(STAT_ASSN_FAIL, "association failures"),
            IPW2100_ORD(STAT_ASSN_RESP_FAIL,
                                "failures due to response fail"),
            IPW2100_ORD(STAT_FULL_SCANS, "full scans"),
            IPW2100_ORD(CARD_DISABLED, "Card Disabled"),
            IPW2100_ORD(STAT_ROAM_INHIBIT,
                                "times roaming was inhibited due to activity"),
            IPW2100_ORD(RSSI_AT_ASSN,
                                "RSSI of associated AP at time of association"),
            IPW2100_ORD(STAT_ASSN_CAUSE1,
                                "reassociation: no probe response or TX on hop"),
            IPW2100_ORD(STAT_ASSN_CAUSE2,
                                "reassociation: poor tx/rx quality"),
            IPW2100_ORD(STAT_ASSN_CAUSE3,
                                "reassociation: tx/rx quality (excessive AP load"),
            IPW2100_ORD(STAT_ASSN_CAUSE4,
                                "reassociation: AP RSSI level"),
            IPW2100_ORD(STAT_ASSN_CAUSE5,
                                "reassociations due to load leveling"),
            IPW2100_ORD(STAT_AUTH_FAIL, "times authentication failed"),
            IPW2100_ORD(STAT_AUTH_RESP_FAIL,
                                "times authentication response failed"),
            IPW2100_ORD(STATION_TABLE_CNT,
                                "entries in association table"),
            IPW2100_ORD(RSSI_AVG_CURR, "Current avg RSSI"),
            IPW2100_ORD(POWER_MGMT_MODE, "Power mode - 0=CAM, 1=PSP"),
            IPW2100_ORD(COUNTRY_CODE,
                                "IEEE country code as recv'd from beacon"),
            IPW2100_ORD(COUNTRY_CHANNELS,
                                "channels supported by country"),
            IPW2100_ORD(RESET_CNT, "adapter resets (warm)"),
            IPW2100_ORD(BEACON_INTERVAL, "Beacon interval"),
            IPW2100_ORD(ANTENNA_DIVERSITY,
                                "TRUE if antenna diversity is disabled"),
            IPW2100_ORD(DTIM_PERIOD, "beacon intervals between DTIMs"),
            IPW2100_ORD(OUR_FREQ,
                                "current radio freq lower digits - channel ID"),
            IPW2100_ORD(RTC_TIME, "current RTC time"),
            IPW2100_ORD(PORT_TYPE, "operating mode"),
            IPW2100_ORD(CURRENT_TX_RATE, "current tx rate"),
            IPW2100_ORD(SUPPORTED_RATES, "supported tx rates"),
            IPW2100_ORD(ATIM_WINDOW, "current ATIM Window"),
            IPW2100_ORD(BASIC_RATES, "basic tx rates"),
            IPW2100_ORD(NIC_HIGHEST_RATE, "NIC highest tx rate"),
            IPW2100_ORD(AP_HIGHEST_RATE, "AP highest tx rate"),
            IPW2100_ORD(CAPABILITIES,
                                "Management frame capability field"),
            IPW2100_ORD(AUTH_TYPE, "Type of authentication"),
            IPW2100_ORD(RADIO_TYPE, "Adapter card platform type"),
            IPW2100_ORD(RTS_THRESHOLD,
                                "Min packet length for RTS handshaking"),
            IPW2100_ORD(INT_MODE, "International mode"),
            IPW2100_ORD(FRAGMENTATION_THRESHOLD,
                                "protocol frag threshold"),
            IPW2100_ORD(EEPROM_SRAM_DB_BLOCK_START_ADDRESS,
                                "EEPROM offset in SRAM"),
            IPW2100_ORD(EEPROM_SRAM_DB_BLOCK_SIZE,
                                "EEPROM size in SRAM"),
            IPW2100_ORD(EEPROM_SKU_CAPABILITY, "EEPROM SKU Capability"),
            IPW2100_ORD(EEPROM_IBSS_11B_CHANNELS,
                                "EEPROM IBSS 11b channel set"),
            IPW2100_ORD(MAC_VERSION, "MAC Version"),
            IPW2100_ORD(MAC_REVISION, "MAC Revision"),
            IPW2100_ORD(RADIO_VERSION, "Radio Version"),
            IPW2100_ORD(NIC_MANF_DATE_TIME, "MANF Date/Time STAMP"),
            IPW2100_ORD(UCODE_VERSION, "Ucode Version"),};

static ssize_t show_registers(struct device *d, struct device_attribute *attr,
                              char *buf)
{
        int i;
        struct ipw2100_priv *priv = dev_get_drvdata(d);
        struct net_device *dev = priv->net_dev;
        char *out = buf;
        u32 val = 0;

        out += sprintf(out, "%30s [Address ] : Hex\n", "Register");

        for (i = 0; i < ARRAY_SIZE(hw_data); i++) {
                read_register(dev, hw_data[i].addr, &val);
                out += sprintf(out, "%30s [%08X] : %08X\n",
                               hw_data[i].name, hw_data[i].addr, val);
        }

        return out - buf;
}

static DEVICE_ATTR(registers, S_IRUGO, show_registers, NULL);

static ssize_t show_hardware(struct device *d, struct device_attribute *attr,
                             char *buf)
{
        struct ipw2100_priv *priv = dev_get_drvdata(d);
        struct net_device *dev = priv->net_dev;
        char *out = buf;
        int i;

        out += sprintf(out, "%30s [Address ] : Hex\n", "NIC entry");

        for (i = 0; i < ARRAY_SIZE(nic_data); i++) {
                u8 tmp8;
                u16 tmp16;
                u32 tmp32;

                switch (nic_data[i].size) {
                case 1:
                        read_nic_byte(dev, nic_data[i].addr, &tmp8);
                        out += sprintf(out, "%30s [%08X] : %02X\n",
                                       nic_data[i].name, nic_data[i].addr,
                                       tmp8);
                        break;
                case 2:
                        read_nic_word(dev, nic_data[i].addr, &tmp16);
                        out += sprintf(out, "%30s [%08X] : %04X\n",
                                       nic_data[i].name, nic_data[i].addr,
                                       tmp16);
                        break;
                case 4:
                        read_nic_dword(dev, nic_data[i].addr, &tmp32);
                        out += sprintf(out, "%30s [%08X] : %08X\n",
                                       nic_data[i].name, nic_data[i].addr,
                                       tmp32);
                        break;
                }
        }
        return out - buf;
}

static DEVICE_ATTR(hardware, S_IRUGO, show_hardware, NULL);

static ssize_t show_memory(struct device *d, struct device_attribute *attr,
                           char *buf)
{
        struct ipw2100_priv *priv = dev_get_drvdata(d);
        struct net_device *dev = priv->net_dev;
        static unsigned long loop = 0;
        int len = 0;
        u32 buffer[4];
        int i;
        char line[81];

        if (loop >= 0x30000)
                loop = 0;

        /* sysfs provides us PAGE_SIZE buffer */
        while (len < PAGE_SIZE - 128 && loop < 0x30000) {

                if (priv->snapshot[0])
                        for (i = 0; i < 4; i++)
                                buffer[i] =
                                    *(u32 *) SNAPSHOT_ADDR(loop + i * 4);
                else
                        for (i = 0; i < 4; i++)
                                read_nic_dword(dev, loop + i * 4, &buffer[i]);

                if (priv->dump_raw)
                        len += sprintf(buf + len,
                                       "%c%c%c%c"
                                       "%c%c%c%c"
                                       "%c%c%c%c"
                                       "%c%c%c%c",
                                       ((u8 *) buffer)[0x0],
                                       ((u8 *) buffer)[0x1],
                                       ((u8 *) buffer)[0x2],
                                       ((u8 *) buffer)[0x3],
                                       ((u8 *) buffer)[0x4],
                                       ((u8 *) buffer)[0x5],
                                       ((u8 *) buffer)[0x6],
                                       ((u8 *) buffer)[0x7],
                                       ((u8 *) buffer)[0x8],
                                       ((u8 *) buffer)[0x9],
                                       ((u8 *) buffer)[0xa],
                                       ((u8 *) buffer)[0xb],
                                       ((u8 *) buffer)[0xc],
                                       ((u8 *) buffer)[0xd],
                                       ((u8 *) buffer)[0xe],
                                       ((u8 *) buffer)[0xf]);
                else
                        len += sprintf(buf + len, "%s\n",
                                       snprint_line(line, sizeof(line),
                                                    (u8 *) buffer, 16, loop));
                loop += 16;
        }

        return len;
}

static ssize_t store_memory(struct device *d, struct device_attribute *attr,
                            const char *buf, size_t count)
{
        struct ipw2100_priv *priv = dev_get_drvdata(d);
        struct net_device *dev = priv->net_dev;
        const char *p = buf;

        (void)dev;              /* kill unused-var warning for debug-only code */

        if (count < 1)
                return count;

        if (p[0] == '1' ||
            (count >= 2 && tolower(p[0]) == 'o' && tolower(p[1]) == 'n')) {
                IPW_DEBUG_INFO("%s: Setting memory dump to RAW mode.\n",
                               dev->name);
                priv->dump_raw = 1;

        } else if (p[0] == '0' || (count >= 2 && tolower(p[0]) == 'o' &&
                                   tolower(p[1]) == 'f')) {
                IPW_DEBUG_INFO("%s: Setting memory dump to HEX mode.\n",
                               dev->name);
                priv->dump_raw = 0;

        } else if (tolower(p[0]) == 'r') {
                IPW_DEBUG_INFO("%s: Resetting firmware snapshot.\n", dev->name);
                ipw2100_snapshot_free(priv);

        } else
                IPW_DEBUG_INFO("%s: Usage: 0|on = HEX, 1|off = RAW, "
                               "reset = clear memory snapshot\n", dev->name);

        return count;
}

static DEVICE_ATTR(memory, S_IWUSR | S_IRUGO, show_memory, store_memory);

static ssize_t show_ordinals(struct device *d, struct device_attribute *attr,
                             char *buf)
{
        struct ipw2100_priv *priv = dev_get_drvdata(d);
        u32 val = 0;
        int len = 0;
        u32 val_len;
        static int loop = 0;

        if (priv->status & STATUS_RF_KILL_MASK)
                return 0;

        if (loop >= ARRAY_SIZE(ord_data))
                loop = 0;

        /* sysfs provides us PAGE_SIZE buffer */
        while (len < PAGE_SIZE - 128 && loop < ARRAY_SIZE(ord_data)) {
                val_len = sizeof(u32);

                if (ipw2100_get_ordinal(priv, ord_data[loop].index, &val,
                                        &val_len))
                        len += sprintf(buf + len, "[0x%02X] = ERROR    %s\n",
                                       ord_data[loop].index,
                                       ord_data[loop].desc);
                else
                        len += sprintf(buf + len, "[0x%02X] = 0x%08X %s\n",
                                       ord_data[loop].index, val,
                                       ord_data[loop].desc);
                loop++;
        }

        return len;
}

static DEVICE_ATTR(ordinals, S_IRUGO, show_ordinals, NULL);

static ssize_t show_stats(struct device *d, struct device_attribute *attr,
                          char *buf)
{