/*
 * This file is part of wl1271
 *
 * Copyright (C) 2008-2010 Nokia Corporation
 *
 * Contact: Luciano Coelho <luciano.coelho@nokia.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 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., 51 Franklin St, Fifth Floor, Boston, MA
 * 02110-1301 USA
 *
 */

#include <linux/module.h>
#include <linux/firmware.h>
#include <linux/delay.h>
#include <linux/spi/spi.h>
#include <linux/crc32.h>
#include <linux/etherdevice.h>
#include <linux/vmalloc.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/wl12xx.h>
#include <linux/sched.h>
#include <linux/interrupt.h>

#include "wl12xx.h"
#include "debug.h"
#include "wl12xx_80211.h"
#include "reg.h"
#include "io.h"
#include "event.h"
#include "tx.h"
#include "rx.h"
#include "ps.h"
#include "init.h"
#include "debugfs.h"
#include "cmd.h"
#include "boot.h"
#include "testmode.h"
#include "scan.h"

#define WL1271_BOOT_RETRIES 3

static struct conf_drv_settings default_conf = {
        .sg = {
                .params = {
                        [CONF_SG_ACL_BT_MASTER_MIN_BR] = 10,
                        [CONF_SG_ACL_BT_MASTER_MAX_BR] = 180,
                        [CONF_SG_ACL_BT_SLAVE_MIN_BR] = 10,
                        [CONF_SG_ACL_BT_SLAVE_MAX_BR] = 180,
                        [CONF_SG_ACL_BT_MASTER_MIN_EDR] = 10,
                        [CONF_SG_ACL_BT_MASTER_MAX_EDR] = 80,
                        [CONF_SG_ACL_BT_SLAVE_MIN_EDR] = 10,
                        [CONF_SG_ACL_BT_SLAVE_MAX_EDR] = 80,
                        [CONF_SG_ACL_WLAN_PS_MASTER_BR] = 8,
                        [CONF_SG_ACL_WLAN_PS_SLAVE_BR] = 8,
                        [CONF_SG_ACL_WLAN_PS_MASTER_EDR] = 20,
                        [CONF_SG_ACL_WLAN_PS_SLAVE_EDR] = 20,
                        [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MIN_BR] = 20,
                        [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MAX_BR] = 35,
                        [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MIN_BR] = 16,
                        [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MAX_BR] = 35,
                        [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MIN_EDR] = 32,
                        [CONF_SG_ACL_WLAN_ACTIVE_MASTER_MAX_EDR] = 50,
                        [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MIN_EDR] = 28,
                        [CONF_SG_ACL_WLAN_ACTIVE_SLAVE_MAX_EDR] = 50,
                        [CONF_SG_ACL_ACTIVE_SCAN_WLAN_BR] = 10,
                        [CONF_SG_ACL_ACTIVE_SCAN_WLAN_EDR] = 20,
                        [CONF_SG_ACL_PASSIVE_SCAN_BT_BR] = 75,
                        [CONF_SG_ACL_PASSIVE_SCAN_WLAN_BR] = 15,
                        [CONF_SG_ACL_PASSIVE_SCAN_BT_EDR] = 27,
                        [CONF_SG_ACL_PASSIVE_SCAN_WLAN_EDR] = 17,
                        /* active scan params */
                        [CONF_SG_AUTO_SCAN_PROBE_REQ] = 170,
                        [CONF_SG_ACTIVE_SCAN_DURATION_FACTOR_HV3] = 50,
                        [CONF_SG_ACTIVE_SCAN_DURATION_FACTOR_A2DP] = 100,
                        /* passive scan params */
                        [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_A2DP_BR] = 800,
                        [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_A2DP_EDR] = 200,
                        [CONF_SG_PASSIVE_SCAN_DURATION_FACTOR_HV3] = 200,
                        /* passive scan in dual antenna params */
                        [CONF_SG_CONSECUTIVE_HV3_IN_PASSIVE_SCAN] = 0,
                        [CONF_SG_BCN_HV3_COLLISION_THRESH_IN_PASSIVE_SCAN] = 0,
                        [CONF_SG_TX_RX_PROTECTION_BWIDTH_IN_PASSIVE_SCAN] = 0,
                        /* general params */
                        [CONF_SG_STA_FORCE_PS_IN_BT_SCO] = 1,
                        [CONF_SG_ANTENNA_CONFIGURATION] = 0,
                        [CONF_SG_BEACON_MISS_PERCENT] = 60,
                        [CONF_SG_DHCP_TIME] = 5000,
                        [CONF_SG_RXT] = 1200,
                        [CONF_SG_TXT] = 1000,
                        [CONF_SG_ADAPTIVE_RXT_TXT] = 1,
                        [CONF_SG_GENERAL_USAGE_BIT_MAP] = 3,
                        [CONF_SG_HV3_MAX_SERVED] = 6,
                        [CONF_SG_PS_POLL_TIMEOUT] = 10,
                        [CONF_SG_UPSD_TIMEOUT] = 10,
                        [CONF_SG_CONSECUTIVE_CTS_THRESHOLD] = 2,
                        [CONF_SG_STA_RX_WINDOW_AFTER_DTIM] = 5,
                        [CONF_SG_STA_CONNECTION_PROTECTION_TIME] = 30,
                        /* AP params */
                        [CONF_AP_BEACON_MISS_TX] = 3,
                        [CONF_AP_RX_WINDOW_AFTER_BEACON] = 10,
                        [CONF_AP_BEACON_WINDOW_INTERVAL] = 2,
                        [CONF_AP_CONNECTION_PROTECTION_TIME] = 0,
                        [CONF_AP_BT_ACL_VAL_BT_SERVE_TIME] = 25,
                        [CONF_AP_BT_ACL_VAL_WL_SERVE_TIME] = 25,
                        /* CTS Diluting params */
                        [CONF_SG_CTS_DILUTED_BAD_RX_PACKETS_TH] = 0,
                        [CONF_SG_CTS_CHOP_IN_DUAL_ANT_SCO_MASTER] = 0,
                },
                .state = CONF_SG_PROTECTIVE,
        },
        .rx = {
                .rx_msdu_life_time           = 512000,
                .packet_detection_threshold  = 0,
                .ps_poll_timeout             = 15,
                .upsd_timeout                = 15,
                .rts_threshold               = IEEE80211_MAX_RTS_THRESHOLD,
                .rx_cca_threshold            = 0,
                .irq_blk_threshold           = 0xFFFF,
                .irq_pkt_threshold           = 0,
                .irq_timeout                 = 600,
                .queue_type                  = CONF_RX_QUEUE_TYPE_LOW_PRIORITY,
        },
        .tx = {
                .tx_energy_detection         = 0,
                .sta_rc_conf                 = {
                        .enabled_rates       = 0,
                        .short_retry_limit   = 10,
                        .long_retry_limit    = 10,
                        .aflags              = 0,
                },
                .ac_conf_count               = 4,
                .ac_conf                     = {
                        [CONF_TX_AC_BE] = {
                                .ac          = CONF_TX_AC_BE,
                                .cw_min      = 15,
                                .cw_max      = 63,
                                .aifsn       = 3,
                                .tx_op_limit = 0,
                        },
                        [CONF_TX_AC_BK] = {
                                .ac          = CONF_TX_AC_BK,
                                .cw_min      = 15,
                                .cw_max      = 63,
                                .aifsn       = 7,
                                .tx_op_limit = 0,
                        },
                        [CONF_TX_AC_VI] = {
                                .ac          = CONF_TX_AC_VI,
                                .cw_min      = 15,
                                .cw_max      = 63,
                                .aifsn       = CONF_TX_AIFS_PIFS,
                                .tx_op_limit = 3008,
                        },
                        [CONF_TX_AC_VO] = {
                                .ac          = CONF_TX_AC_VO,
                                .cw_min      = 15,
                                .cw_max      = 63,
                                .aifsn       = CONF_TX_AIFS_PIFS,
                                .tx_op_limit = 1504,
                        },
                },
                .max_tx_retries = 100,
                .ap_aging_period = 300,
                .tid_conf_count = 4,
                .tid_conf = {
                        [CONF_TX_AC_BE] = {
                                .queue_id    = CONF_TX_AC_BE,
                                .channel_type = CONF_CHANNEL_TYPE_EDCF,
                                .tsid        = CONF_TX_AC_BE,
                                .ps_scheme   = CONF_PS_SCHEME_LEGACY,
                                .ack_policy  = CONF_ACK_POLICY_LEGACY,
                                .apsd_conf   = {0, 0},
                        },
                        [CONF_TX_AC_BK] = {
                                .queue_id    = CONF_TX_AC_BK,
                                .channel_type = CONF_CHANNEL_TYPE_EDCF,
                                .tsid        = CONF_TX_AC_BK,
                                .ps_scheme   = CONF_PS_SCHEME_LEGACY,
                                .ack_policy  = CONF_ACK_POLICY_LEGACY,
                                .apsd_conf   = {0, 0},
                        },
                        [CONF_TX_AC_VI] = {
                                .queue_id    = CONF_TX_AC_VI,
                                .channel_type = CONF_CHANNEL_TYPE_EDCF,
                                .tsid        = CONF_TX_AC_VI,
                                .ps_scheme   = CONF_PS_SCHEME_LEGACY,
                                .ack_policy  = CONF_ACK_POLICY_LEGACY,
                                .apsd_conf   = {0, 0},
                        },
                        [CONF_TX_AC_VO] = {
                                .queue_id    = CONF_TX_AC_VO,
                                .channel_type = CONF_CHANNEL_TYPE_EDCF,
                                .tsid        = CONF_TX_AC_VO,
                                .ps_scheme   = CONF_PS_SCHEME_LEGACY,
                                .ack_policy  = CONF_ACK_POLICY_LEGACY,
                                .apsd_conf   = {0, 0},
                        },
                },
                .frag_threshold              = IEEE80211_MAX_FRAG_THRESHOLD,
                .tx_compl_timeout            = 700,
                .tx_compl_threshold          = 4,
                .basic_rate                  = CONF_HW_BIT_RATE_1MBPS,
                .basic_rate_5                = CONF_HW_BIT_RATE_6MBPS,
                .tmpl_short_retry_limit      = 10,
                .tmpl_long_retry_limit       = 10,
                .tx_watchdog_timeout         = 5000,
        },
        .conn = {
                .wake_up_event               = CONF_WAKE_UP_EVENT_DTIM,
                .listen_interval             = 1,
                .suspend_wake_up_event       = CONF_WAKE_UP_EVENT_N_DTIM,
                .suspend_listen_interval     = 3,
                .bcn_filt_mode               = CONF_BCN_FILT_MODE_ENABLED,
                .bcn_filt_ie_count           = 2,
                .bcn_filt_ie = {
                        [0] = {
                                .ie          = WLAN_EID_CHANNEL_SWITCH,
                                .rule        = CONF_BCN_RULE_PASS_ON_APPEARANCE,
                        },
                        [1] = {
                                .ie          = WLAN_EID_HT_INFORMATION,
                                .rule        = CONF_BCN_RULE_PASS_ON_CHANGE,
                        },
                },
                .synch_fail_thold            = 10,
                .bss_lose_timeout            = 100,
                .beacon_rx_timeout           = 10000,
                .broadcast_timeout           = 20000,
                .rx_broadcast_in_ps          = 1,
                .ps_poll_threshold           = 10,
                .bet_enable                  = CONF_BET_MODE_ENABLE,
                .bet_max_consecutive         = 50,
                .psm_entry_retries           = 8,
                .psm_exit_retries            = 16,
                .psm_entry_nullfunc_retries  = 3,
                .dynamic_ps_timeout          = 200,
                .forced_ps                   = false,
                .keep_alive_interval         = 55000,
                .max_listen_interval         = 20,
        },
        .itrim = {
                .enable = false,
                .timeout = 50000,
        },
        .pm_config = {
                .host_clk_settling_time = 5000,
                .host_fast_wakeup_support = false
        },
        .roam_trigger = {
                .trigger_pacing               = 1,
                .avg_weight_rssi_beacon       = 20,
                .avg_weight_rssi_data         = 10,
                .avg_weight_snr_beacon        = 20,
                .avg_weight_snr_data          = 10,
        },
        .scan = {
                .min_dwell_time_active        = 7500,
                .max_dwell_time_active        = 30000,
                .min_dwell_time_passive       = 100000,
                .max_dwell_time_passive       = 100000,
                .num_probe_reqs               = 2,
                .split_scan_timeout           = 50000,
        },
        .sched_scan = {
                /* sched_scan requires dwell times in TU instead of TU/1000 */
                .min_dwell_time_active = 30,
                .max_dwell_time_active = 60,
                .dwell_time_passive    = 100,
                .dwell_time_dfs        = 150,
                .num_probe_reqs        = 2,
                .rssi_threshold        = -90,
                .snr_threshold         = 0,
        },
        .rf = {
                .tx_per_channel_power_compensation_2 = {
                        0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
                },
                .tx_per_channel_power_compensation_5 = {
                        0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
                        0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
                        0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
                },
        },
        .ht = {
                .rx_ba_win_size = 8,
                .tx_ba_win_size = 64,
                .inactivity_timeout = 10000,
                .tx_ba_tid_bitmap = CONF_TX_BA_ENABLED_TID_BITMAP,
        },
        .mem_wl127x = {
                .num_stations                 = 1,
                .ssid_profiles                = 1,
                .rx_block_num                 = 70,
                .tx_min_block_num             = 40,
                .dynamic_memory               = 1,
                .min_req_tx_blocks            = 100,
                .min_req_rx_blocks            = 22,
                .tx_min                       = 27,
        },
        .mem_wl128x = {
                .num_stations                 = 1,
                .ssid_profiles                = 1,
                .rx_block_num                 = 40,
                .tx_min_block_num             = 40,
                .dynamic_memory               = 1,
                .min_req_tx_blocks            = 45,
                .min_req_rx_blocks            = 22,
                .tx_min                       = 27,
        },
        .fm_coex = {
                .enable                       = true,
                .swallow_period               = 5,
                .n_divider_fref_set_1         = 0xff,       /* default */
                .n_divider_fref_set_2         = 12,
                .m_divider_fref_set_1         = 148,
                .m_divider_fref_set_2         = 0xffff,     /* default */
                .coex_pll_stabilization_time  = 0xffffffff, /* default */
                .ldo_stabilization_time       = 0xffff,     /* default */
                .fm_disturbed_band_margin     = 0xff,       /* default */
                .swallow_clk_diff             = 0xff,       /* default */
        },
        .rx_streaming = {
                .duration                      = 150,
                .queues                        = 0x1,
                .interval                      = 20,
                .always                        = 0,
        },
        .fwlog = {
                .mode                         = WL12XX_FWLOG_ON_DEMAND,
                .mem_blocks                   = 2,
                .severity                     = 0,
                .timestamp                    = WL12XX_FWLOG_TIMESTAMP_DISABLED,
                .output                       = WL12XX_FWLOG_OUTPUT_HOST,
                .threshold                    = 0,
        },
        .hci_io_ds = HCI_IO_DS_6MA,
        .rate = {
                .rate_retry_score = 32000,
                .per_add = 8192,
                .per_th1 = 2048,
                .per_th2 = 4096,
                .max_per = 8100,
                .inverse_curiosity_factor = 5,
                .tx_fail_low_th = 4,
                .tx_fail_high_th = 10,
                .per_alpha_shift = 4,
                .per_add_shift = 13,
                .per_beta1_shift = 10,
                .per_beta2_shift = 8,
                .rate_check_up = 2,
                .rate_check_down = 12,
                .rate_retry_policy = {
                        0x00, 0x00, 0x00, 0x00, 0x00,
                        0x00, 0x00, 0x00, 0x00, 0x00,
                        0x00, 0x00, 0x00,
                },
        },
        .hangover = {
                .recover_time               = 0,
                .hangover_period            = 20,
                .dynamic_mode               = 1,
                .early_termination_mode     = 1,
                .max_period                 = 20,
                .min_period                 = 1,
                .increase_delta             = 1,
                .decrease_delta             = 2,
                .quiet_time                 = 4,
                .increase_time              = 1,
                .window_size                = 16,
        },
};

static char *fwlog_param;
static bool bug_on_recovery;

static void __wl1271_op_remove_interface(struct wl1271 *wl,
                                         struct ieee80211_vif *vif,
                                         bool reset_tx_queues);
static void wl1271_op_stop(struct ieee80211_hw *hw);
static void wl1271_free_ap_keys(struct wl1271 *wl, struct wl12xx_vif *wlvif);

static int wl12xx_set_authorized(struct wl1271 *wl,
                                 struct wl12xx_vif *wlvif)
{
        int ret;

        if (WARN_ON(wlvif->bss_type != BSS_TYPE_STA_BSS))
                return -EINVAL;

        if (!test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags))
                return 0;

        if (test_and_set_bit(WLVIF_FLAG_STA_STATE_SENT, &wlvif->flags))
                return 0;

        ret = wl12xx_cmd_set_peer_state(wl, wlvif->sta.hlid);
        if (ret < 0)
                return ret;

        wl12xx_croc(wl, wlvif->role_id);

        wl1271_info("Association completed.");
        return 0;
}

static int wl1271_reg_notify(struct wiphy *wiphy,
                             struct regulatory_request *request)
{
        struct ieee80211_supported_band *band;
        struct ieee80211_channel *ch;
        int i;

        band = wiphy->bands[IEEE80211_BAND_5GHZ];
        for (i = 0; i < band->n_channels; i++) {
                ch = &band->channels[i];
                if (ch->flags & IEEE80211_CHAN_DISABLED)
                        continue;

                if (ch->flags & IEEE80211_CHAN_RADAR)
                        ch->flags |= IEEE80211_CHAN_NO_IBSS |
                                     IEEE80211_CHAN_PASSIVE_SCAN;

        }

        return 0;
}

static int wl1271_set_rx_streaming(struct wl1271 *wl, struct wl12xx_vif *wlvif,
                                   bool enable)
{
        int ret = 0;

        /* we should hold wl->mutex */
        ret = wl1271_acx_ps_rx_streaming(wl, wlvif, enable);
        if (ret < 0)
                goto out;

        if (enable)
                set_bit(WLVIF_FLAG_RX_STREAMING_STARTED, &wlvif->flags);
        else
                clear_bit(WLVIF_FLAG_RX_STREAMING_STARTED, &wlvif->flags);
out:
        return ret;
}

/*
 * this function is being called when the rx_streaming interval
 * has beed changed or rx_streaming should be disabled
 */
int wl1271_recalc_rx_streaming(struct wl1271 *wl, struct wl12xx_vif *wlvif)
{
        int ret = 0;
        int period = wl->conf.rx_streaming.interval;

        /* don't reconfigure if rx_streaming is disabled */
        if (!test_bit(WLVIF_FLAG_RX_STREAMING_STARTED, &wlvif->flags))
                goto out;

        /* reconfigure/disable according to new streaming_period */
        if (period &&
            test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags) &&
            (wl->conf.rx_streaming.always ||
             test_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags)))
                ret = wl1271_set_rx_streaming(wl, wlvif, true);
        else {
                ret = wl1271_set_rx_streaming(wl, wlvif, false);
                /* don't cancel_work_sync since we might deadlock */
                del_timer_sync(&wlvif->rx_streaming_timer);
        }
out:
        return ret;
}

static void wl1271_rx_streaming_enable_work(struct work_struct *work)
{
        int ret;
        struct wl12xx_vif *wlvif = container_of(work, struct wl12xx_vif,
                                                rx_streaming_enable_work);
        struct wl1271 *wl = wlvif->wl;

        mutex_lock(&wl->mutex);

        if (test_bit(WLVIF_FLAG_RX_STREAMING_STARTED, &wlvif->flags) ||
            !test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags) ||
            (!wl->conf.rx_streaming.always &&
             !test_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags)))
                goto out;

        if (!wl->conf.rx_streaming.interval)
                goto out;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        ret = wl1271_set_rx_streaming(wl, wlvif, true);
        if (ret < 0)
                goto out_sleep;

        /* stop it after some time of inactivity */
        mod_timer(&wlvif->rx_streaming_timer,
                  jiffies + msecs_to_jiffies(wl->conf.rx_streaming.duration));

out_sleep:
        wl1271_ps_elp_sleep(wl);
out:
        mutex_unlock(&wl->mutex);
}

static void wl1271_rx_streaming_disable_work(struct work_struct *work)
{
        int ret;
        struct wl12xx_vif *wlvif = container_of(work, struct wl12xx_vif,
                                                rx_streaming_disable_work);
        struct wl1271 *wl = wlvif->wl;

        mutex_lock(&wl->mutex);

        if (!test_bit(WLVIF_FLAG_RX_STREAMING_STARTED, &wlvif->flags))
                goto out;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        ret = wl1271_set_rx_streaming(wl, wlvif, false);
        if (ret)
                goto out_sleep;

out_sleep:
        wl1271_ps_elp_sleep(wl);
out:
        mutex_unlock(&wl->mutex);
}

static void wl1271_rx_streaming_timer(unsigned long data)
{
        struct wl12xx_vif *wlvif = (struct wl12xx_vif *)data;
        struct wl1271 *wl = wlvif->wl;
        ieee80211_queue_work(wl->hw, &wlvif->rx_streaming_disable_work);
}

/* wl->mutex must be taken */
void wl12xx_rearm_tx_watchdog_locked(struct wl1271 *wl)
{
        /* if the watchdog is not armed, don't do anything */
        if (wl->tx_allocated_blocks == 0)
                return;

        cancel_delayed_work(&wl->tx_watchdog_work);
        ieee80211_queue_delayed_work(wl->hw, &wl->tx_watchdog_work,
                msecs_to_jiffies(wl->conf.tx.tx_watchdog_timeout));
}

static void wl12xx_tx_watchdog_work(struct work_struct *work)
{
        struct delayed_work *dwork;
        struct wl1271 *wl;

        dwork = container_of(work, struct delayed_work, work);
        wl = container_of(dwork, struct wl1271, tx_watchdog_work);

        mutex_lock(&wl->mutex);

        if (unlikely(wl->state == WL1271_STATE_OFF))
                goto out;

        /* Tx went out in the meantime - everything is ok */
        if (unlikely(wl->tx_allocated_blocks == 0))
                goto out;

        /*
         * if a ROC is in progress, we might not have any Tx for a long
         * time (e.g. pending Tx on the non-ROC channels)
         */
        if (find_first_bit(wl->roc_map, WL12XX_MAX_ROLES) < WL12XX_MAX_ROLES) {
                wl1271_debug(DEBUG_TX, "No Tx (in FW) for %d ms due to ROC",
                             wl->conf.tx.tx_watchdog_timeout);
                wl12xx_rearm_tx_watchdog_locked(wl);
                goto out;
        }

        /*
         * if a scan is in progress, we might not have any Tx for a long
         * time
         */
        if (wl->scan.state != WL1271_SCAN_STATE_IDLE) {
                wl1271_debug(DEBUG_TX, "No Tx (in FW) for %d ms due to scan",
                             wl->conf.tx.tx_watchdog_timeout);
                wl12xx_rearm_tx_watchdog_locked(wl);
                goto out;
        }

        /*
        * AP might cache a frame for a long time for a sleeping station,
        * so rearm the timer if there's an AP interface with stations. If
        * Tx is genuinely stuck we will most hopefully discover it when all
        * stations are removed due to inactivity.
        */
        if (wl->active_sta_count) {
                wl1271_debug(DEBUG_TX, "No Tx (in FW) for %d ms. AP has "
                             " %d stations",
                              wl->conf.tx.tx_watchdog_timeout,
                              wl->active_sta_count);
                wl12xx_rearm_tx_watchdog_locked(wl);
                goto out;
        }

        wl1271_error("Tx stuck (in FW) for %d ms. Starting recovery",
                     wl->conf.tx.tx_watchdog_timeout);
        wl12xx_queue_recovery_work(wl);

out:
        mutex_unlock(&wl->mutex);
}

static void wl1271_conf_init(struct wl1271 *wl)
{

        /*
         * This function applies the default configuration to the driver. This
         * function is invoked upon driver load (spi probe.)
         *
         * The configuration is stored in a run-time structure in order to
         * facilitate for run-time adjustment of any of the parameters. Making
         * changes to the configuration structure will apply the new values on
         * the next interface up (wl1271_op_start.)
         */

        /* apply driver default configuration */
        memcpy(&wl->conf, &default_conf, sizeof(default_conf));

        /* Adjust settings according to optional module parameters */
        if (fwlog_param) {
                if (!strcmp(fwlog_param, "continuous")) {
                        wl->conf.fwlog.mode = WL12XX_FWLOG_CONTINUOUS;
                } else if (!strcmp(fwlog_param, "ondemand")) {
                        wl->conf.fwlog.mode = WL12XX_FWLOG_ON_DEMAND;
                } else if (!strcmp(fwlog_param, "dbgpins")) {
                        wl->conf.fwlog.mode = WL12XX_FWLOG_CONTINUOUS;
                        wl->conf.fwlog.output = WL12XX_FWLOG_OUTPUT_DBG_PINS;
                } else if (!strcmp(fwlog_param, "disable")) {
                        wl->conf.fwlog.mem_blocks = 0;
                        wl->conf.fwlog.output = WL12XX_FWLOG_OUTPUT_NONE;
                } else {
                        wl1271_error("Unknown fwlog parameter %s", fwlog_param);
                }
        }
}

static int wl1271_plt_init(struct wl1271 *wl)
{
        int ret;

        if (wl->chip.id == CHIP_ID_1283_PG20)
                ret = wl128x_cmd_general_parms(wl);
        else
                ret = wl1271_cmd_general_parms(wl);
        if (ret < 0)
                return ret;

        if (wl->chip.id == CHIP_ID_1283_PG20)
                ret = wl128x_cmd_radio_parms(wl);
        else
                ret = wl1271_cmd_radio_parms(wl);
        if (ret < 0)
                return ret;

        if (wl->chip.id != CHIP_ID_1283_PG20) {
                ret = wl1271_cmd_ext_radio_parms(wl);
                if (ret < 0)
                        return ret;
        }

        /* Chip-specific initializations */
        ret = wl1271_chip_specific_init(wl);
        if (ret < 0)
                return ret;

        ret = wl1271_acx_init_mem_config(wl);
        if (ret < 0)
                return ret;

        ret = wl12xx_acx_mem_cfg(wl);
        if (ret < 0)
                goto out_free_memmap;

        /* Enable data path */
        ret = wl1271_cmd_data_path(wl, 1);
        if (ret < 0)
                goto out_free_memmap;

        /* Configure for CAM power saving (ie. always active) */
        ret = wl1271_acx_sleep_auth(wl, WL1271_PSM_CAM);
        if (ret < 0)
                goto out_free_memmap;

        /* configure PM */
        ret = wl1271_acx_pm_config(wl);
        if (ret < 0)
                goto out_free_memmap;

        return 0;

 out_free_memmap:
        kfree(wl->target_mem_map);
        wl->target_mem_map = NULL;

        return ret;
}

static void wl12xx_irq_ps_regulate_link(struct wl1271 *wl,
                                        struct wl12xx_vif *wlvif,
                                        u8 hlid, u8 tx_pkts)
{
        bool fw_ps, single_sta;

        fw_ps = test_bit(hlid, (unsigned long *)&wl->ap_fw_ps_map);
        single_sta = (wl->active_sta_count == 1);

        /*
         * Wake up from high level PS if the STA is asleep with too little
         * packets in FW or if the STA is awake.
         */
        if (!fw_ps || tx_pkts < WL1271_PS_STA_MAX_PACKETS)
                wl12xx_ps_link_end(wl, wlvif, hlid);

        /*
         * Start high-level PS if the STA is asleep with enough blocks in FW.
         * Make an exception if this is the only connected station. In this
         * case FW-memory congestion is not a problem.
         */
        else if (!single_sta && fw_ps && tx_pkts >= WL1271_PS_STA_MAX_PACKETS)
                wl12xx_ps_link_start(wl, wlvif, hlid, true);
}

static void wl12xx_irq_update_links_status(struct wl1271 *wl,
                                           struct wl12xx_vif *wlvif,
                                           struct wl12xx_fw_status *status)
{
        struct wl1271_link *lnk;
        u32 cur_fw_ps_map;
        u8 hlid, cnt;

        /* TODO: also use link_fast_bitmap here */

        cur_fw_ps_map = le32_to_cpu(status->link_ps_bitmap);
        if (wl->ap_fw_ps_map != cur_fw_ps_map) {
                wl1271_debug(DEBUG_PSM,
                             "link ps prev 0x%x cur 0x%x changed 0x%x",
                             wl->ap_fw_ps_map, cur_fw_ps_map,
                             wl->ap_fw_ps_map ^ cur_fw_ps_map);

                wl->ap_fw_ps_map = cur_fw_ps_map;
        }

        for_each_set_bit(hlid, wlvif->ap.sta_hlid_map, WL12XX_MAX_LINKS) {
                lnk = &wl->links[hlid];
                cnt = status->tx_lnk_free_pkts[hlid] - lnk->prev_freed_pkts;

                lnk->prev_freed_pkts = status->tx_lnk_free_pkts[hlid];
                lnk->allocated_pkts -= cnt;

                wl12xx_irq_ps_regulate_link(wl, wlvif, hlid,
                                            lnk->allocated_pkts);
        }
}

static void wl12xx_fw_status(struct wl1271 *wl,
                             struct wl12xx_fw_status *status)
{
        struct wl12xx_vif *wlvif;
        struct timespec ts;
        u32 old_tx_blk_count = wl->tx_blocks_available;
        int avail, freed_blocks;
        int i;

        wl1271_raw_read(wl, FW_STATUS_ADDR, status, sizeof(*status), false);

        wl1271_debug(DEBUG_IRQ, "intr: 0x%x (fw_rx_counter = %d, "
                     "drv_rx_counter = %d, tx_results_counter = %d)",
                     status->intr,
                     status->fw_rx_counter,
                     status->drv_rx_counter,
                     status->tx_results_counter);

        for (i = 0; i < NUM_TX_QUEUES; i++) {
                /* prevent wrap-around in freed-packets counter */
                wl->tx_allocated_pkts[i] -=
                                (status->tx_released_pkts[i] -
                                wl->tx_pkts_freed[i]) & 0xff;

                wl->tx_pkts_freed[i] = status->tx_released_pkts[i];
        }

        /* prevent wrap-around in total blocks counter */
        if (likely(wl->tx_blocks_freed <=
                   le32_to_cpu(status->total_released_blks)))
                freed_blocks = le32_to_cpu(status->total_released_blks) -
                               wl->tx_blocks_freed;
        else
                freed_blocks = 0x100000000LL - wl->tx_blocks_freed +
                               le32_to_cpu(status->total_released_blks);

        wl->tx_blocks_freed = le32_to_cpu(status->total_released_blks);

        wl->tx_allocated_blocks -= freed_blocks;

        /*
         * If the FW freed some blocks:
         * If we still have allocated blocks - re-arm the timer, Tx is
         * not stuck. Otherwise, cancel the timer (no Tx currently).
         */
        if (freed_blocks) {
                if (wl->tx_allocated_blocks)
                        wl12xx_rearm_tx_watchdog_locked(wl);
                else
                        cancel_delayed_work(&wl->tx_watchdog_work);
        }

        avail = le32_to_cpu(status->tx_total) - wl->tx_allocated_blocks;

        /*
         * The FW might change the total number of TX memblocks before
         * we get a notification about blocks being released. Thus, the
         * available blocks calculation might yield a temporary result
         * which is lower than the actual available blocks. Keeping in
         * mind that only blocks that were allocated can be moved from
         * TX to RX, tx_blocks_available should never decrease here.
         */
        wl->tx_blocks_available = max((int)wl->tx_blocks_available,
                                      avail);

        /* if more blocks are available now, tx work can be scheduled */
        if (wl->tx_blocks_available > old_tx_blk_count)
                clear_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags);

        /* for AP update num of allocated TX blocks per link and ps status */
        wl12xx_for_each_wlvif_ap(wl, wlvif) {
                wl12xx_irq_update_links_status(wl, wlvif, status);
        }

        /* update the host-chipset time offset */
        getnstimeofday(&ts);
        wl->time_offset = (timespec_to_ns(&ts) >> 10) -
                (s64)le32_to_cpu(status->fw_localtime);
}

static void wl1271_flush_deferred_work(struct wl1271 *wl)
{
        struct sk_buff *skb;

        /* Pass all received frames to the network stack */
        while ((skb = skb_dequeue(&wl->deferred_rx_queue)))
                ieee80211_rx_ni(wl->hw, skb);

        /* Return sent skbs to the network stack */
        while ((skb = skb_dequeue(&wl->deferred_tx_queue)))
                ieee80211_tx_status_ni(wl->hw, skb);
}

static void wl1271_netstack_work(struct work_struct *work)
{
        struct wl1271 *wl =
                container_of(work, struct wl1271, netstack_work);

        do {
                wl1271_flush_deferred_work(wl);
        } while (skb_queue_len(&wl->deferred_rx_queue));
}

#define WL1271_IRQ_MAX_LOOPS 256

static irqreturn_t wl1271_irq(int irq, void *cookie)
{
        int ret;
        u32 intr;
        int loopcount = WL1271_IRQ_MAX_LOOPS;
        struct wl1271 *wl = (struct wl1271 *)cookie;
        bool done = false;
        unsigned int defer_count;
        unsigned long flags;

        /* TX might be handled here, avoid redundant work */
        set_bit(WL1271_FLAG_TX_PENDING, &wl->flags);
        cancel_work_sync(&wl->tx_work);

        /*
         * In case edge triggered interrupt must be used, we cannot iterate
         * more than once without introducing race conditions with the hardirq.
         */
        if (wl->platform_quirks & WL12XX_PLATFORM_QUIRK_EDGE_IRQ)
                loopcount = 1;

        mutex_lock(&wl->mutex);

        wl1271_debug(DEBUG_IRQ, "IRQ work");

        if (unlikely(wl->state == WL1271_STATE_OFF))
                goto out;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        while (!done && loopcount--) {
                /*
                 * In order to avoid a race with the hardirq, clear the flag
                 * before acknowledging the chip. Since the mutex is held,
                 * wl1271_ps_elp_wakeup cannot be called concurrently.
                 */
                clear_bit(WL1271_FLAG_IRQ_RUNNING, &wl->flags);
                smp_mb__after_clear_bit();

                wl12xx_fw_status(wl, wl->fw_status);
                intr = le32_to_cpu(wl->fw_status->intr);
                intr &= WL1271_INTR_MASK;
                if (!intr) {
                        done = true;
                        continue;
                }

                if (unlikely(intr & WL1271_ACX_INTR_WATCHDOG)) {
                        wl1271_error("watchdog interrupt received! "
                                     "starting recovery.");
                        wl12xx_queue_recovery_work(wl);

                        /* restarting the chip. ignore any other interrupt. */
                        goto out;
                }

                if (likely(intr & WL1271_ACX_INTR_DATA)) {
                        wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_DATA");

                        wl12xx_rx(wl, wl->fw_status);

                        /* Check if any tx blocks were freed */
                        spin_lock_irqsave(&wl->wl_lock, flags);
                        if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
                            wl1271_tx_total_queue_count(wl) > 0) {
                                spin_unlock_irqrestore(&wl->wl_lock, flags);
                                /*
                                 * In order to avoid starvation of the TX path,
                                 * call the work function directly.
                                 */
                                wl1271_tx_work_locked(wl);
                        } else {
                                spin_unlock_irqrestore(&wl->wl_lock, flags);
                        }

                        /* check for tx results */
                        if (wl->fw_status->tx_results_counter !=
                            (wl->tx_results_count & 0xff))
                                wl1271_tx_complete(wl);

                        /* Make sure the deferred queues don't get too long */
                        defer_count = skb_queue_len(&wl->deferred_tx_queue) +
                                      skb_queue_len(&wl->deferred_rx_queue);
                        if (defer_count > WL1271_DEFERRED_QUEUE_LIMIT)
                                wl1271_flush_deferred_work(wl);
                }

                if (intr & WL1271_ACX_INTR_EVENT_A) {
                        wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_EVENT_A");
                        wl1271_event_handle(wl, 0);
                }

                if (intr & WL1271_ACX_INTR_EVENT_B) {
                        wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_EVENT_B");
                        wl1271_event_handle(wl, 1);
                }

                if (intr & WL1271_ACX_INTR_INIT_COMPLETE)
                        wl1271_debug(DEBUG_IRQ,
                                     "WL1271_ACX_INTR_INIT_COMPLETE");

                if (intr & WL1271_ACX_INTR_HW_AVAILABLE)
                        wl1271_debug(DEBUG_IRQ, "WL1271_ACX_INTR_HW_AVAILABLE");
        }

        wl1271_ps_elp_sleep(wl);

out:
        spin_lock_irqsave(&wl->wl_lock, flags);
        /* In case TX was not handled here, queue TX work */
        clear_bit(WL1271_FLAG_TX_PENDING, &wl->flags);

        if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
            wl1271_tx_total_queue_count(wl) > 0)
                ieee80211_queue_work(wl->hw, &wl->tx_work);
        spin_unlock_irqrestore(&wl->wl_lock, flags);

        mutex_unlock(&wl->mutex);

        return IRQ_HANDLED;
}

struct vif_counter_data {
        u8 counter;

        struct ieee80211_vif *cur_vif;
        bool cur_vif_running;
};

static void wl12xx_vif_count_iter(void *data, u8 *mac,
                                  struct ieee80211_vif *vif)
{
        struct vif_counter_data *counter = data;

        counter->counter++;
        if (counter->cur_vif == vif)
                counter->cur_vif_running = true;
}

/* caller must not hold wl->mutex, as it might deadlock */
static void wl12xx_get_vif_count(struct ieee80211_hw *hw,
                               struct ieee80211_vif *cur_vif,
                               struct vif_counter_data *data)
{
        memset(data, 0, sizeof(*data));
        data->cur_vif = cur_vif;

        ieee80211_iterate_active_interfaces(hw,
                                            wl12xx_vif_count_iter, data);
}

static int wl12xx_fetch_firmware(struct wl1271 *wl, bool plt)
{
        const struct firmware *fw;
        const char *fw_name;
        enum wl12xx_fw_type fw_type;
        int ret;

        if (plt) {
                fw_type = WL12XX_FW_TYPE_PLT;
                if (wl->chip.id == CHIP_ID_1283_PG20)
                        fw_name = WL128X_PLT_FW_NAME;
                else
                        fw_name = WL127X_PLT_FW_NAME;
        } else {
                /*
                 * we can't call wl12xx_get_vif_count() here because
                 * wl->mutex is taken, so use the cached last_vif_count value
                 */
                if (wl->last_vif_count > 1) {
                        fw_type = WL12XX_FW_TYPE_MULTI;
                        if (wl->chip.id == CHIP_ID_1283_PG20)
                                fw_name = WL128X_FW_NAME_MULTI;
                        else
                                fw_name = WL127X_FW_NAME_MULTI;
                } else {
                        fw_type = WL12XX_FW_TYPE_NORMAL;
                        if (wl->chip.id == CHIP_ID_1283_PG20)
                                fw_name = WL128X_FW_NAME_SINGLE;
                        else
                                fw_name = WL127X_FW_NAME_SINGLE;
                }
        }

        if (wl->fw_type == fw_type)
                return 0;

        wl1271_debug(DEBUG_BOOT, "booting firmware %s", fw_name);

        ret = request_firmware(&fw, fw_name, wl->dev);

        if (ret < 0) {
                wl1271_error("could not get firmware %s: %d", fw_name, ret);
                return ret;
        }

        if (fw->size % 4) {
                wl1271_error("firmware size is not multiple of 32 bits: %zu",
                             fw->size);
                ret = -EILSEQ;
                goto out;
        }

        vfree(wl->fw);
        wl->fw_type = WL12XX_FW_TYPE_NONE;
        wl->fw_len = fw->size;
        wl->fw = vmalloc(wl->fw_len);

        if (!wl->fw) {
                wl1271_error("could not allocate memory for the firmware");
                ret = -ENOMEM;
                goto out;
        }

        memcpy(wl->fw, fw->data, wl->fw_len);
        ret = 0;
        wl->fw_type = fw_type;
out:
        release_firmware(fw);

        return ret;
}

static int wl1271_fetch_nvs(struct wl1271 *wl)
{
        const struct firmware *fw;
        int ret;

        ret = request_firmware(&fw, WL12XX_NVS_NAME, wl->dev);

        if (ret < 0) {
                wl1271_error("could not get nvs file %s: %d", WL12XX_NVS_NAME,
                             ret);
                return ret;
        }

        wl->nvs = kmemdup(fw->data, fw->size, GFP_KERNEL);

        if (!wl->nvs) {
                wl1271_error("could not allocate memory for the nvs file");
                ret = -ENOMEM;
                goto out;
        }

        wl->nvs_len = fw->size;

out:
        release_firmware(fw);

        return ret;
}

void wl12xx_queue_recovery_work(struct wl1271 *wl)
{
        if (!test_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags))
                ieee80211_queue_work(wl->hw, &wl->recovery_work);
}

size_t wl12xx_copy_fwlog(struct wl1271 *wl, u8 *memblock, size_t maxlen)
{
        size_t len = 0;

        /* The FW log is a length-value list, find where the log end */
        while (len < maxlen) {
                if (memblock[len] == 0)
                        break;
                if (len + memblock[len] + 1 > maxlen)
                        break;
                len += memblock[len] + 1;
        }

        /* Make sure we have enough room */
        len = min(len, (size_t)(PAGE_SIZE - wl->fwlog_size));

        /* Fill the FW log file, consumed by the sysfs fwlog entry */
        memcpy(wl->fwlog + wl->fwlog_size, memblock, len);
        wl->fwlog_size += len;

        return len;
}

static void wl12xx_read_fwlog_panic(struct wl1271 *wl)
{
        u32 addr;
        u32 first_addr;
        u8 *block;

        if ((wl->quirks & WL12XX_QUIRK_FWLOG_NOT_IMPLEMENTED) ||
            (wl->conf.fwlog.mode != WL12XX_FWLOG_ON_DEMAND) ||
            (wl->conf.fwlog.mem_blocks == 0))
                return;

        wl1271_info("Reading FW panic log");

        block = kmalloc(WL12XX_HW_BLOCK_SIZE, GFP_KERNEL);
        if (!block)
                return;

        /*
         * Make sure the chip is awake and the logger isn't active.
         * This might fail if the firmware hanged.
         */
        if (!wl1271_ps_elp_wakeup(wl))
                wl12xx_cmd_stop_fwlog(wl);

        /* Read the first memory block address */
        wl12xx_fw_status(wl, wl->fw_status);
        first_addr = le32_to_cpu(wl->fw_status->log_start_addr);
        if (!first_addr)
                goto out;

        /* Traverse the memory blocks linked list */
        addr = first_addr;
        do {
                memset(block, 0, WL12XX_HW_BLOCK_SIZE);
                wl1271_read_hwaddr(wl, addr, block, WL12XX_HW_BLOCK_SIZE,
                                   false);

                /*
                 * Memory blocks are linked to one another. The first 4 bytes
                 * of each memory block hold the hardware address of the next
                 * one. The last memory block points to the first one.
                 */
                addr = le32_to_cpup((__le32 *)block);
                if (!wl12xx_copy_fwlog(wl, block + sizeof(addr),
                                       WL12XX_HW_BLOCK_SIZE - sizeof(addr)))
                        break;
        } while (addr && (addr != first_addr));

        wake_up_interruptible(&wl->fwlog_waitq);

out:
        kfree(block);
}

static void wl1271_recovery_work(struct work_struct *work)
{
        struct wl1271 *wl =
                container_of(work, struct wl1271, recovery_work);
        struct wl12xx_vif *wlvif;
        struct ieee80211_vif *vif;

        mutex_lock(&wl->mutex);

        if (wl->state != WL1271_STATE_ON || wl->plt)
                goto out_unlock;

        /* Avoid a recursive recovery */
        set_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags);

        wl12xx_read_fwlog_panic(wl);

        wl1271_info("Hardware recovery in progress. FW ver: %s pc: 0x%x",
                    wl->chip.fw_ver_str, wl1271_read32(wl, SCR_PAD4));

        BUG_ON(bug_on_recovery &&
               !test_bit(WL1271_FLAG_INTENDED_FW_RECOVERY, &wl->flags));

        /*
         * Advance security sequence number to overcome potential progress
         * in the firmware during recovery. This doens't hurt if the network is
         * not encrypted.
         */
        wl12xx_for_each_wlvif(wl, wlvif) {
                if (test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags) ||
                    test_bit(WLVIF_FLAG_AP_STARTED, &wlvif->flags))
                        wlvif->tx_security_seq +=
                                WL1271_TX_SQN_POST_RECOVERY_PADDING;
        }

        /* Prevent spurious TX during FW restart */
        ieee80211_stop_queues(wl->hw);

        if (wl->sched_scanning) {
                ieee80211_sched_scan_stopped(wl->hw);
                wl->sched_scanning = false;
        }

        /* reboot the chipset */
        while (!list_empty(&wl->wlvif_list)) {
                wlvif = list_first_entry(&wl->wlvif_list,
                                       struct wl12xx_vif, list);
                vif = wl12xx_wlvif_to_vif(wlvif);
                __wl1271_op_remove_interface(wl, vif, false);
        }
        mutex_unlock(&wl->mutex);
        wl1271_op_stop(wl->hw);

        clear_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags);

        ieee80211_restart_hw(wl->hw);

        /*
         * Its safe to enable TX now - the queues are stopped after a request
         * to restart the HW.
         */
        ieee80211_wake_queues(wl->hw);
        return;
out_unlock:
        mutex_unlock(&wl->mutex);
}

static void wl1271_fw_wakeup(struct wl1271 *wl)
{
        u32 elp_reg;

        elp_reg = ELPCTRL_WAKE_UP;
        wl1271_raw_write32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, elp_reg);
}

static int wl1271_setup(struct wl1271 *wl)
{
        wl->fw_status = kmalloc(sizeof(*wl->fw_status), GFP_KERNEL);
        if (!wl->fw_status)
                return -ENOMEM;

        wl->tx_res_if = kmalloc(sizeof(*wl->tx_res_if), GFP_KERNEL);
        if (!wl->tx_res_if) {
                kfree(wl->fw_status);
                return -ENOMEM;
        }

        return 0;
}

static int wl12xx_set_power_on(struct wl1271 *wl)
{
        int ret;

        msleep(WL1271_PRE_POWER_ON_SLEEP);
        ret = wl1271_power_on(wl);
        if (ret < 0)
                goto out;
        msleep(WL1271_POWER_ON_SLEEP);
        wl1271_io_reset(wl);
        wl1271_io_init(wl);

        wl1271_set_partition(wl, &wl12xx_part_table[PART_DOWN]);

        /* ELP module wake up */
        wl1271_fw_wakeup(wl);

out:
        return ret;
}

static int wl12xx_chip_wakeup(struct wl1271 *wl, bool plt)
{
        int ret = 0;

        ret = wl12xx_set_power_on(wl);
        if (ret < 0)
                goto out;

        /*
         * For wl127x based devices we could use the default block
         * size (512 bytes), but due to a bug in the sdio driver, we
         * need to set it explicitly after the chip is powered on.  To
         * simplify the code and since the performance impact is
         * negligible, we use the same block size for all different
         * chip types.
         */
        if (!wl1271_set_block_size(wl))
                wl->quirks |= WL12XX_QUIRK_NO_BLOCKSIZE_ALIGNMENT;

        switch (wl->chip.id) {
        case CHIP_ID_1271_PG10:
                wl1271_warning("chip id 0x%x (1271 PG10) support is obsolete",
                               wl->chip.id);

                ret = wl1271_setup(wl);
                if (ret < 0)
                        goto out;
                wl->quirks |= WL12XX_QUIRK_NO_BLOCKSIZE_ALIGNMENT;
                break;

        case CHIP_ID_1271_PG20:
                wl1271_debug(DEBUG_BOOT, "chip id 0x%x (1271 PG20)",
                             wl->chip.id);

                ret = wl1271_setup(wl);
                if (ret < 0)
                        goto out;
                wl->quirks |= WL12XX_QUIRK_NO_BLOCKSIZE_ALIGNMENT;
                break;

        case CHIP_ID_1283_PG20:
                wl1271_debug(DEBUG_BOOT, "chip id 0x%x (1283 PG20)",
                             wl->chip.id);

                ret = wl1271_setup(wl);
                if (ret < 0)
                        goto out;
                break;
        case CHIP_ID_1283_PG10:
        default:
                wl1271_warning("unsupported chip id: 0x%x", wl->chip.id);
                ret = -ENODEV;
                goto out;
        }

        ret = wl12xx_fetch_firmware(wl, plt);
        if (ret < 0)
                goto out;

        /* No NVS from netlink, try to get it from the filesystem */
        if (wl->nvs == NULL) {
                ret = wl1271_fetch_nvs(wl);
                if (ret < 0)
                        goto out;
        }

out:
        return ret;
}

int wl1271_plt_start(struct wl1271 *wl)
{
        int retries = WL1271_BOOT_RETRIES;
        struct wiphy *wiphy = wl->hw->wiphy;
        int ret;

        mutex_lock(&wl->mutex);

        wl1271_notice("power up");

        if (wl->state != WL1271_STATE_OFF) {
                wl1271_error("cannot go into PLT state because not "
                             "in off state: %d", wl->state);
                ret = -EBUSY;
                goto out;
        }

        while (retries) {
                retries--;
                ret = wl12xx_chip_wakeup(wl, true);
                if (ret < 0)
                        goto power_off;

                ret = wl1271_boot(wl);
                if (ret < 0)
                        goto power_off;

                ret = wl1271_plt_init(wl);
                if (ret < 0)
                        goto irq_disable;

                wl->plt = true;
                wl->state = WL1271_STATE_ON;
                wl1271_notice("firmware booted in PLT mode (%s)",
                              wl->chip.fw_ver_str);

                /* update hw/fw version info in wiphy struct */
                wiphy->hw_version = wl->chip.id;
                strncpy(wiphy->fw_version, wl->chip.fw_ver_str,
                        sizeof(wiphy->fw_version));

                goto out;

irq_disable:
                mutex_unlock(&wl->mutex);
                /* Unlocking the mutex in the middle of handling is
                   inherently unsafe. In this case we deem it safe to do,
                   because we need to let any possibly pending IRQ out of
                   the system (and while we are WL1271_STATE_OFF the IRQ
                   work function will not do anything.) Also, any other
                   possible concurrent operations will fail due to the
                   current state, hence the wl1271 struct should be safe. */
                wl1271_disable_interrupts(wl);
                wl1271_flush_deferred_work(wl);
                cancel_work_sync(&wl->netstack_work);
                mutex_lock(&wl->mutex);
power_off:
                wl1271_power_off(wl);
        }

        wl1271_error("firmware boot in PLT mode failed despite %d retries",
                     WL1271_BOOT_RETRIES);
out:
        mutex_unlock(&wl->mutex);

        return ret;
}

int wl1271_plt_stop(struct wl1271 *wl)
{
        int ret = 0;

        wl1271_notice("power down");

        /*
         * Interrupts must be disabled before setting the state to OFF.
         * Otherwise, the interrupt handler might be called and exit without
         * reading the interrupt status.
         */
        wl1271_disable_interrupts(wl);
        mutex_lock(&wl->mutex);
        if (!wl->plt) {
                mutex_unlock(&wl->mutex);

                /*
                 * This will not necessarily enable interrupts as interrupts
                 * may have been disabled when op_stop was called. It will,
                 * however, balance the above call to disable_interrupts().
                 */
                wl1271_enable_interrupts(wl);

                wl1271_error("cannot power down because not in PLT "
                             "state: %d", wl->state);
                ret = -EBUSY;
                goto out;
        }

        mutex_unlock(&wl->mutex);

        wl1271_flush_deferred_work(wl);
        cancel_work_sync(&wl->netstack_work);
        cancel_work_sync(&wl->recovery_work);
        cancel_delayed_work_sync(&wl->elp_work);
        cancel_delayed_work_sync(&wl->tx_watchdog_work);

        mutex_lock(&wl->mutex);
        wl1271_power_off(wl);
        wl->flags = 0;
        wl->state = WL1271_STATE_OFF;
        wl->plt = false;
        wl->rx_counter = 0;
        mutex_unlock(&wl->mutex);

out:
        return ret;
}

static void wl1271_op_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
{
        struct wl1271 *wl = hw->priv;
        struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
        struct ieee80211_vif *vif = info->control.vif;
        struct wl12xx_vif *wlvif = NULL;
        unsigned long flags;
        int q, mapping;
        u8 hlid;

        if (vif)
                wlvif = wl12xx_vif_to_data(vif);

        mapping = skb_get_queue_mapping(skb);
        q = wl1271_tx_get_queue(mapping);

        hlid = wl12xx_tx_get_hlid(wl, wlvif, skb);

        spin_lock_irqsave(&wl->wl_lock, flags);

        /* queue the packet */
        if (hlid == WL12XX_INVALID_LINK_ID ||
            (wlvif && !test_bit(hlid, wlvif->links_map))) {
                wl1271_debug(DEBUG_TX, "DROP skb hlid %d q %d", hlid, q);
                ieee80211_free_txskb(hw, skb);
                goto out;
        }

        wl1271_debug(DEBUG_TX, "queue skb hlid %d q %d len %d",
                     hlid, q, skb->len);
        skb_queue_tail(&wl->links[hlid].tx_queue[q], skb);

        wl->tx_queue_count[q]++;

        /*
         * The workqueue is slow to process the tx_queue and we need stop
         * the queue here, otherwise the queue will get too long.
         */
        if (wl->tx_queue_count[q] >= WL1271_TX_QUEUE_HIGH_WATERMARK) {
                wl1271_debug(DEBUG_TX, "op_tx: stopping queues for q %d", q);
                ieee80211_stop_queue(wl->hw, mapping);
                set_bit(q, &wl->stopped_queues_map);
        }

        /*
         * The chip specific setup must run before the first TX packet -
         * before that, the tx_work will not be initialized!
         */

        if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags) &&
            !test_bit(WL1271_FLAG_TX_PENDING, &wl->flags))
                ieee80211_queue_work(wl->hw, &wl->tx_work);

out:
        spin_unlock_irqrestore(&wl->wl_lock, flags);
}

int wl1271_tx_dummy_packet(struct wl1271 *wl)
{
        unsigned long flags;
        int q;

        /* no need to queue a new dummy packet if one is already pending */
        if (test_bit(WL1271_FLAG_DUMMY_PACKET_PENDING, &wl->flags))
                return 0;

        q = wl1271_tx_get_queue(skb_get_queue_mapping(wl->dummy_packet));

        spin_lock_irqsave(&wl->wl_lock, flags);
        set_bit(WL1271_FLAG_DUMMY_PACKET_PENDING, &wl->flags);
        wl->tx_queue_count[q]++;
        spin_unlock_irqrestore(&wl->wl_lock, flags);

        /* The FW is low on RX memory blocks, so send the dummy packet asap */
        if (!test_bit(WL1271_FLAG_FW_TX_BUSY, &wl->flags))
                wl1271_tx_work_locked(wl);

        /*
         * If the FW TX is busy, TX work will be scheduled by the threaded
         * interrupt handler function
         */
        return 0;
}

/*
 * The size of the dummy packet should be at least 1400 bytes. However, in
 * order to minimize the number of bus transactions, aligning it to 512 bytes
 * boundaries could be beneficial, performance wise
 */
#define TOTAL_TX_DUMMY_PACKET_SIZE (ALIGN(1400, 512))

static struct sk_buff *wl12xx_alloc_dummy_packet(struct wl1271 *wl)
{
        struct sk_buff *skb;
        struct ieee80211_hdr_3addr *hdr;
        unsigned int dummy_packet_size;

        dummy_packet_size = TOTAL_TX_DUMMY_PACKET_SIZE -
                            sizeof(struct wl1271_tx_hw_descr) - sizeof(*hdr);

        skb = dev_alloc_skb(TOTAL_TX_DUMMY_PACKET_SIZE);
        if (!skb) {
                wl1271_warning("Failed to allocate a dummy packet skb");
                return NULL;
        }

        skb_reserve(skb, sizeof(struct wl1271_tx_hw_descr));

        hdr = (struct ieee80211_hdr_3addr *) skb_put(skb, sizeof(*hdr));
        memset(hdr, 0, sizeof(*hdr));
        hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA |
                                         IEEE80211_STYPE_NULLFUNC |
                                         IEEE80211_FCTL_TODS);

        memset(skb_put(skb, dummy_packet_size), 0, dummy_packet_size);

        /* Dummy packets require the TID to be management */
        skb->priority = WL1271_TID_MGMT;

        /* Initialize all fields that might be used */
        skb_set_queue_mapping(skb, 0);
        memset(IEEE80211_SKB_CB(skb), 0, sizeof(struct ieee80211_tx_info));

        return skb;
}


#ifdef CONFIG_PM
static int wl1271_configure_suspend_sta(struct wl1271 *wl,
                                        struct wl12xx_vif *wlvif)
{
        int ret = 0;

        mutex_lock(&wl->mutex);

        if (!test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags))
                goto out_unlock;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out_unlock;

        ret = wl1271_acx_wake_up_conditions(wl, wlvif,
                                    wl->conf.conn.suspend_wake_up_event,
                                    wl->conf.conn.suspend_listen_interval);

        if (ret < 0)
                wl1271_error("suspend: set wake up conditions failed: %d", ret);


        wl1271_ps_elp_sleep(wl);

out_unlock:
        mutex_unlock(&wl->mutex);
        return ret;

}

static int wl1271_configure_suspend_ap(struct wl1271 *wl,
                                       struct wl12xx_vif *wlvif)
{
        int ret = 0;

        mutex_lock(&wl->mutex);

        if (!test_bit(WLVIF_FLAG_AP_STARTED, &wlvif->flags))
                goto out_unlock;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out_unlock;

        ret = wl1271_acx_beacon_filter_opt(wl, wlvif, true);

        wl1271_ps_elp_sleep(wl);
out_unlock:
        mutex_unlock(&wl->mutex);
        return ret;

}

static int wl1271_configure_suspend(struct wl1271 *wl,
                                    struct wl12xx_vif *wlvif)
{
        if (wlvif->bss_type == BSS_TYPE_STA_BSS)
                return wl1271_configure_suspend_sta(wl, wlvif);
        if (wlvif->bss_type == BSS_TYPE_AP_BSS)
                return wl1271_configure_suspend_ap(wl, wlvif);
        return 0;
}

static void wl1271_configure_resume(struct wl1271 *wl,
                                    struct wl12xx_vif *wlvif)
{
        int ret = 0;
        bool is_ap = wlvif->bss_type == BSS_TYPE_AP_BSS;
        bool is_sta = wlvif->bss_type == BSS_TYPE_STA_BSS;

        if ((!is_ap) && (!is_sta))
                return;

        mutex_lock(&wl->mutex);
        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        if (is_sta) {
                ret = wl1271_acx_wake_up_conditions(wl, wlvif,
                                    wl->conf.conn.wake_up_event,
                                    wl->conf.conn.listen_interval);

                if (ret < 0)
                        wl1271_error("resume: wake up conditions failed: %d",
                                     ret);

        } else if (is_ap) {
                ret = wl1271_acx_beacon_filter_opt(wl, wlvif, false);
        }

        wl1271_ps_elp_sleep(wl);
out:
        mutex_unlock(&wl->mutex);
}

static int wl1271_op_suspend(struct ieee80211_hw *hw,
                            struct cfg80211_wowlan *wow)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif;
        int ret;

        wl1271_debug(DEBUG_MAC80211, "mac80211 suspend wow=%d", !!wow);
        WARN_ON(!wow || !wow->any);

        wl1271_tx_flush(wl);

        wl->wow_enabled = true;
        wl12xx_for_each_wlvif(wl, wlvif) {
                ret = wl1271_configure_suspend(wl, wlvif);
                if (ret < 0) {
                        wl1271_warning("couldn't prepare device to suspend");
                        return ret;
                }
        }
        /* flush any remaining work */
        wl1271_debug(DEBUG_MAC80211, "flushing remaining works");

        /*
         * disable and re-enable interrupts in order to flush
         * the threaded_irq
         */
        wl1271_disable_interrupts(wl);

        /*
         * set suspended flag to avoid triggering a new threaded_irq
         * work. no need for spinlock as interrupts are disabled.
         */
        set_bit(WL1271_FLAG_SUSPENDED, &wl->flags);

        wl1271_enable_interrupts(wl);
        flush_work(&wl->tx_work);
        flush_delayed_work(&wl->elp_work);

        return 0;
}

static int wl1271_op_resume(struct ieee80211_hw *hw)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif;
        unsigned long flags;
        bool run_irq_work = false;

        wl1271_debug(DEBUG_MAC80211, "mac80211 resume wow=%d",
                     wl->wow_enabled);
        WARN_ON(!wl->wow_enabled);

        /*
         * re-enable irq_work enqueuing, and call irq_work directly if
         * there is a pending work.
         */
        spin_lock_irqsave(&wl->wl_lock, flags);
        clear_bit(WL1271_FLAG_SUSPENDED, &wl->flags);
        if (test_and_clear_bit(WL1271_FLAG_PENDING_WORK, &wl->flags))
                run_irq_work = true;
        spin_unlock_irqrestore(&wl->wl_lock, flags);

        if (run_irq_work) {
                wl1271_debug(DEBUG_MAC80211,
                             "run postponed irq_work directly");
                wl1271_irq(0, wl);
                wl1271_enable_interrupts(wl);
        }
        wl12xx_for_each_wlvif(wl, wlvif) {
                wl1271_configure_resume(wl, wlvif);
        }
        wl->wow_enabled = false;

        return 0;
}
#endif

static int wl1271_op_start(struct ieee80211_hw *hw)
{
        wl1271_debug(DEBUG_MAC80211, "mac80211 start");

        /*
         * We have to delay the booting of the hardware because
         * we need to know the local MAC address before downloading and
         * initializing the firmware. The MAC address cannot be changed
         * after boot, and without the proper MAC address, the firmware
         * will not function properly.
         *
         * The MAC address is first known when the corresponding interface
         * is added. That is where we will initialize the hardware.
         */

        return 0;
}

static void wl1271_op_stop(struct ieee80211_hw *hw)
{
        struct wl1271 *wl = hw->priv;
        int i;

        wl1271_debug(DEBUG_MAC80211, "mac80211 stop");

        /*
         * Interrupts must be disabled before setting the state to OFF.
         * Otherwise, the interrupt handler might be called and exit without
         * reading the interrupt status.
         */
        wl1271_disable_interrupts(wl);
        mutex_lock(&wl->mutex);
        if (wl->state == WL1271_STATE_OFF) {
                mutex_unlock(&wl->mutex);

                /*
                 * This will not necessarily enable interrupts as interrupts
                 * may have been disabled when op_stop was called. It will,
                 * however, balance the above call to disable_interrupts().
                 */
                wl1271_enable_interrupts(wl);
                return;
        }

        /*
         * this must be before the cancel_work calls below, so that the work
         * functions don't perform further work.
         */
        wl->state = WL1271_STATE_OFF;
        mutex_unlock(&wl->mutex);

        wl1271_flush_deferred_work(wl);
        cancel_delayed_work_sync(&wl->scan_complete_work);
        cancel_work_sync(&wl->netstack_work);
        cancel_work_sync(&wl->tx_work);
        cancel_delayed_work_sync(&wl->elp_work);
        cancel_delayed_work_sync(&wl->tx_watchdog_work);

        /* let's notify MAC80211 about the remaining pending TX frames */
        wl12xx_tx_reset(wl, true);
        mutex_lock(&wl->mutex);

        wl1271_power_off(wl);

        wl->band = IEEE80211_BAND_2GHZ;

        wl->rx_counter = 0;
        wl->power_level = WL1271_DEFAULT_POWER_LEVEL;
        wl->tx_blocks_available = 0;
        wl->tx_allocated_blocks = 0;
        wl->tx_results_count = 0;
        wl->tx_packets_count = 0;
        wl->time_offset = 0;
        wl->tx_spare_blocks = TX_HW_BLOCK_SPARE_DEFAULT;
        wl->ap_fw_ps_map = 0;
        wl->ap_ps_map = 0;
        wl->sched_scanning = false;
        memset(wl->roles_map, 0, sizeof(wl->roles_map));
        memset(wl->links_map, 0, sizeof(wl->links_map));
        memset(wl->roc_map, 0, sizeof(wl->roc_map));
        wl->active_sta_count = 0;

        /* The system link is always allocated */
        __set_bit(WL12XX_SYSTEM_HLID, wl->links_map);

        /*
         * this is performed after the cancel_work calls and the associated
         * mutex_lock, so that wl1271_op_add_interface does not accidentally
         * get executed before all these vars have been reset.
         */
        wl->flags = 0;

        wl->tx_blocks_freed = 0;

        for (i = 0; i < NUM_TX_QUEUES; i++) {
                wl->tx_pkts_freed[i] = 0;
                wl->tx_allocated_pkts[i] = 0;
        }

        wl1271_debugfs_reset(wl);

        kfree(wl->fw_status);
        wl->fw_status = NULL;
        kfree(wl->tx_res_if);
        wl->tx_res_if = NULL;
        kfree(wl->target_mem_map);
        wl->target_mem_map = NULL;

        mutex_unlock(&wl->mutex);
}

static int wl12xx_allocate_rate_policy(struct wl1271 *wl, u8 *idx)
{
        u8 policy = find_first_zero_bit(wl->rate_policies_map,
                                        WL12XX_MAX_RATE_POLICIES);
        if (policy >= WL12XX_MAX_RATE_POLICIES)
                return -EBUSY;

        __set_bit(policy, wl->rate_policies_map);
        *idx = policy;
        return 0;
}

static void wl12xx_free_rate_policy(struct wl1271 *wl, u8 *idx)
{
        if (WARN_ON(*idx >= WL12XX_MAX_RATE_POLICIES))
                return;

        __clear_bit(*idx, wl->rate_policies_map);
        *idx = WL12XX_MAX_RATE_POLICIES;
}

static u8 wl12xx_get_role_type(struct wl1271 *wl, struct wl12xx_vif *wlvif)
{
        switch (wlvif->bss_type) {
        case BSS_TYPE_AP_BSS:
                if (wlvif->p2p)
                        return WL1271_ROLE_P2P_GO;
                else
                        return WL1271_ROLE_AP;

        case BSS_TYPE_STA_BSS:
                if (wlvif->p2p)
                        return WL1271_ROLE_P2P_CL;
                else
                        return WL1271_ROLE_STA;

        case BSS_TYPE_IBSS:
                return WL1271_ROLE_IBSS;

        default:
                wl1271_error("invalid bss_type: %d", wlvif->bss_type);
        }
        return WL12XX_INVALID_ROLE_TYPE;
}

static int wl12xx_init_vif_data(struct wl1271 *wl, struct ieee80211_vif *vif)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        int i;

        /* clear everything but the persistent data */
        memset(wlvif, 0, offsetof(struct wl12xx_vif, persistent));

        switch (ieee80211_vif_type_p2p(vif)) {
        case NL80211_IFTYPE_P2P_CLIENT:
                wlvif->p2p = 1;
                /* fall-through */
        case NL80211_IFTYPE_STATION:
                wlvif->bss_type = BSS_TYPE_STA_BSS;
                break;
        case NL80211_IFTYPE_ADHOC:
                wlvif->bss_type = BSS_TYPE_IBSS;
                break;
        case NL80211_IFTYPE_P2P_GO:
                wlvif->p2p = 1;
                /* fall-through */

        case NL80211_IFTYPE_AP:
                wlvif->bss_type = BSS_TYPE_AP_BSS;
                break;
        default:
                wlvif->bss_type = MAX_BSS_TYPE;
                return -EOPNOTSUPP;
        }

        wlvif->role_id = WL12XX_INVALID_ROLE_ID;
        wlvif->dev_role_id = WL12XX_INVALID_ROLE_ID;
        wlvif->dev_hlid = WL12XX_INVALID_LINK_ID;

        if (wlvif->bss_type == BSS_TYPE_STA_BSS ||
            wlvif->bss_type == BSS_TYPE_IBSS) {
                /* init sta/ibss data */
                wlvif->sta.hlid = WL12XX_INVALID_LINK_ID;
                wl12xx_allocate_rate_policy(wl, &wlvif->sta.basic_rate_idx);
                wl12xx_allocate_rate_policy(wl, &wlvif->sta.ap_rate_idx);
                wl12xx_allocate_rate_policy(wl, &wlvif->sta.p2p_rate_idx);
        } else {
                /* init ap data */
                wlvif->ap.bcast_hlid = WL12XX_INVALID_LINK_ID;
                wlvif->ap.global_hlid = WL12XX_INVALID_LINK_ID;
                wl12xx_allocate_rate_policy(wl, &wlvif->ap.mgmt_rate_idx);
                wl12xx_allocate_rate_policy(wl, &wlvif->ap.bcast_rate_idx);
                for (i = 0; i < CONF_TX_MAX_AC_COUNT; i++)
                        wl12xx_allocate_rate_policy(wl,
                                                &wlvif->ap.ucast_rate_idx[i]);
        }

        wlvif->bitrate_masks[IEEE80211_BAND_2GHZ] = wl->conf.tx.basic_rate;
        wlvif->bitrate_masks[IEEE80211_BAND_5GHZ] = wl->conf.tx.basic_rate_5;
        wlvif->basic_rate_set = CONF_TX_RATE_MASK_BASIC;
        wlvif->basic_rate = CONF_TX_RATE_MASK_BASIC;
        wlvif->rate_set = CONF_TX_RATE_MASK_BASIC;
        wlvif->beacon_int = WL1271_DEFAULT_BEACON_INT;

        /*
         * mac80211 configures some values globally, while we treat them
         * per-interface. thus, on init, we have to copy them from wl
         */
        wlvif->band = wl->band;
        wlvif->channel = wl->channel;
        wlvif->power_level = wl->power_level;

        INIT_WORK(&wlvif->rx_streaming_enable_work,
                  wl1271_rx_streaming_enable_work);
        INIT_WORK(&wlvif->rx_streaming_disable_work,
                  wl1271_rx_streaming_disable_work);
        INIT_LIST_HEAD(&wlvif->list);

        setup_timer(&wlvif->rx_streaming_timer, wl1271_rx_streaming_timer,
                    (unsigned long) wlvif);
        return 0;
}

static bool wl12xx_init_fw(struct wl1271 *wl)
{
        int retries = WL1271_BOOT_RETRIES;
        bool booted = false;
        struct wiphy *wiphy = wl->hw->wiphy;
        int ret;

        while (retries) {
                retries--;
                ret = wl12xx_chip_wakeup(wl, false);
                if (ret < 0)
                        goto power_off;

                ret = wl1271_boot(wl);
                if (ret < 0)
                        goto power_off;

                ret = wl1271_hw_init(wl);
                if (ret < 0)
                        goto irq_disable;

                booted = true;
                break;

irq_disable:
                mutex_unlock(&wl->mutex);
                /* Unlocking the mutex in the middle of handling is
                   inherently unsafe. In this case we deem it safe to do,
                   because we need to let any possibly pending IRQ out of
                   the system (and while we are WL1271_STATE_OFF the IRQ
                   work function will not do anything.) Also, any other
                   possible concurrent operations will fail due to the
                   current state, hence the wl1271 struct should be safe. */
                wl1271_disable_interrupts(wl);
                wl1271_flush_deferred_work(wl);
                cancel_work_sync(&wl->netstack_work);
                mutex_lock(&wl->mutex);
power_off:
                wl1271_power_off(wl);
        }

        if (!booted) {
                wl1271_error("firmware boot failed despite %d retries",
                             WL1271_BOOT_RETRIES);
                goto out;
        }

        wl1271_info("firmware booted (%s)", wl->chip.fw_ver_str);

        /* update hw/fw version info in wiphy struct */
        wiphy->hw_version = wl->chip.id;
        strncpy(wiphy->fw_version, wl->chip.fw_ver_str,
                sizeof(wiphy->fw_version));

        /*
         * Now we know if 11a is supported (info from the NVS), so disable
         * 11a channels if not supported
         */
        if (!wl->enable_11a)
                wiphy->bands[IEEE80211_BAND_5GHZ]->n_channels = 0;

        wl1271_debug(DEBUG_MAC80211, "11a is %ssupported",
                     wl->enable_11a ? "" : "not ");

        wl->state = WL1271_STATE_ON;
out:
        return booted;
}

static bool wl12xx_dev_role_started(struct wl12xx_vif *wlvif)
{
        return wlvif->dev_hlid != WL12XX_INVALID_LINK_ID;
}

/*
 * Check whether a fw switch (i.e. moving from one loaded
 * fw to another) is needed. This function is also responsible
 * for updating wl->last_vif_count, so it must be called before
 * loading a non-plt fw (so the correct fw (single-role/multi-role)
 * will be used).
 */
static bool wl12xx_need_fw_change(struct wl1271 *wl,
                                  struct vif_counter_data vif_counter_data,
                                  bool add)
{
        enum wl12xx_fw_type current_fw = wl->fw_type;
        u8 vif_count = vif_counter_data.counter;

        if (test_bit(WL1271_FLAG_VIF_CHANGE_IN_PROGRESS, &wl->flags))
                return false;

        /* increase the vif count if this is a new vif */
        if (add && !vif_counter_data.cur_vif_running)
                vif_count++;

        wl->last_vif_count = vif_count;

        /* no need for fw change if the device is OFF */
        if (wl->state == WL1271_STATE_OFF)
                return false;

        if (vif_count > 1 && current_fw == WL12XX_FW_TYPE_NORMAL)
                return true;
        if (vif_count <= 1 && current_fw == WL12XX_FW_TYPE_MULTI)
                return true;

        return false;
}

/*
 * Enter "forced psm". Make sure the sta is in psm against the ap,
 * to make the fw switch a bit more disconnection-persistent.
 */
static void wl12xx_force_active_psm(struct wl1271 *wl)
{
        struct wl12xx_vif *wlvif;

        wl12xx_for_each_wlvif_sta(wl, wlvif) {
                wl1271_ps_set_mode(wl, wlvif, STATION_POWER_SAVE_MODE);
        }
}

static int wl1271_op_add_interface(struct ieee80211_hw *hw,
                                   struct ieee80211_vif *vif)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        struct vif_counter_data vif_count;
        int ret = 0;
        u8 role_type;
        bool booted = false;

        vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER |
                             IEEE80211_VIF_SUPPORTS_CQM_RSSI;

        wl1271_debug(DEBUG_MAC80211, "mac80211 add interface type %d mac %pM",
                     ieee80211_vif_type_p2p(vif), vif->addr);

        wl12xx_get_vif_count(hw, vif, &vif_count);

        mutex_lock(&wl->mutex);
        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out_unlock;

        /*
         * in some very corner case HW recovery scenarios its possible to
         * get here before __wl1271_op_remove_interface is complete, so
         * opt out if that is the case.
         */
        if (test_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags) ||
            test_bit(WLVIF_FLAG_INITIALIZED, &wlvif->flags)) {
                ret = -EBUSY;
                goto out;
        }


        ret = wl12xx_init_vif_data(wl, vif);
        if (ret < 0)
                goto out;

        wlvif->wl = wl;
        role_type = wl12xx_get_role_type(wl, wlvif);
        if (role_type == WL12XX_INVALID_ROLE_TYPE) {
                ret = -EINVAL;
                goto out;
        }

        if (wl12xx_need_fw_change(wl, vif_count, true)) {
                wl12xx_force_active_psm(wl);
                set_bit(WL1271_FLAG_INTENDED_FW_RECOVERY, &wl->flags);
                mutex_unlock(&wl->mutex);
                wl1271_recovery_work(&wl->recovery_work);
                return 0;
        }

        /*
         * TODO: after the nvs issue will be solved, move this block
         * to start(), and make sure here the driver is ON.
         */
        if (wl->state == WL1271_STATE_OFF) {
                /*
                 * we still need this in order to configure the fw
                 * while uploading the nvs
                 */
                memcpy(wl->addresses[0].addr, vif->addr, ETH_ALEN);

                booted = wl12xx_init_fw(wl);
                if (!booted) {
                        ret = -EINVAL;
                        goto out;
                }
        }

        if (wlvif->bss_type == BSS_TYPE_STA_BSS ||
            wlvif->bss_type == BSS_TYPE_IBSS) {
                /*
                 * The device role is a special role used for
                 * rx and tx frames prior to association (as
                 * the STA role can get packets only from
                 * its associated bssid)
                 */
                ret = wl12xx_cmd_role_enable(wl, vif->addr,
                                                 WL1271_ROLE_DEVICE,
                                                 &wlvif->dev_role_id);
                if (ret < 0)
                        goto out;
        }

        ret = wl12xx_cmd_role_enable(wl, vif->addr,
                                     role_type, &wlvif->role_id);
        if (ret < 0)
                goto out;

        ret = wl1271_init_vif_specific(wl, vif);
        if (ret < 0)
                goto out;

        list_add(&wlvif->list, &wl->wlvif_list);
        set_bit(WLVIF_FLAG_INITIALIZED, &wlvif->flags);

        if (wlvif->bss_type == BSS_TYPE_AP_BSS)
                wl->ap_count++;
        else
                wl->sta_count++;
out:
        wl1271_ps_elp_sleep(wl);
out_unlock:
        mutex_unlock(&wl->mutex);

        return ret;
}

static void __wl1271_op_remove_interface(struct wl1271 *wl,
                                         struct ieee80211_vif *vif,
                                         bool reset_tx_queues)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        int i, ret;

        wl1271_debug(DEBUG_MAC80211, "mac80211 remove interface");

        if (!test_and_clear_bit(WLVIF_FLAG_INITIALIZED, &wlvif->flags))
                return;

        /* because of hardware recovery, we may get here twice */
        if (wl->state != WL1271_STATE_ON)
                return;

        wl1271_info("down");

        if (wl->scan.state != WL1271_SCAN_STATE_IDLE &&
            wl->scan_vif == vif) {
                /*
                 * Rearm the tx watchdog just before idling scan. This
                 * prevents just-finished scans from triggering the watchdog
                 */
                wl12xx_rearm_tx_watchdog_locked(wl);

                wl->scan.state = WL1271_SCAN_STATE_IDLE;
                memset(wl->scan.scanned_ch, 0, sizeof(wl->scan.scanned_ch));
                wl->scan_vif = NULL;
                wl->scan.req = NULL;
                ieee80211_scan_completed(wl->hw, true);
        }

        if (!test_bit(WL1271_FLAG_RECOVERY_IN_PROGRESS, &wl->flags)) {
                /* disable active roles */
                ret = wl1271_ps_elp_wakeup(wl);
                if (ret < 0)
                        goto deinit;

                if (wlvif->bss_type == BSS_TYPE_STA_BSS ||
                    wlvif->bss_type == BSS_TYPE_IBSS) {
                        if (wl12xx_dev_role_started(wlvif))
                                wl12xx_stop_dev(wl, wlvif);

                        ret = wl12xx_cmd_role_disable(wl, &wlvif->dev_role_id);
                        if (ret < 0)
                                goto deinit;
                }

                ret = wl12xx_cmd_role_disable(wl, &wlvif->role_id);
                if (ret < 0)
                        goto deinit;

                wl1271_ps_elp_sleep(wl);
        }
deinit:
        /* clear all hlids (except system_hlid) */
        wlvif->dev_hlid = WL12XX_INVALID_LINK_ID;

        if (wlvif->bss_type == BSS_TYPE_STA_BSS ||
            wlvif->bss_type == BSS_TYPE_IBSS) {
                wlvif->sta.hlid = WL12XX_INVALID_LINK_ID;
                wl12xx_free_rate_policy(wl, &wlvif->sta.basic_rate_idx);
                wl12xx_free_rate_policy(wl, &wlvif->sta.ap_rate_idx);
                wl12xx_free_rate_policy(wl, &wlvif->sta.p2p_rate_idx);
        } else {
                wlvif->ap.bcast_hlid = WL12XX_INVALID_LINK_ID;
                wlvif->ap.global_hlid = WL12XX_INVALID_LINK_ID;
                wl12xx_free_rate_policy(wl, &wlvif->ap.mgmt_rate_idx);
                wl12xx_free_rate_policy(wl, &wlvif->ap.bcast_rate_idx);
                for (i = 0; i < CONF_TX_MAX_AC_COUNT; i++)
                        wl12xx_free_rate_policy(wl,
                                                &wlvif->ap.ucast_rate_idx[i]);
        }

        wl12xx_tx_reset_wlvif(wl, wlvif);
        wl1271_free_ap_keys(wl, wlvif);
        if (wl->last_wlvif == wlvif)
                wl->last_wlvif = NULL;
        list_del(&wlvif->list);
        memset(wlvif->ap.sta_hlid_map, 0, sizeof(wlvif->ap.sta_hlid_map));
        wlvif->role_id = WL12XX_INVALID_ROLE_ID;
        wlvif->dev_role_id = WL12XX_INVALID_ROLE_ID;

        if (wlvif->bss_type == BSS_TYPE_AP_BSS)
                wl->ap_count--;
        else
                wl->sta_count--;

        mutex_unlock(&wl->mutex);

        del_timer_sync(&wlvif->rx_streaming_timer);
        cancel_work_sync(&wlvif->rx_streaming_enable_work);
        cancel_work_sync(&wlvif->rx_streaming_disable_work);

        mutex_lock(&wl->mutex);
}

static void wl1271_op_remove_interface(struct ieee80211_hw *hw,
                                       struct ieee80211_vif *vif)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        struct wl12xx_vif *iter;
        struct vif_counter_data vif_count;
        bool cancel_recovery = true;

        wl12xx_get_vif_count(hw, vif, &vif_count);
        mutex_lock(&wl->mutex);

        if (wl->state == WL1271_STATE_OFF ||
            !test_bit(WLVIF_FLAG_INITIALIZED, &wlvif->flags))
                goto out;

        /*
         * wl->vif can be null here if someone shuts down the interface
         * just when hardware recovery has been started.
         */
        wl12xx_for_each_wlvif(wl, iter) {
                if (iter != wlvif)
                        continue;

                __wl1271_op_remove_interface(wl, vif, true);
                break;
        }
        WARN_ON(iter != wlvif);
        if (wl12xx_need_fw_change(wl, vif_count, false)) {
                wl12xx_force_active_psm(wl);
                set_bit(WL1271_FLAG_INTENDED_FW_RECOVERY, &wl->flags);
                wl12xx_queue_recovery_work(wl);
                cancel_recovery = false;
        }
out:
        mutex_unlock(&wl->mutex);
        if (cancel_recovery)
                cancel_work_sync(&wl->recovery_work);
}

static int wl12xx_op_change_interface(struct ieee80211_hw *hw,
                                      struct ieee80211_vif *vif,
                                      enum nl80211_iftype new_type, bool p2p)
{
        struct wl1271 *wl = hw->priv;
        int ret;

        set_bit(WL1271_FLAG_VIF_CHANGE_IN_PROGRESS, &wl->flags);
        wl1271_op_remove_interface(hw, vif);

        vif->type = new_type;
        vif->p2p = p2p;
        ret = wl1271_op_add_interface(hw, vif);

        clear_bit(WL1271_FLAG_VIF_CHANGE_IN_PROGRESS, &wl->flags);
        return ret;
}

static int wl1271_join(struct wl1271 *wl, struct wl12xx_vif *wlvif,
                          bool set_assoc)
{
        int ret;
        bool is_ibss = (wlvif->bss_type == BSS_TYPE_IBSS);

        /*
         * One of the side effects of the JOIN command is that is clears
         * WPA/WPA2 keys from the chipset. Performing a JOIN while associated
         * to a WPA/WPA2 access point will therefore kill the data-path.
         * Currently the only valid scenario for JOIN during association
         * is on roaming, in which case we will also be given new keys.
         * Keep the below message for now, unless it starts bothering
         * users who really like to roam a lot :)
         */
        if (test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags))
                wl1271_info("JOIN while associated.");

        /* clear encryption type */
        wlvif->encryption_type = KEY_NONE;

        if (set_assoc)
                set_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags);

        if (is_ibss)
                ret = wl12xx_cmd_role_start_ibss(wl, wlvif);
        else
                ret = wl12xx_cmd_role_start_sta(wl, wlvif);
        if (ret < 0)
                goto out;

        if (!test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags))
                goto out;

        /*
         * The join command disable the keep-alive mode, shut down its process,
         * and also clear the template config, so we need to reset it all after
         * the join. The acx_aid starts the keep-alive process, and the order
         * of the commands below is relevant.
         */
        ret = wl1271_acx_keep_alive_mode(wl, wlvif, true);
        if (ret < 0)
                goto out;

        ret = wl1271_acx_aid(wl, wlvif, wlvif->aid);
        if (ret < 0)
                goto out;

        ret = wl12xx_cmd_build_klv_null_data(wl, wlvif);
        if (ret < 0)
                goto out;

        ret = wl1271_acx_keep_alive_config(wl, wlvif,
                                           CMD_TEMPL_KLV_IDX_NULL_DATA,
                                           ACX_KEEP_ALIVE_TPL_VALID);
        if (ret < 0)
                goto out;

out:
        return ret;
}

static int wl1271_unjoin(struct wl1271 *wl, struct wl12xx_vif *wlvif)
{
        int ret;

        if (test_and_clear_bit(WLVIF_FLAG_CS_PROGRESS, &wlvif->flags)) {
                struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif);

                wl12xx_cmd_stop_channel_switch(wl);
                ieee80211_chswitch_done(vif, false);
        }

        /* to stop listening to a channel, we disconnect */
        ret = wl12xx_cmd_role_stop_sta(wl, wlvif);
        if (ret < 0)
                goto out;

        /* reset TX security counters on a clean disconnect */
        wlvif->tx_security_last_seq_lsb = 0;
        wlvif->tx_security_seq = 0;

out:
        return ret;
}

static void wl1271_set_band_rate(struct wl1271 *wl, struct wl12xx_vif *wlvif)
{
        wlvif->basic_rate_set = wlvif->bitrate_masks[wlvif->band];
        wlvif->rate_set = wlvif->basic_rate_set;
}

static int wl1271_sta_handle_idle(struct wl1271 *wl, struct wl12xx_vif *wlvif,
                                  bool idle)
{
        int ret;
        bool cur_idle = !test_bit(WLVIF_FLAG_IN_USE, &wlvif->flags);

        if (idle == cur_idle)
                return 0;

        if (idle) {
                /* no need to croc if we weren't busy (e.g. during boot) */
                if (wl12xx_dev_role_started(wlvif)) {
                        ret = wl12xx_stop_dev(wl, wlvif);
                        if (ret < 0)
                                goto out;
                }
                wlvif->rate_set =
                        wl1271_tx_min_rate_get(wl, wlvif->basic_rate_set);
                ret = wl1271_acx_sta_rate_policies(wl, wlvif);
                if (ret < 0)
                        goto out;
                ret = wl1271_acx_keep_alive_config(
                        wl, wlvif, CMD_TEMPL_KLV_IDX_NULL_DATA,
                        ACX_KEEP_ALIVE_TPL_INVALID);
                if (ret < 0)
                        goto out;
                clear_bit(WLVIF_FLAG_IN_USE, &wlvif->flags);
        } else {
                /* The current firmware only supports sched_scan in idle */
                if (wl->sched_scanning) {
                        wl1271_scan_sched_scan_stop(wl);
                        ieee80211_sched_scan_stopped(wl->hw);
                }

                ret = wl12xx_start_dev(wl, wlvif);
                if (ret < 0)
                        goto out;
                set_bit(WLVIF_FLAG_IN_USE, &wlvif->flags);
        }

out:
        return ret;
}

static int wl12xx_config_vif(struct wl1271 *wl, struct wl12xx_vif *wlvif,
                             struct ieee80211_conf *conf, u32 changed)
{
        bool is_ap = (wlvif->bss_type == BSS_TYPE_AP_BSS);
        int channel, ret;

        channel = ieee80211_frequency_to_channel(conf->channel->center_freq);

        /* if the channel changes while joined, join again */
        if (changed & IEEE80211_CONF_CHANGE_CHANNEL &&
            ((wlvif->band != conf->channel->band) ||
             (wlvif->channel != channel))) {
                /* send all pending packets */
                wl1271_tx_work_locked(wl);
                wlvif->band = conf->channel->band;
                wlvif->channel = channel;

                if (!is_ap) {
                        /*
                         * FIXME: the mac80211 should really provide a fixed
                         * rate to use here. for now, just use the smallest
                         * possible rate for the band as a fixed rate for
                         * association frames and other control messages.
                         */
                        if (!test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags))
                                wl1271_set_band_rate(wl, wlvif);

                        wlvif->basic_rate =
                                wl1271_tx_min_rate_get(wl,
                                                       wlvif->basic_rate_set);
                        ret = wl1271_acx_sta_rate_policies(wl, wlvif);
                        if (ret < 0)
                                wl1271_warning("rate policy for channel "
                                               "failed %d", ret);

                        /*
                         * change the ROC channel. do it only if we are
                         * not idle. otherwise, CROC will be called
                         * anyway.
                         */
                        if (!test_bit(WLVIF_FLAG_STA_ASSOCIATED,
                                      &wlvif->flags) &&
                            wl12xx_dev_role_started(wlvif) &&
                            !(conf->flags & IEEE80211_CONF_IDLE)) {
                                ret = wl12xx_stop_dev(wl, wlvif);
                                if (ret < 0)
                                        return ret;

                                ret = wl12xx_start_dev(wl, wlvif);
                                if (ret < 0)
                                        return ret;
                        }
                }
        }

        if ((changed & IEEE80211_CONF_CHANGE_PS) && !is_ap) {

                if ((conf->flags & IEEE80211_CONF_PS) &&
                    test_bit(WLVIF_FLAG_STA_ASSOCIATED, &wlvif->flags) &&
                    !test_bit(WLVIF_FLAG_IN_PS, &wlvif->flags)) {

                        int ps_mode;
                        char *ps_mode_str;

                        if (wl->conf.conn.forced_ps) {
                                ps_mode = STATION_POWER_SAVE_MODE;
                                ps_mode_str = "forced";
                        } else {
                                ps_mode = STATION_AUTO_PS_MODE;
                                ps_mode_str = "auto";
                        }

                        wl1271_debug(DEBUG_PSM, "%s ps enabled", ps_mode_str);

                        ret = wl1271_ps_set_mode(wl, wlvif, ps_mode);

                        if (ret < 0)
                                wl1271_warning("enter %s ps failed %d",
                                               ps_mode_str, ret);

                } else if (!(conf->flags & IEEE80211_CONF_PS) &&
                           test_bit(WLVIF_FLAG_IN_PS, &wlvif->flags)) {

                        wl1271_debug(DEBUG_PSM, "auto ps disabled");

                        ret = wl1271_ps_set_mode(wl, wlvif,
                                                 STATION_ACTIVE_MODE);
                        if (ret < 0)
                                wl1271_warning("exit auto ps failed %d", ret);
                }
        }

        if (conf->power_level != wlvif->power_level) {
                ret = wl1271_acx_tx_power(wl, wlvif, conf->power_level);
                if (ret < 0)
                        return ret;

                wlvif->power_level = conf->power_level;
        }

        return 0;
}

static int wl1271_op_config(struct ieee80211_hw *hw, u32 changed)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif;
        struct ieee80211_conf *conf = &hw->conf;
        int channel, ret = 0;

        channel = ieee80211_frequency_to_channel(conf->channel->center_freq);

        wl1271_debug(DEBUG_MAC80211, "mac80211 config ch %d psm %s power %d %s"
                     " changed 0x%x",
                     channel,
                     conf->flags & IEEE80211_CONF_PS ? "on" : "off",
                     conf->power_level,
                     conf->flags & IEEE80211_CONF_IDLE ? "idle" : "in use",
                         changed);

        /*
         * mac80211 will go to idle nearly immediately after transmitting some
         * frames, such as the deauth. To make sure those frames reach the air,
         * wait here until the TX queue is fully flushed.
         */
        if ((changed & IEEE80211_CONF_CHANGE_IDLE) &&
            (conf->flags & IEEE80211_CONF_IDLE))
                wl1271_tx_flush(wl);

        mutex_lock(&wl->mutex);

        /* we support configuring the channel and band even while off */
        if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
                wl->band = conf->channel->band;
                wl->channel = channel;
        }

        if (changed & IEEE80211_CONF_CHANGE_POWER)
                wl->power_level = conf->power_level;

        if (unlikely(wl->state == WL1271_STATE_OFF))
                goto out;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        /* configure each interface */
        wl12xx_for_each_wlvif(wl, wlvif) {
                ret = wl12xx_config_vif(wl, wlvif, conf, changed);
                if (ret < 0)
                        goto out_sleep;
        }

out_sleep:
        wl1271_ps_elp_sleep(wl);

out:
        mutex_unlock(&wl->mutex);

        return ret;
}

struct wl1271_filter_params {
        bool enabled;
        int mc_list_length;
        u8 mc_list[ACX_MC_ADDRESS_GROUP_MAX][ETH_ALEN];
};

static u64 wl1271_op_prepare_multicast(struct ieee80211_hw *hw,
                                       struct netdev_hw_addr_list *mc_list)
{
        struct wl1271_filter_params *fp;
        struct netdev_hw_addr *ha;
        struct wl1271 *wl = hw->priv;

        if (unlikely(wl->state == WL1271_STATE_OFF))
                return 0;

        fp = kzalloc(sizeof(*fp), GFP_ATOMIC);
        if (!fp) {
                wl1271_error("Out of memory setting filters.");
                return 0;
        }

        /* update multicast filtering parameters */
        fp->mc_list_length = 0;
        if (netdev_hw_addr_list_count(mc_list) > ACX_MC_ADDRESS_GROUP_MAX) {
                fp->enabled = false;
        } else {
                fp->enabled = true;
                netdev_hw_addr_list_for_each(ha, mc_list) {
                        memcpy(fp->mc_list[fp->mc_list_length],
                                        ha->addr, ETH_ALEN);
                        fp->mc_list_length++;
                }
        }

        return (u64)(unsigned long)fp;
}

#define WL1271_SUPPORTED_FILTERS (FIF_PROMISC_IN_BSS | \
                                  FIF_ALLMULTI | \
                                  FIF_FCSFAIL | \
                                  FIF_BCN_PRBRESP_PROMISC | \
                                  FIF_CONTROL | \
                                  FIF_OTHER_BSS)

static void wl1271_op_configure_filter(struct ieee80211_hw *hw,
                                       unsigned int changed,
                                       unsigned int *total, u64 multicast)
{
        struct wl1271_filter_params *fp = (void *)(unsigned long)multicast;
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif;

        int ret;

        wl1271_debug(DEBUG_MAC80211, "mac80211 configure filter changed %x"
                     " total %x", changed, *total);

        mutex_lock(&wl->mutex);

        *total &= WL1271_SUPPORTED_FILTERS;
        changed &= WL1271_SUPPORTED_FILTERS;

        if (unlikely(wl->state == WL1271_STATE_OFF))
                goto out;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        wl12xx_for_each_wlvif(wl, wlvif) {
                if (wlvif->bss_type != BSS_TYPE_AP_BSS) {
                        if (*total & FIF_ALLMULTI)
                                ret = wl1271_acx_group_address_tbl(wl, wlvif,
                                                                   false,
                                                                   NULL, 0);
                        else if (fp)
                                ret = wl1271_acx_group_address_tbl(wl, wlvif,
                                                        fp->enabled,
                                                        fp->mc_list,
                                                        fp->mc_list_length);
                        if (ret < 0)
                                goto out_sleep;
                }
        }

        /*
         * the fw doesn't provide an api to configure the filters. instead,
         * the filters configuration is based on the active roles / ROC
         * state.
         */

out_sleep:
        wl1271_ps_elp_sleep(wl);

out:
        mutex_unlock(&wl->mutex);
        kfree(fp);
}

static int wl1271_record_ap_key(struct wl1271 *wl, struct wl12xx_vif *wlvif,
                                u8 id, u8 key_type, u8 key_size,
                                const u8 *key, u8 hlid, u32 tx_seq_32,
                                u16 tx_seq_16)
{
        struct wl1271_ap_key *ap_key;
        int i;

        wl1271_debug(DEBUG_CRYPT, "record ap key id %d", (int)id);

        if (key_size > MAX_KEY_SIZE)
                return -EINVAL;

        /*
         * Find next free entry in ap_keys. Also check we are not replacing
         * an existing key.
         */
        for (i = 0; i < MAX_NUM_KEYS; i++) {
                if (wlvif->ap.recorded_keys[i] == NULL)
                        break;

                if (wlvif->ap.recorded_keys[i]->id == id) {
                        wl1271_warning("trying to record key replacement");
                        return -EINVAL;
                }
        }

        if (i == MAX_NUM_KEYS)
                return -EBUSY;

        ap_key = kzalloc(sizeof(*ap_key), GFP_KERNEL);
        if (!ap_key)
                return -ENOMEM;

        ap_key->id = id;
        ap_key->key_type = key_type;
        ap_key->key_size = key_size;
        memcpy(ap_key->key, key, key_size);
        ap_key->hlid = hlid;
        ap_key->tx_seq_32 = tx_seq_32;
        ap_key->tx_seq_16 = tx_seq_16;

        wlvif->ap.recorded_keys[i] = ap_key;
        return 0;
}

static void wl1271_free_ap_keys(struct wl1271 *wl, struct wl12xx_vif *wlvif)
{
        int i;

        for (i = 0; i < MAX_NUM_KEYS; i++) {
                kfree(wlvif->ap.recorded_keys[i]);
                wlvif->ap.recorded_keys[i] = NULL;
        }
}

static int wl1271_ap_init_hwenc(struct wl1271 *wl, struct wl12xx_vif *wlvif)
{
        int i, ret = 0;
        struct wl1271_ap_key *key;
        bool wep_key_added = false;

        for (i = 0; i < MAX_NUM_KEYS; i++) {
                u8 hlid;
                if (wlvif->ap.recorded_keys[i] == NULL)
                        break;

                key = wlvif->ap.recorded_keys[i];
                hlid = key->hlid;
                if (hlid == WL12XX_INVALID_LINK_ID)
                        hlid = wlvif->ap.bcast_hlid;

                ret = wl1271_cmd_set_ap_key(wl, wlvif, KEY_ADD_OR_REPLACE,
                                            key->id, key->key_type,
                                            key->key_size, key->key,
                                            hlid, key->tx_seq_32,
                                            key->tx_seq_16);
                if (ret < 0)
                        goto out;

                if (key->key_type == KEY_WEP)
                        wep_key_added = true;
        }

        if (wep_key_added) {
                ret = wl12xx_cmd_set_default_wep_key(wl, wlvif->default_key,
                                                     wlvif->ap.bcast_hlid);
                if (ret < 0)
                        goto out;
        }

out:
        wl1271_free_ap_keys(wl, wlvif);
        return ret;
}

static int wl1271_set_key(struct wl1271 *wl, struct wl12xx_vif *wlvif,
                       u16 action, u8 id, u8 key_type,
                       u8 key_size, const u8 *key, u32 tx_seq_32,
                       u16 tx_seq_16, struct ieee80211_sta *sta)
{
        int ret;
        bool is_ap = (wlvif->bss_type == BSS_TYPE_AP_BSS);

        if (is_ap) {
                struct wl1271_station *wl_sta;
                u8 hlid;

                if (sta) {
                        wl_sta = (struct wl1271_station *)sta->drv_priv;
                        hlid = wl_sta->hlid;
                } else {
                        hlid = wlvif->ap.bcast_hlid;
                }

                if (!test_bit(WLVIF_FLAG_AP_STARTED, &wlvif->flags)) {
                        /*
                         * We do not support removing keys after AP shutdown.
                         * Pretend we do to make mac80211 happy.
                         */
                        if (action != KEY_ADD_OR_REPLACE)
                                return 0;

                        ret = wl1271_record_ap_key(wl, wlvif, id,
                                             key_type, key_size,
                                             key, hlid, tx_seq_32,
                                             tx_seq_16);
                } else {
                        ret = wl1271_cmd_set_ap_key(wl, wlvif, action,
                                             id, key_type, key_size,
                                             key, hlid, tx_seq_32,
                                             tx_seq_16);
                }

                if (ret < 0)
                        return ret;
        } else {
                const u8 *addr;
                static const u8 bcast_addr[ETH_ALEN] = {
                        0xff, 0xff, 0xff, 0xff, 0xff, 0xff
                };

                /*
                 * A STA set to GEM cipher requires 2 tx spare blocks.
                 * Return to default value when GEM cipher key is removed
                 */
                if (key_type == KEY_GEM) {
                        if (action == KEY_ADD_OR_REPLACE)
                                wl->tx_spare_blocks = 2;
                        else if (action == KEY_REMOVE)
                                wl->tx_spare_blocks = TX_HW_BLOCK_SPARE_DEFAULT;
                }

                addr = sta ? sta->addr : bcast_addr;

                if (is_zero_ether_addr(addr)) {

                        /* We dont support TX only encryption */
                        return -EOPNOTSUPP;
                }

                /* The wl1271 does not allow to remove unicast keys - they
                   will be cleared automatically on next CMD_JOIN. Ignore the
                   request silently, as we dont want the mac80211 to emit
                   an error message. */
                if (action == KEY_REMOVE && !is_broadcast_ether_addr(addr))
                        return 0;

                /* don't remove key if hlid was already deleted */
                if (action == KEY_REMOVE &&
                    wlvif->sta.hlid == WL12XX_INVALID_LINK_ID)
                        return 0;

                ret = wl1271_cmd_set_sta_key(wl, wlvif, action,
                                             id, key_type, key_size,
                                             key, addr, tx_seq_32,
                                             tx_seq_16);
                if (ret < 0)
                        return ret;

                /* the default WEP key needs to be configured at least once */
                if (key_type == KEY_WEP) {
                        ret = wl12xx_cmd_set_default_wep_key(wl,
                                                        wlvif->default_key,
                                                        wlvif->sta.hlid);
                        if (ret < 0)
                                return ret;
                }
        }

        return 0;
}

static int wl1271_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
                             struct ieee80211_vif *vif,
                             struct ieee80211_sta *sta,
                             struct ieee80211_key_conf *key_conf)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        int ret;
        u32 tx_seq_32 = 0;
        u16 tx_seq_16 = 0;
        u8 key_type;

        wl1271_debug(DEBUG_MAC80211, "mac80211 set key");

        wl1271_debug(DEBUG_CRYPT, "CMD: 0x%x sta: %p", cmd, sta);
        wl1271_debug(DEBUG_CRYPT, "Key: algo:0x%x, id:%d, len:%d flags 0x%x",
                     key_conf->cipher, key_conf->keyidx,
                     key_conf->keylen, key_conf->flags);
        wl1271_dump(DEBUG_CRYPT, "KEY: ", key_conf->key, key_conf->keylen);

        mutex_lock(&wl->mutex);

        if (unlikely(wl->state == WL1271_STATE_OFF)) {
                ret = -EAGAIN;
                goto out_unlock;
        }

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out_unlock;

        switch (key_conf->cipher) {
        case WLAN_CIPHER_SUITE_WEP40:
        case WLAN_CIPHER_SUITE_WEP104:
                key_type = KEY_WEP;

                key_conf->hw_key_idx = key_conf->keyidx;
                break;
        case WLAN_CIPHER_SUITE_TKIP:
                key_type = KEY_TKIP;

                key_conf->hw_key_idx = key_conf->keyidx;
                tx_seq_32 = WL1271_TX_SECURITY_HI32(wlvif->tx_security_seq);
                tx_seq_16 = WL1271_TX_SECURITY_LO16(wlvif->tx_security_seq);
                break;
        case WLAN_CIPHER_SUITE_CCMP:
                key_type = KEY_AES;

                key_conf->flags |= IEEE80211_KEY_FLAG_PUT_IV_SPACE;
                tx_seq_32 = WL1271_TX_SECURITY_HI32(wlvif->tx_security_seq);
                tx_seq_16 = WL1271_TX_SECURITY_LO16(wlvif->tx_security_seq);
                break;
        case WL1271_CIPHER_SUITE_GEM:
                key_type = KEY_GEM;
                tx_seq_32 = WL1271_TX_SECURITY_HI32(wlvif->tx_security_seq);
                tx_seq_16 = WL1271_TX_SECURITY_LO16(wlvif->tx_security_seq);
                break;
        default:
                wl1271_error("Unknown key algo 0x%x", key_conf->cipher);

                ret = -EOPNOTSUPP;
                goto out_sleep;
        }

        switch (cmd) {
        case SET_KEY:
                ret = wl1271_set_key(wl, wlvif, KEY_ADD_OR_REPLACE,
                                 key_conf->keyidx, key_type,
                                 key_conf->keylen, key_conf->key,
                                 tx_seq_32, tx_seq_16, sta);
                if (ret < 0) {
                        wl1271_error("Could not add or replace key");
                        goto out_sleep;
                }

                /*
                 * reconfiguring arp response if the unicast (or common)
                 * encryption key type was changed
                 */
                if (wlvif->bss_type == BSS_TYPE_STA_BSS &&
                    (sta || key_type == KEY_WEP) &&
                    wlvif->encryption_type != key_type) {
                        wlvif->encryption_type = key_type;
                        ret = wl1271_cmd_build_arp_rsp(wl, wlvif);
                        if (ret < 0) {
                                wl1271_warning("build arp rsp failed: %d", ret);
                                goto out_sleep;
                        }
                }
                break;

        case DISABLE_KEY:
                ret = wl1271_set_key(wl, wlvif, KEY_REMOVE,
                                     key_conf->keyidx, key_type,
                                     key_conf->keylen, key_conf->key,
                                     0, 0, sta);
                if (ret < 0) {
                        wl1271_error("Could not remove key");
                        goto out_sleep;
                }
                break;

        default:
                wl1271_error("Unsupported key cmd 0x%x", cmd);
                ret = -EOPNOTSUPP;
                break;
        }

out_sleep:
        wl1271_ps_elp_sleep(wl);

out_unlock:
        mutex_unlock(&wl->mutex);

        return ret;
}

static int wl1271_op_hw_scan(struct ieee80211_hw *hw,
                             struct ieee80211_vif *vif,
                             struct cfg80211_scan_request *req)
{
        struct wl1271 *wl = hw->priv;
        int ret;
        u8 *ssid = NULL;
        size_t len = 0;

        wl1271_debug(DEBUG_MAC80211, "mac80211 hw scan");

        if (req->n_ssids) {
                ssid = req->ssids[0].ssid;
                len = req->ssids[0].ssid_len;
        }

        mutex_lock(&wl->mutex);

        if (wl->state == WL1271_STATE_OFF) {
                /*
                 * We cannot return -EBUSY here because cfg80211 will expect
                 * a call to ieee80211_scan_completed if we do - in this case
                 * there won't be any call.
                 */
                ret = -EAGAIN;
                goto out;
        }

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        /* fail if there is any role in ROC */
        if (find_first_bit(wl->roc_map, WL12XX_MAX_ROLES) < WL12XX_MAX_ROLES) {
                /* don't allow scanning right now */
                ret = -EBUSY;
                goto out_sleep;
        }

        ret = wl1271_scan(hw->priv, vif, ssid, len, req);
out_sleep:
        wl1271_ps_elp_sleep(wl);
out:
        mutex_unlock(&wl->mutex);

        return ret;
}

static void wl1271_op_cancel_hw_scan(struct ieee80211_hw *hw,
                                     struct ieee80211_vif *vif)
{
        struct wl1271 *wl = hw->priv;
        int ret;

        wl1271_debug(DEBUG_MAC80211, "mac80211 cancel hw scan");

        mutex_lock(&wl->mutex);

        if (wl->state == WL1271_STATE_OFF)
                goto out;

        if (wl->scan.state == WL1271_SCAN_STATE_IDLE)
                goto out;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        if (wl->scan.state != WL1271_SCAN_STATE_DONE) {
                ret = wl1271_scan_stop(wl);
                if (ret < 0)
                        goto out_sleep;
        }

        /*
         * Rearm the tx watchdog just before idling scan. This
         * prevents just-finished scans from triggering the watchdog
         */
        wl12xx_rearm_tx_watchdog_locked(wl);

        wl->scan.state = WL1271_SCAN_STATE_IDLE;
        memset(wl->scan.scanned_ch, 0, sizeof(wl->scan.scanned_ch));
        wl->scan_vif = NULL;
        wl->scan.req = NULL;
        ieee80211_scan_completed(wl->hw, true);

out_sleep:
        wl1271_ps_elp_sleep(wl);
out:
        mutex_unlock(&wl->mutex);

        cancel_delayed_work_sync(&wl->scan_complete_work);
}

static int wl1271_op_sched_scan_start(struct ieee80211_hw *hw,
                                      struct ieee80211_vif *vif,
                                      struct cfg80211_sched_scan_request *req,
                                      struct ieee80211_sched_scan_ies *ies)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        int ret;

        wl1271_debug(DEBUG_MAC80211, "wl1271_op_sched_scan_start");

        mutex_lock(&wl->mutex);

        if (wl->state == WL1271_STATE_OFF) {
                ret = -EAGAIN;
                goto out;
        }

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        ret = wl1271_scan_sched_scan_config(wl, wlvif, req, ies);
        if (ret < 0)
                goto out_sleep;

        ret = wl1271_scan_sched_scan_start(wl, wlvif);
        if (ret < 0)
                goto out_sleep;

        wl->sched_scanning = true;

out_sleep:
        wl1271_ps_elp_sleep(wl);
out:
        mutex_unlock(&wl->mutex);
        return ret;
}

static void wl1271_op_sched_scan_stop(struct ieee80211_hw *hw,
                                      struct ieee80211_vif *vif)
{
        struct wl1271 *wl = hw->priv;
        int ret;

        wl1271_debug(DEBUG_MAC80211, "wl1271_op_sched_scan_stop");

        mutex_lock(&wl->mutex);

        if (wl->state == WL1271_STATE_OFF)
                goto out;

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        wl1271_scan_sched_scan_stop(wl);

        wl1271_ps_elp_sleep(wl);
out:
        mutex_unlock(&wl->mutex);
}

static int wl1271_op_set_frag_threshold(struct ieee80211_hw *hw, u32 value)
{
        struct wl1271 *wl = hw->priv;
        int ret = 0;

        mutex_lock(&wl->mutex);

        if (unlikely(wl->state == WL1271_STATE_OFF)) {
                ret = -EAGAIN;
                goto out;
        }

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        ret = wl1271_acx_frag_threshold(wl, value);
        if (ret < 0)
                wl1271_warning("wl1271_op_set_frag_threshold failed: %d", ret);

        wl1271_ps_elp_sleep(wl);

out:
        mutex_unlock(&wl->mutex);

        return ret;
}

static int wl1271_op_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
{
        struct wl1271 *wl = hw->priv;
        struct wl12xx_vif *wlvif;
        int ret = 0;

        mutex_lock(&wl->mutex);

        if (unlikely(wl->state == WL1271_STATE_OFF)) {
                ret = -EAGAIN;
                goto out;
        }

        ret = wl1271_ps_elp_wakeup(wl);
        if (ret < 0)
                goto out;

        wl12xx_for_each_wlvif(wl, wlvif) {
                ret = wl1271_acx_rts_threshold(wl, wlvif, value);
                if (ret < 0)
                        wl1271_warning("set rts threshold failed: %d", ret);
        }
        wl1271_ps_elp_sleep(wl);

out:
        mutex_unlock(&wl->mutex);

        return ret;
}

static int wl1271_ssid_set(struct ieee80211_vif *vif, struct sk_buff *skb,
                            int offset)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        u8 ssid_len;
        const u8 *ptr = cfg80211_find_ie(WLAN_EID_SSID, skb->data + offset,
                                         skb->len - offset);

        if (!ptr) {
                wl1271_error("No SSID in IEs!");
                return -ENOENT;
        }

        ssid_len = ptr[1];
        if (ssid_len > IEEE80211_MAX_SSID_LEN) {
                wl1271_error("SSID is too long!");
                return -EINVAL;
        }

        wlvif->ssid_len = ssid_len;
        memcpy(wlvif->ssid, ptr+2, ssid_len);
        return 0;
}

static void wl12xx_remove_ie(struct sk_buff *skb, u8 eid, int ieoffset)
{
        int len;
        const u8 *next, *end = skb->data + skb->len;
        u8 *ie = (u8 *)cfg80211_find_ie(eid, skb->data + ieoffset,
                                        skb->len - ieoffset);
        if (!ie)
                return;
        len = ie[1] + 2;
        next = ie + len;
        memmove(ie, next, end - next);
        skb_trim(skb, skb->len - len);
}

static void wl12xx_remove_vendor_ie(struct sk_buff *skb,
                                            unsigned int oui, u8 oui_type,
                                            int ieoffset)
{
        int len;
        const u8 *next, *end = skb->data + skb->len;
        u8 *ie = (u8 *)cfg80211_find_vendor_ie(oui, oui_type,
                                               skb->data + ieoffset,
                                               skb->len - ieoffset);
        if (!ie)
                return;
        len = ie[1] + 2;
        next = ie + len;
        memmove(ie, next, end - next);
        skb_trim(skb, skb->len - len);
}

static int wl1271_ap_set_probe_resp_tmpl(struct wl1271 *wl, u32 rates,
                                         struct ieee80211_vif *vif)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        struct sk_buff *skb;
        int ret;

        skb = ieee80211_proberesp_get(wl->hw, vif);
        if (!skb)
                return -EOPNOTSUPP;

        ret = wl1271_cmd_template_set(wl, wlvif->role_id,
                                      CMD_TEMPL_AP_PROBE_RESPONSE,
                                      skb->data,
                                      skb->len, 0,
                                      rates);

        dev_kfree_skb(skb);
        return ret;
}

static int wl1271_ap_set_probe_resp_tmpl_legacy(struct wl1271 *wl,
                                             struct ieee80211_vif *vif,
                                             u8 *probe_rsp_data,
                                             size_t probe_rsp_len,
                                             u32 rates)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
        u8 probe_rsp_templ[WL1271_CMD_TEMPL_MAX_SIZE];
        int ssid_ie_offset, ie_offset, templ_len;
        const u8 *ptr;

        /* no need to change probe response if the SSID is set correctly */
        if (wlvif->ssid_len > 0)
                return wl1271_cmd_template_set(wl, wlvif->role_id,
                                               CMD_TEMPL_AP_PROBE_RESPONSE,
                                               probe_rsp_data,
                                               probe_rsp_len, 0,
                                               rates);

        if (probe_rsp_len + bss_conf->ssid_len > WL1271_CMD_TEMPL_MAX_SIZE) {
                wl1271_error("probe_rsp template too big");
                return -EINVAL;
        }

        /* start searching from IE offset */
        ie_offset = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);

        ptr = cfg80211_find_ie(WLAN_EID_SSID, probe_rsp_data + ie_offset,
                               probe_rsp_len - ie_offset);
        if (!ptr) {
                wl1271_error("No SSID in beacon!");
                return -EINVAL;
        }

        ssid_ie_offset = ptr - probe_rsp_data;
        ptr += (ptr[1] + 2);

        memcpy(probe_rsp_templ, probe_rsp_data, ssid_ie_offset);

        /* insert SSID from bss_conf */
        probe_rsp_templ[ssid_ie_offset] = WLAN_EID_SSID;
        probe_rsp_templ[ssid_ie_offset + 1] = bss_conf->ssid_len;
        memcpy(probe_rsp_templ + ssid_ie_offset + 2,
               bss_conf->ssid, bss_conf->ssid_len);
        templ_len = ssid_ie_offset + 2 + bss_conf->ssid_len;

        memcpy(probe_rsp_templ + ssid_ie_offset + 2 + bss_conf->ssid_len,
               ptr, probe_rsp_len - (ptr - probe_rsp_data));
        templ_len += probe_rsp_len - (ptr - probe_rsp_data);

        return wl1271_cmd_template_set(wl, wlvif->role_id,
                                       CMD_TEMPL_AP_PROBE_RESPONSE,
                                       probe_rsp_templ,
                                       templ_len, 0,
                                       rates);
}

static int wl1271_bss_erp_info_changed(struct wl1271 *wl,
                                       struct ieee80211_vif *vif,
                                       struct ieee80211_bss_conf *bss_conf,
                                       u32 changed)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        int ret = 0;

        if (changed & BSS_CHANGED_ERP_SLOT) {
                if (bss_conf->use_short_slot)
                        ret = wl1271_acx_slot(wl, wlvif, SLOT_TIME_SHORT);
                else
                        ret = wl1271_acx_slot(wl, wlvif, SLOT_TIME_LONG);
                if (ret < 0) {
                        wl1271_warning("Set slot time failed %d", ret);
                        goto out;
                }
        }

        if (changed & BSS_CHANGED_ERP_PREAMBLE) {
                if (bss_conf->use_short_preamble)
                        wl1271_acx_set_preamble(wl, wlvif, ACX_PREAMBLE_SHORT);
                else
                        wl1271_acx_set_preamble(wl, wlvif, ACX_PREAMBLE_LONG);
        }

        if (changed & BSS_CHANGED_ERP_CTS_PROT) {
                if (bss_conf->use_cts_prot)
                        ret = wl1271_acx_cts_protect(wl, wlvif,
                                                     CTSPROTECT_ENABLE);
                else
                        ret = wl1271_acx_cts_protect(wl, wlvif,
                                                     CTSPROTECT_DISABLE);
                if (ret < 0) {
                        wl1271_warning("Set ctsprotect failed %d", ret);
                        goto out;
                }
        }

out:
        return ret;
}

static int wl1271_bss_beacon_info_changed(struct wl1271 *wl,
                                          struct ieee80211_vif *vif,
                                          struct ieee80211_bss_conf *bss_conf,
                                          u32 changed)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        bool is_ap = (wlvif->bss_type == BSS_TYPE_AP_BSS);
        int ret = 0;

        if ((changed & BSS_CHANGED_BEACON_INT)) {
                wl1271_debug(DEBUG_MASTER, "beacon interval updated: %d",
                        bss_conf->beacon_int);

                wlvif->beacon_int = bss_conf->beacon_int;
        }

        if ((changed & BSS_CHANGED_AP_PROBE_RESP) && is_ap) {
                u32 rate = wl1271_tx_min_rate_get(wl, wlvif->basic_rate_set);
                if (!wl1271_ap_set_probe_resp_tmpl(wl, rate, vif)) {
                        wl1271_debug(DEBUG_AP, "probe response updated");
                        set_bit(WLVIF_FLAG_AP_PROBE_RESP_SET, &wlvif->flags);
                }
        }

        if ((changed & BSS_CHANGED_BEACON)) {
                struct ieee80211_hdr *hdr;
                u32 min_rate;
                int ieoffset = offsetof(struct ieee80211_mgmt,
                                        u.beacon.variable);
                struct sk_buff *beacon = ieee80211_beacon_get(wl->hw, vif);
                u16 tmpl_id;

                if (!beacon) {
                        ret = -EINVAL;
                        goto out;
                }

                wl1271_debug(DEBUG_MASTER, "beacon updated");

                ret = wl1271_ssid_set(vif, beacon, ieoffset);
                if (ret < 0) {
                        dev_kfree_skb(beacon);
                        goto out;
                }
                min_rate = wl1271_tx_min_rate_get(wl, wlvif->basic_rate_set);
                tmpl_id = is_ap ? CMD_TEMPL_AP_BEACON :
                                  CMD_TEMPL_BEACON;
                ret = wl1271_cmd_template_set(wl, wlvif->role_id, tmpl_id,
                                              beacon->data,
                                              beacon->len, 0,
                                              min_rate);
                if (ret < 0) {
                        dev_kfree_skb(beacon);
                        goto out;
                }

                /*
                 * In case we already have a probe-resp beacon set explicitly
                 * by usermode, don't use the beacon data.
                 */
                if (test_bit(WLVIF_FLAG_AP_PROBE_RESP_SET, &wlvif->flags))
                        goto end_bcn;

                /* remove TIM ie from probe response */
                wl12xx_remove_ie(beacon, WLAN_EID_TIM, ieoffset);

                /*
                 * remove p2p ie from probe response.
                 * the fw reponds to probe requests that don't include
                 * the p2p ie. probe requests with p2p ie will be passed,
                 * and will be responded by the supplicant (the spec
                 * forbids including the p2p ie when responding to probe
                 * requests that didn't include it).
                 */
                wl12xx_remove_vendor_ie(beacon, WLAN_OUI_WFA,
                                        WLAN_OUI_TYPE_WFA_P2P, ieoffset);

                hdr = (struct ieee80211_hdr *) beacon->data;
                hdr->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
                                                 IEEE80211_STYPE_PROBE_RESP);
                if (is_ap)
                        ret = wl1271_ap_set_probe_resp_tmpl_legacy(wl, vif,
                                                beacon->data,
                                                beacon->len,
                                                min_rate);
                else
                        ret = wl1271_cmd_template_set(wl, wlvif->role_id,
                                                CMD_TEMPL_PROBE_RESPONSE,
                                                beacon->data,
                                                beacon->len, 0,
                                                min_rate);
end_bcn:
                dev_kfree_skb(beacon);
                if (ret < 0)
                        goto out;
        }

out:
        if (ret != 0)
                wl1271_error("beacon info change failed: %d", ret);
        return ret;
}

/* AP mode changes */
static void wl1271_bss_info_changed_ap(struct wl1271 *wl,
                                       struct ieee80211_vif *vif,
                                       struct ieee80211_bss_conf *bss_conf,
                                       u32 changed)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        int ret = 0;

        if ((changed & BSS_CHANGED_BASIC_RATES)) {
                u32 rates = bss_conf->basic_rates;

                wlvif->basic_rate_set = wl1271_tx_enabled_rates_get(wl, rates,
                                                                 wlvif->band);
                wlvif->basic_rate = wl1271_tx_min_rate_get(wl,
                                                        wlvif->basic_rate_set);

                ret = wl1271_init_ap_rates(wl, wlvif);
                if (ret < 0) {
                        wl1271_error("AP rate policy change failed %d", ret);
                        goto out;
                }

                ret = wl1271_ap_init_templates(wl, vif);
                if (ret < 0)
                        goto out;
        }

        ret = wl1271_bss_beacon_info_changed(wl, vif, bss_conf, changed);
        if (ret < 0)
                goto out;

        if ((changed & BSS_CHANGED_BEACON_ENABLED)) {
                if (bss_conf->enable_beacon) {
                        if (!test_bit(WLVIF_FLAG_AP_STARTED, &wlvif->flags)) {
                                ret = wl12xx_cmd_role_start_ap(wl, wlvif);
                                if (ret < 0)
                                        goto out;

                                ret = wl1271_ap_init_hwenc(wl, wlvif);
                                if (ret < 0)
                                        goto out;

                                set_bit(WLVIF_FLAG_AP_STARTED, &wlvif->flags);
                                wl1271_debug(DEBUG_AP, "started AP");
                        }
                } else {
                        if (test_bit(WLVIF_FLAG_AP_STARTED, &wlvif->flags)) {
                                ret = wl12xx_cmd_role_stop_ap(wl, wlvif);
                                if (ret < 0)
                                        goto out;

                                clear_bit(WLVIF_FLAG_AP_STARTED, &wlvif->flags);
                                clear_bit(WLVIF_FLAG_AP_PROBE_RESP_SET,
                                          &wlvif->flags);
                                wl1271_debug(DEBUG_AP, "stopped AP");
                        }
                }
        }

        ret = wl1271_bss_erp_info_changed(wl, vif, bss_conf, changed);
        if (ret < 0)
                goto out;

        /* Handle HT information change */
        if ((changed & BSS_CHANGED_HT) &&
            (bss_conf->channel_type != NL80211_CHAN_NO_HT)) {
                ret = wl1271_acx_set_ht_information(wl, wlvif,
                                        bss_conf->ht_operation_mode);
                if (ret < 0) {
                        wl1271_warning("Set ht information failed %d", ret);
                        goto out;
                }
        }

out:
        return;
}

/* STA/IBSS mode changes */
static void wl1271_bss_info_changed_sta(struct wl1271 *wl,
                                        struct ieee80211_vif *vif,
                                        struct ieee80211_bss_conf *bss_conf,
                                        u32 changed)
{
        struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
        bool do_join = false, set_assoc = false;
        bool is_ibss = (wlvif->bss_type == BSS_TYPE_IBSS);
        bool ibss_joined = false;
        u32 sta_rate_set = 0;
        int ret;
        struct ieee80211_sta *sta;
        bool sta_exists = false;
        struct ieee80211_sta_ht_cap sta_ht_cap;

        if (is_ibss) {
                ret = wl1271_bss_beacon_info_changed(wl, vif, bss_conf,
                                                     changed);
                if (ret < 0)
                        goto out;
        }

        if (changed & BSS_CHANGED_IBSS) {
                if (bss_conf->ibss_joined) {
                        set_bit(WLVIF_FLAG_IBSS_JOINED, &wlvif->flags);
                        ibss_joined = true;
                } else {
                        if (test_and_clear_bit(WLVIF_FLAG_IBSS_JOINED,
                                               &wlvif->flags))
                                wl1271_unjoin(wl, wlvif);
                }
        }

        if ((changed & BSS_CHANGED_BEACON_INT) && ibss_joined)
                do_join = true;

        /* Need to update the SSID (for filtering etc) */
        if ((changed & BSS_CHANGED_BEACON) && ibss_joined)
                do_join = true;

        if ((changed & BSS_CHANGED_BEACON_ENABLED) && ibss_joined) {
                wl1271_debug(DEBUG_ADHOC, "ad-hoc beaconing: %s",
                             bss_conf->enable_beacon ? "enabled" : "disabled");

                do_join = true;
        }

        if (changed & BSS_CHANGED_IDLE && !is_ibss) {
                ret = wl1271_sta_handle_idle(wl, wlvif, bss_conf->idle);
                if (ret < 0)
                        wl1271_warning("idle mode change failed %d", ret);
        }

        if ((changed & BSS_CHANGED_CQM)) {
                bool enable = false;
                if (bss_conf->cqm_rssi_thold)
                        enable = true;
                ret = wl1271_acx_rssi_snr_trigger(wl, wlvif, enable,
                                                  bss_conf->cqm_rssi_thold,
                                                  bss_conf->cqm_rssi_hyst);
                if (ret < 0)
                        goto out;
                wlvif->rssi_thold = bss_conf->cqm_rssi_thold;
        }

        if (changed & BSS_CHANGED_BSSID &&
            (is_ibss || bss_conf->assoc))
                if (!is_zero_ether_addr(bss_conf->bssid)) {
                        ret = wl12xx_cmd_build_null_data(wl, wlvif);
                        if (ret < 0)
                                goto out;

                        ret = wl1271_build_qos_null_data(wl, vif);
                        if (ret < 0)
                                goto out;

                        /* Need to update the BSSID (for filtering etc) */
                        do_join = true;
                }

        if (changed & (BSS_CHANGED_ASSOC | BSS_CHANGED_HT)) {
                rcu_read_lock();
                sta = ieee80211_find_sta(vif, bss_conf->bssid);
                if (!sta)
                        goto sta_not_found;

                /* save the supp_rates of the ap */
                sta_rate_set = sta->supp_rates[wl->hw->conf.channel->band];
                if (sta->ht_cap.ht_supported)
                        sta_rate_set |=
                            (sta->ht_cap.mcs.rx_mask[0] << HW_HT_RATES_OFFSET);
                sta_ht_cap = sta->ht_cap;
                sta_exists = true;

sta_not_found:
                rcu_read_unlock();
        }

        if ((changed & BSS_CHANGED_ASSOC)) {
                if (bss_conf->assoc) {
                        u32 rates;
                        int ieoffset;
                        wlvif->aid = bss_conf->aid;
                        wlvif->beacon_int = bss_conf->beacon_int;
                        set_assoc = true;

                        /*
                         * use basic rates from AP, and determine lowest rate
                         * to use with control frames.
                         */
                        rates = bss_conf->basic_rates;
                        wlvif->basic_rate_set =
                                wl1271_tx_enabled_rates_get(wl, rates,
                                                            wlvif->band);
                        wlvif->basic_rate =
                                wl1271_tx_min_rate_get(wl,
                                                       wlvif->basic_rate_set);
                        if (sta_rate_set)
                                wlvif->rate_set =
                                        wl1271_tx_enabled_rates_get(wl,
                                                                sta_rate_set,
                                                                wlvif->band);
                        ret = wl1271_acx_sta_rate_policies(wl, wlvif);
                        if (ret < 0)
                                goto out;

                        /*
                         * with wl1271, we don't need to update the
                         * beacon_int and dtim_period, because the firmware
                         * updates it by itself when the first beacon is
                         * received after a join.
                         */
                        ret = wl1271_cmd_build_ps_poll(wl, wlvif, wlvif->aid);
                        if (ret < 0)
                                goto out;

                        /*
                         * Get a template for hardware connection maintenance
                         */
                        dev_kfree_skb(wlvif->probereq);
                        wlvif->probereq = wl1271_cmd_build_ap_probe_req(wl,
                                                                        wlvif,
                                                                        NULL);
                        ieoffset = offsetof(struct ieee80211_mgmt,
                                            u.probe_req.variable);
                        wl1271_ssid_set(vif, wlvif->probereq, ieoffset);

                        /* enable the connection monitoring feature */
                        ret = wl1271_acx_conn_monit_params(wl, wlvif, true);
                        if (ret < 0)
                                goto out;
                } else {
                        /* use defaults when not associated */
                        bool was_assoc =
                            !!test_and_clear_bit(WLVIF_FLAG_STA_ASSOCIATED,
                                                 &wlvif->flags);
                        bool was_ifup =
                            !!test_and_clear_bit(WLVIF_FLAG_STA_STATE_SENT,
                                                 &wlvif->flags);
                        wlvif->aid = 0;

                        /* free probe-request template */
                        dev_kfree_skb(wlvif->probereq);
                        wlvif->probereq = NULL;

                        /* revert back to minimum rates for the current band */
                        wl1271_set_band_rate(wl, wlvif);
                        wlvif->basic_rate =
                                wl1271_tx_min_rate_get(wl,
                                                       wlvif->basic_rate_set);
                        ret = wl1271_acx_sta_rate_policies(wl, wlvif);
                        if (ret < 0)
                                goto out;

                        /* disable connection monitor features */
                        ret = wl1271_acx_conn_monit_params(wl, wlvif, false);

                        /* Disable the keep-alive feature */
                        ret = wl1271_acx_keep_alive_mode(wl, wlvif, false);
                        if (ret < 0)
                                goto out;

                        /* restore the bssid filter and go to dummy bssid */
                        if (was_assoc) {
                                /*
                                 * we might have to disable roc, if there was
                                 * no IF_OPER_UP notification.
                                 */
                                if (!was_ifup) {
                                        ret = wl12xx_croc(wl, wlvif->role_id);
                                        if (ret < 0)
                                                goto out;
                                }
                                /*
                                 * (we also need to disable roc in case of
                                 * roaming on the same channel. until we will
                                 * have a better flow...)
                                 */
                                if (test_bit(wlvif->dev_role_id, wl->roc_map)) {
                                        ret = wl12xx_croc(wl,
                                                          wlvif->dev_role_id);
                                        if (ret < 0)
                                                goto out;
                                }

                                wl1271_unjoin(wl, wlvif);
                                if (!bss_conf->idle)
                                        wl12xx_start_dev(wl, wlvif);
                        }
                }
        }

        if (changed & BSS_CHANGED_IBSS) {
                wl1271_debug(DEBUG_ADHOC, "ibss_joined: %d",
                             bss_conf->ibss_joined);

                if (bss_conf->ibss_joined) {
                        u32 rates = bss_conf->basic_rates;
                        wlvif->basic_rate_set =
                                wl1271_tx_enabled_rates_get(wl, rates,
                                                            wlvif->band);
                        wlvif->basic_rate =
                                wl1271_tx_min_rate_get(wl,
                                                       wlvif->basic_rate_set);

                        /* by default, use 11b + OFDM rates */
                        wlvif->rate_set = CONF_TX_IBSS_DEFAULT_RATES;
                        ret = wl1271_acx_sta_rate_policies(wl, wlvif);
                        if (ret < 0)
                                goto out;
                }
        }

        ret = wl1271_bss_erp_info_changed(wl, vif, bss_conf, changed);
        if (ret < 0)
                goto out;

        if (do_join) {
                ret = wl1271_join(wl, wlvif, set_assoc);
                if (ret < 0) {
                        wl1271_warning("cmd join failed %d", ret);
                        goto out;
                }

                /* ROC until connected (after EAPOL exchange) */
                if (!is_ibss) {
                        ret = wl12xx_roc(wl, wlvif, wlvif->role_id);
                        if (ret < 0)
                                goto out;

                        if (test_bit(WLVIF_FLAG_STA_AUTHORIZED, &wlvif->flags))
                                wl12xx_set_authorized(wl, wlvif);
                }
                /*
                 * stop device role if started (we might already be in
                 * STA/IBSS role).
                 */
                if (wl12xx_dev_role_started(wlvif)) {
                        ret = wl12xx_stop_dev(wl, wlvif);
                        if (ret < 0)
                                goto out;
                }
        }

        /* Handle new association with HT. Do this after join. */
        if (sta_exists) {
                if ((changed & BSS_CHANGED_HT) &&
                    (bss_conf->channel_type != NL80211_CHAN_NO_HT)) {
                        ret = wl1271_acx_set_ht_capabilities(wl,
                                                             &sta_ht_cap,
                                                             true,
                                                             wlvif->sta.hlid);