/*
 * Copyright (c) 2010 Broadcom Corporation
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include <linux/pci_ids.h>
#include <net/mac80211.h>

#include <brcm_hw_ids.h>
#include <aiutils.h>
#include "rate.h"
#include "scb.h"
#include "phy/phy_hal.h"
#include "channel.h"
#include "bmac.h"
#include "antsel.h"
#include "stf.h"
#include "ampdu.h"
#include "alloc.h"
#include "mac80211_if.h"
#include "main.h"

/*
 * WPA(2) definitions
 */
#define RSN_CAP_4_REPLAY_CNTRS          2
#define RSN_CAP_16_REPLAY_CNTRS         3

#define WPA_CAP_4_REPLAY_CNTRS          RSN_CAP_4_REPLAY_CNTRS
#define WPA_CAP_16_REPLAY_CNTRS         RSN_CAP_16_REPLAY_CNTRS

/*
 * Indication for txflowcontrol that all priority bits in
 * TXQ_STOP_FOR_PRIOFC_MASK are to be considered.
 */
#define ALLPRIO         -1

/*
 * 32 SSID chars, max of 4 chars for each SSID char "\xFF", plus NULL.
 */
#define SSID_FMT_BUF_LEN        ((4 * IEEE80211_MAX_SSID_LEN) + 1)

#define TIMER_INTERVAL_WATCHDOG 1000    /* watchdog timer, in unit of ms */
#define TIMER_INTERVAL_RADIOCHK 800     /* radio monitor timer, in unit of ms */

/* Max MPC timeout, in unit of watchdog */
#ifndef BRCMS_MPC_MAX_DELAYCNT
#define BRCMS_MPC_MAX_DELAYCNT  10
#endif

/* Min MPC timeout, in unit of watchdog */
#define BRCMS_MPC_MIN_DELAYCNT  1
#define BRCMS_MPC_THRESHOLD     3       /* MPC count threshold level */

#define BEACON_INTERVAL_DEFAULT 100     /* beacon interval, in unit of 1024TU */
#define DTIM_INTERVAL_DEFAULT   3       /* DTIM interval, in unit of beacon interval */

/* Scale down delays to accommodate QT slow speed */
#define BEACON_INTERVAL_DEF_QT  20      /* beacon interval, in unit of 1024TU */
#define DTIM_INTERVAL_DEF_QT    1       /* DTIM interval, in unit of beacon interval */

#define TBTT_ALIGN_LEEWAY_US    100     /* min leeway before first TBTT in us */

/* Software feature flag defines used by wlfeatureflag */
#define WL_SWFL_NOHWRADIO       0x0004
#define WL_SWFL_FLOWCONTROL     0x0008  /* Enable backpressure to OS stack */
#define WL_SWFL_WLBSSSORT       0x0010  /* Per-port supports sorting of BSS */

/* n-mode support capability */
/* 2x2 includes both 1x1 & 2x2 devices
 * reserved #define 2 for future when we want to separate 1x1 & 2x2 and
 * control it independently
 */
#define WL_11N_2x2                      1
#define WL_11N_3x3                      3
#define WL_11N_4x4                      4

/* define 11n feature disable flags */
#define WLFEATURE_DISABLE_11N           0x00000001
#define WLFEATURE_DISABLE_11N_STBC_TX   0x00000002
#define WLFEATURE_DISABLE_11N_STBC_RX   0x00000004
#define WLFEATURE_DISABLE_11N_SGI_TX    0x00000008
#define WLFEATURE_DISABLE_11N_SGI_RX    0x00000010
#define WLFEATURE_DISABLE_11N_AMPDU_TX  0x00000020
#define WLFEATURE_DISABLE_11N_AMPDU_RX  0x00000040
#define WLFEATURE_DISABLE_11N_GF        0x00000080

#define EDCF_ACI_MASK                0x60
#define EDCF_ACI_SHIFT               5
#define EDCF_ECWMIN_MASK             0x0f
#define EDCF_ECWMAX_SHIFT            4
#define EDCF_AIFSN_MASK              0x0f
#define EDCF_AIFSN_MAX               15
#define EDCF_ECWMAX_MASK             0xf0

#define EDCF_AC_BE_TXOP_STA          0x0000
#define EDCF_AC_BK_TXOP_STA          0x0000
#define EDCF_AC_VO_ACI_STA           0x62
#define EDCF_AC_VO_ECW_STA           0x32
#define EDCF_AC_VI_ACI_STA           0x42
#define EDCF_AC_VI_ECW_STA           0x43
#define EDCF_AC_BK_ECW_STA           0xA4
#define EDCF_AC_VI_TXOP_STA          0x005e
#define EDCF_AC_VO_TXOP_STA          0x002f
#define EDCF_AC_BE_ACI_STA           0x03
#define EDCF_AC_BE_ECW_STA           0xA4
#define EDCF_AC_BK_ACI_STA           0x27
#define EDCF_AC_VO_TXOP_AP           0x002f

#define EDCF_TXOP2USEC(txop)         ((txop) << 5)
#define EDCF_ECW2CW(exp)             ((1 << (exp)) - 1)

#define APHY_SYMBOL_TIME        4
#define APHY_PREAMBLE_TIME      16
#define APHY_SIGNAL_TIME        4
#define APHY_SIFS_TIME          16
#define APHY_SERVICE_NBITS      16
#define APHY_TAIL_NBITS         6
#define BPHY_SIFS_TIME          10
#define BPHY_PLCP_SHORT_TIME    96

#define PREN_PREAMBLE           24
#define PREN_MM_EXT             12
#define PREN_PREAMBLE_EXT       4

#define DOT11_MAC_HDR_LEN               24
#define DOT11_ACK_LEN           10
#define DOT11_BA_LEN            4
#define DOT11_OFDM_SIGNAL_EXTENSION     6
#define DOT11_MIN_FRAG_LEN              256
#define DOT11_RTS_LEN           16
#define DOT11_CTS_LEN           10
#define DOT11_BA_BITMAP_LEN             128
#define DOT11_MIN_BEACON_PERIOD         1
#define DOT11_MAX_BEACON_PERIOD         0xFFFF
#define DOT11_MAXNUMFRAGS       16
#define DOT11_MAX_FRAG_LEN              2346

#define BPHY_PLCP_TIME          192
#define RIFS_11N_TIME           2

#define WME_VER                 1
#define WME_SUBTYPE_PARAM_IE    1
#define WME_TYPE                2
#define WME_OUI                 "\x00\x50\xf2"

#define AC_BE                   0
#define AC_BK                   1
#define AC_VI                   2
#define AC_VO                   3

/*
 * driver maintains internal 'tick'(wlc->pub->now) which increments in 1s OS timer(soft
 * watchdog) it is not a wall clock and won't increment when driver is in "down" state
 * this low resolution driver tick can be used for maintenance tasks such as phy
 * calibration and scb update
 */

/* To inform the ucode of the last mcast frame posted so that it can clear moredata bit */
#define BCMCFID(wlc, fid) brcms_b_write_shm((wlc)->hw, M_BCMC_FID, (fid))

#define BRCMS_WAR16165(wlc) (wlc->pub->sih->bustype == PCI_BUS && \
                                (!AP_ENAB(wlc->pub)) && (wlc->war16165))

/* debug/trace */
uint brcm_msg_level =
#if defined(BCMDBG)
        LOG_ERROR_VAL;
#else
        0;
#endif                          /* BCMDBG */

/* Find basic rate for a given rate */
#define BRCMS_BASIC_RATE(wlc, rspec)    (IS_MCS(rspec) ? \
                        (wlc)->band->basic_rate[mcs_table[rspec & RSPEC_RATE_MASK].leg_ofdm] : \
                        (wlc)->band->basic_rate[rspec & RSPEC_RATE_MASK])

#define FRAMETYPE(r, mimoframe) (IS_MCS(r) ? mimoframe  : (IS_CCK(r) ? FT_CCK : FT_OFDM))

#define RFDISABLE_DEFAULT       10000000        /* rfdisable delay timer 500 ms, runs of ALP clock */

#define BRCMS_TEMPSENSE_PERIOD          10      /* 10 second timeout */

#define SCAN_IN_PROGRESS(x)     0

#define EPI_VERSION_NUM         0x054b0b00

#ifdef BCMDBG
/* pointer to most recently allocated wl/wlc */
static struct brcms_c_info *wlc_info_dbg = (struct brcms_c_info *) (NULL);
#endif

const u8 prio2fifo[NUMPRIO] = {
        TX_AC_BE_FIFO,          /* 0    BE      AC_BE   Best Effort */
        TX_AC_BK_FIFO,          /* 1    BK      AC_BK   Background */
        TX_AC_BK_FIFO,          /* 2    --      AC_BK   Background */
        TX_AC_BE_FIFO,          /* 3    EE      AC_BE   Best Effort */
        TX_AC_VI_FIFO,          /* 4    CL      AC_VI   Video */
        TX_AC_VI_FIFO,          /* 5    VI      AC_VI   Video */
        TX_AC_VO_FIFO,          /* 6    VO      AC_VO   Voice */
        TX_AC_VO_FIFO           /* 7    NC      AC_VO   Voice */
};

/* precedences numbers for wlc queues. These are twice as may levels as
 * 802.1D priorities.
 * Odd numbers are used for HI priority traffic at same precedence levels
 * These constants are used ONLY by wlc_prio2prec_map.  Do not use them elsewhere.
 */
#define _BRCMS_PREC_NONE                0       /* None = - */
#define _BRCMS_PREC_BK          2       /* BK - Background */
#define _BRCMS_PREC_BE          4       /* BE - Best-effort */
#define _BRCMS_PREC_EE          6       /* EE - Excellent-effort */
#define _BRCMS_PREC_CL          8       /* CL - Controlled Load */
#define _BRCMS_PREC_VI          10      /* Vi - Video */
#define _BRCMS_PREC_VO          12      /* Vo - Voice */
#define _BRCMS_PREC_NC          14      /* NC - Network Control */

#define MAXMACLIST              64      /* max # source MAC matches */
#define BCN_TEMPLATE_COUNT      2

/* The BSS is generating beacons in HW */
#define BRCMS_BSSCFG_HW_BCN     0x20

#define HWBCN_ENAB(cfg)         (((cfg)->flags & BRCMS_BSSCFG_HW_BCN) != 0)

#define MBSS_BCN_ENAB(cfg)       0
#define MBSS_PRB_ENAB(cfg)       0
#define SOFTBCN_ENAB(pub)    (0)

/* 802.1D Priority to precedence queue mapping */
const u8 wlc_prio2prec_map[] = {
        _BRCMS_PREC_BE,         /* 0 BE - Best-effort */
        _BRCMS_PREC_BK,         /* 1 BK - Background */
        _BRCMS_PREC_NONE,               /* 2 None = - */
        _BRCMS_PREC_EE,         /* 3 EE - Excellent-effort */
        _BRCMS_PREC_CL,         /* 4 CL - Controlled Load */
        _BRCMS_PREC_VI,         /* 5 Vi - Video */
        _BRCMS_PREC_VO,         /* 6 Vo - Voice */
        _BRCMS_PREC_NC,         /* 7 NC - Network Control */
};

/* Check if a particular BSS config is AP or STA */
#define BSSCFG_AP(cfg)          (0)
#define BSSCFG_STA(cfg)         (1)
#define BSSCFG_IBSS(cfg)        (!(cfg)->BSS)

/* As above for all non-NULL BSS configs */
#define FOREACH_BSS(wlc, idx, cfg) \
        for (idx = 0; (int) idx < BRCMS_MAXBSSCFG; idx++) \
                if ((cfg = (wlc)->bsscfg[idx]))

/* TX FIFO number to WME/802.1E Access Category */
const u8 wme_fifo2ac[] = { AC_BK, AC_BE, AC_VI, AC_VO, AC_BE, AC_BE };

/* WME/802.1E Access Category to TX FIFO number */
static const u8 wme_ac2fifo[] = { 1, 0, 2, 3 };

static bool in_send_q;

/* Shared memory location index for various AC params */
#define wme_shmemacindex(ac)    wme_ac2fifo[ac]

#ifdef BCMDBG
static const char * const fifo_names[] = {
        "AC_BK", "AC_BE", "AC_VI", "AC_VO", "BCMC", "ATIM" };
#else
static const char fifo_names[6][0];
#endif

static const u8 acbitmap2maxprio[] = {
        PRIO_8021D_BE, PRIO_8021D_BE, PRIO_8021D_BK, PRIO_8021D_BK,
        PRIO_8021D_VI, PRIO_8021D_VI, PRIO_8021D_VI, PRIO_8021D_VI,
        PRIO_8021D_VO, PRIO_8021D_VO, PRIO_8021D_VO, PRIO_8021D_VO,
        PRIO_8021D_VO, PRIO_8021D_VO, PRIO_8021D_VO, PRIO_8021D_VO
};

/* currently the best mechanism for determining SIFS is the band in use */
#define SIFS(band) ((band)->bandtype == BRCM_BAND_5G ? APHY_SIFS_TIME : \
                                                       BPHY_SIFS_TIME);

/* local prototypes */
static u16 brcms_c_d11hdrs_mac80211(struct brcms_c_info *wlc,
                                               struct ieee80211_hw *hw,
                                               struct sk_buff *p,
                                               struct scb *scb, uint frag,
                                               uint nfrags, uint queue,
                                               uint next_frag_len,
                                               struct wsec_key *key,
                                               ratespec_t rspec_override);
static void brcms_c_bss_default_init(struct brcms_c_info *wlc);
static void brcms_c_ucode_mac_upd(struct brcms_c_info *wlc);
static ratespec_t mac80211_wlc_set_nrate(struct brcms_c_info *wlc,
                                         struct brcms_band *cur_band,
                                         u32 int_val);
static void brcms_c_tx_prec_map_init(struct brcms_c_info *wlc);
static void brcms_c_watchdog(void *arg);
static void brcms_c_watchdog_by_timer(void *arg);
static u16 brcms_c_rate_shm_offset(struct brcms_c_info *wlc, u8 rate);
static int brcms_c_set_rateset(struct brcms_c_info *wlc, wlc_rateset_t *rs_arg);
static u8 brcms_c_local_constraint_qdbm(struct brcms_c_info *wlc);

/* send and receive */
static struct brcms_txq_info *brcms_c_txq_alloc(struct brcms_c_info *wlc);
static void brcms_c_txq_free(struct brcms_c_info *wlc,
                         struct brcms_txq_info *qi);
static void brcms_c_txflowcontrol_signal(struct brcms_c_info *wlc,
                                     struct brcms_txq_info *qi,
                                     bool on, int prio);
static void brcms_c_txflowcontrol_reset(struct brcms_c_info *wlc);
static void brcms_c_compute_cck_plcp(struct brcms_c_info *wlc, ratespec_t rate,
                                 uint length, u8 *plcp);
static void brcms_c_compute_ofdm_plcp(ratespec_t rate, uint length, u8 *plcp);
static void brcms_c_compute_mimo_plcp(ratespec_t rate, uint length, u8 *plcp);
static u16 brcms_c_compute_frame_dur(struct brcms_c_info *wlc, ratespec_t rate,
                                    u8 preamble_type, uint next_frag_len);
static u64 brcms_c_recover_tsf64(struct brcms_c_info *wlc,
                             struct brcms_d11rxhdr *rxh);
static void brcms_c_recvctl(struct brcms_c_info *wlc,
                        struct d11rxhdr *rxh, struct sk_buff *p);
static uint brcms_c_calc_frame_len(struct brcms_c_info *wlc, ratespec_t rate,
                               u8 preamble_type, uint dur);
static uint brcms_c_calc_ack_time(struct brcms_c_info *wlc, ratespec_t rate,
                              u8 preamble_type);
static uint brcms_c_calc_cts_time(struct brcms_c_info *wlc, ratespec_t rate,
                              u8 preamble_type);
/* interrupt, up/down, band */
static void brcms_c_setband(struct brcms_c_info *wlc, uint bandunit);
static chanspec_t brcms_c_init_chanspec(struct brcms_c_info *wlc);
static void brcms_c_bandinit_ordered(struct brcms_c_info *wlc,
                                     chanspec_t chanspec);
static void brcms_c_bsinit(struct brcms_c_info *wlc);
static int brcms_c_duty_cycle_set(struct brcms_c_info *wlc, int duty_cycle,
                              bool isOFDM, bool writeToShm);
static void brcms_c_radio_hwdisable_upd(struct brcms_c_info *wlc);
static bool brcms_c_radio_monitor_start(struct brcms_c_info *wlc);
static void brcms_c_radio_timer(void *arg);
static void brcms_c_radio_enable(struct brcms_c_info *wlc);
static void brcms_c_radio_upd(struct brcms_c_info *wlc);

/* scan, association, BSS */
static uint brcms_c_calc_ba_time(struct brcms_c_info *wlc, ratespec_t rate,
                             u8 preamble_type);
static void brcms_c_update_mimo_band_bwcap(struct brcms_c_info *wlc, u8 bwcap);
static void brcms_c_ht_update_sgi_rx(struct brcms_c_info *wlc, int val);
static void brcms_c_ht_update_ldpc(struct brcms_c_info *wlc, s8 val);
static void brcms_c_war16165(struct brcms_c_info *wlc, bool tx);

static void brcms_c_wme_retries_write(struct brcms_c_info *wlc);
static bool brcms_c_attach_stf_ant_init(struct brcms_c_info *wlc);
static uint brcms_c_attach_module(struct brcms_c_info *wlc);
static void brcms_c_detach_module(struct brcms_c_info *wlc);
static void brcms_c_timers_deinit(struct brcms_c_info *wlc);
static void brcms_c_down_led_upd(struct brcms_c_info *wlc);
static uint brcms_c_down_del_timer(struct brcms_c_info *wlc);
static void brcms_c_ofdm_rateset_war(struct brcms_c_info *wlc);
static int _brcms_c_ioctl(struct brcms_c_info *wlc, int cmd, void *arg, int len,
                      struct brcms_c_if *wlcif);

/* conditions under which the PM bit should be set in outgoing frames and STAY_AWAKE is meaningful
 */
bool brcms_c_ps_allowed(struct brcms_c_info *wlc)
{
        int idx;
        struct brcms_bss_cfg *cfg;

        /* disallow PS when one of the following global conditions meets */
        if (!wlc->pub->associated)
                return false;

        /* disallow PS when one of these meets when not scanning */
        if (AP_ACTIVE(wlc) || wlc->monitor)
                return false;

        for (idx = 0; idx < BRCMS_MAXBSSCFG; idx++) {
                cfg = wlc->bsscfg[idx];
                if (cfg && BSSCFG_STA(cfg) && cfg->associated) {
                        /*
                         * disallow PS when one of the following
                         * bsscfg specific conditions meets
                         */
                        if (!cfg->BSS || !BRCMS_PORTOPEN(cfg))
                                return false;

                        if (!cfg->dtim_programmed)
                                return false;
                }
        }

        return true;
}

void brcms_c_reset(struct brcms_c_info *wlc)
{
        BCMMSG(wlc->wiphy, "wl%d\n", wlc->pub->unit);

        /* slurp up hw mac counters before core reset */
        brcms_c_statsupd(wlc);

        /* reset our snapshot of macstat counters */
        memset((char *)wlc->core->macstat_snapshot, 0,
                sizeof(struct macstat));

        brcms_b_reset(wlc->hw);
}

void brcms_c_fatal_error(struct brcms_c_info *wlc)
{
        wiphy_err(wlc->wiphy, "wl%d: fatal error, reinitializing\n",
                  wlc->pub->unit);
        brcms_init(wlc->wl);
}

/* Return the channel the driver should initialize during brcms_c_init.
 * the channel may have to be changed from the currently configured channel
 * if other configurations are in conflict (bandlocked, 11n mode disabled,
 * invalid channel for current country, etc.)
 */
static chanspec_t brcms_c_init_chanspec(struct brcms_c_info *wlc)
{
        chanspec_t chanspec =
            1 | WL_CHANSPEC_BW_20 | WL_CHANSPEC_CTL_SB_NONE |
            WL_CHANSPEC_BAND_2G;

        return chanspec;
}

struct scb global_scb;

static void brcms_c_init_scb(struct brcms_c_info *wlc, struct scb *scb)
{
        int i;
        scb->flags = SCB_WMECAP | SCB_HTCAP;
        for (i = 0; i < NUMPRIO; i++)
                scb->seqnum[i] = 0;
}

void brcms_c_init(struct brcms_c_info *wlc)
{
        d11regs_t *regs;
        chanspec_t chanspec;
        int i;
        struct brcms_bss_cfg *bsscfg;
        bool mute = false;

        BCMMSG(wlc->wiphy, "wl%d\n", wlc->pub->unit);

        regs = wlc->regs;

        /* This will happen if a big-hammer was executed. In that case, we want to go back
         * to the channel that we were on and not new channel
         */
        if (wlc->pub->associated)
                chanspec = wlc->home_chanspec;
        else
                chanspec = brcms_c_init_chanspec(wlc);

        brcms_b_init(wlc->hw, chanspec, mute);

        /* update beacon listen interval */
        brcms_c_bcn_li_upd(wlc);

        /* the world is new again, so is our reported rate */
        brcms_c_reprate_init(wlc);

        /* write ethernet address to core */
        FOREACH_BSS(wlc, i, bsscfg) {
                brcms_c_set_mac(bsscfg);
                brcms_c_set_bssid(bsscfg);
        }

        /* Update tsf_cfprep if associated and up */
        if (wlc->pub->associated) {
                FOREACH_BSS(wlc, i, bsscfg) {
                        if (bsscfg->up) {
                                u32 bi;

                                /* get beacon period and convert to uS */
                                bi = bsscfg->current_bss->beacon_period << 10;
                                /*
                                 * update since init path would reset
                                 * to default value
                                 */
                                W_REG(&regs->tsf_cfprep,
                                      (bi << CFPREP_CBI_SHIFT));

                                /* Update maccontrol PM related bits */
                                brcms_c_set_ps_ctrl(wlc);

                                break;
                        }
                }
        }

        brcms_c_bandinit_ordered(wlc, chanspec);

        brcms_c_init_scb(wlc, &global_scb);

        /* init probe response timeout */
        brcms_c_write_shm(wlc, M_PRS_MAXTIME, wlc->prb_resp_timeout);

        /* init max burst txop (framebursting) */
        brcms_c_write_shm(wlc, M_MBURST_TXOP,
                      (wlc->
                       _rifs ? (EDCF_AC_VO_TXOP_AP << 5) : MAXFRAMEBURST_TXOP));

        /* initialize maximum allowed duty cycle */
        brcms_c_duty_cycle_set(wlc, wlc->tx_duty_cycle_ofdm, true, true);
        brcms_c_duty_cycle_set(wlc, wlc->tx_duty_cycle_cck, false, true);

        /* Update some shared memory locations related to max AMPDU size allowed to received */
        brcms_c_ampdu_shm_upd(wlc->ampdu);

        /* band-specific inits */
        brcms_c_bsinit(wlc);

        /* Enable EDCF mode (while the MAC is suspended) */
        if (EDCF_ENAB(wlc->pub)) {
                OR_REG(&regs->ifs_ctl, IFS_USEEDCF);
                brcms_c_edcf_setparams(wlc, false);
        }

        /* Init precedence maps for empty FIFOs */
        brcms_c_tx_prec_map_init(wlc);

        /* read the ucode version if we have not yet done so */
        if (wlc->ucode_rev == 0) {
                wlc->ucode_rev =
                    brcms_c_read_shm(wlc, M_BOM_REV_MAJOR) << NBITS(u16);
                wlc->ucode_rev |= brcms_c_read_shm(wlc, M_BOM_REV_MINOR);
        }

        /* ..now really unleash hell (allow the MAC out of suspend) */
        brcms_c_enable_mac(wlc);

        /* clear tx flow control */
        brcms_c_txflowcontrol_reset(wlc);

        /* clear tx data fifo suspends */
        wlc->tx_suspended = false;

        /* enable the RF Disable Delay timer */
        W_REG(&wlc->regs->rfdisabledly, RFDISABLE_DEFAULT);

        /* initialize mpc delay */
        wlc->mpc_delay_off = wlc->mpc_dlycnt = BRCMS_MPC_MIN_DELAYCNT;

        /*
         * Initialize WME parameters; if they haven't been set by some other
         * mechanism (IOVar, etc) then read them from the hardware.
         */
        if (BRCMS_WME_RETRY_SHORT_GET(wlc, 0) == 0) {
                /* Uninitialized; read from HW */
                int ac;

                for (ac = 0; ac < AC_COUNT; ac++) {
                        wlc->wme_retries[ac] =
                            brcms_c_read_shm(wlc, M_AC_TXLMT_ADDR(ac));
                }
        }
}

void brcms_c_mac_bcn_promisc_change(struct brcms_c_info *wlc, bool promisc)
{
        wlc->bcnmisc_monitor = promisc;
        brcms_c_mac_bcn_promisc(wlc);
}

void brcms_c_mac_bcn_promisc(struct brcms_c_info *wlc)
{
        if ((AP_ENAB(wlc->pub) && (N_ENAB(wlc->pub) || wlc->band->gmode)) ||
            wlc->bcnmisc_ibss || wlc->bcnmisc_scan || wlc->bcnmisc_monitor)
                brcms_c_mctrl(wlc, MCTL_BCNS_PROMISC, MCTL_BCNS_PROMISC);
        else
                brcms_c_mctrl(wlc, MCTL_BCNS_PROMISC, 0);
}

/* set or clear maccontrol bits MCTL_PROMISC and MCTL_KEEPCONTROL */
void brcms_c_mac_promisc(struct brcms_c_info *wlc)
{
        u32 promisc_bits = 0;

        /* promiscuous mode just sets MCTL_PROMISC
         * Note: APs get all BSS traffic without the need to set the MCTL_PROMISC bit
         * since all BSS data traffic is directed at the AP
         */
        if (PROMISC_ENAB(wlc->pub) && !AP_ENAB(wlc->pub))
                promisc_bits |= MCTL_PROMISC;

        /* monitor mode needs both MCTL_PROMISC and MCTL_KEEPCONTROL
         * Note: monitor mode also needs MCTL_BCNS_PROMISC, but that is
         * handled in brcms_c_mac_bcn_promisc()
         */
        if (MONITOR_ENAB(wlc))
                promisc_bits |= MCTL_PROMISC | MCTL_KEEPCONTROL;

        brcms_c_mctrl(wlc, MCTL_PROMISC | MCTL_KEEPCONTROL, promisc_bits);
}

/* push sw hps and wake state through hardware */
void brcms_c_set_ps_ctrl(struct brcms_c_info *wlc)
{
        u32 v1, v2;
        bool hps;
        bool awake_before;

        hps = PS_ALLOWED(wlc);

        BCMMSG(wlc->wiphy, "wl%d: hps %d\n", wlc->pub->unit, hps);

        v1 = R_REG(&wlc->regs->maccontrol);
        v2 = MCTL_WAKE;
        if (hps)
                v2 |= MCTL_HPS;

        brcms_c_mctrl(wlc, MCTL_WAKE | MCTL_HPS, v2);

        awake_before = ((v1 & MCTL_WAKE) || ((v1 & MCTL_HPS) == 0));

        if (!awake_before)
                brcms_b_wait_for_wake(wlc->hw);

}

/*
 * Write this BSS config's MAC address to core.
 * Updates RXE match engine.
 */
int brcms_c_set_mac(struct brcms_bss_cfg *cfg)
{
        int err = 0;
        struct brcms_c_info *wlc = cfg->wlc;

        if (cfg == wlc->cfg) {
                /* enter the MAC addr into the RXE match registers */
                brcms_c_set_addrmatch(wlc, RCM_MAC_OFFSET, cfg->cur_etheraddr);
        }

        brcms_c_ampdu_macaddr_upd(wlc);

        return err;
}

/* Write the BSS config's BSSID address to core (set_bssid in d11procs.tcl).
 * Updates RXE match engine.
 */
void brcms_c_set_bssid(struct brcms_bss_cfg *cfg)
{
        struct brcms_c_info *wlc = cfg->wlc;

        /* if primary config, we need to update BSSID in RXE match registers */
        if (cfg == wlc->cfg) {
                brcms_c_set_addrmatch(wlc, RCM_BSSID_OFFSET, cfg->BSSID);
        }
#ifdef SUPPORT_HWKEYS
        else if (BSSCFG_STA(cfg) && cfg->BSS) {
                brcms_c_rcmta_add_bssid(wlc, cfg);
        }
#endif
}

/*
 * Suspend the the MAC and update the slot timing
 * for standard 11b/g (20us slots) or shortslot 11g (9us slots).
 */
void brcms_c_switch_shortslot(struct brcms_c_info *wlc, bool shortslot)
{
        int idx;
        struct brcms_bss_cfg *cfg;

        /* use the override if it is set */
        if (wlc->shortslot_override != BRCMS_SHORTSLOT_AUTO)
                shortslot = (wlc->shortslot_override == BRCMS_SHORTSLOT_ON);

        if (wlc->shortslot == shortslot)
                return;

        wlc->shortslot = shortslot;

        /* update the capability based on current shortslot mode */
        FOREACH_BSS(wlc, idx, cfg) {
                if (!cfg->associated)
                        continue;
                cfg->current_bss->capability &=
                                        ~WLAN_CAPABILITY_SHORT_SLOT_TIME;
                if (wlc->shortslot)
                        cfg->current_bss->capability |=
                                        WLAN_CAPABILITY_SHORT_SLOT_TIME;
        }

        brcms_b_set_shortslot(wlc->hw, shortslot);
}

static u8 brcms_c_local_constraint_qdbm(struct brcms_c_info *wlc)
{
        u8 local;
        s16 local_max;

        local = BRCMS_TXPWR_MAX;
        if (wlc->pub->associated &&
            (brcmu_chspec_ctlchan(wlc->chanspec) ==
             brcmu_chspec_ctlchan(wlc->home_chanspec))) {

                /* get the local power constraint if we are on the AP's
                 * channel [802.11h, 7.3.2.13]
                 */
                /* Clamp the value between 0 and BRCMS_TXPWR_MAX w/o
                 * overflowing the target */
                local_max =
                    (wlc->txpwr_local_max -
                     wlc->txpwr_local_constraint) * BRCMS_TXPWR_DB_FACTOR;
                if (local_max > 0 && local_max < BRCMS_TXPWR_MAX)
                        return (u8) local_max;
                if (local_max < 0)
                        return 0;
        }

        return local;
}

/* propagate home chanspec to all bsscfgs in case bsscfg->current_bss->chanspec is referenced */
void brcms_c_set_home_chanspec(struct brcms_c_info *wlc, chanspec_t chanspec)
{
        if (wlc->home_chanspec != chanspec) {
                int idx;
                struct brcms_bss_cfg *cfg;

                wlc->home_chanspec = chanspec;

                FOREACH_BSS(wlc, idx, cfg) {
                        if (!cfg->associated)
                                continue;

                        cfg->current_bss->chanspec = chanspec;
                }

        }
}

static void brcms_c_set_phy_chanspec(struct brcms_c_info *wlc,
                                     chanspec_t chanspec)
{
        /* Save our copy of the chanspec */
        wlc->chanspec = chanspec;

        /* Set the chanspec and power limits for this locale after computing
         * any 11h local tx power constraints.
         */
        brcms_c_channel_set_chanspec(wlc->cmi, chanspec,
                                 brcms_c_local_constraint_qdbm(wlc));

        if (wlc->stf->ss_algosel_auto)
                brcms_c_stf_ss_algo_channel_get(wlc, &wlc->stf->ss_algo_channel,
                                            chanspec);

        brcms_c_stf_ss_update(wlc, wlc->band);

}

void brcms_c_set_chanspec(struct brcms_c_info *wlc, chanspec_t chanspec)
{
        uint bandunit;
        bool switchband = false;
        chanspec_t old_chanspec = wlc->chanspec;

        if (!brcms_c_valid_chanspec_db(wlc->cmi, chanspec)) {
                wiphy_err(wlc->wiphy, "wl%d: %s: Bad channel %d\n",
                          wlc->pub->unit, __func__, CHSPEC_CHANNEL(chanspec));
                return;
        }

        /* Switch bands if necessary */
        if (NBANDS(wlc) > 1) {
                bandunit = CHSPEC_BANDUNIT(chanspec);
                if (wlc->band->bandunit != bandunit || wlc->bandinit_pending) {
                        switchband = true;
                        if (wlc->bandlocked) {
                                wiphy_err(wlc->wiphy, "wl%d: %s: chspec %d "
                                          "band is locked!\n",
                                          wlc->pub->unit, __func__,
                                          CHSPEC_CHANNEL(chanspec));
                                return;
                        }
                        /*
                         * should the setband call come after the
                         * brcms_b_chanspec() ? if the setband updates
                         * (brcms_c_bsinit) use low level calls to inspect and
                         * set state, the state inspected may be from the wrong
                         * band, or the following brcms_b_set_chanspec() may
                         * undo the work.
                         */
                        brcms_c_setband(wlc, bandunit);
                }
        }

        /* sync up phy/radio chanspec */
        brcms_c_set_phy_chanspec(wlc, chanspec);

        /* init antenna selection */
        if (CHSPEC_WLC_BW(old_chanspec) != CHSPEC_WLC_BW(chanspec)) {
                brcms_c_antsel_init(wlc->asi);

                /* Fix the hardware rateset based on bw.
                 * Mainly add MCS32 for 40Mhz, remove MCS 32 for 20Mhz
                 */
                brcms_c_rateset_bw_mcs_filter(&wlc->band->hw_rateset,
                                          wlc->band->
                                          mimo_cap_40 ? CHSPEC_WLC_BW(chanspec)
                                          : 0);
        }

        /* update some mac configuration since chanspec changed */
        brcms_c_ucode_mac_upd(wlc);
}

ratespec_t brcms_c_lowest_basic_rspec(struct brcms_c_info *wlc,
                                      wlc_rateset_t *rs)
{
        ratespec_t lowest_basic_rspec;
        uint i;

        /* Use the lowest basic rate */
        lowest_basic_rspec = rs->rates[0] & BRCMS_RATE_MASK;
        for (i = 0; i < rs->count; i++) {
                if (rs->rates[i] & BRCMS_RATE_FLAG) {
                        lowest_basic_rspec = rs->rates[i] & BRCMS_RATE_MASK;
                        break;
                }
        }
#if NCONF
        /* pick siso/cdd as default for OFDM (note no basic rate MCSs are supported yet) */
        if (IS_OFDM(lowest_basic_rspec)) {
                lowest_basic_rspec |= (wlc->stf->ss_opmode << RSPEC_STF_SHIFT);
        }
#endif

        return lowest_basic_rspec;
}

/* This function changes the phytxctl for beacon based on current beacon ratespec AND txant
 * setting as per this table:
 *  ratespec     CCK            ant = wlc->stf->txant
 *              OFDM            ant = 3
 */
void brcms_c_beacon_phytxctl_txant_upd(struct brcms_c_info *wlc,
                                       ratespec_t bcn_rspec)
{
        u16 phyctl;
        u16 phytxant = wlc->stf->phytxant;
        u16 mask = PHY_TXC_ANT_MASK;

        /* for non-siso rates or default setting, use the available chains */
        if (BRCMS_PHY_11N_CAP(wlc->band))
                phytxant = brcms_c_stf_phytxchain_sel(wlc, bcn_rspec);

        phyctl = brcms_c_read_shm(wlc, M_BCN_PCTLWD);
        phyctl = (phyctl & ~mask) | phytxant;
        brcms_c_write_shm(wlc, M_BCN_PCTLWD, phyctl);
}

/* centralized protection config change function to simplify debugging, no consistency checking
 * this should be called only on changes to avoid overhead in periodic function
*/
void brcms_c_protection_upd(struct brcms_c_info *wlc, uint idx, int val)
{
        BCMMSG(wlc->wiphy, "idx %d, val %d\n", idx, val);

        switch (idx) {
        case BRCMS_PROT_G_SPEC:
                wlc->protection->_g = (bool) val;
                break;
        case BRCMS_PROT_G_OVR:
                wlc->protection->g_override = (s8) val;
                break;
        case BRCMS_PROT_G_USER:
                wlc->protection->gmode_user = (u8) val;
                break;
        case BRCMS_PROT_OVERLAP:
                wlc->protection->overlap = (s8) val;
                break;
        case BRCMS_PROT_N_USER:
                wlc->protection->nmode_user = (s8) val;
                break;
        case BRCMS_PROT_N_CFG:
                wlc->protection->n_cfg = (s8) val;
                break;
        case BRCMS_PROT_N_CFG_OVR:
                wlc->protection->n_cfg_override = (s8) val;
                break;
        case BRCMS_PROT_N_NONGF:
                wlc->protection->nongf = (bool) val;
                break;
        case BRCMS_PROT_N_NONGF_OVR:
                wlc->protection->nongf_override = (s8) val;
                break;
        case BRCMS_PROT_N_PAM_OVR:
                wlc->protection->n_pam_override = (s8) val;
                break;
        case BRCMS_PROT_N_OBSS:
                wlc->protection->n_obss = (bool) val;
                break;

        default:
                break;
        }

}

static void brcms_c_ht_update_sgi_rx(struct brcms_c_info *wlc, int val)
{
        wlc->ht_cap.cap_info &= ~(IEEE80211_HT_CAP_SGI_20 |
                                        IEEE80211_HT_CAP_SGI_40);
        wlc->ht_cap.cap_info |= (val & BRCMS_N_SGI_20) ?
                                        IEEE80211_HT_CAP_SGI_20 : 0;
        wlc->ht_cap.cap_info |= (val & BRCMS_N_SGI_40) ?
                                        IEEE80211_HT_CAP_SGI_40 : 0;

        if (wlc->pub->up) {
                brcms_c_update_beacon(wlc);
                brcms_c_update_probe_resp(wlc, true);
        }
}

static void brcms_c_ht_update_ldpc(struct brcms_c_info *wlc, s8 val)
{
        wlc->stf->ldpc = val;

        wlc->ht_cap.cap_info &= ~IEEE80211_HT_CAP_LDPC_CODING;
        if (wlc->stf->ldpc != OFF)
                wlc->ht_cap.cap_info |= IEEE80211_HT_CAP_LDPC_CODING;

        if (wlc->pub->up) {
                brcms_c_update_beacon(wlc);
                brcms_c_update_probe_resp(wlc, true);
                wlc_phy_ldpc_override_set(wlc->band->pi, (val ? true : false));
        }
}

/*
 * ucode, hwmac update
 *    Channel dependent updates for ucode and hw
 */
static void brcms_c_ucode_mac_upd(struct brcms_c_info *wlc)
{
        /* enable or disable any active IBSSs depending on whether or not
         * we are on the home channel
         */
        if (wlc->home_chanspec == BRCMS_BAND_PI_RADIO_CHANSPEC) {
                if (wlc->pub->associated) {
                        /* BMAC_NOTE: This is something that should be fixed in ucode inits.
                         * I think that the ucode inits set up the bcn templates and shm values
                         * with a bogus beacon. This should not be done in the inits. If ucode needs
                         * to set up a beacon for testing, the test routines should write it down,
                         * not expect the inits to populate a bogus beacon.
                         */
                        if (BRCMS_PHY_11N_CAP(wlc->band)) {
                                brcms_c_write_shm(wlc, M_BCN_TXTSF_OFFSET,
                                              wlc->band->bcntsfoff);
                        }
                }
        } else {
                /* disable an active IBSS if we are not on the home channel */
        }

        /* update the various promisc bits */
        brcms_c_mac_bcn_promisc(wlc);
        brcms_c_mac_promisc(wlc);
}

static void brcms_c_bandinit_ordered(struct brcms_c_info *wlc,
                                     chanspec_t chanspec)
{
        wlc_rateset_t default_rateset;
        uint parkband;
        uint i, band_order[2];

        BCMMSG(wlc->wiphy, "wl%d\n", wlc->pub->unit);
        /*
         * We might have been bandlocked during down and the chip power-cycled (hibernate).
         * figure out the right band to park on
         */
        if (wlc->bandlocked || NBANDS(wlc) == 1) {
                /* updated in brcms_c_bandlock() */
                parkband = wlc->band->bandunit;
                band_order[0] = band_order[1] = parkband;
        } else {
                /* park on the band of the specified chanspec */
                parkband = CHSPEC_BANDUNIT(chanspec);

                /* order so that parkband initialize last */

                band_order[0] = parkband ^ 1;
                band_order[1] = parkband;
        }

        /* make each band operational, software state init */
        for (i = 0; i < NBANDS(wlc); i++) {
                uint j = band_order[i];

                wlc->band = wlc->bandstate[j];

                brcms_default_rateset(wlc, &default_rateset);

                /* fill in hw_rate */
                brcms_c_rateset_filter(&default_rateset, &wlc->band->hw_rateset,
                                   false, BRCMS_RATES_CCK_OFDM, BRCMS_RATE_MASK,
                                   (bool) N_ENAB(wlc->pub));

                /* init basic rate lookup */
                brcms_c_rate_lookup_init(wlc, &default_rateset);
        }

        /* sync up phy/radio chanspec */
        brcms_c_set_phy_chanspec(wlc, chanspec);
}

/* band-specific init */
static void brcms_c_bsinit(struct brcms_c_info *wlc)
{
        BCMMSG(wlc->wiphy, "wl%d: bandunit %d\n",
                 wlc->pub->unit, wlc->band->bandunit);

        /* write ucode ACK/CTS rate table */
        brcms_c_set_ratetable(wlc);

        /* update some band specific mac configuration */
        brcms_c_ucode_mac_upd(wlc);

        /* init antenna selection */
        brcms_c_antsel_init(wlc->asi);

}

/* switch to and initialize new band */
static void brcms_c_setband(struct brcms_c_info *wlc,
                                           uint bandunit)
{
        int idx;
        struct brcms_bss_cfg *cfg;

        wlc->band = wlc->bandstate[bandunit];

        if (!wlc->pub->up)
                return;

        /* wait for at least one beacon before entering sleeping state */
        for (idx = 0; idx < BRCMS_MAXBSSCFG; idx++) {
                cfg = wlc->bsscfg[idx];
                if (cfg && BSSCFG_STA(cfg) && cfg->associated)
                        cfg->PMawakebcn = true;
        }
        brcms_c_set_ps_ctrl(wlc);

        /* band-specific initializations */
        brcms_c_bsinit(wlc);
}

/* Initialize a WME Parameter Info Element with default STA parameters from WMM Spec, Table 12 */
void
brcms_c_wme_initparams_sta(struct brcms_c_info *wlc, struct wme_param_ie *pe)
{
        static const struct wme_param_ie stadef = {
                WME_OUI,
                WME_TYPE,
                WME_SUBTYPE_PARAM_IE,
                WME_VER,
                0,
                0,
                {
                 {EDCF_AC_BE_ACI_STA, EDCF_AC_BE_ECW_STA,
                  cpu_to_le16(EDCF_AC_BE_TXOP_STA)},
                 {EDCF_AC_BK_ACI_STA, EDCF_AC_BK_ECW_STA,
                  cpu_to_le16(EDCF_AC_BK_TXOP_STA)},
                 {EDCF_AC_VI_ACI_STA, EDCF_AC_VI_ECW_STA,
                  cpu_to_le16(EDCF_AC_VI_TXOP_STA)},
                 {EDCF_AC_VO_ACI_STA, EDCF_AC_VO_ECW_STA,
                  cpu_to_le16(EDCF_AC_VO_TXOP_STA)}
                 }
        };
        memcpy(pe, &stadef, sizeof(*pe));
}

void brcms_c_wme_setparams(struct brcms_c_info *wlc, u16 aci,
                       const struct ieee80211_tx_queue_params *params,
                       bool suspend)
{
        int i;
        struct shm_acparams acp_shm;
        u16 *shm_entry;

        /* Only apply params if the core is out of reset and has clocks */
        if (!wlc->clk) {
                wiphy_err(wlc->wiphy, "wl%d: %s : no-clock\n", wlc->pub->unit,
                          __func__);
                return;
        }

        do {
                memset((char *)&acp_shm, 0, sizeof(struct shm_acparams));
                /* fill in shm ac params struct */
                acp_shm.txop = le16_to_cpu(params->txop);
                /* convert from units of 32us to us for ucode */
                wlc->edcf_txop[aci & 0x3] = acp_shm.txop =
                    EDCF_TXOP2USEC(acp_shm.txop);
                acp_shm.aifs = (params->aifs & EDCF_AIFSN_MASK);

                if (aci == AC_VI && acp_shm.txop == 0
                    && acp_shm.aifs < EDCF_AIFSN_MAX)
                        acp_shm.aifs++;

                if (acp_shm.aifs < EDCF_AIFSN_MIN
                    || acp_shm.aifs > EDCF_AIFSN_MAX) {
                        wiphy_err(wlc->wiphy, "wl%d: edcf_setparams: bad "
                                  "aifs %d\n", wlc->pub->unit, acp_shm.aifs);
                        continue;
                }

                acp_shm.cwmin = params->cw_min;
                acp_shm.cwmax = params->cw_max;
                acp_shm.cwcur = acp_shm.cwmin;
                acp_shm.bslots =
                    R_REG(&wlc->regs->tsf_random) & acp_shm.cwcur;
                acp_shm.reggap = acp_shm.bslots + acp_shm.aifs;
                /* Indicate the new params to the ucode */
                acp_shm.status = brcms_c_read_shm(wlc, (M_EDCF_QINFO +
                                                    wme_shmemacindex(aci) *
                                                    M_EDCF_QLEN +
                                                    M_EDCF_STATUS_OFF));
                acp_shm.status |= WME_STATUS_NEWAC;

                /* Fill in shm acparam table */
                shm_entry = (u16 *) &acp_shm;
                for (i = 0; i < (int)sizeof(struct shm_acparams); i += 2)
                        brcms_c_write_shm(wlc,
                                      M_EDCF_QINFO +
                                      wme_shmemacindex(aci) * M_EDCF_QLEN + i,
                                      *shm_entry++);

        } while (0);

        if (suspend)
                brcms_c_suspend_mac_and_wait(wlc);

        if (suspend)
                brcms_c_enable_mac(wlc);

}

void brcms_c_edcf_setparams(struct brcms_c_info *wlc, bool suspend)
{
        u16 aci;
        int i_ac;
        struct edcf_acparam *edcf_acp;

        struct ieee80211_tx_queue_params txq_pars;
        struct ieee80211_tx_queue_params *params = &txq_pars;

        /*
         * AP uses AC params from wme_param_ie_ap.
         * AP advertises AC params from wme_param_ie.
         * STA uses AC params from wme_param_ie.
         */

        edcf_acp = (struct edcf_acparam *) &wlc->wme_param_ie.acparam[0];

        for (i_ac = 0; i_ac < AC_COUNT; i_ac++, edcf_acp++) {
                /* find out which ac this set of params applies to */
                aci = (edcf_acp->ACI & EDCF_ACI_MASK) >> EDCF_ACI_SHIFT;

                /* fill in shm ac params struct */
                params->txop = edcf_acp->TXOP;
                params->aifs = edcf_acp->ACI;

                /* CWmin = 2^(ECWmin) - 1 */
                params->cw_min = EDCF_ECW2CW(edcf_acp->ECW & EDCF_ECWMIN_MASK);
                /* CWmax = 2^(ECWmax) - 1 */
                params->cw_max = EDCF_ECW2CW((edcf_acp->ECW & EDCF_ECWMAX_MASK)
                                            >> EDCF_ECWMAX_SHIFT);
                brcms_c_wme_setparams(wlc, aci, params, suspend);
        }

        if (suspend)
                brcms_c_suspend_mac_and_wait(wlc);

        if (AP_ENAB(wlc->pub) && WME_ENAB(wlc->pub)) {
                brcms_c_update_beacon(wlc);
                brcms_c_update_probe_resp(wlc, false);
        }

        if (suspend)
                brcms_c_enable_mac(wlc);

}

bool brcms_c_timers_init(struct brcms_c_info *wlc, int unit)
{
        wlc->wdtimer = brcms_init_timer(wlc->wl, brcms_c_watchdog_by_timer,
                wlc, "watchdog");
        if (!wlc->wdtimer) {
                wiphy_err(wlc->wiphy, "wl%d:  wl_init_timer for wdtimer "
                          "failed\n", unit);
                goto fail;
        }

        wlc->radio_timer = brcms_init_timer(wlc->wl, brcms_c_radio_timer,
                wlc, "radio");
        if (!wlc->radio_timer) {
                wiphy_err(wlc->wiphy, "wl%d:  wl_init_timer for radio_timer "
                          "failed\n", unit);
                goto fail;
        }

        return true;

 fail:
        return false;
}

/*
 * Initialize brcms_c_info default values ...
 * may get overrides later in this function
 */
void brcms_c_info_init(struct brcms_c_info *wlc, int unit)
{
        int i;
        /* Assume the device is there until proven otherwise */
        wlc->device_present = true;

        /* Save our copy of the chanspec */
        wlc->chanspec = CH20MHZ_CHSPEC(1);

        /* various 802.11g modes */
        wlc->shortslot = false;
        wlc->shortslot_override = BRCMS_SHORTSLOT_AUTO;

        brcms_c_protection_upd(wlc, BRCMS_PROT_G_OVR, BRCMS_PROTECTION_AUTO);
        brcms_c_protection_upd(wlc, BRCMS_PROT_G_SPEC, false);

        brcms_c_protection_upd(wlc, BRCMS_PROT_N_CFG_OVR,
                               BRCMS_PROTECTION_AUTO);
        brcms_c_protection_upd(wlc, BRCMS_PROT_N_CFG, BRCMS_N_PROTECTION_OFF);
        brcms_c_protection_upd(wlc, BRCMS_PROT_N_NONGF_OVR,
                               BRCMS_PROTECTION_AUTO);
        brcms_c_protection_upd(wlc, BRCMS_PROT_N_NONGF, false);
        brcms_c_protection_upd(wlc, BRCMS_PROT_N_PAM_OVR, AUTO);

        brcms_c_protection_upd(wlc, BRCMS_PROT_OVERLAP,
                               BRCMS_PROTECTION_CTL_OVERLAP);

        /* 802.11g draft 4.0 NonERP elt advertisement */
        wlc->include_legacy_erp = true;

        wlc->stf->ant_rx_ovr = ANT_RX_DIV_DEF;
        wlc->stf->txant = ANT_TX_DEF;

        wlc->prb_resp_timeout = BRCMS_PRB_RESP_TIMEOUT;

        wlc->usr_fragthresh = DOT11_DEFAULT_FRAG_LEN;
        for (i = 0; i < NFIFO; i++)
                wlc->fragthresh[i] = DOT11_DEFAULT_FRAG_LEN;
        wlc->RTSThresh = DOT11_DEFAULT_RTS_LEN;

        /* default rate fallback retry limits */
        wlc->SFBL = RETRY_SHORT_FB;
        wlc->LFBL = RETRY_LONG_FB;

        /* default mac retry limits */
        wlc->SRL = RETRY_SHORT_DEF;
        wlc->LRL = RETRY_LONG_DEF;

        /* Set flag to indicate that hw keys should be used when available. */
        wlc->wsec_swkeys = false;

        /* init the 4 static WEP default keys */
        for (i = 0; i < WSEC_MAX_DEFAULT_KEYS; i++) {
                wlc->wsec_keys[i] = wlc->wsec_def_keys[i];
                wlc->wsec_keys[i]->idx = (u8) i;
        }

        /* WME QoS mode is Auto by default */
        wlc->pub->_wme = AUTO;

#ifdef BCMSDIODEV_ENABLED
        wlc->pub->_priofc = true;       /* enable priority flow control for sdio dongle */
#endif

        wlc->pub->_ampdu = AMPDU_AGG_HOST;
        wlc->pub->bcmerror = 0;
        wlc->pub->_coex = ON;

        /* initialize mpc delay */
        wlc->mpc_delay_off = wlc->mpc_dlycnt = BRCMS_MPC_MIN_DELAYCNT;
}

static bool brcms_c_state_bmac_sync(struct brcms_c_info *wlc)
{
        struct brcms_b_state state_bmac;

        if (brcms_b_state_get(wlc->hw, &state_bmac) != 0)
                return false;

        wlc->machwcap = state_bmac.machwcap;
        brcms_c_protection_upd(wlc, BRCMS_PROT_N_PAM_OVR,
                           (s8) state_bmac.preamble_ovr);

        return true;
}

static uint brcms_c_attach_module(struct brcms_c_info *wlc)
{
        uint err = 0;
        uint unit;
        unit = wlc->pub->unit;

        wlc->asi = brcms_c_antsel_attach(wlc);
        if (wlc->asi == NULL) {
                wiphy_err(wlc->wiphy, "wl%d: attach: antsel_attach "
                          "failed\n", unit);
                err = 44;
                goto fail;
        }

        wlc->ampdu = brcms_c_ampdu_attach(wlc);
        if (wlc->ampdu == NULL) {
                wiphy_err(wlc->wiphy, "wl%d: attach: ampdu_attach "
                          "failed\n", unit);
                err = 50;
                goto fail;
        }

        if ((brcms_c_stf_attach(wlc) != 0)) {
                wiphy_err(wlc->wiphy, "wl%d: attach: stf_attach "
                          "failed\n", unit);
                err = 68;
                goto fail;
        }
 fail:
        return err;
}

struct brcms_pub *brcms_c_pub(void *wlc)
{
        return ((struct brcms_c_info *) wlc)->pub;
}

#define CHIP_SUPPORTS_11N(wlc)  1

/*
 * The common driver entry routine. Error codes should be unique
 */
void *brcms_c_attach(struct brcms_info *wl, u16 vendor, u16 device, uint unit,
                 bool piomode, void *regsva, uint bustype, void *btparam,
                 uint *perr)
{
        struct brcms_c_info *wlc;
        uint err = 0;
        uint j;
        struct brcms_pub *pub;
        uint n_disabled;

        /* allocate struct brcms_c_info state and its substructures */
        wlc = (struct brcms_c_info *) brcms_c_attach_malloc(unit, &err, device);
        if (wlc == NULL)
                goto fail;
        wlc->wiphy = wl->wiphy;
        pub = wlc->pub;

#if defined(BCMDBG)
        wlc_info_dbg = wlc;
#endif

        wlc->band = wlc->bandstate[0];
        wlc->core = wlc->corestate;
        wlc->wl = wl;
        pub->unit = unit;
        pub->_piomode = piomode;
        wlc->bandinit_pending = false;

        /* populate struct brcms_c_info with default values  */
        brcms_c_info_init(wlc, unit);

        /* update sta/ap related parameters */
        brcms_c_ap_upd(wlc);

        /* 11n_disable nvram */
        n_disabled = getintvar(pub->vars, "11n_disable");

        /*
         * low level attach steps(all hw accesses go
         * inside, no more in rest of the attach)
         */
        err = brcms_b_attach(wlc, vendor, device, unit, piomode, regsva,
                              bustype, btparam);
        if (err)
                goto fail;

        /* for some states, due to different info pointer(e,g, wlc, wlc_hw) or master/slave split,
         * HIGH driver(both monolithic and HIGH_ONLY) needs to sync states FROM BMAC portion driver
         */
        if (!brcms_c_state_bmac_sync(wlc)) {
                err = 20;
                goto fail;
        }

        pub->phy_11ncapable = BRCMS_PHY_11N_CAP(wlc->band);

        /* propagate *vars* from BMAC driver to high driver */
        brcms_b_copyfrom_vars(wlc->hw, &pub->vars, &wlc->vars_size);


        /* set maximum allowed duty cycle */
        wlc->tx_duty_cycle_ofdm =
            (u16) getintvar(pub->vars, "tx_duty_cycle_ofdm");
        wlc->tx_duty_cycle_cck =
            (u16) getintvar(pub->vars, "tx_duty_cycle_cck");

        brcms_c_stf_phy_chain_calc(wlc);

        /* txchain 1: txant 0, txchain 2: txant 1 */
        if (BRCMS_ISNPHY(wlc->band) && (wlc->stf->txstreams == 1))
                wlc->stf->txant = wlc->stf->hw_txchain - 1;

        /* push to BMAC driver */
        wlc_phy_stf_chain_init(wlc->band->pi, wlc->stf->hw_txchain,
                               wlc->stf->hw_rxchain);

        /* pull up some info resulting from the low attach */
        {
                int i;
                for (i = 0; i < NFIFO; i++)
                        wlc->core->txavail[i] = wlc->hw->txavail[i];
        }

        brcms_b_hw_etheraddr(wlc->hw, wlc->perm_etheraddr);

        memcpy(&pub->cur_etheraddr, &wlc->perm_etheraddr, ETH_ALEN);

        for (j = 0; j < NBANDS(wlc); j++) {
                /* Use band 1 for single band 11a */
                if (IS_SINGLEBAND_5G(wlc->deviceid))
                        j = BAND_5G_INDEX;

                wlc->band = wlc->bandstate[j];

                if (!brcms_c_attach_stf_ant_init(wlc)) {
                        err = 24;
                        goto fail;
                }

                /* default contention windows size limits */
                wlc->band->CWmin = APHY_CWMIN;
                wlc->band->CWmax = PHY_CWMAX;

                /* init gmode value */
                if (BAND_2G(wlc->band->bandtype)) {
                        wlc->band->gmode = GMODE_AUTO;
                        brcms_c_protection_upd(wlc, BRCMS_PROT_G_USER,
                                           wlc->band->gmode);
                }

                /* init _n_enab supported mode */
                if (BRCMS_PHY_11N_CAP(wlc->band) && CHIP_SUPPORTS_11N(wlc)) {
                        if (n_disabled & WLFEATURE_DISABLE_11N) {
                                pub->_n_enab = OFF;
                                brcms_c_protection_upd(wlc, BRCMS_PROT_N_USER,
                                                       OFF);
                        } else {
                                pub->_n_enab = SUPPORT_11N;
                                brcms_c_protection_upd(wlc, BRCMS_PROT_N_USER,
                                                   ((pub->_n_enab ==
                                                     SUPPORT_11N) ? WL_11N_2x2 :
                                                    WL_11N_3x3));
                        }
                }

                /* init per-band default rateset, depend on band->gmode */
                brcms_default_rateset(wlc, &wlc->band->defrateset);

                /* fill in hw_rateset (used early by BRCM_SET_RATESET) */
                brcms_c_rateset_filter(&wlc->band->defrateset,
                                   &wlc->band->hw_rateset, false,
                                   BRCMS_RATES_CCK_OFDM, BRCMS_RATE_MASK,
                                   (bool) N_ENAB(wlc->pub));
        }

        /* update antenna config due to wlc->stf->txant/txchain/ant_rx_ovr change */
        brcms_c_stf_phy_txant_upd(wlc);

        /* attach each modules */
        err = brcms_c_attach_module(wlc);
        if (err != 0)
                goto fail;

        if (!brcms_c_timers_init(wlc, unit)) {
                wiphy_err(wl->wiphy, "wl%d: %s: init_timer failed\n", unit,
                          __func__);
                err = 32;
                goto fail;
        }

        /* depend on rateset, gmode */
        wlc->cmi = brcms_c_channel_mgr_attach(wlc);
        if (!wlc->cmi) {
                wiphy_err(wl->wiphy, "wl%d: %s: channel_mgr_attach failed"
                          "\n", unit, __func__);
                err = 33;
                goto fail;
        }

        /* init default when all parameters are ready, i.e. ->rateset */
        brcms_c_bss_default_init(wlc);

        /*
         * Complete the wlc default state initializations..
         */

        /* allocate our initial queue */
        wlc->pkt_queue = brcms_c_txq_alloc(wlc);
        if (wlc->pkt_queue == NULL) {
                wiphy_err(wl->wiphy, "wl%d: %s: failed to malloc tx queue\n",
                          unit, __func__);
                err = 100;
                goto fail;
        }

        wlc->bsscfg[0] = wlc->cfg;
        wlc->cfg->_idx = 0;
        wlc->cfg->wlc = wlc;
        pub->txmaxpkts = MAXTXPKTS;

        brcms_c_wme_initparams_sta(wlc, &wlc->wme_param_ie);

        wlc->mimoft = FT_HT;
        wlc->ht_cap.cap_info = HT_CAP;
        if (HT_ENAB(wlc->pub))
                wlc->stf->ldpc = AUTO;

        wlc->mimo_40txbw = AUTO;
        wlc->ofdm_40txbw = AUTO;
        wlc->cck_40txbw = AUTO;
        brcms_c_update_mimo_band_bwcap(wlc, BRCMS_N_BW_20IN2G_40IN5G);

        /* Set default values of SGI */
        if (BRCMS_SGI_CAP_PHY(wlc)) {
                brcms_c_ht_update_sgi_rx(wlc, (BRCMS_N_SGI_20 |
                                               BRCMS_N_SGI_40));
                wlc->sgi_tx = AUTO;
        } else if (BRCMS_ISSSLPNPHY(wlc->band)) {
                brcms_c_ht_update_sgi_rx(wlc, (BRCMS_N_SGI_20 |
                                               BRCMS_N_SGI_40));
                wlc->sgi_tx = AUTO;
        } else {
                brcms_c_ht_update_sgi_rx(wlc, 0);
                wlc->sgi_tx = OFF;
        }

        /* *******nvram 11n config overrides Start ********* */

        /* apply the sgi override from nvram conf */
        if (n_disabled & WLFEATURE_DISABLE_11N_SGI_TX)
                wlc->sgi_tx = OFF;

        if (n_disabled & WLFEATURE_DISABLE_11N_SGI_RX)
                brcms_c_ht_update_sgi_rx(wlc, 0);

        /* apply the stbc override from nvram conf */
        if (n_disabled & WLFEATURE_DISABLE_11N_STBC_TX) {
                wlc->bandstate[BAND_2G_INDEX]->band_stf_stbc_tx = OFF;
                wlc->bandstate[BAND_5G_INDEX]->band_stf_stbc_tx = OFF;
                wlc->ht_cap.cap_info &= ~IEEE80211_HT_CAP_TX_STBC;
        }
        if (n_disabled & WLFEATURE_DISABLE_11N_STBC_RX)
                brcms_c_stf_stbc_rx_set(wlc, HT_CAP_RX_STBC_NO);

        /* apply the GF override from nvram conf */
        if (n_disabled & WLFEATURE_DISABLE_11N_GF)
                wlc->ht_cap.cap_info &= ~IEEE80211_HT_CAP_GRN_FLD;

        /* initialize radio_mpc_disable according to wlc->mpc */
        brcms_c_radio_mpc_upd(wlc);
        brcms_b_antsel_set(wlc->hw, wlc->asi->antsel_avail);

        if (perr)
                *perr = 0;

        return (void *)wlc;

 fail:
        wiphy_err(wl->wiphy, "wl%d: %s: failed with err %d\n",
                  unit, __func__, err);
        if (wlc)
                brcms_c_detach(wlc);

        if (perr)
                *perr = err;
        return NULL;
}

static void brcms_c_attach_antgain_init(struct brcms_c_info *wlc)
{
        uint unit;
        unit = wlc->pub->unit;

        if ((wlc->band->antgain == -1) && (wlc->pub->sromrev == 1)) {
                /* default antenna gain for srom rev 1 is 2 dBm (8 qdbm) */
                wlc->band->antgain = 8;
        } else if (wlc->band->antgain == -1) {
                wiphy_err(wlc->wiphy, "wl%d: %s: Invalid antennas available in"
                          " srom, using 2dB\n", unit, __func__);
                wlc->band->antgain = 8;
        } else {
                s8 gain, fract;
                /* Older sroms specified gain in whole dbm only.  In order
                 * be able to specify qdbm granularity and remain backward compatible
                 * the whole dbms are now encoded in only low 6 bits and remaining qdbms
                 * are encoded in the hi 2 bits. 6 bit signed number ranges from
                 * -32 - 31. Examples: 0x1 = 1 db,
                 * 0xc1 = 1.75 db (1 + 3 quarters),
                 * 0x3f = -1 (-1 + 0 quarters),
                 * 0x7f = -.75 (-1 in low 6 bits + 1 quarters in hi 2 bits) = -3 qdbm.
                 * 0xbf = -.50 (-1 in low 6 bits + 2 quarters in hi 2 bits) = -2 qdbm.
                 */
                gain = wlc->band->antgain & 0x3f;
                gain <<= 2;     /* Sign extend */
                gain >>= 2;
                fract = (wlc->band->antgain & 0xc0) >> 6;
                wlc->band->antgain = 4 * gain + fract;
        }
}

static bool brcms_c_attach_stf_ant_init(struct brcms_c_info *wlc)
{
        int aa;
        uint unit;
        char *vars;
        int bandtype;

        unit = wlc->pub->unit;
        vars = wlc->pub->vars;
        bandtype = wlc->band->bandtype;

        /* get antennas available */
        aa = (s8) getintvar(vars, (BAND_5G(bandtype) ? "aa5g" : "aa2g"));
        if (aa == 0)
                aa = (s8) getintvar(vars,
                                      (BAND_5G(bandtype) ? "aa1" : "aa0"));
        if ((aa < 1) || (aa > 15)) {
                wiphy_err(wlc->wiphy, "wl%d: %s: Invalid antennas available in"
                          " srom (0x%x), using 3\n", unit, __func__, aa);
                aa = 3;
        }

        /* reset the defaults if we have a single antenna */
        if (aa == 1) {
                wlc->stf->ant_rx_ovr = ANT_RX_DIV_FORCE_0;
                wlc->stf->txant = ANT_TX_FORCE_0;
        } else if (aa == 2) {
                wlc->stf->ant_rx_ovr = ANT_RX_DIV_FORCE_1;
                wlc->stf->txant = ANT_TX_FORCE_1;
        } else {
        }

        /* Compute Antenna Gain */
        wlc->band->antgain =
            (s8) getintvar(vars, (BAND_5G(bandtype) ? "ag1" : "ag0"));
        brcms_c_attach_antgain_init(wlc);

        return true;
}


static void brcms_c_timers_deinit(struct brcms_c_info *wlc)
{
        /* free timer state */
        if (wlc->wdtimer) {
                brcms_free_timer(wlc->wl, wlc->wdtimer);
                wlc->wdtimer = NULL;
        }
        if (wlc->radio_timer) {
                brcms_free_timer(wlc->wl, wlc->radio_timer);
                wlc->radio_timer = NULL;
        }
}

static void brcms_c_detach_module(struct brcms_c_info *wlc)
{
        if (wlc->asi) {
                brcms_c_antsel_detach(wlc->asi);
                wlc->asi = NULL;
        }

        if (wlc->ampdu) {
                brcms_c_ampdu_detach(wlc->ampdu);
                wlc->ampdu = NULL;
        }

        brcms_c_stf_detach(wlc);
}

/*
 * Return a count of the number of driver callbacks still pending.
 *
 * General policy is that brcms_c_detach can only dealloc/free software states.
 * It can NOT touch hardware registers since the d11core may be in reset and
 * clock may not be available.
 * One exception is sb register access, which is possible if crystal is turned
 * on after "down" state, driver should avoid software timer with the exception
 * of radio_monitor.
 */
uint brcms_c_detach(struct brcms_c_info *wlc)
{
        uint callbacks = 0;

        if (wlc == NULL)
                return 0;

        BCMMSG(wlc->wiphy, "wl%d\n", wlc->pub->unit);

        callbacks += brcms_b_detach(wlc);

        /* delete software timers */
        if (!brcms_c_radio_monitor_stop(wlc))
                callbacks++;

        brcms_c_channel_mgr_detach(wlc->cmi);

        brcms_c_timers_deinit(wlc);

        brcms_c_detach_module(wlc);


        while (wlc->tx_queues != NULL)
                brcms_c_txq_free(wlc, wlc->tx_queues);

        brcms_c_detach_mfree(wlc);
        return callbacks;
}

/* update state that depends on the current value of "ap" */
void brcms_c_ap_upd(struct brcms_c_info *wlc)
{
        if (AP_ENAB(wlc->pub))
                /* AP: short not allowed, but not enforced */
                wlc->PLCPHdr_override = BRCMS_PLCP_AUTO;
        else
                /* STA-BSS; short capable */
                wlc->PLCPHdr_override = BRCMS_PLCP_SHORT;

        /* fixup mpc */
        wlc->mpc = true;
}

/* read hwdisable state and propagate to wlc flag */
static void brcms_c_radio_hwdisable_upd(struct brcms_c_info *wlc)
{
        if (wlc->pub->wlfeatureflag & WL_SWFL_NOHWRADIO || wlc->pub->hw_off)
                return;

        if (brcms_b_radio_read_hwdisabled(wlc->hw)) {
                mboolset(wlc->pub->radio_disabled, WL_RADIO_HW_DISABLE);
        } else {
                mboolclr(wlc->pub->radio_disabled, WL_RADIO_HW_DISABLE);
        }
}

/* return true if Minimum Power Consumption should be entered, false otherwise */
bool brcms_c_is_non_delay_mpc(struct brcms_c_info *wlc)
{
        return false;
}

bool brcms_c_ismpc(struct brcms_c_info *wlc)
{
        return (wlc->mpc_delay_off == 0) && (brcms_c_is_non_delay_mpc(wlc));
}

void brcms_c_radio_mpc_upd(struct brcms_c_info *wlc)
{
        bool mpc_radio, radio_state;

        /*
         * Clear the WL_RADIO_MPC_DISABLE bit when mpc feature is disabled
         * in case the WL_RADIO_MPC_DISABLE bit was set. Stop the radio
         * monitor also when WL_RADIO_MPC_DISABLE is the only reason that
         * the radio is going down.
         */
        if (!wlc->mpc) {
                if (!wlc->pub->radio_disabled)
                        return;
                mboolclr(wlc->pub->radio_disabled, WL_RADIO_MPC_DISABLE);
                brcms_c_radio_upd(wlc);
                if (!wlc->pub->radio_disabled)
                        brcms_c_radio_monitor_stop(wlc);
                return;
        }

        /*
         * sync ismpc logic with WL_RADIO_MPC_DISABLE bit in wlc->pub->radio_disabled
         * to go ON, always call radio_upd synchronously
         * to go OFF, postpone radio_upd to later when context is safe(e.g. watchdog)
         */
        radio_state =
            (mboolisset(wlc->pub->radio_disabled, WL_RADIO_MPC_DISABLE) ? OFF :
             ON);
        mpc_radio = (brcms_c_ismpc(wlc) == true) ? OFF : ON;

        if (radio_state == ON && mpc_radio == OFF)
                wlc->mpc_delay_off = wlc->mpc_dlycnt;
        else if (radio_state == OFF && mpc_radio == ON) {
                mboolclr(wlc->pub->radio_disabled, WL_RADIO_MPC_DISABLE);
                brcms_c_radio_upd(wlc);
                if (wlc->mpc_offcnt < BRCMS_MPC_THRESHOLD)
                        wlc->mpc_dlycnt = BRCMS_MPC_MAX_DELAYCNT;
                else
                        wlc->mpc_dlycnt = BRCMS_MPC_MIN_DELAYCNT;
                wlc->mpc_dur += OSL_SYSUPTIME() - wlc->mpc_laston_ts;
        }
        /* Below logic is meant to capture the transition from mpc off to mpc on for reasons
         * other than wlc->mpc_delay_off keeping the mpc off. In that case reset
         * wlc->mpc_delay_off to wlc->mpc_dlycnt, so that we restart the countdown of mpc_delay_off
         */
        if ((wlc->prev_non_delay_mpc == false) &&
            (brcms_c_is_non_delay_mpc(wlc) == true) && wlc->mpc_delay_off) {
                wlc->mpc_delay_off = wlc->mpc_dlycnt;
        }
        wlc->prev_non_delay_mpc = brcms_c_is_non_delay_mpc(wlc);
}

/*
 * centralized radio disable/enable function,
 * invoke radio enable/disable after updating hwradio status
 */
static void brcms_c_radio_upd(struct brcms_c_info *wlc)
{
        if (wlc->pub->radio_disabled) {
                brcms_c_radio_disable(wlc);
        } else {
                brcms_c_radio_enable(wlc);
        }
}

/* maintain LED behavior in down state */
static void brcms_c_down_led_upd(struct brcms_c_info *wlc)
{
        /* maintain LEDs while in down state, turn on sbclk if not available yet */
        /* turn on sbclk if necessary */
        if (!AP_ENAB(wlc->pub)) {
                brcms_c_pllreq(wlc, true, BRCMS_PLLREQ_FLIP);

                brcms_c_pllreq(wlc, false, BRCMS_PLLREQ_FLIP);
        }
}

/* update hwradio status and return it */
bool brcms_c_check_radio_disabled(struct brcms_c_info *wlc)
{
        brcms_c_radio_hwdisable_upd(wlc);

        return mboolisset(wlc->pub->radio_disabled, WL_RADIO_HW_DISABLE) ? true : false;
}

void brcms_c_radio_disable(struct brcms_c_info *wlc)
{
        if (!wlc->pub->up) {
                brcms_c_down_led_upd(wlc);
                return;
        }

        brcms_c_radio_monitor_start(wlc);
        brcms_down(wlc->wl);
}

static void brcms_c_radio_enable(struct brcms_c_info *wlc)
{
        if (wlc->pub->up)
                return;

        if (DEVICEREMOVED(wlc))
                return;

        brcms_up(wlc->wl);
}

/* periodical query hw radio button while driver is "down" */
static void brcms_c_radio_timer(void *arg)
{
        struct brcms_c_info *wlc = (struct brcms_c_info *) arg;

        if (DEVICEREMOVED(wlc)) {
                wiphy_err(wlc->wiphy, "wl%d: %s: dead chip\n", wlc->pub->unit,
                        __func__);
                brcms_down(wlc->wl);
                return;
        }

        /* cap mpc off count */
        if (wlc->mpc_offcnt < BRCMS_MPC_MAX_DELAYCNT)
                wlc->mpc_offcnt++;

        brcms_c_radio_hwdisable_upd(wlc);
        brcms_c_radio_upd(wlc);
}

static bool brcms_c_radio_monitor_start(struct brcms_c_info *wlc)
{
        /* Don't start the timer if HWRADIO feature is disabled */
        if (wlc->radio_monitor || (wlc->pub->wlfeatureflag & WL_SWFL_NOHWRADIO))
                return true;

        wlc->radio_monitor = true;
        brcms_c_pllreq(wlc, true, BRCMS_PLLREQ_RADIO_MON);
        brcms_add_timer(wlc->wl, wlc->radio_timer, TIMER_INTERVAL_RADIOCHK,
                        true);
        return true;
}

bool brcms_c_radio_monitor_stop(struct brcms_c_info *wlc)
{
        if (!wlc->radio_monitor)
                return true;

        wlc->radio_monitor = false;
        brcms_c_pllreq(wlc, false, BRCMS_PLLREQ_RADIO_MON);
        return brcms_del_timer(wlc->wl, wlc->radio_timer);
}

static void brcms_c_watchdog_by_timer(void *arg)
{
        brcms_c_watchdog(arg);
}

/* common watchdog code */
static void brcms_c_watchdog(void *arg)
{
        struct brcms_c_info *wlc = (struct brcms_c_info *) arg;
        int i;
        struct brcms_bss_cfg *cfg;

        BCMMSG(wlc->wiphy, "wl%d\n", wlc->pub->unit);

        if (!wlc->pub->up)
                return;

        if (DEVICEREMOVED(wlc)) {
                wiphy_err(wlc->wiphy, "wl%d: %s: dead chip\n", wlc->pub->unit,
                          __func__);
                brcms_down(wlc->wl);
                return;
        }

        /* increment second count */
        wlc->pub->now++;

        /* delay radio disable */
        if (wlc->mpc_delay_off) {
                if (--wlc->mpc_delay_off == 0) {
                        mboolset(wlc->pub->radio_disabled,
                                 WL_RADIO_MPC_DISABLE);
                        if (wlc->mpc && brcms_c_ismpc(wlc))
                                wlc->mpc_offcnt = 0;
                        wlc->mpc_laston_ts = OSL_SYSUPTIME();
                }
        }

        /* mpc sync */
        brcms_c_radio_mpc_upd(wlc);
        /* radio sync: sw/hw/mpc --> radio_disable/radio_enable */
        brcms_c_radio_hwdisable_upd(wlc);
        brcms_c_radio_upd(wlc);
        /* if radio is disable, driver may be down, quit here */
        if (wlc->pub->radio_disabled)
                return;

        brcms_b_watchdog(wlc);

        /* occasionally sample mac stat counters to detect 16-bit counter wrap */
        if ((wlc->pub->now % SW_TIMER_MAC_STAT_UPD) == 0)
                brcms_c_statsupd(wlc);

        /* Manage TKIP countermeasures timers */
        FOREACH_BSS(wlc, i, cfg) {
                if (cfg->tk_cm_dt) {
                        cfg->tk_cm_dt--;
                }
                if (cfg->tk_cm_bt) {
                        cfg->tk_cm_bt--;
                }
        }

        /* Call any registered watchdog handlers */
        for (i = 0; i < BRCMS_MAXMODULES; i++) {

                if (wlc->modulecb[i].watchdog_fn)
                        wlc->modulecb[i].watchdog_fn(wlc->modulecb[i].hdl);
        }

        if (BRCMS_ISNPHY(wlc->band) && !wlc->pub->tempsense_disable &&
            ((wlc->pub->now - wlc->tempsense_lasttime) >=
             BRCMS_TEMPSENSE_PERIOD)) {
                wlc->tempsense_lasttime = wlc->pub->now;
                brcms_c_tempsense_upd(wlc);
        }
}

/* make interface operational */
int brcms_c_up(struct brcms_c_info *wlc)
{
        BCMMSG(wlc->wiphy, "wl%d\n", wlc->pub->unit);

        /* HW is turned off so don't try to access it */
        if (wlc->pub->hw_off || DEVICEREMOVED(wlc))
                return -ENOMEDIUM;

        if (!wlc->pub->hw_up) {
                brcms_b_hw_up(wlc->hw);
                wlc->pub->hw_up = true;
        }

        if ((wlc->pub->boardflags & BFL_FEM)
            && (wlc->pub->sih->chip == BCM4313_CHIP_ID)) {
                if (wlc->pub->boardrev >= 0x1250
                    && (wlc->pub->boardflags & BFL_FEM_BT)) {
                        brcms_c_mhf(wlc, MHF5, MHF5_4313_GPIOCTRL,
                                MHF5_4313_GPIOCTRL, BRCM_BAND_ALL);
                } else {
                        brcms_c_mhf(wlc, MHF4, MHF4_EXTPA_ENABLE,
                                    MHF4_EXTPA_ENABLE, BRCM_BAND_ALL);
                }
        }

        /*
         * Need to read the hwradio status here to cover the case where the system
         * is loaded with the hw radio disabled. We do not want to bring the driver up in this case.
         * if radio is disabled, abort up, lower power, start radio timer and return 0(for NDIS)
         * don't call radio_update to avoid looping brcms_c_up.
         *
         * brcms_b_up_prep() returns either 0 or -BCME_RADIOOFF only
         */
        if (!wlc->pub->radio_disabled) {
                int status = brcms_b_up_prep(wlc->hw);
                if (status == -ENOMEDIUM) {
                        if (!mboolisset
                            (wlc->pub->radio_disabled, WL_RADIO_HW_DISABLE)) {
                                int idx;
                                struct brcms_bss_cfg *bsscfg;
                                mboolset(wlc->pub->radio_disabled,
                                         WL_RADIO_HW_DISABLE);

                                FOREACH_BSS(wlc, idx, bsscfg) {
                                        if (!BSSCFG_STA(bsscfg)
                                            || !bsscfg->enable || !bsscfg->BSS)
                                                continue;
                                        wiphy_err(wlc->wiphy, "wl%d.%d: up"
                                                  ": rfdisable -> "
                                                  "bsscfg_disable()\n",
                                                   wlc->pub->unit, idx);
                                }
                        }
                }
        }

        if (wlc->pub->radio_disabled) {
                brcms_c_radio_monitor_start(wlc);
                return 0;
        }

        /* brcms_b_up_prep has done brcms_c_corereset(). so clk is on, set it */
        wlc->clk = true;

        brcms_c_radio_monitor_stop(wlc);

        /* Set EDCF hostflags */
        if (EDCF_ENAB(wlc->pub)) {
                brcms_c_mhf(wlc, MHF1, MHF1_EDCF, MHF1_EDCF, BRCM_BAND_ALL);
        } else {
                brcms_c_mhf(wlc, MHF1, MHF1_EDCF, 0, BRCM_BAND_ALL);
        }

        if (BRCMS_WAR16165(wlc))
                brcms_c_mhf(wlc, MHF2, MHF2_PCISLOWCLKWAR, MHF2_PCISLOWCLKWAR,
                        BRCM_BAND_ALL);

        brcms_init(wlc->wl);
        wlc->pub->up = true;

        if (wlc->bandinit_pending) {
                brcms_c_suspend_mac_and_wait(wlc);
                brcms_c_set_chanspec(wlc, wlc->default_bss->chanspec);
                wlc->bandinit_pending = false;
                brcms_c_enable_mac(wlc);
        }

        brcms_b_up_finish(wlc->hw);

        /* other software states up after ISR is running */
        /* start APs that were to be brought up but are not up  yet */
        /* if (AP_ENAB(wlc->pub)) brcms_c_restart_ap(wlc->ap); */

        /* Program the TX wme params with the current settings */
        brcms_c_wme_retries_write(wlc);

        /* start one second watchdog timer */
        brcms_add_timer(wlc->wl, wlc->wdtimer, TIMER_INTERVAL_WATCHDOG, true);
        wlc->WDarmed = true;

        /* ensure antenna config is up to date */
        brcms_c_stf_phy_txant_upd(wlc);
        /* ensure LDPC config is in sync */
        brcms_c_ht_update_ldpc(wlc, wlc->stf->ldpc);

        return 0;
}

/* Initialize the base precedence map for dequeueing from txq based on WME settings */
static void brcms_c_tx_prec_map_init(struct brcms_c_info *wlc)
{
        wlc->tx_prec_map = BRCMS_PREC_BMP_ALL;
        memset(wlc->fifo2prec_map, 0, NFIFO * sizeof(u16));

        /* For non-WME, both fifos have overlapping MAXPRIO. So just disable all precedences
         * if either is full.
         */
        if (!EDCF_ENAB(wlc->pub)) {
                wlc->fifo2prec_map[TX_DATA_FIFO] = BRCMS_PREC_BMP_ALL;
                wlc->fifo2prec_map[TX_CTL_FIFO] = BRCMS_PREC_BMP_ALL;
        } else {
                wlc->fifo2prec_map[TX_AC_BK_FIFO] = BRCMS_PREC_BMP_AC_BK;
                wlc->fifo2prec_map[TX_AC_BE_FIFO] = BRCMS_PREC_BMP_AC_BE;
                wlc->fifo2prec_map[TX_AC_VI_FIFO] = BRCMS_PREC_BMP_AC_VI;
                wlc->fifo2prec_map[TX_AC_VO_FIFO] = BRCMS_PREC_BMP_AC_VO;
        }
}

static uint brcms_c_down_del_timer(struct brcms_c_info *wlc)
{
        uint callbacks = 0;

        return callbacks;
}

/*
 * Mark the interface nonoperational, stop the software mechanisms,
 * disable the hardware, free any transient buffer state.
 * Return a count of the number of driver callbacks still pending.
 */
uint brcms_c_down(struct brcms_c_info *wlc)
{

        uint callbacks = 0;
        int i;
        bool dev_gone = false;
        struct brcms_txq_info *qi;

        BCMMSG(wlc->wiphy, "wl%d\n", wlc->pub->unit);

        /* check if we are already in the going down path */
        if (wlc->going_down) {
                wiphy_err(wlc->wiphy, "wl%d: %s: Driver going down so return"
                          "\n", wlc->pub->unit, __func__);
                return 0;
        }
        if (!wlc->pub->up)
                return callbacks;

        /* in between, mpc could try to bring down again.. */
        wlc->going_down = true;

        callbacks += brcms_b_bmac_down_prep(wlc->hw);

        dev_gone = DEVICEREMOVED(wlc);

        /* Call any registered down handlers */
        for (i = 0; i < BRCMS_MAXMODULES; i++) {
                if (wlc->modulecb[i].down_fn)
                        callbacks +=
                            wlc->modulecb[i].down_fn(wlc->modulecb[i].hdl);
        }

        /* cancel the watchdog timer */
        if (wlc->WDarmed) {
                if (!brcms_del_timer(wlc->wl, wlc->wdtimer))
                        callbacks++;
                wlc->WDarmed = false;
        }
        /* cancel all other timers */
        callbacks += brcms_c_down_del_timer(wlc);

        wlc->pub->up = false;

        wlc_phy_mute_upd(wlc->band->pi, false, PHY_MUTE_ALL);

        /* clear txq flow control */
        brcms_c_txflowcontrol_reset(wlc);

        /* flush tx queues */
        for (qi = wlc->tx_queues; qi != NULL; qi = qi->next) {
                brcmu_pktq_flush(&qi->q, true, NULL, NULL);
        }

        callbacks += brcms_b_down_finish(wlc->hw);

        /* brcms_b_down_finish has done brcms_c_coredisable(). so clk is off */
        wlc->clk = false;

        wlc->going_down = false;
        return callbacks;
}

/* Set the current gmode configuration */
int brcms_c_set_gmode(struct brcms_c_info *wlc, u8 gmode, bool config)
{
        int ret = 0;
        uint i;
        wlc_rateset_t rs;
        /* Default to 54g Auto */
        /* Advertise and use shortslot (-1/0/1 Auto/Off/On) */
        s8 shortslot = BRCMS_SHORTSLOT_AUTO;
        bool shortslot_restrict = false;        /* Restrict association to stations that support shortslot
                                                 */
        bool ofdm_basic = false;        /* Make 6, 12, and 24 basic rates */
        /* Advertise and use short preambles (-1/0/1 Auto/Off/On) */
        int preamble = BRCMS_PLCP_LONG;
        bool preamble_restrict = false; /* Restrict association to stations that support short
                                         * preambles
                                         */
        struct brcms_band *band;

        /* if N-support is enabled, allow Gmode set as long as requested
         * Gmode is not GMODE_LEGACY_B
         */
        if (N_ENAB(wlc->pub) && gmode == GMODE_LEGACY_B)
                return -ENOTSUPP;

        /* verify that we are dealing with 2G band and grab the band pointer */
        if (wlc->band->bandtype == BRCM_BAND_2G)
                band = wlc->band;
        else if ((NBANDS(wlc) > 1) &&
                 (wlc->bandstate[OTHERBANDUNIT(wlc)]->bandtype == BRCM_BAND_2G))
                band = wlc->bandstate[OTHERBANDUNIT(wlc)];
        else
                return -EINVAL;

        /* Legacy or bust when no OFDM is supported by regulatory */
        if ((brcms_c_channel_locale_flags_in_band(wlc->cmi, band->bandunit) &
             BRCMS_NO_OFDM) && (gmode != GMODE_LEGACY_B))
                return -EINVAL;

        /* update configuration value */
        if (config == true)
                brcms_c_protection_upd(wlc, BRCMS_PROT_G_USER, gmode);

        /* Clear supported rates filter */
        memset(&wlc->sup_rates_override, 0, sizeof(wlc_rateset_t));

        /* Clear rateset override */
        memset(&rs, 0, sizeof(wlc_rateset_t));

        switch (gmode) {
        case GMODE_LEGACY_B:
                shortslot = BRCMS_SHORTSLOT_OFF;
                brcms_c_rateset_copy(&gphy_legacy_rates, &rs);

                break;

        case GMODE_LRS:
                if (AP_ENAB(wlc->pub))
                        brcms_c_rateset_copy(&cck_rates,
                                             &wlc->sup_rates_override);
                break;

        case GMODE_AUTO:
                /* Accept defaults */
                break;

        case GMODE_ONLY:
                ofdm_basic = true;
                preamble = BRCMS_PLCP_SHORT;
                preamble_restrict = true;
                break;

        case GMODE_PERFORMANCE:
                if (AP_ENAB(wlc->pub))  /* Put all rates into the Supported Rates element */
                        brcms_c_rateset_copy(&cck_ofdm_rates,
                                         &wlc->sup_rates_override);

                shortslot = BRCMS_SHORTSLOT_ON;
                shortslot_restrict = true;
                ofdm_basic = true;
                preamble = BRCMS_PLCP_SHORT;
                preamble_restrict = true;
                break;

        default:
                /* Error */
                wiphy_err(wlc->wiphy, "wl%d: %s: invalid gmode %d\n",
                          wlc->pub->unit, __func__, gmode);
                return -ENOTSUPP;
        }

        /*
         * If we are switching to gmode == GMODE_LEGACY_B,
         * clean up rate info that may refer to OFDM rates.
         */
        if ((gmode == GMODE_LEGACY_B) && (band->gmode != GMODE_LEGACY_B)) {
                band->gmode = gmode;
                if (band->rspec_override && !IS_CCK(band->rspec_override)) {
                        band->rspec_override = 0;
                        brcms_c_reprate_init(wlc);
                }
                if (band->mrspec_override && !IS_CCK(band->mrspec_override)) {
                        band->mrspec_override = 0;
                }
        }

        band->gmode = gmode;

        wlc->shortslot_override = shortslot;

        if (AP_ENAB(wlc->pub)) {
                /* wlc->ap->shortslot_restrict = shortslot_restrict; */
                wlc->PLCPHdr_override =
                    (preamble !=
                     BRCMS_PLCP_LONG) ? BRCMS_PLCP_SHORT : BRCMS_PLCP_AUTO;
        }

        if ((AP_ENAB(wlc->pub) && preamble != BRCMS_PLCP_LONG)
            || preamble == BRCMS_PLCP_SHORT)
                wlc->default_bss->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
        else
                wlc->default_bss->capability &= ~WLAN_CAPABILITY_SHORT_PREAMBLE;

        /* Update shortslot capability bit for AP and IBSS */
        if ((AP_ENAB(wlc->pub) && shortslot == BRCMS_SHORTSLOT_AUTO) ||
            shortslot == BRCMS_SHORTSLOT_ON)
                wlc->default_bss->capability |= WLAN_CAPABILITY_SHORT_SLOT_TIME;
        else
                wlc->default_bss->capability &=
                                        ~WLAN_CAPABILITY_SHORT_SLOT_TIME;

        /* Use the default 11g rateset */
        if (!rs.count)
                brcms_c_rateset_copy(&cck_ofdm_rates, &rs);

        if (ofdm_basic) {
                for (i = 0; i < rs.count; i++) {
                        if (rs.rates[i] == BRCM_RATE_6M
                            || rs.rates[i] == BRCM_RATE_12M
                            || rs.rates[i] == BRCM_RATE_24M)
                                rs.rates[i] |= BRCMS_RATE_FLAG;
                }
        }

        /* Set default bss rateset */
        wlc->default_bss->rateset.count = rs.count;
        memcpy(wlc->default_bss->rateset.rates, rs.rates,
               sizeof(wlc->default_bss->rateset.rates));

        return ret;
}

static int brcms_c_nmode_validate(struct brcms_c_info *wlc, s32 nmode)
{
        int err = 0;

        switch (nmode) {

        case OFF:
                break;

        case AUTO:
        case WL_11N_2x2:
        case WL_11N_3x3:
                if (!(BRCMS_PHY_11N_CAP(wlc->band)))
                        err = -EINVAL;
                break;

        default:
                err = -EINVAL;
                break;
        }

        return err;
}

int brcms_c_set_nmode(struct brcms_c_info *wlc, s32 nmode)
{
        uint i;
        int err;

        err = brcms_c_nmode_validate(wlc, nmode);
        if (err)
                return err;

        switch (nmode) {
        case OFF:
                wlc->pub->_n_enab = OFF;
                wlc->default_bss->flags &= ~BRCMS_BSS_HT;
                /* delete the mcs rates from the default and hw ratesets */
                brcms_c_rateset_mcs_clear(&wlc->default_bss->rateset);
                for (i = 0; i < NBANDS(wlc); i++) {
                        memset(wlc->bandstate[i]->hw_rateset.mcs, 0,
                               MCSSET_LEN);
                        if (IS_MCS(wlc->band->rspec_override)) {
                                wlc->bandstate[i]->rspec_override = 0;
                                brcms_c_reprate_init(wlc);
                        }
                        if (IS_MCS(wlc->band->mrspec_override))
                                wlc->bandstate[i]->mrspec_override = 0;
                }
                break;

        case AUTO:
                if (wlc->stf->txstreams == WL_11N_3x3)
                        nmode = WL_11N_3x3;
                else
                        nmode = WL_11N_2x2;
        case WL_11N_2x2:
        case WL_11N_3x3:
                /* force GMODE_AUTO if NMODE is ON */
                brcms_c_set_gmode(wlc, GMODE_AUTO, true);
                if (nmode == WL_11N_3x3)
                        wlc->pub->_n_enab = SUPPORT_HT;
                else
                        wlc->pub->_n_enab = SUPPORT_11N;
                wlc->default_bss->flags |= BRCMS_BSS_HT;
                /* add the mcs rates to the default and hw ratesets */
                brcms_c_rateset_mcs_build(&wlc->default_bss->rateset,
                                      wlc->stf->txstreams);
                for (i = 0; i < NBANDS(wlc); i++)
                        memcpy(wlc->bandstate[i]->hw_rateset.mcs,
                               wlc->default_bss->rateset.mcs, MCSSET_LEN);
                break;

        default:
                break;
        }

        return err;
}

static int brcms_c_set_rateset(struct brcms_c_info *wlc, wlc_rateset_t *rs_arg)
{
        wlc_rateset_t rs, new;
        uint bandunit;

        memcpy(&rs, rs_arg, sizeof(wlc_rateset_t));

        /* check for bad count value */
        if ((rs.count == 0) || (rs.count > BRCMS_NUMRATES))
                return -EINVAL;

        /* try the current band */
        bandunit = wlc->band->bandunit;
        memcpy(&new, &rs, sizeof(wlc_rateset_t));
        if (brcms_c_rate_hwrs_filter_sort_validate
            (&new, &wlc->bandstate[bandunit]->hw_rateset, true,
             wlc->stf->txstreams))
                goto good;

        /* try the other band */
        if (IS_MBAND_UNLOCKED(wlc)) {
                bandunit = OTHERBANDUNIT(wlc);
                memcpy(&new, &rs, sizeof(wlc_rateset_t));
                if (brcms_c_rate_hwrs_filter_sort_validate(&new,
                                                       &wlc->
                                                       bandstate[bandunit]->
                                                       hw_rateset, true,
                                                       wlc->stf->txstreams))
                        goto good;
        }

        return -EBADE;

 good:
        /* apply new rateset */
        memcpy(&wlc->default_bss->rateset, &new, sizeof(wlc_rateset_t));
        memcpy(&wlc->bandstate[bandunit]->defrateset, &new,
               sizeof(wlc_rateset_t));
        return 0;
}

/* simplified integer set interface for common ioctl handler */
int brcms_c_set(struct brcms_c_info *wlc, int cmd, int arg)
{
        return brcms_c_ioctl(wlc, cmd, (void *)&arg, sizeof(arg), NULL);
}

/* simplified integer get interface for common ioctl handler */
int brcms_c_get(struct brcms_c_info *wlc, int cmd, int *arg)
{
        return brcms_c_ioctl(wlc, cmd, arg, sizeof(int), NULL);
}

static void brcms_c_ofdm_rateset_war(struct brcms_c_info *wlc)
{
        u8 r;
        bool war = false;

        if (wlc->cfg->associated)
                r = wlc->cfg->current_bss->rateset.rates[0];
        else
                r = wlc->default_bss->rateset.rates[0];

        wlc_phy_ofdm_rateset_war(wlc->band->pi, war);

        return;
}

int
brcms_c_ioctl(struct brcms_c_info *wlc, int cmd, void *arg, int len,
              struct brcms_c_if *wlcif)
{
        return _brcms_c_ioctl(wlc, cmd, arg, len, wlcif);
}

/* common ioctl handler. return: 0=ok, -1=error, positive=particular error */
static int
_brcms_c_ioctl(struct brcms_c_info *wlc, int cmd, void *arg, int len,
               struct brcms_c_if *wlcif)
{
        int val, *pval;
        bool bool_val;
        int bcmerror;
        struct scb *nextscb;
        bool ta_ok;
        uint band;
        struct brcms_bss_cfg *bsscfg;
        struct brcms_bss_info *current_bss;

        /* update bsscfg pointer */
        bsscfg = wlc->cfg;
        current_bss = bsscfg->current_bss;

        /* initialize the following to get rid of compiler warning */
        nextscb = NULL;
        ta_ok = false;
        band = 0;

        /* If the device is turned off, then it's not "removed" */
        if (!wlc->pub->hw_off && DEVICEREMOVED(wlc)) {
                wiphy_err(wlc->wiphy, "wl%d: %s: dead chip\n", wlc->pub->unit,
                          __func__);
                brcms_down(wlc->wl);
                return -EBADE;
        }

        /* default argument is generic integer */
        pval = arg ? (int *)arg : NULL;

        /* This will prevent the misaligned access */
        if (pval && (u32) len >= sizeof(val))
                memcpy(&val, pval, sizeof(val));
        else
                val = 0;

        /* bool conversion to avoid duplication below */
        bool_val = val != 0;
        bcmerror = 0;

        if ((arg == NULL) || (len <= 0)) {
                wiphy_err(wlc->wiphy, "wl%d: %s: Command %d needs arguments\n",
                          wlc->pub->unit, __func__, cmd);
                bcmerror = -EINVAL;
                goto done;
        }

        switch (cmd) {

        case BRCM_SET_CHANNEL:{
                        chanspec_t chspec = CH20MHZ_CHSPEC(val);

                        if (val < 0 || val > MAXCHANNEL) {
                                bcmerror = -EINVAL;
                                break;
                        }

                        if (!brcms_c_valid_chanspec_db(wlc->cmi, chspec)) {
                                bcmerror = -EINVAL;
                                break;
                        }

                        if (!wlc->pub->up && IS_MBAND_UNLOCKED(wlc)) {
                                if (wlc->band->bandunit !=
                                    CHSPEC_BANDUNIT(chspec))
                                        wlc->bandinit_pending = true;
                                else
                                        wlc->bandinit_pending = false;
                        }

                        wlc->default_bss->chanspec = chspec;
                        /* brcms_c_BSSinit() will sanitize the rateset before
                         * using it.. */
                        if (wlc->pub->up &&
                            (BRCMS_BAND_PI_RADIO_CHANSPEC != chspec)) {
                                brcms_c_set_home_chanspec(wlc, chspec);
                                brcms_c_suspend_mac_and_wait(wlc);
                                brcms_c_set_chanspec(wlc, chspec);
                                brcms_c_enable_mac(wlc);
                        }
                        break;
                }

        case BRCM_SET_SRL:
                if (val >= 1 && val <= RETRY_SHORT_MAX) {
                        int ac;
                        wlc->SRL = (u16) val;

                        brcms_b_retrylimit_upd(wlc->hw, wlc->SRL, wlc->LRL);

                        for (ac = 0; ac < AC_COUNT; ac++) {
                                BRCMS_WME_RETRY_SHORT_SET(wlc, ac, wlc->SRL);
                        }
                        brcms_c_wme_retries_write(wlc);
                } else
                        bcmerror = -EINVAL;
                break;

        case BRCM_SET_LRL:
                if (val >= 1 && val <= 255) {
                        int ac;
                        wlc->LRL = (u16) val;

                        brcms_b_retrylimit_upd(wlc->hw, wlc->SRL, wlc->LRL);

                        for (ac = 0; ac < AC_COUNT; ac++) {
                                BRCMS_WME_RETRY_LONG_SET(wlc, ac, wlc->LRL);
                        }
                        brcms_c_wme_retries_write(wlc);
                } else
                        bcmerror = -EINVAL;
                break;

        case BRCM_GET_CURR_RATESET:{
                        wl_rateset_t *ret_rs = (wl_rateset_t *) arg;
                        wlc_rateset_t *rs;

                        if (wlc->pub->associated)
                                rs = &current_bss->rateset;
                        else
                                rs = &wlc->default_bss->rateset;

                        if (len < (int)(rs->count + sizeof(rs->count))) {
                                bcmerror = -EOVERFLOW;
                                break;
                        }

                        /* Copy only legacy rateset section */
                        ret_rs->count = rs->count;
                        memcpy(&ret_rs->rates, &rs->rates, rs->count);
                        break;
                }

        case BRCM_SET_RATESET:{
                        wlc_rateset_t rs;
                        wl_rateset_t *in_rs = (wl_rateset_t *) arg;

                        if (len < (int)(in_rs->count + sizeof(in_rs->count))) {
                                bcmerror = -EOVERFLOW;
                                break;
                        }

                        if (in_rs->count > BRCMS_NUMRATES) {
                                bcmerror = -ENOBUFS;
                                break;
                        }

                        memset(&rs, 0, sizeof(wlc_rateset_t));

                        /* Copy only legacy rateset section */
                        rs.count = in_rs->count;
                        memcpy(&rs.rates, &in_rs->rates, rs.count);

                        /* merge rateset coming in with the current mcsset */
                        if (N_ENAB(wlc->pub)) {
                                if (bsscfg->associated)
                                        memcpy(rs.mcs,
                                               &current_bss->rateset.mcs[0],
                                               MCSSET_LEN);
                                else
                                        memcpy(rs.mcs,
                                               &wlc->default_bss->rateset.mcs[0],
                                               MCSSET_LEN);
                        }

                        bcmerror = brcms_c_set_rateset(wlc, &rs);

                        if (!bcmerror)
                                brcms_c_ofdm_rateset_war(wlc);

                        break;
                }

        case BRCM_SET_BCNPRD:
                /* range [1, 0xffff] */
                if (val >= DOT11_MIN_BEACON_PERIOD
                    && val <= DOT11_MAX_BEACON_PERIOD)
                        wlc->default_bss->beacon_period = (u16) val;
                else
                        bcmerror = -EINVAL;
                break;

        case BRCM_GET_PHYLIST:
                {
                        unsigned char *cp = arg;
                        if (len < 3) {
                                bcmerror = -EOVERFLOW;
                                break;
                        }

                        if (BRCMS_ISNPHY(wlc->band))
                                *cp++ = 'n';
                        else if (BRCMS_ISLCNPHY(wlc->band))
                                *cp++ = 'c';
                        else if (BRCMS_ISSSLPNPHY(wlc->band))
                                *cp++ = 's';
                        *cp = '\0';
                        break;
                }

        case BRCMS_SET_SHORTSLOT_OVERRIDE:
                if (val != BRCMS_SHORTSLOT_AUTO && val != BRCMS_SHORTSLOT_OFF &&
                    val != BRCMS_SHORTSLOT_ON) {
                        bcmerror = -EINVAL;
                        break;
                }

                wlc->shortslot_override = (s8) val;

                /* shortslot is an 11g feature, so no more work if we are
                 * currently on the 5G band
                 */
                if (BAND_5G(wlc->band->bandtype))
                        break;

                if (wlc->pub->up && wlc->pub->associated) {
                        /* let watchdog or beacon processing update shortslot */
                } else if (wlc->pub->up) {
                        /* unassociated shortslot is off */
                        brcms_c_switch_shortslot(wlc, false);
                } else {
                        /* driver is down, so just update the brcms_c_info
                         * value */
                        if (wlc->shortslot_override == BRCMS_SHORTSLOT_AUTO) {
                                wlc->shortslot = false;
                        } else {
                                wlc->shortslot =
                                    (wlc->shortslot_override ==
                                     BRCMS_SHORTSLOT_ON);
                        }
                }

                break;

        }
 done:

        if (bcmerror)
                wlc->pub->bcmerror = bcmerror;

        return bcmerror;
}

/*
 * register watchdog and down handlers.
 */
int brcms_c_module_register(struct brcms_pub *pub,
                        const char *name, void *hdl,
                        watchdog_fn_t w_fn, down_fn_t d_fn)
{
        struct brcms_c_info *wlc = (struct brcms_c_info *) pub->wlc;
        int i;

        /* find an empty entry and just add, no duplication check! */
        for (i = 0; i < BRCMS_MAXMODULES; i++) {
                if (wlc->modulecb[i].name[0] == '\0') {
                        strncpy(wlc->modulecb[i].name, name,
                                sizeof(wlc->modulecb[i].name) - 1);
                        wlc->modulecb[i].hdl = hdl;
                        wlc->modulecb[i].watchdog_fn = w_fn;
                        wlc->modulecb[i].down_fn = d_fn;
                        return 0;
                }
        }

        return -ENOSR;
}

/* unregister module callbacks */
int
brcms_c_module_unregister(struct brcms_pub *pub, const char *name, void *hdl)
{
        struct brcms_c_info *wlc = (struct brcms_c_info *) pub->wlc;
        int i;

        if (wlc == NULL)
                return -ENODATA;

        for (i = 0; i < BRCMS_MAXMODULES; i++) {
                if (!strcmp(wlc->modulecb[i].name, name) &&
                    (wlc->modulecb[i].hdl == hdl)) {
                        memset(&wlc->modulecb[i], 0, sizeof(struct modulecb));
                        return 0;
                }
        }

        /* table not found! */
        return -ENODATA;
}

/* Write WME tunable parameters for retransmit/max rate from wlc struct to ucode */
static void brcms_c_wme_retries_write(struct brcms_c_info *wlc)
{
        int ac;

        /* Need clock to do this */
        if (!wlc->clk)
                return;

        for (ac = 0; ac < AC_COUNT; ac++) {
                brcms_c_write_shm(wlc, M_AC_TXLMT_ADDR(ac),
                                  wlc->wme_retries[ac]);
        }
}

#ifdef BCMDBG
static const char * const supr_reason[] = {
        "None", "PMQ Entry", "Flush request",
        "Previous frag failure", "Channel mismatch",
        "Lifetime Expiry", "Underflow"
};

static void brcms_c_print_txs_status(u16 s)
{
        printk(KERN_DEBUG "[15:12]  %d  frame attempts\n",
               (s & TX_STATUS_FRM_RTX_MASK) >> TX_STATUS_FRM_RTX_SHIFT);
        printk(KERN_DEBUG " [11:8]  %d  rts attempts\n",
               (s & TX_STATUS_RTS_RTX_MASK) >> TX_STATUS_RTS_RTX_SHIFT);
        printk(KERN_DEBUG "    [7]  %d  PM mode indicated\n",
               ((s & TX_STATUS_PMINDCTD) ? 1 : 0));
        printk(KERN_DEBUG "    [6]  %d  intermediate status\n",
               ((s & TX_STATUS_INTERMEDIATE) ? 1 : 0));
        printk(KERN_DEBUG "    [5]  %d  AMPDU\n",
               (s & TX_STATUS_AMPDU) ? 1 : 0);
        printk(KERN_DEBUG "  [4:2]  %d  Frame Suppressed Reason (%s)\n",
               ((s & TX_STATUS_SUPR_MASK) >> TX_STATUS_SUPR_SHIFT),
               supr_reason[(s & TX_STATUS_SUPR_MASK) >> TX_STATUS_SUPR_SHIFT]);
        printk(KERN_DEBUG "    [1]  %d  acked\n",
               ((s & TX_STATUS_ACK_RCV) ? 1 : 0));
}
#endif                          /* BCMDBG */

void brcms_c_print_txstatus(struct tx_status *txs)
{
#if defined(BCMDBG)
        u16 s = txs->status;
        u16 ackphyrxsh = txs->ackphyrxsh;

        printk(KERN_DEBUG "\ntxpkt (MPDU) Complete\n");

        printk(KERN_DEBUG "FrameID: %04x   ", txs->frameid);
        printk(KERN_DEBUG "TxStatus: %04x", s);
        printk(KERN_DEBUG "\n");

        brcms_c_print_txs_status(s);

        printk(KERN_DEBUG "LastTxTime: %04x ", txs->lasttxtime);
        printk(KERN_DEBUG "Seq: %04x ", txs->sequence);
        printk(KERN_DEBUG "PHYTxStatus: %04x ", txs->phyerr);
        printk(KERN_DEBUG "RxAckRSSI: %04x ",
               (ackphyrxsh & PRXS1_JSSI_MASK) >> PRXS1_JSSI_SHIFT);
        printk(KERN_DEBUG "RxAckSQ: %04x",
               (ackphyrxsh & PRXS1_SQ_MASK) >> PRXS1_SQ_SHIFT);
        printk(KERN_DEBUG "\n");
#endif                          /* defined(BCMDBG) */
}

void brcms_c_statsupd(struct brcms_c_info *wlc)
{
        int i;
        struct macstat macstats;
#ifdef BCMDBG
        u16 delta;
        u16 rxf0ovfl;
        u16 txfunfl[NFIFO];
#endif                          /* BCMDBG */

        /* if driver down, make no sense to update stats */
        if (!wlc->pub->up)
                return;

#ifdef BCMDBG
        /* save last rx fifo 0 overflow count */
        rxf0ovfl = wlc->core->macstat_snapshot->rxf0ovfl;

        /* save last tx fifo  underflow count */
        for (i = 0; i < NFIFO; i++)
                txfunfl[i] = wlc->core->macstat_snapshot->txfunfl[i];
#endif                          /* BCMDBG */

        /* Read mac stats from contiguous shared memory */
        brcms_b_copyfrom_shm(wlc->hw, M_UCODE_MACSTAT,
                             &macstats, sizeof(struct macstat));

#ifdef BCMDBG
        /* check for rx fifo 0 overflow */
        delta = (u16) (wlc->core->macstat_snapshot->rxf0ovfl - rxf0ovfl);
        if (delta)
                wiphy_err(wlc->wiphy, "wl%d: %u rx fifo 0 overflows!\n",
                          wlc->pub->unit, delta);

        /* check for tx fifo underflows */
        for (i = 0; i < NFIFO; i++) {
                delta =
                    (u16) (wlc->core->macstat_snapshot->txfunfl[i] -
                              txfunfl[i]);
                if (delta)
                        wiphy_err(wlc->wiphy, "wl%d: %u tx fifo %d underflows!"
                                  "\n", wlc->pub->unit, delta, i);
        }
#endif                          /* BCMDBG */

        /* merge counters from dma module */
        for (i = 0; i < NFIFO; i++) {
                if (wlc->hw->di[i]) {
                        dma_counterreset(wlc->hw->di[i]);
                }
        }
}

bool brcms_c_chipmatch(u16 vendor, u16 device)
{
        if (vendor != PCI_VENDOR_ID_BROADCOM) {
                pr_err("chipmatch: unknown vendor id %04x\n", vendor);
                return false;
        }

        if (device == BCM43224_D11N_ID_VEN1)
                return true;
        if ((device == BCM43224_D11N_ID) || (device == BCM43225_D11N2G_ID))
                return true;
        if (device == BCM4313_D11N2G_ID)
                return true;
        if ((device == BCM43236_D11N_ID) || (device == BCM43236_D11N2G_ID))
                return true;

        pr_err("chipmatch: unknown device id %04x\n", device);
        return false;
}

#if defined(BCMDBG)
void brcms_c_print_txdesc(struct d11txh *txh)
{
        u16 mtcl = le16_to_cpu(txh->MacTxControlLow);
        u16 mtch = le16_to_cpu(txh->MacTxControlHigh);
        u16 mfc = le16_to_cpu(txh->MacFrameControl);
        u16 tfest = le16_to_cpu(txh->TxFesTimeNormal);
        u16 ptcw = le16_to_cpu(txh->PhyTxControlWord);
        u16 ptcw_1 = le16_to_cpu(txh->PhyTxControlWord_1);
        u16 ptcw_1_Fbr = le16_to_cpu(txh->PhyTxControlWord_1_Fbr);
        u16 ptcw_1_Rts = le16_to_cpu(txh->PhyTxControlWord_1_Rts);
        u16 ptcw_1_FbrRts = le16_to_cpu(txh->PhyTxControlWord_1_FbrRts);
        u16 mainrates = le16_to_cpu(txh->MainRates);
        u16 xtraft = le16_to_cpu(txh->XtraFrameTypes);
        u8 *iv = txh->IV;
        u8 *ra = txh->TxFrameRA;
        u16 tfestfb = le16_to_cpu(txh->TxFesTimeFallback);
        u8 *rtspfb = txh->RTSPLCPFallback;
        u16 rtsdfb = le16_to_cpu(txh->RTSDurFallback);
        u8 *fragpfb = txh->FragPLCPFallback;
        u16 fragdfb = le16_to_cpu(txh->FragDurFallback);
        u16 mmodelen = le16_to_cpu(txh->MModeLen);
        u16 mmodefbrlen = le16_to_cpu(txh->MModeFbrLen);
        u16 tfid = le16_to_cpu(txh->TxFrameID);
        u16 txs = le16_to_cpu(txh->TxStatus);
        u16 mnmpdu = le16_to_cpu(txh->MaxNMpdus);
        u16 mabyte = le16_to_cpu(txh->MaxABytes_MRT);
        u16 mabyte_f = le16_to_cpu(txh->MaxABytes_FBR);
        u16 mmbyte = le16_to_cpu(txh->MinMBytes);

        u8 *rtsph = txh->RTSPhyHeader;
        struct ieee80211_rts rts = txh->rts_frame;
        char hexbuf[256];

        /* add plcp header along with txh descriptor */
        printk(KERN_DEBUG "Raw TxDesc + plcp header:\n");
        print_hex_dump_bytes("", DUMP_PREFIX_OFFSET,
                             txh, sizeof(struct d11txh) + 48);

        printk(KERN_DEBUG "TxCtlLow: %04x ", mtcl);
        printk(KERN_DEBUG "TxCtlHigh: %04x ", mtch);
        printk(KERN_DEBUG "FC: %04x ", mfc);
        printk(KERN_DEBUG "FES Time: %04x\n", tfest);