microblaze: Fix IRQ entry/exit ftracing

[linux-2.6/libata-dev.git] / drivers / staging / wlan-ng / prism2sta.c

/* src/prism2/driver/prism2sta.c
*
* Implements the station functionality for prism2
*
* Copyright (C) 1999 AbsoluteValue Systems, Inc.  All Rights Reserved.
* --------------------------------------------------------------------
*
* linux-wlan
*
*   The contents of this file are subject to the Mozilla Public
*   License Version 1.1 (the "License"); you may not use this file
*   except in compliance with the License. You may obtain a copy of
*   the License at http://www.mozilla.org/MPL/
*
*   Software distributed under the License is distributed on an "AS
*   IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
*   implied. See the License for the specific language governing
*   rights and limitations under the License.
*
*   Alternatively, the contents of this file may be used under the
*   terms of the GNU Public License version 2 (the "GPL"), in which
*   case the provisions of the GPL are applicable instead of the
*   above.  If you wish to allow the use of your version of this file
*   only under the terms of the GPL and not to allow others to use
*   your version of this file under the MPL, indicate your decision
*   by deleting the provisions above and replace them with the notice
*   and other provisions required by the GPL.  If you do not delete
*   the provisions above, a recipient may use your version of this
*   file under either the MPL or the GPL.
*
* --------------------------------------------------------------------
*
* Inquiries regarding the linux-wlan Open Source project can be
* made directly to:
*
* AbsoluteValue Systems Inc.
* info@linux-wlan.com
* http://www.linux-wlan.com
*
* --------------------------------------------------------------------
*
* Portions of the development of this software were funded by
* Intersil Corporation as part of PRISM(R) chipset product development.
*
* --------------------------------------------------------------------
*
* This file implements the module and linux pcmcia routines for the
* prism2 driver.
*
* --------------------------------------------------------------------
*/

#include <linux/version.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/types.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/wireless.h>
#include <linux/netdevice.h>
#include <linux/workqueue.h>
#include <linux/byteorder/generic.h>
#include <linux/ctype.h>

#include <linux/io.h>
#include <linux/delay.h>
#include <asm/byteorder.h>
#include <linux/if_arp.h>
#include <linux/if_ether.h>
#include <linux/bitops.h>

#include "p80211types.h"
#include "p80211hdr.h"
#include "p80211mgmt.h"
#include "p80211conv.h"
#include "p80211msg.h"
#include "p80211netdev.h"
#include "p80211req.h"
#include "p80211metadef.h"
#include "p80211metastruct.h"
#include "hfa384x.h"
#include "prism2mgmt.h"

#define wlan_hexchar(x) (((x) < 0x0a) ? ('0' + (x)) : ('a' + ((x) - 0x0a)))

/* Create a string of printable chars from something that might not be */
/* It's recommended that the str be 4*len + 1 bytes long */
#define wlan_mkprintstr(buf, buflen, str, strlen) \
{ \
        int i = 0; \
        int j = 0; \
        memset(str, 0, (strlen)); \
        for (i = 0; i < (buflen); i++) { \
                if (isprint((buf)[i])) { \
                        (str)[j] = (buf)[i]; \
                        j++; \
                } else { \
                        (str)[j] = '\\'; \
                        (str)[j+1] = 'x'; \
                        (str)[j+2] = wlan_hexchar(((buf)[i] & 0xf0) >> 4); \
                        (str)[j+3] = wlan_hexchar(((buf)[i] & 0x0f)); \
                        j += 4; \
                } \
        } \
}

static char *dev_info = "prism2_usb";
static wlandevice_t *create_wlan(void);

int prism2_reset_holdtime = 30; /* Reset hold time in ms */
int prism2_reset_settletime = 100;      /* Reset settle time in ms */

static int prism2_doreset;      /* Do a reset at init? */

module_param(prism2_doreset, int, 0644);
MODULE_PARM_DESC(prism2_doreset, "Issue a reset on initialization");

module_param(prism2_reset_holdtime, int, 0644);
MODULE_PARM_DESC(prism2_reset_holdtime, "reset hold time in ms");
module_param(prism2_reset_settletime, int, 0644);
MODULE_PARM_DESC(prism2_reset_settletime, "reset settle time in ms");

MODULE_LICENSE("Dual MPL/GPL");

static int prism2sta_open(wlandevice_t *wlandev);
static int prism2sta_close(wlandevice_t *wlandev);
static void prism2sta_reset(wlandevice_t *wlandev);
static int prism2sta_txframe(wlandevice_t *wlandev, struct sk_buff *skb,
                             p80211_hdr_t *p80211_hdr,
                             p80211_metawep_t *p80211_wep);
static int prism2sta_mlmerequest(wlandevice_t *wlandev, p80211msg_t *msg);
static int prism2sta_getcardinfo(wlandevice_t *wlandev);
static int prism2sta_globalsetup(wlandevice_t *wlandev);
static int prism2sta_setmulticast(wlandevice_t *wlandev, netdevice_t *dev);

static void prism2sta_inf_handover(wlandevice_t *wlandev,
                                   hfa384x_InfFrame_t *inf);
static void prism2sta_inf_tallies(wlandevice_t *wlandev,
                                  hfa384x_InfFrame_t *inf);
static void prism2sta_inf_hostscanresults(wlandevice_t *wlandev,
                                          hfa384x_InfFrame_t *inf);
static void prism2sta_inf_scanresults(wlandevice_t *wlandev,
                                      hfa384x_InfFrame_t *inf);
static void prism2sta_inf_chinforesults(wlandevice_t *wlandev,
                                        hfa384x_InfFrame_t *inf);
static void prism2sta_inf_linkstatus(wlandevice_t *wlandev,
                                     hfa384x_InfFrame_t *inf);
static void prism2sta_inf_assocstatus(wlandevice_t *wlandev,
                                      hfa384x_InfFrame_t *inf);
static void prism2sta_inf_authreq(wlandevice_t *wlandev,
                                  hfa384x_InfFrame_t *inf);
static void prism2sta_inf_authreq_defer(wlandevice_t *wlandev,
                                        hfa384x_InfFrame_t *inf);
static void prism2sta_inf_psusercnt(wlandevice_t *wlandev,
                                    hfa384x_InfFrame_t *inf);

/*----------------------------------------------------------------
* prism2sta_open
*
* WLAN device open method.  Called from p80211netdev when kernel
* device open (start) method is called in response to the
* SIOCSIIFFLAGS ioctl changing the flags bit IFF_UP
* from clear to set.
*
* Arguments:
*       wlandev         wlan device structure
*
* Returns:
*       0       success
*       >0      f/w reported error
*       <0      driver reported error
*
* Side effects:
*
* Call context:
*       process thread
----------------------------------------------------------------*/
static int prism2sta_open(wlandevice_t *wlandev)
{
        /* We don't currently have to do anything else.
         * The setup of the MAC should be subsequently completed via
         * the mlme commands.
         * Higher layers know we're ready from dev->start==1 and
         * dev->tbusy==0.  Our rx path knows to pass up received/
         * frames because of dev->flags&IFF_UP is true.
         */

        return 0;
}

/*----------------------------------------------------------------
* prism2sta_close
*
* WLAN device close method.  Called from p80211netdev when kernel
* device close method is called in response to the
* SIOCSIIFFLAGS ioctl changing the flags bit IFF_UP
* from set to clear.
*
* Arguments:
*       wlandev         wlan device structure
*
* Returns:
*       0       success
*       >0      f/w reported error
*       <0      driver reported error
*
* Side effects:
*
* Call context:
*       process thread
----------------------------------------------------------------*/
static int prism2sta_close(wlandevice_t *wlandev)
{
        /* We don't currently have to do anything else.
         * Higher layers know we're not ready from dev->start==0 and
         * dev->tbusy==1.  Our rx path knows to not pass up received
         * frames because of dev->flags&IFF_UP is false.
         */

        return 0;
}

/*----------------------------------------------------------------
* prism2sta_reset
*
* Not currently implented.
*
* Arguments:
*       wlandev         wlan device structure
*       none
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       process thread
----------------------------------------------------------------*/
static void prism2sta_reset(wlandevice_t *wlandev)
{
        return;
}

/*----------------------------------------------------------------
* prism2sta_txframe
*
* Takes a frame from p80211 and queues it for transmission.
*
* Arguments:
*       wlandev         wlan device structure
*       pb              packet buffer struct.  Contains an 802.11
*                       data frame.
*       p80211_hdr      points to the 802.11 header for the packet.
* Returns:
*       0               Success and more buffs available
*       1               Success but no more buffs
*       2               Allocation failure
*       4               Buffer full or queue busy
*
* Side effects:
*
* Call context:
*       process thread
----------------------------------------------------------------*/
static int prism2sta_txframe(wlandevice_t *wlandev, struct sk_buff *skb,
                             p80211_hdr_t *p80211_hdr,
                             p80211_metawep_t *p80211_wep)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        int result;

        /* If necessary, set the 802.11 WEP bit */
        if ((wlandev->hostwep & (HOSTWEP_PRIVACYINVOKED | HOSTWEP_ENCRYPT)) ==
            HOSTWEP_PRIVACYINVOKED) {
                p80211_hdr->a3.fc |= cpu_to_le16(WLAN_SET_FC_ISWEP(1));
        }

        result = hfa384x_drvr_txframe(hw, skb, p80211_hdr, p80211_wep);

        return result;
}

/*----------------------------------------------------------------
* prism2sta_mlmerequest
*
* wlan command message handler.  All we do here is pass the message
* over to the prism2sta_mgmt_handler.
*
* Arguments:
*       wlandev         wlan device structure
*       msg             wlan command message
* Returns:
*       0               success
*       <0              successful acceptance of message, but we're
*                       waiting for an async process to finish before
*                       we're done with the msg.  When the asynch
*                       process is done, we'll call the p80211
*                       function p80211req_confirm() .
*       >0              An error occurred while we were handling
*                       the message.
*
* Side effects:
*
* Call context:
*       process thread
----------------------------------------------------------------*/
static int prism2sta_mlmerequest(wlandevice_t *wlandev, p80211msg_t *msg)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;

        int result = 0;

        switch (msg->msgcode) {
        case DIDmsg_dot11req_mibget:
                pr_debug("Received mibget request\n");
                result = prism2mgmt_mibset_mibget(wlandev, msg);
                break;
        case DIDmsg_dot11req_mibset:
                pr_debug("Received mibset request\n");
                result = prism2mgmt_mibset_mibget(wlandev, msg);
                break;
        case DIDmsg_dot11req_scan:
                pr_debug("Received scan request\n");
                result = prism2mgmt_scan(wlandev, msg);
                break;
        case DIDmsg_dot11req_scan_results:
                pr_debug("Received scan_results request\n");
                result = prism2mgmt_scan_results(wlandev, msg);
                break;
        case DIDmsg_dot11req_start:
                pr_debug("Received mlme start request\n");
                result = prism2mgmt_start(wlandev, msg);
                break;
                /*
                 * Prism2 specific messages
                 */
        case DIDmsg_p2req_readpda:
                pr_debug("Received mlme readpda request\n");
                result = prism2mgmt_readpda(wlandev, msg);
                break;
        case DIDmsg_p2req_ramdl_state:
                pr_debug("Received mlme ramdl_state request\n");
                result = prism2mgmt_ramdl_state(wlandev, msg);
                break;
        case DIDmsg_p2req_ramdl_write:
                pr_debug("Received mlme ramdl_write request\n");
                result = prism2mgmt_ramdl_write(wlandev, msg);
                break;
        case DIDmsg_p2req_flashdl_state:
                pr_debug("Received mlme flashdl_state request\n");
                result = prism2mgmt_flashdl_state(wlandev, msg);
                break;
        case DIDmsg_p2req_flashdl_write:
                pr_debug("Received mlme flashdl_write request\n");
                result = prism2mgmt_flashdl_write(wlandev, msg);
                break;
                /*
                 * Linux specific messages
                 */
        case DIDmsg_lnxreq_hostwep:
                break;          /* ignore me. */
        case DIDmsg_lnxreq_ifstate:
                {
                        p80211msg_lnxreq_ifstate_t *ifstatemsg;
                        pr_debug("Received mlme ifstate request\n");
                        ifstatemsg = (p80211msg_lnxreq_ifstate_t *) msg;
                        result =
                            prism2sta_ifstate(wlandev,
                                              ifstatemsg->ifstate.data);
                        ifstatemsg->resultcode.status =
                            P80211ENUM_msgitem_status_data_ok;
                        ifstatemsg->resultcode.data = result;
                        result = 0;
                }
                break;
        case DIDmsg_lnxreq_wlansniff:
                pr_debug("Received mlme wlansniff request\n");
                result = prism2mgmt_wlansniff(wlandev, msg);
                break;
        case DIDmsg_lnxreq_autojoin:
                pr_debug("Received mlme autojoin request\n");
                result = prism2mgmt_autojoin(wlandev, msg);
                break;
        case DIDmsg_lnxreq_commsquality:{
                        p80211msg_lnxreq_commsquality_t *qualmsg;

                        pr_debug("Received commsquality request\n");

                        qualmsg = (p80211msg_lnxreq_commsquality_t *) msg;

                        qualmsg->link.status =
                            P80211ENUM_msgitem_status_data_ok;
                        qualmsg->level.status =
                            P80211ENUM_msgitem_status_data_ok;
                        qualmsg->noise.status =
                            P80211ENUM_msgitem_status_data_ok;

                        qualmsg->link.data = le16_to_cpu(hw->qual.CQ_currBSS);
                        qualmsg->level.data = le16_to_cpu(hw->qual.ASL_currBSS);
                        qualmsg->noise.data = le16_to_cpu(hw->qual.ANL_currFC);

                        break;
                }
        default:
                printk(KERN_WARNING "Unknown mgmt request message 0x%08x",
                       msg->msgcode);
                break;
        }

        return result;
}

/*----------------------------------------------------------------
* prism2sta_ifstate
*
* Interface state.  This is the primary WLAN interface enable/disable
* handler.  Following the driver/load/deviceprobe sequence, this
* function must be called with a state of "enable" before any other
* commands will be accepted.
*
* Arguments:
*       wlandev         wlan device structure
*       msgp            ptr to msg buffer
*
* Returns:
*       A p80211 message resultcode value.
*
* Side effects:
*
* Call context:
*       process thread  (usually)
*       interrupt
----------------------------------------------------------------*/
u32 prism2sta_ifstate(wlandevice_t *wlandev, u32 ifstate)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        u32 result;

        result = P80211ENUM_resultcode_implementation_failure;

        pr_debug("Current MSD state(%d), requesting(%d)\n",
                 wlandev->msdstate, ifstate);
        switch (ifstate) {
        case P80211ENUM_ifstate_fwload:
                switch (wlandev->msdstate) {
                case WLAN_MSD_HWPRESENT:
                        wlandev->msdstate = WLAN_MSD_FWLOAD_PENDING;
                        /*
                         * Initialize the device+driver sufficiently
                         * for firmware loading.
                         */
                        result = hfa384x_drvr_start(hw);
                        if (result) {
                                printk(KERN_ERR
                                       "hfa384x_drvr_start() failed,"
                                       "result=%d\n", (int)result);
                                result =
                                    P80211ENUM_resultcode_implementation_failure;
                                wlandev->msdstate = WLAN_MSD_HWPRESENT;
                                break;
                        }
                        wlandev->msdstate = WLAN_MSD_FWLOAD;
                        result = P80211ENUM_resultcode_success;
                        break;
                case WLAN_MSD_FWLOAD:
                        hfa384x_cmd_initialize(hw);
                        result = P80211ENUM_resultcode_success;
                        break;
                case WLAN_MSD_RUNNING:
                        printk(KERN_WARNING
                               "Cannot enter fwload state from enable state,"
                               "you must disable first.\n");
                        result = P80211ENUM_resultcode_invalid_parameters;
                        break;
                case WLAN_MSD_HWFAIL:
                default:
                        /* probe() had a problem or the msdstate contains
                         * an unrecognized value, there's nothing we can do.
                         */
                        result = P80211ENUM_resultcode_implementation_failure;
                        break;
                }
                break;
        case P80211ENUM_ifstate_enable:
                switch (wlandev->msdstate) {
                case WLAN_MSD_HWPRESENT:
                case WLAN_MSD_FWLOAD:
                        wlandev->msdstate = WLAN_MSD_RUNNING_PENDING;
                        /* Initialize the device+driver for full
                         * operation. Note that this might me an FWLOAD to
                         * to RUNNING transition so we must not do a chip
                         * or board level reset.  Note that on failure,
                         * the MSD state is set to HWPRESENT because we
                         * can't make any assumptions about the state
                         * of the hardware or a previous firmware load.
                         */
                        result = hfa384x_drvr_start(hw);
                        if (result) {
                                printk(KERN_ERR
                                       "hfa384x_drvr_start() failed,"
                                       "result=%d\n", (int)result);
                                result =
                                    P80211ENUM_resultcode_implementation_failure;
                                wlandev->msdstate = WLAN_MSD_HWPRESENT;
                                break;
                        }

                        result = prism2sta_getcardinfo(wlandev);
                        if (result) {
                                printk(KERN_ERR
                                       "prism2sta_getcardinfo() failed,"
                                       "result=%d\n", (int)result);
                                result =
                                    P80211ENUM_resultcode_implementation_failure;
                                hfa384x_drvr_stop(hw);
                                wlandev->msdstate = WLAN_MSD_HWPRESENT;
                                break;
                        }
                        result = prism2sta_globalsetup(wlandev);
                        if (result) {
                                printk(KERN_ERR
                                       "prism2sta_globalsetup() failed,"
                                       "result=%d\n", (int)result);
                                result =
                                    P80211ENUM_resultcode_implementation_failure;
                                hfa384x_drvr_stop(hw);
                                wlandev->msdstate = WLAN_MSD_HWPRESENT;
                                break;
                        }
                        wlandev->msdstate = WLAN_MSD_RUNNING;
                        hw->join_ap = 0;
                        hw->join_retries = 60;
                        result = P80211ENUM_resultcode_success;
                        break;
                case WLAN_MSD_RUNNING:
                        /* Do nothing, we're already in this state. */
                        result = P80211ENUM_resultcode_success;
                        break;
                case WLAN_MSD_HWFAIL:
                default:
                        /* probe() had a problem or the msdstate contains
                         * an unrecognized value, there's nothing we can do.
                         */
                        result = P80211ENUM_resultcode_implementation_failure;
                        break;
                }
                break;
        case P80211ENUM_ifstate_disable:
                switch (wlandev->msdstate) {
                case WLAN_MSD_HWPRESENT:
                        /* Do nothing, we're already in this state. */
                        result = P80211ENUM_resultcode_success;
                        break;
                case WLAN_MSD_FWLOAD:
                case WLAN_MSD_RUNNING:
                        wlandev->msdstate = WLAN_MSD_HWPRESENT_PENDING;
                        /*
                         * TODO: Shut down the MAC completely. Here a chip
                         * or board level reset is probably called for.
                         * After a "disable" _all_ results are lost, even
                         * those from a fwload.
                         */
                        if (!wlandev->hwremoved)
                                netif_carrier_off(wlandev->netdev);

                        hfa384x_drvr_stop(hw);

                        wlandev->macmode = WLAN_MACMODE_NONE;
                        wlandev->msdstate = WLAN_MSD_HWPRESENT;
                        result = P80211ENUM_resultcode_success;
                        break;
                case WLAN_MSD_HWFAIL:
                default:
                        /* probe() had a problem or the msdstate contains
                         * an unrecognized value, there's nothing we can do.
                         */
                        result = P80211ENUM_resultcode_implementation_failure;
                        break;
                }
                break;
        default:
                result = P80211ENUM_resultcode_invalid_parameters;
                break;
        }

        return result;
}

/*----------------------------------------------------------------
* prism2sta_getcardinfo
*
* Collect the NICID, firmware version and any other identifiers
* we'd like to have in host-side data structures.
*
* Arguments:
*       wlandev         wlan device structure
*
* Returns:
*       0       success
*       >0      f/w reported error
*       <0      driver reported error
*
* Side effects:
*
* Call context:
*       Either.
----------------------------------------------------------------*/
static int prism2sta_getcardinfo(wlandevice_t *wlandev)
{
        int result = 0;
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        u16 temp;
        u8 snum[HFA384x_RID_NICSERIALNUMBER_LEN];
        char pstr[(HFA384x_RID_NICSERIALNUMBER_LEN * 4) + 1];

        /* Collect version and compatibility info */
        /*  Some are critical, some are not */
        /* NIC identity */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_NICIDENTITY,
                                        &hw->ident_nic,
                                        sizeof(hfa384x_compident_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve NICIDENTITY\n");
                goto failed;
        }

        /* get all the nic id fields in host byte order */
        hw->ident_nic.id = le16_to_cpu(hw->ident_nic.id);
        hw->ident_nic.variant = le16_to_cpu(hw->ident_nic.variant);
        hw->ident_nic.major = le16_to_cpu(hw->ident_nic.major);
        hw->ident_nic.minor = le16_to_cpu(hw->ident_nic.minor);

        printk(KERN_INFO "ident: nic h/w: id=0x%02x %d.%d.%d\n",
               hw->ident_nic.id, hw->ident_nic.major,
               hw->ident_nic.minor, hw->ident_nic.variant);

        /* Primary f/w identity */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_PRIIDENTITY,
                                        &hw->ident_pri_fw,
                                        sizeof(hfa384x_compident_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve PRIIDENTITY\n");
                goto failed;
        }

        /* get all the private fw id fields in host byte order */
        hw->ident_pri_fw.id = le16_to_cpu(hw->ident_pri_fw.id);
        hw->ident_pri_fw.variant = le16_to_cpu(hw->ident_pri_fw.variant);
        hw->ident_pri_fw.major = le16_to_cpu(hw->ident_pri_fw.major);
        hw->ident_pri_fw.minor = le16_to_cpu(hw->ident_pri_fw.minor);

        printk(KERN_INFO "ident: pri f/w: id=0x%02x %d.%d.%d\n",
               hw->ident_pri_fw.id, hw->ident_pri_fw.major,
               hw->ident_pri_fw.minor, hw->ident_pri_fw.variant);

        /* Station (Secondary?) f/w identity */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_STAIDENTITY,
                                        &hw->ident_sta_fw,
                                        sizeof(hfa384x_compident_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve STAIDENTITY\n");
                goto failed;
        }

        if (hw->ident_nic.id < 0x8000) {
                printk(KERN_ERR
                       "FATAL: Card is not an Intersil Prism2/2.5/3\n");
                result = -1;
                goto failed;
        }

        /* get all the station fw id fields in host byte order */
        hw->ident_sta_fw.id = le16_to_cpu(hw->ident_sta_fw.id);
        hw->ident_sta_fw.variant = le16_to_cpu(hw->ident_sta_fw.variant);
        hw->ident_sta_fw.major = le16_to_cpu(hw->ident_sta_fw.major);
        hw->ident_sta_fw.minor = le16_to_cpu(hw->ident_sta_fw.minor);

        /* strip out the 'special' variant bits */
        hw->mm_mods = hw->ident_sta_fw.variant & (BIT(14) | BIT(15));
        hw->ident_sta_fw.variant &= ~((u16) (BIT(14) | BIT(15)));

        if (hw->ident_sta_fw.id == 0x1f) {
                printk(KERN_INFO
                       "ident: sta f/w: id=0x%02x %d.%d.%d\n",
                       hw->ident_sta_fw.id, hw->ident_sta_fw.major,
                       hw->ident_sta_fw.minor, hw->ident_sta_fw.variant);
        } else {
                printk(KERN_INFO
                       "ident:  ap f/w: id=0x%02x %d.%d.%d\n",
                       hw->ident_sta_fw.id, hw->ident_sta_fw.major,
                       hw->ident_sta_fw.minor, hw->ident_sta_fw.variant);
                printk(KERN_ERR "Unsupported Tertiary AP firmeare loaded!\n");
                goto failed;
        }

        /* Compatibility range, Modem supplier */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_MFISUPRANGE,
                                        &hw->cap_sup_mfi,
                                        sizeof(hfa384x_caplevel_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve MFISUPRANGE\n");
                goto failed;
        }

        /* get all the Compatibility range, modem interface supplier
           fields in byte order */
        hw->cap_sup_mfi.role = le16_to_cpu(hw->cap_sup_mfi.role);
        hw->cap_sup_mfi.id = le16_to_cpu(hw->cap_sup_mfi.id);
        hw->cap_sup_mfi.variant = le16_to_cpu(hw->cap_sup_mfi.variant);
        hw->cap_sup_mfi.bottom = le16_to_cpu(hw->cap_sup_mfi.bottom);
        hw->cap_sup_mfi.top = le16_to_cpu(hw->cap_sup_mfi.top);

        printk(KERN_INFO
               "MFI:SUP:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
               hw->cap_sup_mfi.role, hw->cap_sup_mfi.id,
               hw->cap_sup_mfi.variant, hw->cap_sup_mfi.bottom,
               hw->cap_sup_mfi.top);

        /* Compatibility range, Controller supplier */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_CFISUPRANGE,
                                        &hw->cap_sup_cfi,
                                        sizeof(hfa384x_caplevel_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve CFISUPRANGE\n");
                goto failed;
        }

        /* get all the Compatibility range, controller interface supplier
           fields in byte order */
        hw->cap_sup_cfi.role = le16_to_cpu(hw->cap_sup_cfi.role);
        hw->cap_sup_cfi.id = le16_to_cpu(hw->cap_sup_cfi.id);
        hw->cap_sup_cfi.variant = le16_to_cpu(hw->cap_sup_cfi.variant);
        hw->cap_sup_cfi.bottom = le16_to_cpu(hw->cap_sup_cfi.bottom);
        hw->cap_sup_cfi.top = le16_to_cpu(hw->cap_sup_cfi.top);

        printk(KERN_INFO
               "CFI:SUP:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
               hw->cap_sup_cfi.role, hw->cap_sup_cfi.id,
               hw->cap_sup_cfi.variant, hw->cap_sup_cfi.bottom,
               hw->cap_sup_cfi.top);

        /* Compatibility range, Primary f/w supplier */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_PRISUPRANGE,
                                        &hw->cap_sup_pri,
                                        sizeof(hfa384x_caplevel_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve PRISUPRANGE\n");
                goto failed;
        }

        /* get all the Compatibility range, primary firmware supplier
           fields in byte order */
        hw->cap_sup_pri.role = le16_to_cpu(hw->cap_sup_pri.role);
        hw->cap_sup_pri.id = le16_to_cpu(hw->cap_sup_pri.id);
        hw->cap_sup_pri.variant = le16_to_cpu(hw->cap_sup_pri.variant);
        hw->cap_sup_pri.bottom = le16_to_cpu(hw->cap_sup_pri.bottom);
        hw->cap_sup_pri.top = le16_to_cpu(hw->cap_sup_pri.top);

        printk(KERN_INFO
               "PRI:SUP:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
               hw->cap_sup_pri.role, hw->cap_sup_pri.id,
               hw->cap_sup_pri.variant, hw->cap_sup_pri.bottom,
               hw->cap_sup_pri.top);

        /* Compatibility range, Station f/w supplier */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_STASUPRANGE,
                                        &hw->cap_sup_sta,
                                        sizeof(hfa384x_caplevel_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve STASUPRANGE\n");
                goto failed;
        }

        /* get all the Compatibility range, station firmware supplier
           fields in byte order */
        hw->cap_sup_sta.role = le16_to_cpu(hw->cap_sup_sta.role);
        hw->cap_sup_sta.id = le16_to_cpu(hw->cap_sup_sta.id);
        hw->cap_sup_sta.variant = le16_to_cpu(hw->cap_sup_sta.variant);
        hw->cap_sup_sta.bottom = le16_to_cpu(hw->cap_sup_sta.bottom);
        hw->cap_sup_sta.top = le16_to_cpu(hw->cap_sup_sta.top);

        if (hw->cap_sup_sta.id == 0x04) {
                printk(KERN_INFO
                       "STA:SUP:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
                       hw->cap_sup_sta.role, hw->cap_sup_sta.id,
                       hw->cap_sup_sta.variant, hw->cap_sup_sta.bottom,
                       hw->cap_sup_sta.top);
        } else {
                printk(KERN_INFO
                       "AP:SUP:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
                       hw->cap_sup_sta.role, hw->cap_sup_sta.id,
                       hw->cap_sup_sta.variant, hw->cap_sup_sta.bottom,
                       hw->cap_sup_sta.top);
        }

        /* Compatibility range, primary f/w actor, CFI supplier */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_PRI_CFIACTRANGES,
                                        &hw->cap_act_pri_cfi,
                                        sizeof(hfa384x_caplevel_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve PRI_CFIACTRANGES\n");
                goto failed;
        }

        /* get all the Compatibility range, primary f/w actor, CFI supplier
           fields in byte order */
        hw->cap_act_pri_cfi.role = le16_to_cpu(hw->cap_act_pri_cfi.role);
        hw->cap_act_pri_cfi.id = le16_to_cpu(hw->cap_act_pri_cfi.id);
        hw->cap_act_pri_cfi.variant = le16_to_cpu(hw->cap_act_pri_cfi.variant);
        hw->cap_act_pri_cfi.bottom = le16_to_cpu(hw->cap_act_pri_cfi.bottom);
        hw->cap_act_pri_cfi.top = le16_to_cpu(hw->cap_act_pri_cfi.top);

        printk(KERN_INFO
               "PRI-CFI:ACT:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
               hw->cap_act_pri_cfi.role, hw->cap_act_pri_cfi.id,
               hw->cap_act_pri_cfi.variant, hw->cap_act_pri_cfi.bottom,
               hw->cap_act_pri_cfi.top);

        /* Compatibility range, sta f/w actor, CFI supplier */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_STA_CFIACTRANGES,
                                        &hw->cap_act_sta_cfi,
                                        sizeof(hfa384x_caplevel_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve STA_CFIACTRANGES\n");
                goto failed;
        }

        /* get all the Compatibility range, station f/w actor, CFI supplier
           fields in byte order */
        hw->cap_act_sta_cfi.role = le16_to_cpu(hw->cap_act_sta_cfi.role);
        hw->cap_act_sta_cfi.id = le16_to_cpu(hw->cap_act_sta_cfi.id);
        hw->cap_act_sta_cfi.variant = le16_to_cpu(hw->cap_act_sta_cfi.variant);
        hw->cap_act_sta_cfi.bottom = le16_to_cpu(hw->cap_act_sta_cfi.bottom);
        hw->cap_act_sta_cfi.top = le16_to_cpu(hw->cap_act_sta_cfi.top);

        printk(KERN_INFO
               "STA-CFI:ACT:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
               hw->cap_act_sta_cfi.role, hw->cap_act_sta_cfi.id,
               hw->cap_act_sta_cfi.variant, hw->cap_act_sta_cfi.bottom,
               hw->cap_act_sta_cfi.top);

        /* Compatibility range, sta f/w actor, MFI supplier */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_STA_MFIACTRANGES,
                                        &hw->cap_act_sta_mfi,
                                        sizeof(hfa384x_caplevel_t));
        if (result) {
                printk(KERN_ERR "Failed to retrieve STA_MFIACTRANGES\n");
                goto failed;
        }

        /* get all the Compatibility range, station f/w actor, MFI supplier
           fields in byte order */
        hw->cap_act_sta_mfi.role = le16_to_cpu(hw->cap_act_sta_mfi.role);
        hw->cap_act_sta_mfi.id = le16_to_cpu(hw->cap_act_sta_mfi.id);
        hw->cap_act_sta_mfi.variant = le16_to_cpu(hw->cap_act_sta_mfi.variant);
        hw->cap_act_sta_mfi.bottom = le16_to_cpu(hw->cap_act_sta_mfi.bottom);
        hw->cap_act_sta_mfi.top = le16_to_cpu(hw->cap_act_sta_mfi.top);

        printk(KERN_INFO
               "STA-MFI:ACT:role=0x%02x:id=0x%02x:var=0x%02x:b/t=%d/%d\n",
               hw->cap_act_sta_mfi.role, hw->cap_act_sta_mfi.id,
               hw->cap_act_sta_mfi.variant, hw->cap_act_sta_mfi.bottom,
               hw->cap_act_sta_mfi.top);

        /* Serial Number */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_NICSERIALNUMBER,
                                        snum, HFA384x_RID_NICSERIALNUMBER_LEN);
        if (!result) {
                wlan_mkprintstr(snum, HFA384x_RID_NICSERIALNUMBER_LEN,
                                pstr, sizeof(pstr));
                printk(KERN_INFO "Prism2 card SN: %s\n", pstr);
        } else {
                printk(KERN_ERR "Failed to retrieve Prism2 Card SN\n");
                goto failed;
        }

        /* Collect the MAC address */
        result = hfa384x_drvr_getconfig(hw, HFA384x_RID_CNFOWNMACADDR,
                                        wlandev->netdev->dev_addr, ETH_ALEN);
        if (result != 0) {
                printk(KERN_ERR "Failed to retrieve mac address\n");
                goto failed;
        }

        /* short preamble is always implemented */
        wlandev->nsdcaps |= P80211_NSDCAP_SHORT_PREAMBLE;

        /* find out if hardware wep is implemented */
        hfa384x_drvr_getconfig16(hw, HFA384x_RID_PRIVACYOPTIMP, &temp);
        if (temp)
                wlandev->nsdcaps |= P80211_NSDCAP_HARDWAREWEP;

        /* get the dBm Scaling constant */
        hfa384x_drvr_getconfig16(hw, HFA384x_RID_CNFDBMADJUST, &temp);
        hw->dbmadjust = temp;

        /* Only enable scan by default on newer firmware */
        if (HFA384x_FIRMWARE_VERSION(hw->ident_sta_fw.major,
                                     hw->ident_sta_fw.minor,
                                     hw->ident_sta_fw.variant) <
            HFA384x_FIRMWARE_VERSION(1, 5, 5)) {
                wlandev->nsdcaps |= P80211_NSDCAP_NOSCAN;
        }

        /* TODO: Set any internally managed config items */

        goto done;
failed:
        printk(KERN_ERR "Failed, result=%d\n", result);
done:
        return result;
}

/*----------------------------------------------------------------
* prism2sta_globalsetup
*
* Set any global RIDs that we want to set at device activation.
*
* Arguments:
*       wlandev         wlan device structure
*
* Returns:
*       0       success
*       >0      f/w reported error
*       <0      driver reported error
*
* Side effects:
*
* Call context:
*       process thread
----------------------------------------------------------------*/
static int prism2sta_globalsetup(wlandevice_t *wlandev)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;

        /* Set the maximum frame size */
        return hfa384x_drvr_setconfig16(hw, HFA384x_RID_CNFMAXDATALEN,
                                        WLAN_DATA_MAXLEN);
}

static int prism2sta_setmulticast(wlandevice_t *wlandev, netdevice_t *dev)
{
        int result = 0;
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;

        u16 promisc;

        /* If we're not ready, what's the point? */
        if (hw->state != HFA384x_STATE_RUNNING)
                goto exit;

        if ((dev->flags & (IFF_PROMISC | IFF_ALLMULTI)) != 0)
                promisc = P80211ENUM_truth_true;
        else
                promisc = P80211ENUM_truth_false;

        result =
            hfa384x_drvr_setconfig16_async(hw, HFA384x_RID_PROMISCMODE,
                                           promisc);
exit:
        return result;
}

/*----------------------------------------------------------------
* prism2sta_inf_handover
*
* Handles the receipt of a Handover info frame. Should only be present
* in APs only.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_handover(wlandevice_t *wlandev,
                                   hfa384x_InfFrame_t *inf)
{
        pr_debug("received infoframe:HANDOVER (unhandled)\n");
        return;
}

/*----------------------------------------------------------------
* prism2sta_inf_tallies
*
* Handles the receipt of a CommTallies info frame.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_tallies(wlandevice_t *wlandev,
                                  hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        u16 *src16;
        u32 *dst;
        u32 *src32;
        int i;
        int cnt;

        /*
         ** Determine if these are 16-bit or 32-bit tallies, based on the
         ** record length of the info record.
         */

        cnt = sizeof(hfa384x_CommTallies32_t) / sizeof(u32);
        if (inf->framelen > 22) {
                dst = (u32 *) &hw->tallies;
                src32 = (u32 *) &inf->info.commtallies32;
                for (i = 0; i < cnt; i++, dst++, src32++)
                        *dst += le32_to_cpu(*src32);
        } else {
                dst = (u32 *) &hw->tallies;
                src16 = (u16 *) &inf->info.commtallies16;
                for (i = 0; i < cnt; i++, dst++, src16++)
                        *dst += le16_to_cpu(*src16);
        }

        return;
}

/*----------------------------------------------------------------
* prism2sta_inf_scanresults
*
* Handles the receipt of a Scan Results info frame.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_scanresults(wlandevice_t *wlandev,
                                      hfa384x_InfFrame_t *inf)
{

        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        int nbss;
        hfa384x_ScanResult_t *sr = &(inf->info.scanresult);
        int i;
        hfa384x_JoinRequest_data_t joinreq;
        int result;

        /* Get the number of results, first in bytes, then in results */
        nbss = (inf->framelen * sizeof(u16)) -
            sizeof(inf->infotype) - sizeof(inf->info.scanresult.scanreason);
        nbss /= sizeof(hfa384x_ScanResultSub_t);

        /* Print em */
        pr_debug("rx scanresults, reason=%d, nbss=%d:\n",
                 inf->info.scanresult.scanreason, nbss);
        for (i = 0; i < nbss; i++) {
                pr_debug("chid=%d anl=%d sl=%d bcnint=%d\n",
                         sr->result[i].chid,
                         sr->result[i].anl,
                         sr->result[i].sl, sr->result[i].bcnint);
                pr_debug("  capinfo=0x%04x proberesp_rate=%d\n",
                         sr->result[i].capinfo, sr->result[i].proberesp_rate);
        }
        /* issue a join request */
        joinreq.channel = sr->result[0].chid;
        memcpy(joinreq.bssid, sr->result[0].bssid, WLAN_BSSID_LEN);
        result = hfa384x_drvr_setconfig(hw,
                                        HFA384x_RID_JOINREQUEST,
                                        &joinreq, HFA384x_RID_JOINREQUEST_LEN);
        if (result) {
                printk(KERN_ERR "setconfig(joinreq) failed, result=%d\n",
                       result);
        }

        return;
}

/*----------------------------------------------------------------
* prism2sta_inf_hostscanresults
*
* Handles the receipt of a Scan Results info frame.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_hostscanresults(wlandevice_t *wlandev,
                                          hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        int nbss;

        nbss = (inf->framelen - 3) / 32;
        pr_debug("Received %d hostscan results\n", nbss);

        if (nbss > 32)
                nbss = 32;

        kfree(hw->scanresults);

        hw->scanresults = kmalloc(sizeof(hfa384x_InfFrame_t), GFP_ATOMIC);
        memcpy(hw->scanresults, inf, sizeof(hfa384x_InfFrame_t));

        if (nbss == 0)
                nbss = -1;

        /* Notify/wake the sleeping caller. */
        hw->scanflag = nbss;
        wake_up_interruptible(&hw->cmdq);
};

/*----------------------------------------------------------------
* prism2sta_inf_chinforesults
*
* Handles the receipt of a Channel Info Results info frame.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_chinforesults(wlandevice_t *wlandev,
                                        hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        unsigned int i, n;

        hw->channel_info.results.scanchannels =
            le16_to_cpu(inf->info.chinforesult.scanchannels);

        for (i = 0, n = 0; i < HFA384x_CHINFORESULT_MAX; i++) {
                if (hw->channel_info.results.scanchannels & (1 << i)) {
                        int channel =
                            le16_to_cpu(inf->info.chinforesult.result[n].chid) -
                            1;
                        hfa384x_ChInfoResultSub_t *chinforesult =
                            &hw->channel_info.results.result[channel];
                        chinforesult->chid = channel;
                        chinforesult->anl =
                            le16_to_cpu(inf->info.chinforesult.result[n].anl);
                        chinforesult->pnl =
                            le16_to_cpu(inf->info.chinforesult.result[n].pnl);
                        chinforesult->active =
                            le16_to_cpu(inf->info.chinforesult.result[n].
                                        active);
                        pr_debug
                            ("chinfo: channel %d, %s level (avg/peak)=%d/%d dB, pcf %d\n",
                             channel + 1,
                             chinforesult->
                             active & HFA384x_CHINFORESULT_BSSACTIVE ? "signal"
                             : "noise", chinforesult->anl, chinforesult->pnl,
                             chinforesult->
                             active & HFA384x_CHINFORESULT_PCFACTIVE ? 1 : 0);
                        n++;
                }
        }
        atomic_set(&hw->channel_info.done, 2);

        hw->channel_info.count = n;
        return;
}

void prism2sta_processing_defer(struct work_struct *data)
{
        hfa384x_t *hw = container_of(data, struct hfa384x, link_bh);
        wlandevice_t *wlandev = hw->wlandev;
        hfa384x_bytestr32_t ssid;
        int result;

        /* First let's process the auth frames */
        {
                struct sk_buff *skb;
                hfa384x_InfFrame_t *inf;

                while ((skb = skb_dequeue(&hw->authq))) {
                        inf = (hfa384x_InfFrame_t *) skb->data;
                        prism2sta_inf_authreq_defer(wlandev, inf);
                }

        }

        /* Now let's handle the linkstatus stuff */
        if (hw->link_status == hw->link_status_new)
                goto failed;

        hw->link_status = hw->link_status_new;

        switch (hw->link_status) {
        case HFA384x_LINK_NOTCONNECTED:
                /* I'm currently assuming that this is the initial link
                 * state.  It should only be possible immediately
                 * following an Enable command.
                 * Response:
                 * Block Transmits, Ignore receives of data frames
                 */
                netif_carrier_off(wlandev->netdev);

                printk(KERN_INFO "linkstatus=NOTCONNECTED (unhandled)\n");
                break;

        case HFA384x_LINK_CONNECTED:
                /* This one indicates a successful scan/join/auth/assoc.
                 * When we have the full MLME complement, this event will
                 * signify successful completion of both mlme_authenticate
                 * and mlme_associate.  State management will get a little
                 * ugly here.
                 * Response:
                 * Indicate authentication and/or association
                 * Enable Transmits, Receives and pass up data frames
                 */

                netif_carrier_on(wlandev->netdev);

                /* If we are joining a specific AP, set our state and reset retries */
                if (hw->join_ap == 1)
                        hw->join_ap = 2;
                hw->join_retries = 60;

                /* Don't call this in monitor mode */
                if (wlandev->netdev->type == ARPHRD_ETHER) {
                        u16 portstatus;

                        printk(KERN_INFO "linkstatus=CONNECTED\n");

                        /* For non-usb devices, we can use the sync versions */
                        /* Collect the BSSID, and set state to allow tx */

                        result = hfa384x_drvr_getconfig(hw,
                                                        HFA384x_RID_CURRENTBSSID,
                                                        wlandev->bssid,
                                                        WLAN_BSSID_LEN);
                        if (result) {
                                pr_debug
                                    ("getconfig(0x%02x) failed, result = %d\n",
                                     HFA384x_RID_CURRENTBSSID, result);
                                goto failed;
                        }

                        result = hfa384x_drvr_getconfig(hw,
                                                        HFA384x_RID_CURRENTSSID,
                                                        &ssid, sizeof(ssid));
                        if (result) {
                                pr_debug
                                    ("getconfig(0x%02x) failed, result = %d\n",
                                     HFA384x_RID_CURRENTSSID, result);
                                goto failed;
                        }
                        prism2mgmt_bytestr2pstr((hfa384x_bytestr_t *) &ssid,
                                                (p80211pstrd_t *) &
                                                wlandev->ssid);

                        /* Collect the port status */
                        result = hfa384x_drvr_getconfig16(hw,
                                                          HFA384x_RID_PORTSTATUS,
                                                          &portstatus);
                        if (result) {
                                pr_debug
                                    ("getconfig(0x%02x) failed, result = %d\n",
                                     HFA384x_RID_PORTSTATUS, result);
                                goto failed;
                        }
                        wlandev->macmode =
                            (portstatus == HFA384x_PSTATUS_CONN_IBSS) ?
                            WLAN_MACMODE_IBSS_STA : WLAN_MACMODE_ESS_STA;

                        /* Get the ball rolling on the comms quality stuff */
                        prism2sta_commsqual_defer(&hw->commsqual_bh);
                }
                break;

        case HFA384x_LINK_DISCONNECTED:
                /* This one indicates that our association is gone.  We've
                 * lost connection with the AP and/or been disassociated.
                 * This indicates that the MAC has completely cleared it's
                 * associated state.  We * should send a deauth indication
                 * (implying disassoc) up * to the MLME.
                 * Response:
                 * Indicate Deauthentication
                 * Block Transmits, Ignore receives of data frames
                 */
                if (hw->join_ap == 2) {
                        hfa384x_JoinRequest_data_t joinreq;
                        joinreq = hw->joinreq;
                        /* Send the join request */
                        hfa384x_drvr_setconfig(hw,
                                               HFA384x_RID_JOINREQUEST,
                                               &joinreq,
                                               HFA384x_RID_JOINREQUEST_LEN);
                        printk(KERN_INFO
                               "linkstatus=DISCONNECTED (re-submitting join)\n");
                } else {
                        if (wlandev->netdev->type == ARPHRD_ETHER)
                                printk(KERN_INFO
                                       "linkstatus=DISCONNECTED (unhandled)\n");
                }
                wlandev->macmode = WLAN_MACMODE_NONE;

                netif_carrier_off(wlandev->netdev);

                break;

        case HFA384x_LINK_AP_CHANGE:
                /* This one indicates that the MAC has decided to and
                 * successfully completed a change to another AP.  We
                 * should probably implement a reassociation indication
                 * in response to this one.  I'm thinking that the the
                 * p80211 layer needs to be notified in case of
                 * buffering/queueing issues.  User mode also needs to be
                 * notified so that any BSS dependent elements can be
                 * updated.
                 * associated state.  We * should send a deauth indication
                 * (implying disassoc) up * to the MLME.
                 * Response:
                 * Indicate Reassociation
                 * Enable Transmits, Receives and pass up data frames
                 */
                printk(KERN_INFO "linkstatus=AP_CHANGE\n");

                result = hfa384x_drvr_getconfig(hw,
                                                HFA384x_RID_CURRENTBSSID,
                                                wlandev->bssid, WLAN_BSSID_LEN);
                if (result) {
                        pr_debug("getconfig(0x%02x) failed, result = %d\n",
                                 HFA384x_RID_CURRENTBSSID, result);
                        goto failed;
                }

                result = hfa384x_drvr_getconfig(hw,
                                                HFA384x_RID_CURRENTSSID,
                                                &ssid, sizeof(ssid));
                if (result) {
                        pr_debug("getconfig(0x%02x) failed, result = %d\n",
                                 HFA384x_RID_CURRENTSSID, result);
                        goto failed;
                }
                prism2mgmt_bytestr2pstr((hfa384x_bytestr_t *) &ssid,
                                        (p80211pstrd_t *) &wlandev->ssid);

                hw->link_status = HFA384x_LINK_CONNECTED;
                netif_carrier_on(wlandev->netdev);

                break;

        case HFA384x_LINK_AP_OUTOFRANGE:
                /* This one indicates that the MAC has decided that the
                 * AP is out of range, but hasn't found a better candidate
                 * so the MAC maintains its "associated" state in case
                 * we get back in range.  We should block transmits and
                 * receives in this state.  Do we need an indication here?
                 * Probably not since a polling user-mode element would
                 * get this status from from p2PortStatus(FD40). What about
                 * p80211?
                 * Response:
                 * Block Transmits, Ignore receives of data frames
                 */
                printk(KERN_INFO "linkstatus=AP_OUTOFRANGE (unhandled)\n");

                netif_carrier_off(wlandev->netdev);

                break;

        case HFA384x_LINK_AP_INRANGE:
                /* This one indicates that the MAC has decided that the
                 * AP is back in range.  We continue working with our
                 * existing association.
                 * Response:
                 * Enable Transmits, Receives and pass up data frames
                 */
                printk(KERN_INFO "linkstatus=AP_INRANGE\n");

                hw->link_status = HFA384x_LINK_CONNECTED;
                netif_carrier_on(wlandev->netdev);

                break;

        case HFA384x_LINK_ASSOCFAIL:
                /* This one is actually a peer to CONNECTED.  We've
                 * requested a join for a given SSID and optionally BSSID.
                 * We can use this one to indicate authentication and
                 * association failures.  The trick is going to be
                 * 1) identifying the failure, and 2) state management.
                 * Response:
                 * Disable Transmits, Ignore receives of data frames
                 */
                if (hw->join_ap && --hw->join_retries > 0) {
                        hfa384x_JoinRequest_data_t joinreq;
                        joinreq = hw->joinreq;
                        /* Send the join request */
                        hfa384x_drvr_setconfig(hw,
                                               HFA384x_RID_JOINREQUEST,
                                               &joinreq,
                                               HFA384x_RID_JOINREQUEST_LEN);
                        printk(KERN_INFO
                               "linkstatus=ASSOCFAIL (re-submitting join)\n");
                } else {
                        printk(KERN_INFO "linkstatus=ASSOCFAIL (unhandled)\n");
                }

                netif_carrier_off(wlandev->netdev);

                break;

        default:
                /* This is bad, IO port problems? */
                printk(KERN_WARNING
                       "unknown linkstatus=0x%02x\n", hw->link_status);
                goto failed;
                break;
        }

        wlandev->linkstatus = (hw->link_status == HFA384x_LINK_CONNECTED);
        p80211wext_event_associated(wlandev, wlandev->linkstatus);

failed:
        return;
}

/*----------------------------------------------------------------
* prism2sta_inf_linkstatus
*
* Handles the receipt of a Link Status info frame.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_linkstatus(wlandevice_t *wlandev,
                                     hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;

        hw->link_status_new = le16_to_cpu(inf->info.linkstatus.linkstatus);

        schedule_work(&hw->link_bh);

        return;
}

/*----------------------------------------------------------------
* prism2sta_inf_assocstatus
*
* Handles the receipt of an Association Status info frame. Should
* be present in APs only.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_assocstatus(wlandevice_t *wlandev,
                                      hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        hfa384x_AssocStatus_t rec;
        int i;

        memcpy(&rec, &inf->info.assocstatus, sizeof(rec));
        rec.assocstatus = le16_to_cpu(rec.assocstatus);
        rec.reason = le16_to_cpu(rec.reason);

        /*
         ** Find the address in the list of authenticated stations.  If it wasn't
         ** found, then this address has not been previously authenticated and
         ** something weird has happened if this is anything other than an
         ** "authentication failed" message.  If the address was found, then
         ** set the "associated" flag for that station, based on whether the
         ** station is associating or losing its association.  Something weird
         ** has also happened if we find the address in the list of authenticated
         ** stations but we are getting an "authentication failed" message.
         */

        for (i = 0; i < hw->authlist.cnt; i++)
                if (memcmp(rec.sta_addr, hw->authlist.addr[i], ETH_ALEN) == 0)
                        break;

        if (i >= hw->authlist.cnt) {
                if (rec.assocstatus != HFA384x_ASSOCSTATUS_AUTHFAIL)
                        printk(KERN_WARNING
                               "assocstatus info frame received for non-authenticated station.\n");
        } else {
                hw->authlist.assoc[i] =
                    (rec.assocstatus == HFA384x_ASSOCSTATUS_STAASSOC ||
                     rec.assocstatus == HFA384x_ASSOCSTATUS_REASSOC);

                if (rec.assocstatus == HFA384x_ASSOCSTATUS_AUTHFAIL)
                        printk(KERN_WARNING
                               "authfail assocstatus info frame received for authenticated station.\n");
        }

        return;
}

/*----------------------------------------------------------------
* prism2sta_inf_authreq
*
* Handles the receipt of an Authentication Request info frame. Should
* be present in APs only.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
*
----------------------------------------------------------------*/
static void prism2sta_inf_authreq(wlandevice_t *wlandev,
                                  hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        struct sk_buff *skb;

        skb = dev_alloc_skb(sizeof(*inf));
        if (skb) {
                skb_put(skb, sizeof(*inf));
                memcpy(skb->data, inf, sizeof(*inf));
                skb_queue_tail(&hw->authq, skb);
                schedule_work(&hw->link_bh);
        }
}

static void prism2sta_inf_authreq_defer(wlandevice_t *wlandev,
                                        hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;
        hfa384x_authenticateStation_data_t rec;

        int i, added, result, cnt;
        u8 *addr;

        /*
         ** Build the AuthenticateStation record.  Initialize it for denying
         ** authentication.
         */

        memcpy(rec.address, inf->info.authreq.sta_addr, ETH_ALEN);
        rec.status = P80211ENUM_status_unspec_failure;

        /*
         ** Authenticate based on the access mode.
         */

        switch (hw->accessmode) {
        case WLAN_ACCESS_NONE:

                /*
                 ** Deny all new authentications.  However, if a station
                 ** is ALREADY authenticated, then accept it.
                 */

                for (i = 0; i < hw->authlist.cnt; i++)
                        if (memcmp(rec.address, hw->authlist.addr[i],
                                   ETH_ALEN) == 0) {
                                rec.status = P80211ENUM_status_successful;
                                break;
                        }

                break;

        case WLAN_ACCESS_ALL:

                /*
                 ** Allow all authentications.
                 */

                rec.status = P80211ENUM_status_successful;
                break;

        case WLAN_ACCESS_ALLOW:

                /*
                 ** Only allow the authentication if the MAC address
                 ** is in the list of allowed addresses.
                 **
                 ** Since this is the interrupt handler, we may be here
                 ** while the access list is in the middle of being
                 ** updated.  Choose the list which is currently okay.
                 ** See "prism2mib_priv_accessallow()" for details.
                 */

                if (hw->allow.modify == 0) {
                        cnt = hw->allow.cnt;
                        addr = hw->allow.addr[0];
                } else {
                        cnt = hw->allow.cnt1;
                        addr = hw->allow.addr1[0];
                }

                for (i = 0; i < cnt; i++, addr += ETH_ALEN)
                        if (memcmp(rec.address, addr, ETH_ALEN) == 0) {
                                rec.status = P80211ENUM_status_successful;
                                break;
                        }

                break;

        case WLAN_ACCESS_DENY:

                /*
                 ** Allow the authentication UNLESS the MAC address is
                 ** in the list of denied addresses.
                 **
                 ** Since this is the interrupt handler, we may be here
                 ** while the access list is in the middle of being
                 ** updated.  Choose the list which is currently okay.
                 ** See "prism2mib_priv_accessdeny()" for details.
                 */

                if (hw->deny.modify == 0) {
                        cnt = hw->deny.cnt;
                        addr = hw->deny.addr[0];
                } else {
                        cnt = hw->deny.cnt1;
                        addr = hw->deny.addr1[0];
                }

                rec.status = P80211ENUM_status_successful;

                for (i = 0; i < cnt; i++, addr += ETH_ALEN)
                        if (memcmp(rec.address, addr, ETH_ALEN) == 0) {
                                rec.status = P80211ENUM_status_unspec_failure;
                                break;
                        }

                break;
        }

        /*
         ** If the authentication is okay, then add the MAC address to the list
         ** of authenticated stations.  Don't add the address if it is already in
         ** the list.  (802.11b does not seem to disallow a station from issuing
         ** an authentication request when the station is already authenticated.
         ** Does this sort of thing ever happen?  We might as well do the check
         ** just in case.)
         */

        added = 0;

        if (rec.status == P80211ENUM_status_successful) {
                for (i = 0; i < hw->authlist.cnt; i++)
                        if (memcmp(rec.address, hw->authlist.addr[i], ETH_ALEN)
                            == 0)
                                break;

                if (i >= hw->authlist.cnt) {
                        if (hw->authlist.cnt >= WLAN_AUTH_MAX) {
                                rec.status = P80211ENUM_status_ap_full;
                        } else {
                                memcpy(hw->authlist.addr[hw->authlist.cnt],
                                       rec.address, ETH_ALEN);
                                hw->authlist.cnt++;
                                added = 1;
                        }
                }
        }

        /*
         ** Send back the results of the authentication.  If this doesn't work,
         ** then make sure to remove the address from the authenticated list if
         ** it was added.
         */

        rec.status = cpu_to_le16(rec.status);
        rec.algorithm = inf->info.authreq.algorithm;

        result = hfa384x_drvr_setconfig(hw, HFA384x_RID_AUTHENTICATESTA,
                                        &rec, sizeof(rec));
        if (result) {
                if (added)
                        hw->authlist.cnt--;
                printk(KERN_ERR
                       "setconfig(authenticatestation) failed, result=%d\n",
                       result);
        }
        return;
}

/*----------------------------------------------------------------
* prism2sta_inf_psusercnt
*
* Handles the receipt of a PowerSaveUserCount info frame. Should
* be present in APs only.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to info frame (contents in hfa384x order)
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
static void prism2sta_inf_psusercnt(wlandevice_t *wlandev,
                                    hfa384x_InfFrame_t *inf)
{
        hfa384x_t *hw = (hfa384x_t *) wlandev->priv;

        hw->psusercount = le16_to_cpu(inf->info.psusercnt.usercnt);

        return;
}

/*----------------------------------------------------------------
* prism2sta_ev_info
*
* Handles the Info event.
*
* Arguments:
*       wlandev         wlan device structure
*       inf             ptr to a generic info frame
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
void prism2sta_ev_info(wlandevice_t *wlandev, hfa384x_InfFrame_t *inf)
{
        inf->infotype = le16_to_cpu(inf->infotype);
        /* Dispatch */
        switch (inf->infotype) {
        case HFA384x_IT_HANDOVERADDR:
                prism2sta_inf_handover(wlandev, inf);
                break;
        case HFA384x_IT_COMMTALLIES:
                prism2sta_inf_tallies(wlandev, inf);
                break;
        case HFA384x_IT_HOSTSCANRESULTS:
                prism2sta_inf_hostscanresults(wlandev, inf);
                break;
        case HFA384x_IT_SCANRESULTS:
                prism2sta_inf_scanresults(wlandev, inf);
                break;
        case HFA384x_IT_CHINFORESULTS:
                prism2sta_inf_chinforesults(wlandev, inf);
                break;
        case HFA384x_IT_LINKSTATUS:
                prism2sta_inf_linkstatus(wlandev, inf);
                break;
        case HFA384x_IT_ASSOCSTATUS:
                prism2sta_inf_assocstatus(wlandev, inf);
                break;
        case HFA384x_IT_AUTHREQ:
                prism2sta_inf_authreq(wlandev, inf);
                break;
        case HFA384x_IT_PSUSERCNT:
                prism2sta_inf_psusercnt(wlandev, inf);
                break;
        case HFA384x_IT_KEYIDCHANGED:
                printk(KERN_WARNING "Unhandled IT_KEYIDCHANGED\n");
                break;
        case HFA384x_IT_ASSOCREQ:
                printk(KERN_WARNING "Unhandled IT_ASSOCREQ\n");
                break;
        case HFA384x_IT_MICFAILURE:
                printk(KERN_WARNING "Unhandled IT_MICFAILURE\n");
                break;
        default:
                printk(KERN_WARNING
                       "Unknown info type=0x%02x\n", inf->infotype);
                break;
        }
        return;
}

/*----------------------------------------------------------------
* prism2sta_ev_txexc
*
* Handles the TxExc event.  A Transmit Exception event indicates
* that the MAC's TX process was unsuccessful - so the packet did
* not get transmitted.
*
* Arguments:
*       wlandev         wlan device structure
*       status          tx frame status word
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
void prism2sta_ev_txexc(wlandevice_t *wlandev, u16 status)
{
        pr_debug("TxExc status=0x%x.\n", status);

        return;
}

/*----------------------------------------------------------------
* prism2sta_ev_tx
*
* Handles the Tx event.
*
* Arguments:
*       wlandev         wlan device structure
*       status          tx frame status word
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
void prism2sta_ev_tx(wlandevice_t *wlandev, u16 status)
{
        pr_debug("Tx Complete, status=0x%04x\n", status);
        /* update linux network stats */
        wlandev->linux_stats.tx_packets++;
        return;
}

/*----------------------------------------------------------------
* prism2sta_ev_rx
*
* Handles the Rx event.
*
* Arguments:
*       wlandev         wlan device structure
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
void prism2sta_ev_rx(wlandevice_t *wlandev, struct sk_buff *skb)
{
        p80211netdev_rx(wlandev, skb);
        return;
}

/*----------------------------------------------------------------
* prism2sta_ev_alloc
*
* Handles the Alloc event.
*
* Arguments:
*       wlandev         wlan device structure
*
* Returns:
*       nothing
*
* Side effects:
*
* Call context:
*       interrupt
----------------------------------------------------------------*/
void prism2sta_ev_alloc(wlandevice_t *wlandev)
{
        netif_wake_queue(wlandev->netdev);
        return;
}

/*----------------------------------------------------------------
* create_wlan
*
* Called at module init time.  This creates the wlandevice_t structure
* and initializes it with relevant bits.
*
* Arguments:
*       none
*
* Returns:
*       the created wlandevice_t structure.
*
* Side effects:
*       also allocates the priv/hw structures.
*
* Call context:
*       process thread
*
----------------------------------------------------------------*/
static wlandevice_t *create_wlan(void)
{
        wlandevice_t *wlandev = NULL;
        hfa384x_t *hw = NULL;

        /* Alloc our structures */
        wlandev = kmalloc(sizeof(wlandevice_t), GFP_KERNEL);
        hw = kmalloc(sizeof(hfa384x_t), GFP_KERNEL);

        if (!wlandev || !hw) {
                printk(KERN_ERR "%s: Memory allocation failure.\n", dev_info);
                kfree(wlandev);
                kfree(hw);
                return NULL;
        }

        /* Clear all the structs */
        memset(wlandev, 0, sizeof(wlandevice_t));
        memset(hw, 0, sizeof(hfa384x_t));

        /* Initialize the network device object. */
        wlandev->nsdname = dev_info;
        wlandev->msdstate = WLAN_MSD_HWPRESENT_PENDING;
        wlandev->priv = hw;
        wlandev->open = prism2sta_open;
        wlandev->close = prism2sta_close;
        wlandev->reset = prism2sta_reset;
        wlandev->txframe = prism2sta_txframe;
        wlandev->mlmerequest = prism2sta_mlmerequest;
        wlandev->set_multicast_list = prism2sta_setmulticast;
        wlandev->tx_timeout = hfa384x_tx_timeout;

        wlandev->nsdcaps = P80211_NSDCAP_HWFRAGMENT | P80211_NSDCAP_AUTOJOIN;

        /* Initialize the device private data stucture. */
        hw->dot11_desired_bss_type = 1;

        return wlandev;
}

void prism2sta_commsqual_defer(struct work_struct *data)
{
        hfa384x_t *hw = container_of(data, struct hfa384x, commsqual_bh);
        wlandevice_t *wlandev = hw->wlandev;
        hfa384x_bytestr32_t ssid;
        int result = 0;

        if (hw->wlandev->hwremoved)
                goto done;

        /* we don't care if we're in AP mode */
        if ((wlandev->macmode == WLAN_MACMODE_NONE) ||
            (wlandev->macmode == WLAN_MACMODE_ESS_AP)) {
                goto done;
        }

        /* It only makes sense to poll these in non-IBSS */
        if (wlandev->macmode != WLAN_MACMODE_IBSS_STA) {
                result = hfa384x_drvr_getconfig(hw, HFA384x_RID_DBMCOMMSQUALITY,
                                                &hw->qual,
                                                HFA384x_RID_DBMCOMMSQUALITY_LEN);

                if (result) {
                        printk(KERN_ERR "error fetching commsqual\n");
                        goto done;
                }

                pr_debug("commsqual %d %d %d\n",
                         le16_to_cpu(hw->qual.CQ_currBSS),
                         le16_to_cpu(hw->qual.ASL_currBSS),
                         le16_to_cpu(hw->qual.ANL_currFC));
        }

        /* Lastly, we need to make sure the BSSID didn't change on us */
        result = hfa384x_drvr_getconfig(hw,
                                        HFA384x_RID_CURRENTBSSID,
                                        wlandev->bssid, WLAN_BSSID_LEN);
        if (result) {
                pr_debug("getconfig(0x%02x) failed, result = %d\n",
                         HFA384x_RID_CURRENTBSSID, result);
                goto done;
        }

        result = hfa384x_drvr_getconfig(hw,
                                        HFA384x_RID_CURRENTSSID,
                                        &ssid, sizeof(ssid));
        if (result) {
                pr_debug("getconfig(0x%02x) failed, result = %d\n",
                         HFA384x_RID_CURRENTSSID, result);
                goto done;
        }
        prism2mgmt_bytestr2pstr((hfa384x_bytestr_t *) &ssid,
                                (p80211pstrd_t *) &wlandev->ssid);

        /* Reschedule timer */
        mod_timer(&hw->commsqual_timer, jiffies + HZ);

done:
        ;
}

void prism2sta_commsqual_timer(unsigned long data)
{
        hfa384x_t *hw = (hfa384x_t *) data;

        schedule_work(&hw->commsqual_bh);
}