86 files changed, 4219 insertions, 1059 deletions
diff --git a/drivers/net/wireless/ath/ath9k/ar9002_hw.c b/drivers/net/wireless/ath/ath9k/ar9002_hw.c
index 44d9d8d56490..b54ab78fb092 100644
--- a/drivers/net/wireless/ath/ath9k/ar9002_hw.c
+++ b/drivers/net/wireless/ath/ath9k/ar9002_hw.c
@@ -303,17 +303,13 @@ static void ar9002_hw_init_mode_gain_regs(struct ath_hw *ah)
 * register as the other analog registers.  Hence the 9 writes.
 */
 static void ar9002_hw_configpcipowersave(struct ath_hw *ah,
-                                         int restore,
+                                         bool power_off)
-                                         int power_off)
 {
        u8 i;
        u32 val;
-        if (ah->is_pciexpress != true || ah->aspm_enabled != true)
-                return;
        /* Nothing to do on restore for 11N */
-        if (!restore) {
+        if (!power_off /* !restore */) {
                if (AR_SREV_9280_20_OR_LATER(ah)) {
                        /*
                         * AR9280 2.0 or later chips use SerDes values from the
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h b/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h
index a0aadaddd071..f2c6f2316a3b 100644
--- a/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h
+++ b/drivers/net/wireless/ath/ath9k/ar9003_2p2_initvals.h
@@ -636,7 +636,7 @@ static const u32 ar9300_2p2_baseband_postamble[][5] = {
        {0x00009e44, 0x02321e27, 0x02321e27, 0x02291e27, 0x02291e27},
        {0x00009e48, 0x5030201a, 0x5030201a, 0x50302012, 0x50302012},
        {0x00009fc8, 0x0003f000, 0x0003f000, 0x0001a000, 0x0001a000},
-        {0x0000a204, 0x000037c0, 0x000037c4, 0x000037c4, 0x000037c0},
+        {0x0000a204, 0x000036c0, 0x000036c4, 0x000036c4, 0x000036c0},
        {0x0000a208, 0x00000104, 0x00000104, 0x00000004, 0x00000004},
        {0x0000a22c, 0x01026a2f, 0x01026a2f, 0x01026a2f, 0x01026a2f},
        {0x0000a230, 0x0000000a, 0x00000014, 0x00000016, 0x0000000b},
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_calib.c b/drivers/net/wireless/ath/ath9k/ar9003_calib.c
index f48051c50092..fa35a0235f44 100644
--- a/drivers/net/wireless/ath/ath9k/ar9003_calib.c
+++ b/drivers/net/wireless/ath/ath9k/ar9003_calib.c
@@ -839,20 +839,8 @@ static bool ar9003_hw_init_cal(struct ath_hw *ah,
                               struct ath9k_channel *chan)
 {
        struct ath_common *common = ath9k_hw_common(ah);
-        struct ath9k_hw_capabilities *pCap = &ah->caps;
-        int val;
        bool txiqcal_done = false;
-        val = REG_READ(ah, AR_ENT_OTP);
-        ath_dbg(common, ATH_DBG_CALIBRATE, "ath9k: AR_ENT_OTP 0x%x\n", val);
-        /* Configure rx/tx chains before running AGC/TxiQ cals */
-        if (val & AR_ENT_OTP_CHAIN2_DISABLE)
-                ar9003_hw_set_chain_masks(ah, 0x3, 0x3);
-        else
-                ar9003_hw_set_chain_masks(ah, pCap->rx_chainmask,
-                                          pCap->tx_chainmask);
        /* Do Tx IQ Calibration */
        REG_RMW_FIELD(ah, AR_PHY_TX_IQCAL_CONTROL_1,
                      AR_PHY_TX_IQCAL_CONTROL_1_IQCORR_I_Q_COFF_DELPT,
@@ -887,9 +875,6 @@ static bool ar9003_hw_init_cal(struct ath_hw *ah,
        if (txiqcal_done)
                ar9003_hw_tx_iq_cal_post_proc(ah);
-        /* Revert chainmasks to their original values before NF cal */
-        ar9003_hw_set_chain_masks(ah, ah->rxchainmask, ah->txchainmask);
        ath9k_hw_start_nfcal(ah, true);
        /* Initialize list pointers */
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_hw.c b/drivers/net/wireless/ath/ath9k/ar9003_hw.c
index ad2bb2bf4e8a..b6839e695270 100644
--- a/drivers/net/wireless/ath/ath9k/ar9003_hw.c
+++ b/drivers/net/wireless/ath/ath9k/ar9003_hw.c
@@ -21,6 +21,7 @@
 #include "ar9340_initvals.h"
 #include "ar9330_1p1_initvals.h"
 #include "ar9330_1p2_initvals.h"
+#include "ar9580_1p0_initvals.h"
 /* General hardware code for the AR9003 hadware family */
@@ -253,6 +254,56 @@ static void ar9003_hw_init_mode_regs(struct ath_hw *ah)
                                ar9485_1_1_pcie_phy_clkreq_disable_L1,
                                ARRAY_SIZE(ar9485_1_1_pcie_phy_clkreq_disable_L1),
                                2);
+        } else if (AR_SREV_9580(ah)) {
+                /* mac */
+                INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
+                INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE],
+                                ar9580_1p0_mac_core,
+                                ARRAY_SIZE(ar9580_1p0_mac_core), 2);
+                INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
+                                ar9580_1p0_mac_postamble,
+                                ARRAY_SIZE(ar9580_1p0_mac_postamble), 5);
+                /* bb */
+                INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], NULL, 0, 0);
+                INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
+                                ar9580_1p0_baseband_core,
+                                ARRAY_SIZE(ar9580_1p0_baseband_core), 2);
+                INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
+                                ar9580_1p0_baseband_postamble,
+                                ARRAY_SIZE(ar9580_1p0_baseband_postamble), 5);
+                /* radio */
+                INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
+                INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
+                                ar9580_1p0_radio_core,
+                                ARRAY_SIZE(ar9580_1p0_radio_core), 2);
+                INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST],
+                                ar9580_1p0_radio_postamble,
+                                ARRAY_SIZE(ar9580_1p0_radio_postamble), 5);
+                /* soc */
+                INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
+                                ar9580_1p0_soc_preamble,
+                                ARRAY_SIZE(ar9580_1p0_soc_preamble), 2);
+                INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
+                INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
+                                ar9580_1p0_soc_postamble,
+                                ARRAY_SIZE(ar9580_1p0_soc_postamble), 5);
+                /* rx/tx gain */
+                INIT_INI_ARRAY(&ah->iniModesRxGain,
+                                ar9580_1p0_rx_gain_table,
+                                ARRAY_SIZE(ar9580_1p0_rx_gain_table), 2);
+                INIT_INI_ARRAY(&ah->iniModesTxGain,
+                                ar9580_1p0_low_ob_db_tx_gain_table,
+                                ARRAY_SIZE(ar9580_1p0_low_ob_db_tx_gain_table),
+                                5);
+                INIT_INI_ARRAY(&ah->iniModesAdditional,
+                                ar9580_1p0_modes_fast_clock,
+                                ARRAY_SIZE(ar9580_1p0_modes_fast_clock),
+                                3);
        } else {
                /* mac */
                INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
@@ -348,6 +399,11 @@ static void ar9003_tx_gain_table_apply(struct ath_hw *ah)
                                       ar9485_modes_lowest_ob_db_tx_gain_1_1,
                                       ARRAY_SIZE(ar9485_modes_lowest_ob_db_tx_gain_1_1),
                                       5);
+                else if (AR_SREV_9580(ah))
+                        INIT_INI_ARRAY(&ah->iniModesTxGain,
+                              ar9580_1p0_lowest_ob_db_tx_gain_table,
+                              ARRAY_SIZE(ar9580_1p0_lowest_ob_db_tx_gain_table),
+                              5);
                else
                        INIT_INI_ARRAY(&ah->iniModesTxGain,
                                       ar9300Modes_lowest_ob_db_tx_gain_table_2p2,
@@ -375,6 +431,11 @@ static void ar9003_tx_gain_table_apply(struct ath_hw *ah)
                                       ar9485Modes_high_ob_db_tx_gain_1_1,
                                       ARRAY_SIZE(ar9485Modes_high_ob_db_tx_gain_1_1),
                                       5);
+                else if (AR_SREV_9580(ah))
+                        INIT_INI_ARRAY(&ah->iniModesTxGain,
+                                ar9580_1p0_high_ob_db_tx_gain_table,
+                                ARRAY_SIZE(ar9580_1p0_high_ob_db_tx_gain_table),
+                                       5);
                else
                        INIT_INI_ARRAY(&ah->iniModesTxGain,
                                       ar9300Modes_high_ob_db_tx_gain_table_2p2,
@@ -402,6 +463,11 @@ static void ar9003_tx_gain_table_apply(struct ath_hw *ah)
                                       ar9485Modes_low_ob_db_tx_gain_1_1,
                                       ARRAY_SIZE(ar9485Modes_low_ob_db_tx_gain_1_1),
                                       5);
+                else if (AR_SREV_9580(ah))
+                        INIT_INI_ARRAY(&ah->iniModesTxGain,
+                                 ar9580_1p0_low_ob_db_tx_gain_table,
+                                 ARRAY_SIZE(ar9580_1p0_low_ob_db_tx_gain_table),
+                                 5);
                else
                        INIT_INI_ARRAY(&ah->iniModesTxGain,
                                       ar9300Modes_low_ob_db_tx_gain_table_2p2,
@@ -429,6 +495,11 @@ static void ar9003_tx_gain_table_apply(struct ath_hw *ah)
                                       ar9485Modes_high_power_tx_gain_1_1,
                                       ARRAY_SIZE(ar9485Modes_high_power_tx_gain_1_1),
                                       5);
+                else if (AR_SREV_9580(ah))
+                        INIT_INI_ARRAY(&ah->iniModesTxGain,
+                                ar9580_1p0_high_power_tx_gain_table,
+                                ARRAY_SIZE(ar9580_1p0_high_power_tx_gain_table),
+                                5);
                else
                        INIT_INI_ARRAY(&ah->iniModesTxGain,
                                       ar9300Modes_high_power_tx_gain_table_2p2,
@@ -463,6 +534,11 @@ static void ar9003_rx_gain_table_apply(struct ath_hw *ah)
                                       ar9485Common_wo_xlna_rx_gain_1_1,
                                       ARRAY_SIZE(ar9485Common_wo_xlna_rx_gain_1_1),
                                       2);
+                else if (AR_SREV_9580(ah))
+                        INIT_INI_ARRAY(&ah->iniModesRxGain,
+                                       ar9580_1p0_rx_gain_table,
+                                       ARRAY_SIZE(ar9580_1p0_rx_gain_table),
+                                       2);
                else
                        INIT_INI_ARRAY(&ah->iniModesRxGain,
                                       ar9300Common_rx_gain_table_2p2,
@@ -490,6 +566,11 @@ static void ar9003_rx_gain_table_apply(struct ath_hw *ah)
                                       ar9485Common_wo_xlna_rx_gain_1_1,
                                       ARRAY_SIZE(ar9485Common_wo_xlna_rx_gain_1_1),
                                       2);
+                else if (AR_SREV_9580(ah))
+                        INIT_INI_ARRAY(&ah->iniModesRxGain,
+                                   ar9580_1p0_wo_xlna_rx_gain_table,
+                                   ARRAY_SIZE(ar9580_1p0_wo_xlna_rx_gain_table),
+                                   2);
                else
                        INIT_INI_ARRAY(&ah->iniModesRxGain,
                                       ar9300Common_wo_xlna_rx_gain_table_2p2,
@@ -516,14 +597,10 @@ static void ar9003_hw_init_mode_gain_regs(struct ath_hw *ah)
 * register as the other analog registers.  Hence the 9 writes.
 */
 static void ar9003_hw_configpcipowersave(struct ath_hw *ah,
-                                         int restore,
+                                         bool power_off)
-                                         int power_off)
 {
-        if (ah->is_pciexpress != true || ah->aspm_enabled != true)
-                return;
        /* Nothing to do on restore for 11N */
-        if (!restore) {
+        if (!power_off /* !restore */) {
                /* set bit 19 to allow forcing of pcie core into L1 state */
                REG_SET_BIT(ah, AR_PCIE_PM_CTRL, AR_PCIE_PM_CTRL_ENA);
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_mac.c b/drivers/net/wireless/ath/ath9k/ar9003_mac.c
index 1aadc4757e67..8ace36e77399 100644
--- a/drivers/net/wireless/ath/ath9k/ar9003_mac.c
+++ b/drivers/net/wireless/ath/ath9k/ar9003_mac.c
@@ -253,8 +253,6 @@ static int ar9003_hw_proc_txdesc(struct ath_hw *ah, void *ds,
                return -EIO;
        }
-        if (status & AR_TxOpExceeded)
-                ts->ts_status |= ATH9K_TXERR_XTXOP;
        ts->ts_rateindex = MS(status, AR_FinalTxIdx);
        ts->ts_seqnum = MS(status, AR_SeqNum);
        ts->tid = MS(status, AR_TxTid);
@@ -264,6 +262,8 @@ static int ar9003_hw_proc_txdesc(struct ath_hw *ah, void *ds,
        ts->ts_status = 0;
        ts->ts_flags  = 0;
+        if (status & AR_TxOpExceeded)
+                ts->ts_status |= ATH9K_TXERR_XTXOP;
        status = ACCESS_ONCE(ads->status2);
        ts->ts_rssi_ctl0 = MS(status, AR_TxRSSIAnt00);
        ts->ts_rssi_ctl1 = MS(status, AR_TxRSSIAnt01);
@@ -415,36 +415,12 @@ static void ar9003_hw_set11n_ratescenario(struct ath_hw *ah, void *ds,
 static void ar9003_hw_set11n_aggr_first(struct ath_hw *ah, void *ds,
                                        u32 aggrLen)
 {
-#define FIRST_DESC_NDELIMS 60
        struct ar9003_txc *ads = (struct ar9003_txc *) ds;
        ads->ctl12 |= (AR_IsAggr | AR_MoreAggr);
-        if (ah->ent_mode & AR_ENT_OTP_MPSD) {
+        ads->ctl17 &= ~AR_AggrLen;
-                u32 ctl17, ndelim;
+        ads->ctl17 |= SM(aggrLen, AR_AggrLen);
-                /*
-                 * Add delimiter when using RTS/CTS with aggregation
-                 * and non enterprise AR9003 card
-                 */
-                ctl17 = ads->ctl17;
-                ndelim = MS(ctl17, AR_PadDelim);
-                if (ndelim < FIRST_DESC_NDELIMS) {
-                        aggrLen += (FIRST_DESC_NDELIMS - ndelim) * 4;
-                        ndelim = FIRST_DESC_NDELIMS;
-                }
-                ctl17 &= ~AR_AggrLen;
-                ctl17 |= SM(aggrLen, AR_AggrLen);
-                ctl17 &= ~AR_PadDelim;
-                ctl17 |= SM(ndelim, AR_PadDelim);
-                ads->ctl17 = ctl17;
-        } else {
-                ads->ctl17 &= ~AR_AggrLen;
-                ads->ctl17 |= SM(aggrLen, AR_AggrLen);
-        }
 }
 static void ar9003_hw_set11n_aggr_middle(struct ath_hw *ah, void *ds,
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_phy.c b/drivers/net/wireless/ath/ath9k/ar9003_phy.c
index a0aaa6855486..33edb5653ca6 100644
--- a/drivers/net/wireless/ath/ath9k/ar9003_phy.c
+++ b/drivers/net/wireless/ath/ath9k/ar9003_phy.c
@@ -482,7 +482,7 @@ static void ar9003_hw_set_channel_regs(struct ath_hw *ah,
                (REG_READ(ah, AR_PHY_GEN_CTRL) & AR_PHY_GC_ENABLE_DAC_FIFO);
        /* Enable 11n HT, 20 MHz */
-        phymode = AR_PHY_GC_HT_EN | AR_PHY_GC_SINGLE_HT_LTF1 | AR_PHY_GC_WALSH |
+        phymode = AR_PHY_GC_HT_EN | AR_PHY_GC_SINGLE_HT_LTF1 |
                  AR_PHY_GC_SHORT_GI_40 | enableDacFifo;
        /* Configure baseband for dynamic 20/40 operation */
@@ -540,7 +540,7 @@ static void ar9003_hw_init_bb(struct ath_hw *ah,
        udelay(synthDelay + BASE_ACTIVATE_DELAY);
 }
-void ar9003_hw_set_chain_masks(struct ath_hw *ah, u8 rx, u8 tx)
+static void ar9003_hw_set_chain_masks(struct ath_hw *ah, u8 rx, u8 tx)
 {
        switch (rx) {
        case 0x5:
diff --git a/drivers/net/wireless/ath/ath9k/ar9003_phy.h b/drivers/net/wireless/ath/ath9k/ar9003_phy.h
index 5c590429f120..80397de11e0d 100644
--- a/drivers/net/wireless/ath/ath9k/ar9003_phy.h
+++ b/drivers/net/wireless/ath/ath9k/ar9003_phy.h
@@ -1124,6 +1124,4 @@
 #define AR_PHY_CL_TAB_CL_GAIN_MOD               0x1f
 #define AR_PHY_CL_TAB_CL_GAIN_MOD_S             0
-void ar9003_hw_set_chain_masks(struct ath_hw *ah, u8 rx, u8 tx);
 #endif  /* AR9003_PHY_H */
diff --git a/drivers/net/wireless/ath/ath9k/ar9580_1p0_initvals.h b/drivers/net/wireless/ath/ath9k/ar9580_1p0_initvals.h
new file mode 100644
index 000000000000..06b3f0df9fad
--- /dev/null
+++ b/drivers/net/wireless/ath/ath9k/ar9580_1p0_initvals.h
@@ -0,0 +1,1673 @@
+/*
+ * Copyright (c) 2010 Atheros Communications Inc.
+ *
+ * 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.
+ */
+#ifndef INITVALS_9580_1P0_H
+#define INITVALS_9580_1P0_H
+/* AR9580 1.0 */
+static const u32 ar9580_1p0_modes_fast_clock[][3] = {
+        /* Addr      5G_HT20     5G_HT40   */
+        {0x00001030, 0x00000268, 0x000004d0},
+        {0x00001070, 0x0000018c, 0x00000318},
+        {0x000010b0, 0x00000fd0, 0x00001fa0},
+        {0x00008014, 0x044c044c, 0x08980898},
+        {0x0000801c, 0x148ec02b, 0x148ec057},
+        {0x00008318, 0x000044c0, 0x00008980},
+        {0x00009e00, 0x0372131c, 0x0372131c},
+        {0x0000a230, 0x0000000b, 0x00000016},
+        {0x0000a254, 0x00000898, 0x00001130},
+};
+static const u32 ar9580_1p0_radio_postamble[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x0001609c, 0x0dd08f29, 0x0dd08f29, 0x0b283f31, 0x0b283f31},
+        {0x000160ac, 0xa4653c00, 0xa4653c00, 0x24652800, 0x24652800},
+        {0x000160b0, 0x03284f3e, 0x03284f3e, 0x05d08f20, 0x05d08f20},
+        {0x0001610c, 0x08000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x00016140, 0x10804008, 0x10804008, 0x50804008, 0x50804008},
+        {0x0001650c, 0x08000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x00016540, 0x10804008, 0x10804008, 0x50804008, 0x50804008},
+        {0x0001690c, 0x08000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x00016940, 0x10804008, 0x10804008, 0x50804008, 0x50804008},
+};
+static const u32 ar9580_1p0_baseband_core[][2] = {
+        /* Addr      allmodes  */
+        {0x00009800, 0xafe68e30},
+        {0x00009804, 0xfd14e000},
+        {0x00009808, 0x9c0a9f6b},
+        {0x0000980c, 0x04900000},
+        {0x00009814, 0x3280c00a},
+        {0x00009818, 0x00000000},
+        {0x0000981c, 0x00020028},
+        {0x00009834, 0x6400a290},
+        {0x00009838, 0x0108ecff},
+        {0x0000983c, 0x0d000600},
+        {0x00009880, 0x201fff00},
+        {0x00009884, 0x00001042},
+        {0x000098a4, 0x00200400},
+        {0x000098b0, 0x32840bbe},
+        {0x000098d0, 0x004b6a8e},
+        {0x000098d4, 0x00000820},
+        {0x000098dc, 0x00000000},
+        {0x000098f0, 0x00000000},
+        {0x000098f4, 0x00000000},
+        {0x00009c04, 0xff55ff55},
+        {0x00009c08, 0x0320ff55},
+        {0x00009c0c, 0x00000000},
+        {0x00009c10, 0x00000000},
+        {0x00009c14, 0x00046384},
+        {0x00009c18, 0x05b6b440},
+        {0x00009c1c, 0x00b6b440},
+        {0x00009d00, 0xc080a333},
+        {0x00009d04, 0x40206c10},
+        {0x00009d08, 0x009c4060},
+        {0x00009d0c, 0x9883800a},
+        {0x00009d10, 0x01834061},
+        {0x00009d14, 0x00c0040b},
+        {0x00009d18, 0x00000000},
+        {0x00009e08, 0x0038230c},
+        {0x00009e24, 0x990bb515},
+        {0x00009e28, 0x0c6f0000},
+        {0x00009e30, 0x06336f77},
+        {0x00009e34, 0x6af6532f},
+        {0x00009e38, 0x0cc80c00},
+        {0x00009e40, 0x0d261820},
+        {0x00009e4c, 0x00001004},
+        {0x00009e50, 0x00ff03f1},
+        {0x00009e54, 0x00000000},
+        {0x00009fc0, 0x803e4788},
+        {0x00009fc4, 0x0001efb5},
+        {0x00009fcc, 0x40000014},
+        {0x00009fd0, 0x01193b93},
+        {0x0000a20c, 0x00000000},
+        {0x0000a220, 0x00000000},
+        {0x0000a224, 0x00000000},
+        {0x0000a228, 0x10002310},
+        {0x0000a23c, 0x00000000},
+        {0x0000a244, 0x0c000000},
+        {0x0000a2a0, 0x00000001},
+        {0x0000a2c0, 0x00000001},
+        {0x0000a2c8, 0x00000000},
+        {0x0000a2cc, 0x18c43433},
+        {0x0000a2d4, 0x00000000},
+        {0x0000a2ec, 0x00000000},
+        {0x0000a2f0, 0x00000000},
+        {0x0000a2f4, 0x00000000},
+        {0x0000a2f8, 0x00000000},
+        {0x0000a344, 0x00000000},
+        {0x0000a34c, 0x00000000},
+        {0x0000a350, 0x0000a000},
+        {0x0000a364, 0x00000000},
+        {0x0000a370, 0x00000000},
+        {0x0000a390, 0x00000001},
+        {0x0000a394, 0x00000444},
+        {0x0000a398, 0x001f0e0f},
+        {0x0000a39c, 0x0075393f},
+        {0x0000a3a0, 0xb79f6427},
+        {0x0000a3a4, 0x00000000},
+        {0x0000a3a8, 0xaaaaaaaa},
+        {0x0000a3ac, 0x3c466478},
+        {0x0000a3c0, 0x20202020},
+        {0x0000a3c4, 0x22222220},
+        {0x0000a3c8, 0x20200020},
+        {0x0000a3cc, 0x20202020},
+        {0x0000a3d0, 0x20202020},
+        {0x0000a3d4, 0x20202020},
+        {0x0000a3d8, 0x20202020},
+        {0x0000a3dc, 0x20202020},
+        {0x0000a3e0, 0x20202020},
+        {0x0000a3e4, 0x20202020},
+        {0x0000a3e8, 0x20202020},
+        {0x0000a3ec, 0x20202020},
+        {0x0000a3f0, 0x00000000},
+        {0x0000a3f4, 0x00000000},
+        {0x0000a3f8, 0x0c9bd380},
+        {0x0000a3fc, 0x000f0f01},
+        {0x0000a400, 0x8fa91f01},
+        {0x0000a404, 0x00000000},
+        {0x0000a408, 0x0e79e5c6},
+        {0x0000a40c, 0x00820820},
+        {0x0000a414, 0x1ce739ce},
+        {0x0000a418, 0x2d001dce},
+        {0x0000a41c, 0x1ce739ce},
+        {0x0000a420, 0x000001ce},
+        {0x0000a424, 0x1ce739ce},
+        {0x0000a428, 0x000001ce},
+        {0x0000a42c, 0x1ce739ce},
+        {0x0000a430, 0x1ce739ce},
+        {0x0000a434, 0x00000000},
+        {0x0000a438, 0x00001801},
+        {0x0000a43c, 0x00100000},
+        {0x0000a440, 0x00000000},
+        {0x0000a444, 0x00000000},
+        {0x0000a448, 0x05000080},
+        {0x0000a44c, 0x00000001},
+        {0x0000a450, 0x00010000},
+        {0x0000a458, 0x00000000},
+        {0x0000a640, 0x00000000},
+        {0x0000a644, 0x3fad9d74},
+        {0x0000a648, 0x0048060a},
+        {0x0000a64c, 0x00003c37},
+        {0x0000a670, 0x03020100},
+        {0x0000a674, 0x09080504},
+        {0x0000a678, 0x0d0c0b0a},
+        {0x0000a67c, 0x13121110},
+        {0x0000a680, 0x31301514},
+        {0x0000a684, 0x35343332},
+        {0x0000a688, 0x00000036},
+        {0x0000a690, 0x00000838},
+        {0x0000a7c0, 0x00000000},
+        {0x0000a7c4, 0xfffffffc},
+        {0x0000a7c8, 0x00000000},
+        {0x0000a7cc, 0x00000000},
+        {0x0000a7d0, 0x00000000},
+        {0x0000a7d4, 0x00000004},
+        {0x0000a7dc, 0x00000000},
+        {0x0000a8d0, 0x004b6a8e},
+        {0x0000a8d4, 0x00000820},
+        {0x0000a8dc, 0x00000000},
+        {0x0000a8f0, 0x00000000},
+        {0x0000a8f4, 0x00000000},
+        {0x0000b2d0, 0x00000080},
+        {0x0000b2d4, 0x00000000},
+        {0x0000b2ec, 0x00000000},
+        {0x0000b2f0, 0x00000000},
+        {0x0000b2f4, 0x00000000},
+        {0x0000b2f8, 0x00000000},
+        {0x0000b408, 0x0e79e5c0},
+        {0x0000b40c, 0x00820820},
+        {0x0000b420, 0x00000000},
+        {0x0000b8d0, 0x004b6a8e},
+        {0x0000b8d4, 0x00000820},
+        {0x0000b8dc, 0x00000000},
+        {0x0000b8f0, 0x00000000},
+        {0x0000b8f4, 0x00000000},
+        {0x0000c2d0, 0x00000080},
+        {0x0000c2d4, 0x00000000},
+        {0x0000c2ec, 0x00000000},
+        {0x0000c2f0, 0x00000000},
+        {0x0000c2f4, 0x00000000},
+        {0x0000c2f8, 0x00000000},
+        {0x0000c408, 0x0e79e5c0},
+        {0x0000c40c, 0x00820820},
+        {0x0000c420, 0x00000000},
+};
+static const u32 ar9580_1p0_mac_postamble[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x00001030, 0x00000230, 0x00000460, 0x000002c0, 0x00000160},
+        {0x00001070, 0x00000168, 0x000002d0, 0x00000318, 0x0000018c},
+        {0x000010b0, 0x00000e60, 0x00001cc0, 0x00007c70, 0x00003e38},
+        {0x00008014, 0x03e803e8, 0x07d007d0, 0x10801600, 0x08400b00},
+        {0x0000801c, 0x128d8027, 0x128d804f, 0x12e00057, 0x12e0002b},
+        {0x00008120, 0x08f04800, 0x08f04800, 0x08f04810, 0x08f04810},
+        {0x000081d0, 0x00003210, 0x00003210, 0x0000320a, 0x0000320a},
+        {0x00008318, 0x00003e80, 0x00007d00, 0x00006880, 0x00003440},
+};
+static const u32 ar9580_1p0_low_ob_db_tx_gain_table[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x0000a2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000a2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000a2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000a2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000a410, 0x000050d9, 0x000050d9, 0x000050d9, 0x000050d9},
+        {0x0000a500, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a504, 0x06000003, 0x06000003, 0x04000002, 0x04000002},
+        {0x0000a508, 0x0a000020, 0x0a000020, 0x08000004, 0x08000004},
+        {0x0000a50c, 0x10000023, 0x10000023, 0x0b000200, 0x0b000200},
+        {0x0000a510, 0x16000220, 0x16000220, 0x0f000202, 0x0f000202},
+        {0x0000a514, 0x1c000223, 0x1c000223, 0x12000400, 0x12000400},
+        {0x0000a518, 0x21002220, 0x21002220, 0x16000402, 0x16000402},
+        {0x0000a51c, 0x27002223, 0x27002223, 0x19000404, 0x19000404},
+        {0x0000a520, 0x2b022220, 0x2b022220, 0x1c000603, 0x1c000603},
+        {0x0000a524, 0x2f022222, 0x2f022222, 0x21000a02, 0x21000a02},
+        {0x0000a528, 0x34022225, 0x34022225, 0x25000a04, 0x25000a04},
+        {0x0000a52c, 0x3a02222a, 0x3a02222a, 0x28000a20, 0x28000a20},
+        {0x0000a530, 0x3e02222c, 0x3e02222c, 0x2c000e20, 0x2c000e20},
+        {0x0000a534, 0x4202242a, 0x4202242a, 0x30000e22, 0x30000e22},
+        {0x0000a538, 0x4702244a, 0x4702244a, 0x34000e24, 0x34000e24},
+        {0x0000a53c, 0x4b02244c, 0x4b02244c, 0x38001640, 0x38001640},
+        {0x0000a540, 0x4e02246c, 0x4e02246c, 0x3c001660, 0x3c001660},
+        {0x0000a544, 0x5302266c, 0x5302266c, 0x3f001861, 0x3f001861},
+        {0x0000a548, 0x5702286c, 0x5702286c, 0x43001a81, 0x43001a81},
+        {0x0000a54c, 0x5c02486b, 0x5c02486b, 0x47001a83, 0x47001a83},
+        {0x0000a550, 0x61024a6c, 0x61024a6c, 0x4a001c84, 0x4a001c84},
+        {0x0000a554, 0x66026a6c, 0x66026a6c, 0x4e001ce3, 0x4e001ce3},
+        {0x0000a558, 0x6b026e6c, 0x6b026e6c, 0x52001ce5, 0x52001ce5},
+        {0x0000a55c, 0x7002708c, 0x7002708c, 0x56001ce9, 0x56001ce9},
+        {0x0000a560, 0x7302b08a, 0x7302b08a, 0x5a001ceb, 0x5a001ceb},
+        {0x0000a564, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a568, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a56c, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a570, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a574, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a578, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a57c, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a580, 0x00800000, 0x00800000, 0x00800000, 0x00800000},
+        {0x0000a584, 0x06800003, 0x06800003, 0x04800002, 0x04800002},
+        {0x0000a588, 0x0a800020, 0x0a800020, 0x08800004, 0x08800004},
+        {0x0000a58c, 0x10800023, 0x10800023, 0x0b800200, 0x0b800200},
+        {0x0000a590, 0x16800220, 0x16800220, 0x0f800202, 0x0f800202},
+        {0x0000a594, 0x1c800223, 0x1c800223, 0x12800400, 0x12800400},
+        {0x0000a598, 0x21802220, 0x21802220, 0x16800402, 0x16800402},
+        {0x0000a59c, 0x27802223, 0x27802223, 0x19800404, 0x19800404},
+        {0x0000a5a0, 0x2b822220, 0x2b822220, 0x1c800603, 0x1c800603},
+        {0x0000a5a4, 0x2f822222, 0x2f822222, 0x21800a02, 0x21800a02},
+        {0x0000a5a8, 0x34822225, 0x34822225, 0x25800a04, 0x25800a04},
+        {0x0000a5ac, 0x3a82222a, 0x3a82222a, 0x28800a20, 0x28800a20},
+        {0x0000a5b0, 0x3e82222c, 0x3e82222c, 0x2c800e20, 0x2c800e20},
+        {0x0000a5b4, 0x4282242a, 0x4282242a, 0x30800e22, 0x30800e22},
+        {0x0000a5b8, 0x4782244a, 0x4782244a, 0x34800e24, 0x34800e24},
+        {0x0000a5bc, 0x4b82244c, 0x4b82244c, 0x38801640, 0x38801640},
+        {0x0000a5c0, 0x4e82246c, 0x4e82246c, 0x3c801660, 0x3c801660},
+        {0x0000a5c4, 0x5382266c, 0x5382266c, 0x3f801861, 0x3f801861},
+        {0x0000a5c8, 0x5782286c, 0x5782286c, 0x43801a81, 0x43801a81},
+        {0x0000a5cc, 0x5c82486b, 0x5c82486b, 0x47801a83, 0x47801a83},
+        {0x0000a5d0, 0x61824a6c, 0x61824a6c, 0x4a801c84, 0x4a801c84},
+        {0x0000a5d4, 0x66826a6c, 0x66826a6c, 0x4e801ce3, 0x4e801ce3},
+        {0x0000a5d8, 0x6b826e6c, 0x6b826e6c, 0x52801ce5, 0x52801ce5},
+        {0x0000a5dc, 0x7082708c, 0x7082708c, 0x56801ce9, 0x56801ce9},
+        {0x0000a5e0, 0x7382b08a, 0x7382b08a, 0x5a801ceb, 0x5a801ceb},
+        {0x0000a5e4, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5e8, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5ec, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f0, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f4, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f8, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5fc, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a600, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a604, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a608, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a60c, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a610, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a614, 0x01404000, 0x01404000, 0x01404000, 0x01404000},
+        {0x0000a618, 0x01404501, 0x01404501, 0x01404501, 0x01404501},
+        {0x0000a61c, 0x02008802, 0x02008802, 0x02008501, 0x02008501},
+        {0x0000a620, 0x0300cc03, 0x0300cc03, 0x0280ca03, 0x0280ca03},
+        {0x0000a624, 0x0300cc03, 0x0300cc03, 0x03010c04, 0x03010c04},
+        {0x0000a628, 0x0300cc03, 0x0300cc03, 0x04014c04, 0x04014c04},
+        {0x0000a62c, 0x03810c03, 0x03810c03, 0x04015005, 0x04015005},
+        {0x0000a630, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a634, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a638, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a63c, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000b2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000b2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000b2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000b2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000c2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000c2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000c2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000c2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x00016044, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016048, 0x66480001, 0x66480001, 0x66480001, 0x66480001},
+        {0x00016068, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016444, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016448, 0x66480001, 0x66480001, 0x66480001, 0x66480001},
+        {0x00016468, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016844, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016848, 0x66480001, 0x66480001, 0x66480001, 0x66480001},
+        {0x00016868, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+};
+static const u32 ar9580_1p0_high_power_tx_gain_table[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x0000a2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000a2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000a2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000a2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000a410, 0x000050d9, 0x000050d9, 0x000050d9, 0x000050d9},
+        {0x0000a500, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a504, 0x06000003, 0x06000003, 0x04000002, 0x04000002},
+        {0x0000a508, 0x0a000020, 0x0a000020, 0x08000004, 0x08000004},
+        {0x0000a50c, 0x10000023, 0x10000023, 0x0b000200, 0x0b000200},
+        {0x0000a510, 0x16000220, 0x16000220, 0x0f000202, 0x0f000202},
+        {0x0000a514, 0x1c000223, 0x1c000223, 0x12000400, 0x12000400},
+        {0x0000a518, 0x21002220, 0x21002220, 0x16000402, 0x16000402},
+        {0x0000a51c, 0x27002223, 0x27002223, 0x19000404, 0x19000404},
+        {0x0000a520, 0x2b022220, 0x2b022220, 0x1c000603, 0x1c000603},
+        {0x0000a524, 0x2f022222, 0x2f022222, 0x21000a02, 0x21000a02},
+        {0x0000a528, 0x34022225, 0x34022225, 0x25000a04, 0x25000a04},
+        {0x0000a52c, 0x3a02222a, 0x3a02222a, 0x28000a20, 0x28000a20},
+        {0x0000a530, 0x3e02222c, 0x3e02222c, 0x2c000e20, 0x2c000e20},
+        {0x0000a534, 0x4202242a, 0x4202242a, 0x30000e22, 0x30000e22},
+        {0x0000a538, 0x4702244a, 0x4702244a, 0x34000e24, 0x34000e24},
+        {0x0000a53c, 0x4b02244c, 0x4b02244c, 0x38001640, 0x38001640},
+        {0x0000a540, 0x4e02246c, 0x4e02246c, 0x3c001660, 0x3c001660},
+        {0x0000a544, 0x5302266c, 0x5302266c, 0x3f001861, 0x3f001861},
+        {0x0000a548, 0x5702286c, 0x5702286c, 0x43001a81, 0x43001a81},
+        {0x0000a54c, 0x5c02486b, 0x5c02486b, 0x47001a83, 0x47001a83},
+        {0x0000a550, 0x61024a6c, 0x61024a6c, 0x4a001c84, 0x4a001c84},
+        {0x0000a554, 0x66026a6c, 0x66026a6c, 0x4e001ce3, 0x4e001ce3},
+        {0x0000a558, 0x6b026e6c, 0x6b026e6c, 0x52001ce5, 0x52001ce5},
+        {0x0000a55c, 0x7002708c, 0x7002708c, 0x56001ce9, 0x56001ce9},
+        {0x0000a560, 0x7302b08a, 0x7302b08a, 0x5a001ceb, 0x5a001ceb},
+        {0x0000a564, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a568, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a56c, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a570, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a574, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a578, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a57c, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a580, 0x00800000, 0x00800000, 0x00800000, 0x00800000},
+        {0x0000a584, 0x06800003, 0x06800003, 0x04800002, 0x04800002},
+        {0x0000a588, 0x0a800020, 0x0a800020, 0x08800004, 0x08800004},
+        {0x0000a58c, 0x10800023, 0x10800023, 0x0b800200, 0x0b800200},
+        {0x0000a590, 0x16800220, 0x16800220, 0x0f800202, 0x0f800202},
+        {0x0000a594, 0x1c800223, 0x1c800223, 0x12800400, 0x12800400},
+        {0x0000a598, 0x21802220, 0x21802220, 0x16800402, 0x16800402},
+        {0x0000a59c, 0x27802223, 0x27802223, 0x19800404, 0x19800404},
+        {0x0000a5a0, 0x2b822220, 0x2b822220, 0x1c800603, 0x1c800603},
+        {0x0000a5a4, 0x2f822222, 0x2f822222, 0x21800a02, 0x21800a02},
+        {0x0000a5a8, 0x34822225, 0x34822225, 0x25800a04, 0x25800a04},
+        {0x0000a5ac, 0x3a82222a, 0x3a82222a, 0x28800a20, 0x28800a20},
+        {0x0000a5b0, 0x3e82222c, 0x3e82222c, 0x2c800e20, 0x2c800e20},
+        {0x0000a5b4, 0x4282242a, 0x4282242a, 0x30800e22, 0x30800e22},
+        {0x0000a5b8, 0x4782244a, 0x4782244a, 0x34800e24, 0x34800e24},
+        {0x0000a5bc, 0x4b82244c, 0x4b82244c, 0x38801640, 0x38801640},
+        {0x0000a5c0, 0x4e82246c, 0x4e82246c, 0x3c801660, 0x3c801660},
+        {0x0000a5c4, 0x5382266c, 0x5382266c, 0x3f801861, 0x3f801861},
+        {0x0000a5c8, 0x5782286c, 0x5782286c, 0x43801a81, 0x43801a81},
+        {0x0000a5cc, 0x5c82486b, 0x5c82486b, 0x47801a83, 0x47801a83},
+        {0x0000a5d0, 0x61824a6c, 0x61824a6c, 0x4a801c84, 0x4a801c84},
+        {0x0000a5d4, 0x66826a6c, 0x66826a6c, 0x4e801ce3, 0x4e801ce3},
+        {0x0000a5d8, 0x6b826e6c, 0x6b826e6c, 0x52801ce5, 0x52801ce5},
+        {0x0000a5dc, 0x7082708c, 0x7082708c, 0x56801ce9, 0x56801ce9},
+        {0x0000a5e0, 0x7382b08a, 0x7382b08a, 0x5a801ceb, 0x5a801ceb},
+        {0x0000a5e4, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5e8, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5ec, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f0, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f4, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f8, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5fc, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a600, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a604, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a608, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a60c, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a610, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a614, 0x01404000, 0x01404000, 0x01404000, 0x01404000},
+        {0x0000a618, 0x01404501, 0x01404501, 0x01404501, 0x01404501},
+        {0x0000a61c, 0x02008802, 0x02008802, 0x02008501, 0x02008501},
+        {0x0000a620, 0x0300cc03, 0x0300cc03, 0x0280ca03, 0x0280ca03},
+        {0x0000a624, 0x0300cc03, 0x0300cc03, 0x03010c04, 0x03010c04},
+        {0x0000a628, 0x0300cc03, 0x0300cc03, 0x04014c04, 0x04014c04},
+        {0x0000a62c, 0x03810c03, 0x03810c03, 0x04015005, 0x04015005},
+        {0x0000a630, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a634, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a638, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a63c, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000b2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000b2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000b2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000b2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000c2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000c2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000c2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000c2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x00016044, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016048, 0x66480001, 0x66480001, 0x66480001, 0x66480001},
+        {0x00016068, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016444, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016448, 0x66480001, 0x66480001, 0x66480001, 0x66480001},
+        {0x00016468, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016844, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016848, 0x66480001, 0x66480001, 0x66480001, 0x66480001},
+        {0x00016868, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+};
+static const u32 ar9580_1p0_lowest_ob_db_tx_gain_table[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x0000a2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000a2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000a2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000a2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000a410, 0x000050d9, 0x000050d9, 0x000050d9, 0x000050d9},
+        {0x0000a500, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a504, 0x06000003, 0x06000003, 0x04000002, 0x04000002},
+        {0x0000a508, 0x0a000020, 0x0a000020, 0x08000004, 0x08000004},
+        {0x0000a50c, 0x10000023, 0x10000023, 0x0b000200, 0x0b000200},
+        {0x0000a510, 0x16000220, 0x16000220, 0x0f000202, 0x0f000202},
+        {0x0000a514, 0x1c000223, 0x1c000223, 0x12000400, 0x12000400},
+        {0x0000a518, 0x21002220, 0x21002220, 0x16000402, 0x16000402},
+        {0x0000a51c, 0x27002223, 0x27002223, 0x19000404, 0x19000404},
+        {0x0000a520, 0x2b022220, 0x2b022220, 0x1c000603, 0x1c000603},
+        {0x0000a524, 0x2f022222, 0x2f022222, 0x21000a02, 0x21000a02},
+        {0x0000a528, 0x34022225, 0x34022225, 0x25000a04, 0x25000a04},
+        {0x0000a52c, 0x3a02222a, 0x3a02222a, 0x28000a20, 0x28000a20},
+        {0x0000a530, 0x3e02222c, 0x3e02222c, 0x2c000e20, 0x2c000e20},
+        {0x0000a534, 0x4202242a, 0x4202242a, 0x30000e22, 0x30000e22},
+        {0x0000a538, 0x4702244a, 0x4702244a, 0x34000e24, 0x34000e24},
+        {0x0000a53c, 0x4b02244c, 0x4b02244c, 0x38001640, 0x38001640},
+        {0x0000a540, 0x4e02246c, 0x4e02246c, 0x3c001660, 0x3c001660},
+        {0x0000a544, 0x5302266c, 0x5302266c, 0x3f001861, 0x3f001861},
+        {0x0000a548, 0x5702286c, 0x5702286c, 0x43001a81, 0x43001a81},
+        {0x0000a54c, 0x5c02486b, 0x5c02486b, 0x47001a83, 0x47001a83},
+        {0x0000a550, 0x61024a6c, 0x61024a6c, 0x4a001c84, 0x4a001c84},
+        {0x0000a554, 0x66026a6c, 0x66026a6c, 0x4e001ce3, 0x4e001ce3},
+        {0x0000a558, 0x6b026e6c, 0x6b026e6c, 0x52001ce5, 0x52001ce5},
+        {0x0000a55c, 0x7002708c, 0x7002708c, 0x56001ce9, 0x56001ce9},
+        {0x0000a560, 0x7302b08a, 0x7302b08a, 0x5a001ceb, 0x5a001ceb},
+        {0x0000a564, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a568, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a56c, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a570, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a574, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a578, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a57c, 0x7702b08c, 0x7702b08c, 0x5d001eec, 0x5d001eec},
+        {0x0000a580, 0x00800000, 0x00800000, 0x00800000, 0x00800000},
+        {0x0000a584, 0x06800003, 0x06800003, 0x04800002, 0x04800002},
+        {0x0000a588, 0x0a800020, 0x0a800020, 0x08800004, 0x08800004},
+        {0x0000a58c, 0x10800023, 0x10800023, 0x0b800200, 0x0b800200},
+        {0x0000a590, 0x16800220, 0x16800220, 0x0f800202, 0x0f800202},
+        {0x0000a594, 0x1c800223, 0x1c800223, 0x12800400, 0x12800400},
+        {0x0000a598, 0x21802220, 0x21802220, 0x16800402, 0x16800402},
+        {0x0000a59c, 0x27802223, 0x27802223, 0x19800404, 0x19800404},
+        {0x0000a5a0, 0x2b822220, 0x2b822220, 0x1c800603, 0x1c800603},
+        {0x0000a5a4, 0x2f822222, 0x2f822222, 0x21800a02, 0x21800a02},
+        {0x0000a5a8, 0x34822225, 0x34822225, 0x25800a04, 0x25800a04},
+        {0x0000a5ac, 0x3a82222a, 0x3a82222a, 0x28800a20, 0x28800a20},
+        {0x0000a5b0, 0x3e82222c, 0x3e82222c, 0x2c800e20, 0x2c800e20},
+        {0x0000a5b4, 0x4282242a, 0x4282242a, 0x30800e22, 0x30800e22},
+        {0x0000a5b8, 0x4782244a, 0x4782244a, 0x34800e24, 0x34800e24},
+        {0x0000a5bc, 0x4b82244c, 0x4b82244c, 0x38801640, 0x38801640},
+        {0x0000a5c0, 0x4e82246c, 0x4e82246c, 0x3c801660, 0x3c801660},
+        {0x0000a5c4, 0x5382266c, 0x5382266c, 0x3f801861, 0x3f801861},
+        {0x0000a5c8, 0x5782286c, 0x5782286c, 0x43801a81, 0x43801a81},
+        {0x0000a5cc, 0x5c82486b, 0x5c82486b, 0x47801a83, 0x47801a83},
+        {0x0000a5d0, 0x61824a6c, 0x61824a6c, 0x4a801c84, 0x4a801c84},
+        {0x0000a5d4, 0x66826a6c, 0x66826a6c, 0x4e801ce3, 0x4e801ce3},
+        {0x0000a5d8, 0x6b826e6c, 0x6b826e6c, 0x52801ce5, 0x52801ce5},
+        {0x0000a5dc, 0x7082708c, 0x7082708c, 0x56801ce9, 0x56801ce9},
+        {0x0000a5e0, 0x7382b08a, 0x7382b08a, 0x5a801ceb, 0x5a801ceb},
+        {0x0000a5e4, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5e8, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5ec, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f0, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f4, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5f8, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a5fc, 0x7782b08c, 0x7782b08c, 0x5d801eec, 0x5d801eec},
+        {0x0000a600, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a604, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a608, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a60c, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a610, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a614, 0x01404000, 0x01404000, 0x01404000, 0x01404000},
+        {0x0000a618, 0x01404501, 0x01404501, 0x01404501, 0x01404501},
+        {0x0000a61c, 0x02008802, 0x02008802, 0x02008501, 0x02008501},
+        {0x0000a620, 0x0300cc03, 0x0300cc03, 0x0280ca03, 0x0280ca03},
+        {0x0000a624, 0x0300cc03, 0x0300cc03, 0x03010c04, 0x03010c04},
+        {0x0000a628, 0x0300cc03, 0x0300cc03, 0x04014c04, 0x04014c04},
+        {0x0000a62c, 0x03810c03, 0x03810c03, 0x04015005, 0x04015005},
+        {0x0000a630, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a634, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a638, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a63c, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000b2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000b2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000b2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000b2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000c2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000c2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000c2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000c2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x00016044, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016048, 0x62480001, 0x62480001, 0x62480001, 0x62480001},
+        {0x00016068, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016444, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016448, 0x62480001, 0x62480001, 0x62480001, 0x62480001},
+        {0x00016468, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016844, 0x012492d4, 0x012492d4, 0x012492d4, 0x012492d4},
+        {0x00016848, 0x62480001, 0x62480001, 0x62480001, 0x62480001},
+        {0x00016868, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+};
+static const u32 ar9580_1p0_baseband_core_txfir_coeff_japan_2484[][2] = {
+        /* Addr      allmodes  */
+        {0x0000a398, 0x00000000},
+        {0x0000a39c, 0x6f7f0301},
+        {0x0000a3a0, 0xca9228ee},
+};
+static const u32 ar9580_1p0_mac_core[][2] = {
+        /* Addr      allmodes  */
+        {0x00000008, 0x00000000},
+        {0x00000030, 0x00020085},
+        {0x00000034, 0x00000005},
+        {0x00000040, 0x00000000},
+        {0x00000044, 0x00000000},
+        {0x00000048, 0x00000008},
+        {0x0000004c, 0x00000010},
+        {0x00000050, 0x00000000},
+        {0x00001040, 0x002ffc0f},
+        {0x00001044, 0x002ffc0f},
+        {0x00001048, 0x002ffc0f},
+        {0x0000104c, 0x002ffc0f},
+        {0x00001050, 0x002ffc0f},
+        {0x00001054, 0x002ffc0f},
+        {0x00001058, 0x002ffc0f},
+        {0x0000105c, 0x002ffc0f},
+        {0x00001060, 0x002ffc0f},
+        {0x00001064, 0x002ffc0f},
+        {0x000010f0, 0x00000100},
+        {0x00001270, 0x00000000},
+        {0x000012b0, 0x00000000},
+        {0x000012f0, 0x00000000},
+        {0x0000143c, 0x00000000},
+        {0x0000147c, 0x00000000},
+        {0x00008000, 0x00000000},
+        {0x00008004, 0x00000000},
+        {0x00008008, 0x00000000},
+        {0x0000800c, 0x00000000},
+        {0x00008018, 0x00000000},
+        {0x00008020, 0x00000000},
+        {0x00008038, 0x00000000},
+        {0x0000803c, 0x00000000},
+        {0x00008040, 0x00000000},
+        {0x00008044, 0x00000000},
+        {0x00008048, 0x00000000},
+        {0x0000804c, 0xffffffff},
+        {0x00008054, 0x00000000},
+        {0x00008058, 0x00000000},
+        {0x0000805c, 0x000fc78f},
+        {0x00008060, 0x0000000f},
+        {0x00008064, 0x00000000},
+        {0x00008070, 0x00000310},
+        {0x00008074, 0x00000020},
+        {0x00008078, 0x00000000},
+        {0x0000809c, 0x0000000f},
+        {0x000080a0, 0x00000000},
+        {0x000080a4, 0x02ff0000},
+        {0x000080a8, 0x0e070605},
+        {0x000080ac, 0x0000000d},
+        {0x000080b0, 0x00000000},
+        {0x000080b4, 0x00000000},
+        {0x000080b8, 0x00000000},
+        {0x000080bc, 0x00000000},
+        {0x000080c0, 0x2a800000},
+        {0x000080c4, 0x06900168},
+        {0x000080c8, 0x13881c22},
+        {0x000080cc, 0x01f40000},
+        {0x000080d0, 0x00252500},
+        {0x000080d4, 0x00a00000},
+        {0x000080d8, 0x00400000},
+        {0x000080dc, 0x00000000},
+        {0x000080e0, 0xffffffff},
+        {0x000080e4, 0x0000ffff},
+        {0x000080e8, 0x3f3f3f3f},
+        {0x000080ec, 0x00000000},
+        {0x000080f0, 0x00000000},
+        {0x000080f4, 0x00000000},
+        {0x000080fc, 0x00020000},
+        {0x00008100, 0x00000000},
+        {0x00008108, 0x00000052},
+        {0x0000810c, 0x00000000},
+        {0x00008110, 0x00000000},
+        {0x00008114, 0x000007ff},
+        {0x00008118, 0x000000aa},
+        {0x0000811c, 0x00003210},
+        {0x00008124, 0x00000000},
+        {0x00008128, 0x00000000},
+        {0x0000812c, 0x00000000},
+        {0x00008130, 0x00000000},
+        {0x00008134, 0x00000000},
+        {0x00008138, 0x00000000},
+        {0x0000813c, 0x0000ffff},
+        {0x00008144, 0xffffffff},
+        {0x00008168, 0x00000000},
+        {0x0000816c, 0x00000000},
+        {0x000081c0, 0x00000000},
+        {0x000081c4, 0x33332210},
+        {0x000081ec, 0x00000000},
+        {0x000081f0, 0x00000000},
+        {0x000081f4, 0x00000000},
+        {0x000081f8, 0x00000000},
+        {0x000081fc, 0x00000000},
+        {0x00008240, 0x00100000},
+        {0x00008244, 0x0010f400},
+        {0x00008248, 0x00000800},
+        {0x0000824c, 0x0001e800},
+        {0x00008250, 0x00000000},
+        {0x00008254, 0x00000000},
+        {0x00008258, 0x00000000},
+        {0x0000825c, 0x40000000},
+        {0x00008260, 0x00080922},
+        {0x00008264, 0x9bc00010},
+        {0x00008268, 0xffffffff},
+        {0x0000826c, 0x0000ffff},
+        {0x00008270, 0x00000000},
+        {0x00008274, 0x40000000},
+        {0x00008278, 0x003e4180},
+        {0x0000827c, 0x00000004},
+        {0x00008284, 0x0000002c},
+        {0x00008288, 0x0000002c},
+        {0x0000828c, 0x000000ff},
+        {0x00008294, 0x00000000},
+        {0x00008298, 0x00000000},
+        {0x0000829c, 0x00000000},
+        {0x00008300, 0x00000140},
+        {0x00008314, 0x00000000},
+        {0x0000831c, 0x0000010d},
+        {0x00008328, 0x00000000},
+        {0x0000832c, 0x00000007},
+        {0x00008330, 0x00000302},
+        {0x00008334, 0x00000700},
+        {0x00008338, 0x00ff0000},
+        {0x0000833c, 0x02400000},
+        {0x00008340, 0x000107ff},
+        {0x00008344, 0xaa48105b},
+        {0x00008348, 0x008f0000},
+        {0x0000835c, 0x00000000},
+        {0x00008360, 0xffffffff},
+        {0x00008364, 0xffffffff},
+        {0x00008368, 0x00000000},
+        {0x00008370, 0x00000000},
+        {0x00008374, 0x000000ff},
+        {0x00008378, 0x00000000},
+        {0x0000837c, 0x00000000},
+        {0x00008380, 0xffffffff},
+        {0x00008384, 0xffffffff},
+        {0x00008390, 0xffffffff},
+        {0x00008394, 0xffffffff},
+        {0x00008398, 0x00000000},
+        {0x0000839c, 0x00000000},
+        {0x000083a0, 0x00000000},
+        {0x000083a4, 0x0000fa14},
+        {0x000083a8, 0x000f0c00},
+        {0x000083ac, 0x33332210},
+        {0x000083b0, 0x33332210},
+        {0x000083b4, 0x33332210},
+        {0x000083b8, 0x33332210},
+        {0x000083bc, 0x00000000},
+        {0x000083c0, 0x00000000},
+        {0x000083c4, 0x00000000},
+        {0x000083c8, 0x00000000},
+        {0x000083cc, 0x00000200},
+        {0x000083d0, 0x000301ff},
+};
+static const u32 ar9580_1p0_mixed_ob_db_tx_gain_table[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x0000a2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000a2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000a2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000a2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000a410, 0x000050d9, 0x000050d9, 0x000050d9, 0x000050d9},
+        {0x0000a500, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a504, 0x06000003, 0x06000003, 0x04000002, 0x04000002},
+        {0x0000a508, 0x0a000020, 0x0a000020, 0x08000004, 0x08000004},
+        {0x0000a50c, 0x10000023, 0x10000023, 0x0b000200, 0x0b000200},
+        {0x0000a510, 0x16000220, 0x16000220, 0x0f000202, 0x0f000202},
+        {0x0000a514, 0x1c000223, 0x1c000223, 0x11000400, 0x11000400},
+        {0x0000a518, 0x21002220, 0x21002220, 0x15000402, 0x15000402},
+        {0x0000a51c, 0x27002223, 0x27002223, 0x19000404, 0x19000404},
+        {0x0000a520, 0x2b022220, 0x2b022220, 0x1b000603, 0x1b000603},
+        {0x0000a524, 0x2f022222, 0x2f022222, 0x1f000a02, 0x1f000a02},
+        {0x0000a528, 0x34022225, 0x34022225, 0x23000a04, 0x23000a04},
+        {0x0000a52c, 0x3a02222a, 0x3a02222a, 0x26000a20, 0x26000a20},
+        {0x0000a530, 0x3e02222c, 0x3e02222c, 0x2a000e20, 0x2a000e20},
+        {0x0000a534, 0x4202242a, 0x4202242a, 0x2e000e22, 0x2e000e22},
+        {0x0000a538, 0x4702244a, 0x4702244a, 0x31000e24, 0x31000e24},
+        {0x0000a53c, 0x4b02244c, 0x4b02244c, 0x34001640, 0x34001640},
+        {0x0000a540, 0x4e02246c, 0x4e02246c, 0x38001660, 0x38001660},
+        {0x0000a544, 0x5302266c, 0x5302266c, 0x3b001861, 0x3b001861},
+        {0x0000a548, 0x5702286c, 0x5702286c, 0x3e001a81, 0x3e001a81},
+        {0x0000a54c, 0x5c02486b, 0x5c02486b, 0x42001a83, 0x42001a83},
+        {0x0000a550, 0x61024a6c, 0x61024a6c, 0x44001c84, 0x44001c84},
+        {0x0000a554, 0x66026a6c, 0x66026a6c, 0x48001ce3, 0x48001ce3},
+        {0x0000a558, 0x6b026e6c, 0x6b026e6c, 0x4c001ce5, 0x4c001ce5},
+        {0x0000a55c, 0x7002708c, 0x7002708c, 0x50001ce9, 0x50001ce9},
+        {0x0000a560, 0x7302b08a, 0x7302b08a, 0x54001ceb, 0x54001ceb},
+        {0x0000a564, 0x7702b08c, 0x7702b08c, 0x56001eec, 0x56001eec},
+        {0x0000a568, 0x7702b08c, 0x7702b08c, 0x56001eec, 0x56001eec},
+        {0x0000a56c, 0x7702b08c, 0x7702b08c, 0x56001eec, 0x56001eec},
+        {0x0000a570, 0x7702b08c, 0x7702b08c, 0x56001eec, 0x56001eec},
+        {0x0000a574, 0x7702b08c, 0x7702b08c, 0x56001eec, 0x56001eec},
+        {0x0000a578, 0x7702b08c, 0x7702b08c, 0x56001eec, 0x56001eec},
+        {0x0000a57c, 0x7702b08c, 0x7702b08c, 0x56001eec, 0x56001eec},
+        {0x0000a580, 0x00800000, 0x00800000, 0x00800000, 0x00800000},
+        {0x0000a584, 0x06800003, 0x06800003, 0x04800002, 0x04800002},
+        {0x0000a588, 0x0a800020, 0x0a800020, 0x08800004, 0x08800004},
+        {0x0000a58c, 0x10800023, 0x10800023, 0x0b800200, 0x0b800200},
+        {0x0000a590, 0x16800220, 0x16800220, 0x0f800202, 0x0f800202},
+        {0x0000a594, 0x1c800223, 0x1c800223, 0x11800400, 0x11800400},
+        {0x0000a598, 0x21802220, 0x21802220, 0x15800402, 0x15800402},
+        {0x0000a59c, 0x27802223, 0x27802223, 0x19800404, 0x19800404},
+        {0x0000a5a0, 0x2b822220, 0x2b822220, 0x1b800603, 0x1b800603},
+        {0x0000a5a4, 0x2f822222, 0x2f822222, 0x1f800a02, 0x1f800a02},
+        {0x0000a5a8, 0x34822225, 0x34822225, 0x23800a04, 0x23800a04},
+        {0x0000a5ac, 0x3a82222a, 0x3a82222a, 0x26800a20, 0x26800a20},
+        {0x0000a5b0, 0x3e82222c, 0x3e82222c, 0x2a800e20, 0x2a800e20},
+        {0x0000a5b4, 0x4282242a, 0x4282242a, 0x2e800e22, 0x2e800e22},
+        {0x0000a5b8, 0x4782244a, 0x4782244a, 0x31800e24, 0x31800e24},
+        {0x0000a5bc, 0x4b82244c, 0x4b82244c, 0x34801640, 0x34801640},
+        {0x0000a5c0, 0x4e82246c, 0x4e82246c, 0x38801660, 0x38801660},
+        {0x0000a5c4, 0x5382266c, 0x5382266c, 0x3b801861, 0x3b801861},
+        {0x0000a5c8, 0x5782286c, 0x5782286c, 0x3e801a81, 0x3e801a81},
+        {0x0000a5cc, 0x5c82486b, 0x5c82486b, 0x42801a83, 0x42801a83},
+        {0x0000a5d0, 0x61824a6c, 0x61824a6c, 0x44801c84, 0x44801c84},
+        {0x0000a5d4, 0x66826a6c, 0x66826a6c, 0x48801ce3, 0x48801ce3},
+        {0x0000a5d8, 0x6b826e6c, 0x6b826e6c, 0x4c801ce5, 0x4c801ce5},
+        {0x0000a5dc, 0x7082708c, 0x7082708c, 0x50801ce9, 0x50801ce9},
+        {0x0000a5e0, 0x7382b08a, 0x7382b08a, 0x54801ceb, 0x54801ceb},
+        {0x0000a5e4, 0x7782b08c, 0x7782b08c, 0x56801eec, 0x56801eec},
+        {0x0000a5e8, 0x7782b08c, 0x7782b08c, 0x56801eec, 0x56801eec},
+        {0x0000a5ec, 0x7782b08c, 0x7782b08c, 0x56801eec, 0x56801eec},
+        {0x0000a5f0, 0x7782b08c, 0x7782b08c, 0x56801eec, 0x56801eec},
+        {0x0000a5f4, 0x7782b08c, 0x7782b08c, 0x56801eec, 0x56801eec},
+        {0x0000a5f8, 0x7782b08c, 0x7782b08c, 0x56801eec, 0x56801eec},
+        {0x0000a5fc, 0x7782b08c, 0x7782b08c, 0x56801eec, 0x56801eec},
+        {0x0000a600, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a604, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a608, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a60c, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a610, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a614, 0x01404000, 0x01404000, 0x01404000, 0x01404000},
+        {0x0000a618, 0x01404501, 0x01404501, 0x01404501, 0x01404501},
+        {0x0000a61c, 0x02008802, 0x02008802, 0x02008501, 0x02008501},
+        {0x0000a620, 0x0300cc03, 0x0300cc03, 0x0280ca03, 0x0280ca03},
+        {0x0000a624, 0x0300cc03, 0x0300cc03, 0x03010c04, 0x03010c04},
+        {0x0000a628, 0x0300cc03, 0x0300cc03, 0x04014c04, 0x04014c04},
+        {0x0000a62c, 0x03810c03, 0x03810c03, 0x04015005, 0x04015005},
+        {0x0000a630, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a634, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a638, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000a63c, 0x03810e04, 0x03810e04, 0x04015005, 0x04015005},
+        {0x0000b2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000b2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000b2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000b2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000c2dc, 0x0380c7fc, 0x0380c7fc, 0x03aaa352, 0x03aaa352},
+        {0x0000c2e0, 0x0000f800, 0x0000f800, 0x03ccc584, 0x03ccc584},
+        {0x0000c2e4, 0x03ff0000, 0x03ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000c2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x00016044, 0x012492d4, 0x012492d4, 0x056db2e4, 0x056db2e4},
+        {0x00016048, 0x66480001, 0x66480001, 0x8e480001, 0x8e480001},
+        {0x00016068, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016444, 0x012492d4, 0x012492d4, 0x056db2e4, 0x056db2e4},
+        {0x00016448, 0x66480001, 0x66480001, 0x8e480001, 0x8e480001},
+        {0x00016468, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016844, 0x012492d4, 0x012492d4, 0x056db2e4, 0x056db2e4},
+        {0x00016848, 0x66480001, 0x66480001, 0x8e480001, 0x8e480001},
+        {0x00016868, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+};
+static const u32 ar9580_1p0_wo_xlna_rx_gain_table[][2] = {
+        /* Addr      allmodes  */
+        {0x0000a000, 0x00010000},
+        {0x0000a004, 0x00030002},
+        {0x0000a008, 0x00050004},
+        {0x0000a00c, 0x00810080},
+        {0x0000a010, 0x00830082},
+        {0x0000a014, 0x01810180},
+        {0x0000a018, 0x01830182},
+        {0x0000a01c, 0x01850184},
+        {0x0000a020, 0x01890188},
+        {0x0000a024, 0x018b018a},
+        {0x0000a028, 0x018d018c},
+        {0x0000a02c, 0x03820190},
+        {0x0000a030, 0x03840383},
+        {0x0000a034, 0x03880385},
+        {0x0000a038, 0x038a0389},
+        {0x0000a03c, 0x038c038b},
+        {0x0000a040, 0x0390038d},
+        {0x0000a044, 0x03920391},
+        {0x0000a048, 0x03940393},
+        {0x0000a04c, 0x03960395},
+        {0x0000a050, 0x00000000},
+        {0x0000a054, 0x00000000},
+        {0x0000a058, 0x00000000},
+        {0x0000a05c, 0x00000000},
+        {0x0000a060, 0x00000000},
+        {0x0000a064, 0x00000000},
+        {0x0000a068, 0x00000000},
+        {0x0000a06c, 0x00000000},
+        {0x0000a070, 0x00000000},
+        {0x0000a074, 0x00000000},
+        {0x0000a078, 0x00000000},
+        {0x0000a07c, 0x00000000},
+        {0x0000a080, 0x29292929},
+        {0x0000a084, 0x29292929},
+        {0x0000a088, 0x29292929},
+        {0x0000a08c, 0x29292929},
+        {0x0000a090, 0x22292929},
+        {0x0000a094, 0x1d1d2222},
+        {0x0000a098, 0x0c111117},
+        {0x0000a09c, 0x00030303},
+        {0x0000a0a0, 0x00000000},
+        {0x0000a0a4, 0x00000000},
+        {0x0000a0a8, 0x00000000},
+        {0x0000a0ac, 0x00000000},
+        {0x0000a0b0, 0x00000000},
+        {0x0000a0b4, 0x00000000},
+        {0x0000a0b8, 0x00000000},
+        {0x0000a0bc, 0x00000000},
+        {0x0000a0c0, 0x001f0000},
+        {0x0000a0c4, 0x01000101},
+        {0x0000a0c8, 0x011e011f},
+        {0x0000a0cc, 0x011c011d},
+        {0x0000a0d0, 0x02030204},
+        {0x0000a0d4, 0x02010202},
+        {0x0000a0d8, 0x021f0200},
+        {0x0000a0dc, 0x0302021e},
+        {0x0000a0e0, 0x03000301},
+        {0x0000a0e4, 0x031e031f},
+        {0x0000a0e8, 0x0402031d},
+        {0x0000a0ec, 0x04000401},
+        {0x0000a0f0, 0x041e041f},
+        {0x0000a0f4, 0x0502041d},
+        {0x0000a0f8, 0x05000501},
+        {0x0000a0fc, 0x051e051f},
+        {0x0000a100, 0x06010602},
+        {0x0000a104, 0x061f0600},
+        {0x0000a108, 0x061d061e},
+        {0x0000a10c, 0x07020703},
+        {0x0000a110, 0x07000701},
+        {0x0000a114, 0x00000000},
+        {0x0000a118, 0x00000000},
+        {0x0000a11c, 0x00000000},
+        {0x0000a120, 0x00000000},
+        {0x0000a124, 0x00000000},
+        {0x0000a128, 0x00000000},
+        {0x0000a12c, 0x00000000},
+        {0x0000a130, 0x00000000},
+        {0x0000a134, 0x00000000},
+        {0x0000a138, 0x00000000},
+        {0x0000a13c, 0x00000000},
+        {0x0000a140, 0x001f0000},
+        {0x0000a144, 0x01000101},
+        {0x0000a148, 0x011e011f},
+        {0x0000a14c, 0x011c011d},
+        {0x0000a150, 0x02030204},
+        {0x0000a154, 0x02010202},
+        {0x0000a158, 0x021f0200},
+        {0x0000a15c, 0x0302021e},
+        {0x0000a160, 0x03000301},
+        {0x0000a164, 0x031e031f},
+        {0x0000a168, 0x0402031d},
+        {0x0000a16c, 0x04000401},
+        {0x0000a170, 0x041e041f},
+        {0x0000a174, 0x0502041d},
+        {0x0000a178, 0x05000501},
+        {0x0000a17c, 0x051e051f},
+        {0x0000a180, 0x06010602},
+        {0x0000a184, 0x061f0600},
+        {0x0000a188, 0x061d061e},
+        {0x0000a18c, 0x07020703},
+        {0x0000a190, 0x07000701},
+        {0x0000a194, 0x00000000},
+        {0x0000a198, 0x00000000},
+        {0x0000a19c, 0x00000000},
+        {0x0000a1a0, 0x00000000},
+        {0x0000a1a4, 0x00000000},
+        {0x0000a1a8, 0x00000000},
+        {0x0000a1ac, 0x00000000},
+        {0x0000a1b0, 0x00000000},
+        {0x0000a1b4, 0x00000000},
+        {0x0000a1b8, 0x00000000},
+        {0x0000a1bc, 0x00000000},
+        {0x0000a1c0, 0x00000000},
+        {0x0000a1c4, 0x00000000},
+        {0x0000a1c8, 0x00000000},
+        {0x0000a1cc, 0x00000000},
+        {0x0000a1d0, 0x00000000},
+        {0x0000a1d4, 0x00000000},
+        {0x0000a1d8, 0x00000000},
+        {0x0000a1dc, 0x00000000},
+        {0x0000a1e0, 0x00000000},
+        {0x0000a1e4, 0x00000000},
+        {0x0000a1e8, 0x00000000},
+        {0x0000a1ec, 0x00000000},
+        {0x0000a1f0, 0x00000396},
+        {0x0000a1f4, 0x00000396},
+        {0x0000a1f8, 0x00000396},
+        {0x0000a1fc, 0x00000196},
+        {0x0000b000, 0x00010000},
+        {0x0000b004, 0x00030002},
+        {0x0000b008, 0x00050004},
+        {0x0000b00c, 0x00810080},
+        {0x0000b010, 0x00830082},
+        {0x0000b014, 0x01810180},
+        {0x0000b018, 0x01830182},
+        {0x0000b01c, 0x01850184},
+        {0x0000b020, 0x02810280},
+        {0x0000b024, 0x02830282},
+        {0x0000b028, 0x02850284},
+        {0x0000b02c, 0x02890288},
+        {0x0000b030, 0x028b028a},
+        {0x0000b034, 0x0388028c},
+        {0x0000b038, 0x038a0389},
+        {0x0000b03c, 0x038c038b},
+        {0x0000b040, 0x0390038d},
+        {0x0000b044, 0x03920391},
+        {0x0000b048, 0x03940393},
+        {0x0000b04c, 0x03960395},
+        {0x0000b050, 0x00000000},
+        {0x0000b054, 0x00000000},
+        {0x0000b058, 0x00000000},
+        {0x0000b05c, 0x00000000},
+        {0x0000b060, 0x00000000},
+        {0x0000b064, 0x00000000},
+        {0x0000b068, 0x00000000},
+        {0x0000b06c, 0x00000000},
+        {0x0000b070, 0x00000000},
+        {0x0000b074, 0x00000000},
+        {0x0000b078, 0x00000000},
+        {0x0000b07c, 0x00000000},
+        {0x0000b080, 0x32323232},
+        {0x0000b084, 0x2f2f3232},
+        {0x0000b088, 0x23282a2d},
+        {0x0000b08c, 0x1c1e2123},
+        {0x0000b090, 0x14171919},
+        {0x0000b094, 0x0e0e1214},
+        {0x0000b098, 0x03050707},
+        {0x0000b09c, 0x00030303},
+        {0x0000b0a0, 0x00000000},
+        {0x0000b0a4, 0x00000000},
+        {0x0000b0a8, 0x00000000},
+        {0x0000b0ac, 0x00000000},
+        {0x0000b0b0, 0x00000000},
+        {0x0000b0b4, 0x00000000},
+        {0x0000b0b8, 0x00000000},
+        {0x0000b0bc, 0x00000000},
+        {0x0000b0c0, 0x003f0020},
+        {0x0000b0c4, 0x00400041},
+        {0x0000b0c8, 0x0140005f},
+        {0x0000b0cc, 0x0160015f},
+        {0x0000b0d0, 0x017e017f},
+        {0x0000b0d4, 0x02410242},
+        {0x0000b0d8, 0x025f0240},
+        {0x0000b0dc, 0x027f0260},
+        {0x0000b0e0, 0x0341027e},
+        {0x0000b0e4, 0x035f0340},
+        {0x0000b0e8, 0x037f0360},
+        {0x0000b0ec, 0x04400441},
+        {0x0000b0f0, 0x0460045f},
+        {0x0000b0f4, 0x0541047f},
+        {0x0000b0f8, 0x055f0540},
+        {0x0000b0fc, 0x057f0560},
+        {0x0000b100, 0x06400641},
+        {0x0000b104, 0x0660065f},
+        {0x0000b108, 0x067e067f},
+        {0x0000b10c, 0x07410742},
+        {0x0000b110, 0x075f0740},
+        {0x0000b114, 0x077f0760},
+        {0x0000b118, 0x07800781},
+        {0x0000b11c, 0x07a0079f},
+        {0x0000b120, 0x07c107bf},
+        {0x0000b124, 0x000007c0},
+        {0x0000b128, 0x00000000},
+        {0x0000b12c, 0x00000000},
+        {0x0000b130, 0x00000000},
+        {0x0000b134, 0x00000000},
+        {0x0000b138, 0x00000000},
+        {0x0000b13c, 0x00000000},
+        {0x0000b140, 0x003f0020},
+        {0x0000b144, 0x00400041},
+        {0x0000b148, 0x0140005f},
+        {0x0000b14c, 0x0160015f},
+        {0x0000b150, 0x017e017f},
+        {0x0000b154, 0x02410242},
+        {0x0000b158, 0x025f0240},
+        {0x0000b15c, 0x027f0260},
+        {0x0000b160, 0x0341027e},
+        {0x0000b164, 0x035f0340},
+        {0x0000b168, 0x037f0360},
+        {0x0000b16c, 0x04400441},
+        {0x0000b170, 0x0460045f},
+        {0x0000b174, 0x0541047f},
+        {0x0000b178, 0x055f0540},
+        {0x0000b17c, 0x057f0560},
+        {0x0000b180, 0x06400641},
+        {0x0000b184, 0x0660065f},
+        {0x0000b188, 0x067e067f},
+        {0x0000b18c, 0x07410742},
+        {0x0000b190, 0x075f0740},
+        {0x0000b194, 0x077f0760},
+        {0x0000b198, 0x07800781},
+        {0x0000b19c, 0x07a0079f},
+        {0x0000b1a0, 0x07c107bf},
+        {0x0000b1a4, 0x000007c0},
+        {0x0000b1a8, 0x00000000},
+        {0x0000b1ac, 0x00000000},
+        {0x0000b1b0, 0x00000000},
+        {0x0000b1b4, 0x00000000},
+        {0x0000b1b8, 0x00000000},
+        {0x0000b1bc, 0x00000000},
+        {0x0000b1c0, 0x00000000},
+        {0x0000b1c4, 0x00000000},
+        {0x0000b1c8, 0x00000000},
+        {0x0000b1cc, 0x00000000},
+        {0x0000b1d0, 0x00000000},
+        {0x0000b1d4, 0x00000000},
+        {0x0000b1d8, 0x00000000},
+        {0x0000b1dc, 0x00000000},
+        {0x0000b1e0, 0x00000000},
+        {0x0000b1e4, 0x00000000},
+        {0x0000b1e8, 0x00000000},
+        {0x0000b1ec, 0x00000000},
+        {0x0000b1f0, 0x00000396},
+        {0x0000b1f4, 0x00000396},
+        {0x0000b1f8, 0x00000396},
+        {0x0000b1fc, 0x00000196},
+};
+static const u32 ar9580_1p0_soc_postamble[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x00007010, 0x00000023, 0x00000023, 0x00000023, 0x00000023},
+};
+static const u32 ar9580_1p0_high_ob_db_tx_gain_table[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x0000a2dc, 0x01feee00, 0x01feee00, 0x03aaa352, 0x03aaa352},
+        {0x0000a2e0, 0x0000f000, 0x0000f000, 0x03ccc584, 0x03ccc584},
+        {0x0000a2e4, 0x01ff0000, 0x01ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000a2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000a410, 0x000050d8, 0x000050d8, 0x000050d9, 0x000050d9},
+        {0x0000a500, 0x00002220, 0x00002220, 0x00000000, 0x00000000},
+        {0x0000a504, 0x04002222, 0x04002222, 0x04000002, 0x04000002},
+        {0x0000a508, 0x09002421, 0x09002421, 0x08000004, 0x08000004},
+        {0x0000a50c, 0x0d002621, 0x0d002621, 0x0b000200, 0x0b000200},
+        {0x0000a510, 0x13004620, 0x13004620, 0x0f000202, 0x0f000202},
+        {0x0000a514, 0x19004a20, 0x19004a20, 0x11000400, 0x11000400},
+        {0x0000a518, 0x1d004e20, 0x1d004e20, 0x15000402, 0x15000402},
+        {0x0000a51c, 0x21005420, 0x21005420, 0x19000404, 0x19000404},
+        {0x0000a520, 0x26005e20, 0x26005e20, 0x1b000603, 0x1b000603},
+        {0x0000a524, 0x2b005e40, 0x2b005e40, 0x1f000a02, 0x1f000a02},
+        {0x0000a528, 0x2f005e42, 0x2f005e42, 0x23000a04, 0x23000a04},
+        {0x0000a52c, 0x33005e44, 0x33005e44, 0x26000a20, 0x26000a20},
+        {0x0000a530, 0x38005e65, 0x38005e65, 0x2a000e20, 0x2a000e20},
+        {0x0000a534, 0x3c005e69, 0x3c005e69, 0x2e000e22, 0x2e000e22},
+        {0x0000a538, 0x40005e6b, 0x40005e6b, 0x31000e24, 0x31000e24},
+        {0x0000a53c, 0x44005e6d, 0x44005e6d, 0x34001640, 0x34001640},
+        {0x0000a540, 0x49005e72, 0x49005e72, 0x38001660, 0x38001660},
+        {0x0000a544, 0x4e005eb2, 0x4e005eb2, 0x3b001861, 0x3b001861},
+        {0x0000a548, 0x53005f12, 0x53005f12, 0x3e001a81, 0x3e001a81},
+        {0x0000a54c, 0x59025eb2, 0x59025eb2, 0x42001a83, 0x42001a83},
+        {0x0000a550, 0x5e025f12, 0x5e025f12, 0x44001c84, 0x44001c84},
+        {0x0000a554, 0x61027f12, 0x61027f12, 0x48001ce3, 0x48001ce3},
+        {0x0000a558, 0x6702bf12, 0x6702bf12, 0x4c001ce5, 0x4c001ce5},
+        {0x0000a55c, 0x6b02bf14, 0x6b02bf14, 0x50001ce9, 0x50001ce9},
+        {0x0000a560, 0x6f02bf16, 0x6f02bf16, 0x54001ceb, 0x54001ceb},
+        {0x0000a564, 0x6f02bf16, 0x6f02bf16, 0x56001eec, 0x56001eec},
+        {0x0000a568, 0x6f02bf16, 0x6f02bf16, 0x56001eec, 0x56001eec},
+        {0x0000a56c, 0x6f02bf16, 0x6f02bf16, 0x56001eec, 0x56001eec},
+        {0x0000a570, 0x6f02bf16, 0x6f02bf16, 0x56001eec, 0x56001eec},
+        {0x0000a574, 0x6f02bf16, 0x6f02bf16, 0x56001eec, 0x56001eec},
+        {0x0000a578, 0x6f02bf16, 0x6f02bf16, 0x56001eec, 0x56001eec},
+        {0x0000a57c, 0x6f02bf16, 0x6f02bf16, 0x56001eec, 0x56001eec},
+        {0x0000a580, 0x00802220, 0x00802220, 0x00800000, 0x00800000},
+        {0x0000a584, 0x04802222, 0x04802222, 0x04800002, 0x04800002},
+        {0x0000a588, 0x09802421, 0x09802421, 0x08800004, 0x08800004},
+        {0x0000a58c, 0x0d802621, 0x0d802621, 0x0b800200, 0x0b800200},
+        {0x0000a590, 0x13804620, 0x13804620, 0x0f800202, 0x0f800202},
+        {0x0000a594, 0x19804a20, 0x19804a20, 0x11800400, 0x11800400},
+        {0x0000a598, 0x1d804e20, 0x1d804e20, 0x15800402, 0x15800402},
+        {0x0000a59c, 0x21805420, 0x21805420, 0x19800404, 0x19800404},
+        {0x0000a5a0, 0x26805e20, 0x26805e20, 0x1b800603, 0x1b800603},
+        {0x0000a5a4, 0x2b805e40, 0x2b805e40, 0x1f800a02, 0x1f800a02},
+        {0x0000a5a8, 0x2f805e42, 0x2f805e42, 0x23800a04, 0x23800a04},
+        {0x0000a5ac, 0x33805e44, 0x33805e44, 0x26800a20, 0x26800a20},
+        {0x0000a5b0, 0x38805e65, 0x38805e65, 0x2a800e20, 0x2a800e20},
+        {0x0000a5b4, 0x3c805e69, 0x3c805e69, 0x2e800e22, 0x2e800e22},
+        {0x0000a5b8, 0x40805e6b, 0x40805e6b, 0x31800e24, 0x31800e24},
+        {0x0000a5bc, 0x44805e6d, 0x44805e6d, 0x34801640, 0x34801640},
+        {0x0000a5c0, 0x49805e72, 0x49805e72, 0x38801660, 0x38801660},
+        {0x0000a5c4, 0x4e805eb2, 0x4e805eb2, 0x3b801861, 0x3b801861},
+        {0x0000a5c8, 0x53805f12, 0x53805f12, 0x3e801a81, 0x3e801a81},
+        {0x0000a5cc, 0x59825eb2, 0x59825eb2, 0x42801a83, 0x42801a83},
+        {0x0000a5d0, 0x5e825f12, 0x5e825f12, 0x44801c84, 0x44801c84},
+        {0x0000a5d4, 0x61827f12, 0x61827f12, 0x48801ce3, 0x48801ce3},
+        {0x0000a5d8, 0x6782bf12, 0x6782bf12, 0x4c801ce5, 0x4c801ce5},
+        {0x0000a5dc, 0x6b82bf14, 0x6b82bf14, 0x50801ce9, 0x50801ce9},
+        {0x0000a5e0, 0x6f82bf16, 0x6f82bf16, 0x54801ceb, 0x54801ceb},
+        {0x0000a5e4, 0x6f82bf16, 0x6f82bf16, 0x56801eec, 0x56801eec},
+        {0x0000a5e8, 0x6f82bf16, 0x6f82bf16, 0x56801eec, 0x56801eec},
+        {0x0000a5ec, 0x6f82bf16, 0x6f82bf16, 0x56801eec, 0x56801eec},
+        {0x0000a5f0, 0x6f82bf16, 0x6f82bf16, 0x56801eec, 0x56801eec},
+        {0x0000a5f4, 0x6f82bf16, 0x6f82bf16, 0x56801eec, 0x56801eec},
+        {0x0000a5f8, 0x6f82bf16, 0x6f82bf16, 0x56801eec, 0x56801eec},
+        {0x0000a5fc, 0x6f82bf16, 0x6f82bf16, 0x56801eec, 0x56801eec},
+        {0x0000a600, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a604, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a608, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a60c, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a610, 0x00804000, 0x00804000, 0x00000000, 0x00000000},
+        {0x0000a614, 0x00804201, 0x00804201, 0x01404000, 0x01404000},
+        {0x0000a618, 0x0280c802, 0x0280c802, 0x01404501, 0x01404501},
+        {0x0000a61c, 0x0280ca03, 0x0280ca03, 0x02008501, 0x02008501},
+        {0x0000a620, 0x04c15104, 0x04c15104, 0x0280ca03, 0x0280ca03},
+        {0x0000a624, 0x04c15305, 0x04c15305, 0x03010c04, 0x03010c04},
+        {0x0000a628, 0x04c15305, 0x04c15305, 0x04014c04, 0x04014c04},
+        {0x0000a62c, 0x04c15305, 0x04c15305, 0x04015005, 0x04015005},
+        {0x0000a630, 0x04c15305, 0x04c15305, 0x04015005, 0x04015005},
+        {0x0000a634, 0x04c15305, 0x04c15305, 0x04015005, 0x04015005},
+        {0x0000a638, 0x04c15305, 0x04c15305, 0x04015005, 0x04015005},
+        {0x0000a63c, 0x04c15305, 0x04c15305, 0x04015005, 0x04015005},
+        {0x0000b2dc, 0x01feee00, 0x01feee00, 0x03aaa352, 0x03aaa352},
+        {0x0000b2e0, 0x0000f000, 0x0000f000, 0x03ccc584, 0x03ccc584},
+        {0x0000b2e4, 0x01ff0000, 0x01ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000b2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x0000c2dc, 0x01feee00, 0x01feee00, 0x03aaa352, 0x03aaa352},
+        {0x0000c2e0, 0x0000f000, 0x0000f000, 0x03ccc584, 0x03ccc584},
+        {0x0000c2e4, 0x01ff0000, 0x01ff0000, 0x03f0f800, 0x03f0f800},
+        {0x0000c2e8, 0x00000000, 0x00000000, 0x03ff0000, 0x03ff0000},
+        {0x00016044, 0x056db2e4, 0x056db2e4, 0x056db2e4, 0x056db2e4},
+        {0x00016048, 0x8e480001, 0x8e480001, 0x8e480001, 0x8e480001},
+        {0x00016068, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016444, 0x056db2e4, 0x056db2e4, 0x056db2e4, 0x056db2e4},
+        {0x00016448, 0x8e480001, 0x8e480001, 0x8e480001, 0x8e480001},
+        {0x00016468, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+        {0x00016844, 0x056db2e4, 0x056db2e4, 0x056db2e4, 0x056db2e4},
+        {0x00016848, 0x8e480001, 0x8e480001, 0x8e480001, 0x8e480001},
+        {0x00016868, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c, 0x6db6db6c},
+};
+static const u32 ar9580_1p0_soc_preamble[][2] = {
+        /* Addr      allmodes  */
+        {0x000040a4, 0x00a0c1c9},
+        {0x00007008, 0x00000000},
+        {0x00007020, 0x00000000},
+        {0x00007034, 0x00000002},
+        {0x00007038, 0x000004c2},
+        {0x00007048, 0x00000008},
+};
+static const u32 ar9580_1p0_rx_gain_table[][2] = {
+        /* Addr      allmodes  */
+        {0x0000a000, 0x00010000},
+        {0x0000a004, 0x00030002},
+        {0x0000a008, 0x00050004},
+        {0x0000a00c, 0x00810080},
+        {0x0000a010, 0x00830082},
+        {0x0000a014, 0x01810180},
+        {0x0000a018, 0x01830182},
+        {0x0000a01c, 0x01850184},
+        {0x0000a020, 0x01890188},
+        {0x0000a024, 0x018b018a},
+        {0x0000a028, 0x018d018c},
+        {0x0000a02c, 0x01910190},
+        {0x0000a030, 0x01930192},
+        {0x0000a034, 0x01950194},
+        {0x0000a038, 0x038a0196},
+        {0x0000a03c, 0x038c038b},
+        {0x0000a040, 0x0390038d},
+        {0x0000a044, 0x03920391},
+        {0x0000a048, 0x03940393},
+        {0x0000a04c, 0x03960395},
+        {0x0000a050, 0x00000000},
+        {0x0000a054, 0x00000000},
+        {0x0000a058, 0x00000000},
+        {0x0000a05c, 0x00000000},
+        {0x0000a060, 0x00000000},
+        {0x0000a064, 0x00000000},
+        {0x0000a068, 0x00000000},
+        {0x0000a06c, 0x00000000},
+        {0x0000a070, 0x00000000},
+        {0x0000a074, 0x00000000},
+        {0x0000a078, 0x00000000},
+        {0x0000a07c, 0x00000000},
+        {0x0000a080, 0x22222229},
+        {0x0000a084, 0x1d1d1d1d},
+        {0x0000a088, 0x1d1d1d1d},
+        {0x0000a08c, 0x1d1d1d1d},
+        {0x0000a090, 0x171d1d1d},
+        {0x0000a094, 0x11111717},
+        {0x0000a098, 0x00030311},
+        {0x0000a09c, 0x00000000},
+        {0x0000a0a0, 0x00000000},
+        {0x0000a0a4, 0x00000000},
+        {0x0000a0a8, 0x00000000},
+        {0x0000a0ac, 0x00000000},
+        {0x0000a0b0, 0x00000000},
+        {0x0000a0b4, 0x00000000},
+        {0x0000a0b8, 0x00000000},
+        {0x0000a0bc, 0x00000000},
+        {0x0000a0c0, 0x001f0000},
+        {0x0000a0c4, 0x01000101},
+        {0x0000a0c8, 0x011e011f},
+        {0x0000a0cc, 0x011c011d},
+        {0x0000a0d0, 0x02030204},
+        {0x0000a0d4, 0x02010202},
+        {0x0000a0d8, 0x021f0200},
+        {0x0000a0dc, 0x0302021e},
+        {0x0000a0e0, 0x03000301},
+        {0x0000a0e4, 0x031e031f},
+        {0x0000a0e8, 0x0402031d},
+        {0x0000a0ec, 0x04000401},
+        {0x0000a0f0, 0x041e041f},
+        {0x0000a0f4, 0x0502041d},
+        {0x0000a0f8, 0x05000501},
+        {0x0000a0fc, 0x051e051f},
+        {0x0000a100, 0x06010602},
+        {0x0000a104, 0x061f0600},
+        {0x0000a108, 0x061d061e},
+        {0x0000a10c, 0x07020703},
+        {0x0000a110, 0x07000701},
+        {0x0000a114, 0x00000000},
+        {0x0000a118, 0x00000000},
+        {0x0000a11c, 0x00000000},
+        {0x0000a120, 0x00000000},
+        {0x0000a124, 0x00000000},
+        {0x0000a128, 0x00000000},
+        {0x0000a12c, 0x00000000},
+        {0x0000a130, 0x00000000},
+        {0x0000a134, 0x00000000},
+        {0x0000a138, 0x00000000},
+        {0x0000a13c, 0x00000000},
+        {0x0000a140, 0x001f0000},
+        {0x0000a144, 0x01000101},
+        {0x0000a148, 0x011e011f},
+        {0x0000a14c, 0x011c011d},
+        {0x0000a150, 0x02030204},
+        {0x0000a154, 0x02010202},
+        {0x0000a158, 0x021f0200},
+        {0x0000a15c, 0x0302021e},
+        {0x0000a160, 0x03000301},
+        {0x0000a164, 0x031e031f},
+        {0x0000a168, 0x0402031d},
+        {0x0000a16c, 0x04000401},
+        {0x0000a170, 0x041e041f},
+        {0x0000a174, 0x0502041d},
+        {0x0000a178, 0x05000501},
+        {0x0000a17c, 0x051e051f},
+        {0x0000a180, 0x06010602},
+        {0x0000a184, 0x061f0600},
+        {0x0000a188, 0x061d061e},
+        {0x0000a18c, 0x07020703},
+        {0x0000a190, 0x07000701},
+        {0x0000a194, 0x00000000},
+        {0x0000a198, 0x00000000},
+        {0x0000a19c, 0x00000000},
+        {0x0000a1a0, 0x00000000},
+        {0x0000a1a4, 0x00000000},
+        {0x0000a1a8, 0x00000000},
+        {0x0000a1ac, 0x00000000},
+        {0x0000a1b0, 0x00000000},
+        {0x0000a1b4, 0x00000000},
+        {0x0000a1b8, 0x00000000},
+        {0x0000a1bc, 0x00000000},
+        {0x0000a1c0, 0x00000000},
+        {0x0000a1c4, 0x00000000},
+        {0x0000a1c8, 0x00000000},
+        {0x0000a1cc, 0x00000000},
+        {0x0000a1d0, 0x00000000},
+        {0x0000a1d4, 0x00000000},
+        {0x0000a1d8, 0x00000000},
+        {0x0000a1dc, 0x00000000},
+        {0x0000a1e0, 0x00000000},
+        {0x0000a1e4, 0x00000000},
+        {0x0000a1e8, 0x00000000},
+        {0x0000a1ec, 0x00000000},
+        {0x0000a1f0, 0x00000396},
+        {0x0000a1f4, 0x00000396},
+        {0x0000a1f8, 0x00000396},
+        {0x0000a1fc, 0x00000196},
+        {0x0000b000, 0x00010000},
+        {0x0000b004, 0x00030002},
+        {0x0000b008, 0x00050004},
+        {0x0000b00c, 0x00810080},
+        {0x0000b010, 0x00830082},
+        {0x0000b014, 0x01810180},
+        {0x0000b018, 0x01830182},
+        {0x0000b01c, 0x01850184},
+        {0x0000b020, 0x02810280},
+        {0x0000b024, 0x02830282},
+        {0x0000b028, 0x02850284},
+        {0x0000b02c, 0x02890288},
+        {0x0000b030, 0x028b028a},
+        {0x0000b034, 0x0388028c},
+        {0x0000b038, 0x038a0389},
+        {0x0000b03c, 0x038c038b},
+        {0x0000b040, 0x0390038d},
+        {0x0000b044, 0x03920391},
+        {0x0000b048, 0x03940393},
+        {0x0000b04c, 0x03960395},
+        {0x0000b050, 0x00000000},
+        {0x0000b054, 0x00000000},
+        {0x0000b058, 0x00000000},
+        {0x0000b05c, 0x00000000},
+        {0x0000b060, 0x00000000},
+        {0x0000b064, 0x00000000},
+        {0x0000b068, 0x00000000},
+        {0x0000b06c, 0x00000000},
+        {0x0000b070, 0x00000000},
+        {0x0000b074, 0x00000000},
+        {0x0000b078, 0x00000000},
+        {0x0000b07c, 0x00000000},
+        {0x0000b080, 0x2a2d2f32},
+        {0x0000b084, 0x21232328},
+        {0x0000b088, 0x19191c1e},
+        {0x0000b08c, 0x12141417},
+        {0x0000b090, 0x07070e0e},
+        {0x0000b094, 0x03030305},
+        {0x0000b098, 0x00000003},
+        {0x0000b09c, 0x00000000},
+        {0x0000b0a0, 0x00000000},
+        {0x0000b0a4, 0x00000000},
+        {0x0000b0a8, 0x00000000},
+        {0x0000b0ac, 0x00000000},
+        {0x0000b0b0, 0x00000000},
+        {0x0000b0b4, 0x00000000},
+        {0x0000b0b8, 0x00000000},
+        {0x0000b0bc, 0x00000000},
+        {0x0000b0c0, 0x003f0020},
+        {0x0000b0c4, 0x00400041},
+        {0x0000b0c8, 0x0140005f},
+        {0x0000b0cc, 0x0160015f},
+        {0x0000b0d0, 0x017e017f},
+        {0x0000b0d4, 0x02410242},
+        {0x0000b0d8, 0x025f0240},
+        {0x0000b0dc, 0x027f0260},
+        {0x0000b0e0, 0x0341027e},
+        {0x0000b0e4, 0x035f0340},
+        {0x0000b0e8, 0x037f0360},
+        {0x0000b0ec, 0x04400441},
+        {0x0000b0f0, 0x0460045f},
+        {0x0000b0f4, 0x0541047f},
+        {0x0000b0f8, 0x055f0540},
+        {0x0000b0fc, 0x057f0560},
+        {0x0000b100, 0x06400641},
+        {0x0000b104, 0x0660065f},
+        {0x0000b108, 0x067e067f},
+        {0x0000b10c, 0x07410742},
+        {0x0000b110, 0x075f0740},
+        {0x0000b114, 0x077f0760},
+        {0x0000b118, 0x07800781},
+        {0x0000b11c, 0x07a0079f},
+        {0x0000b120, 0x07c107bf},
+        {0x0000b124, 0x000007c0},
+        {0x0000b128, 0x00000000},
+        {0x0000b12c, 0x00000000},
+        {0x0000b130, 0x00000000},
+        {0x0000b134, 0x00000000},
+        {0x0000b138, 0x00000000},
+        {0x0000b13c, 0x00000000},
+        {0x0000b140, 0x003f0020},
+        {0x0000b144, 0x00400041},
+        {0x0000b148, 0x0140005f},
+        {0x0000b14c, 0x0160015f},
+        {0x0000b150, 0x017e017f},
+        {0x0000b154, 0x02410242},
+        {0x0000b158, 0x025f0240},
+        {0x0000b15c, 0x027f0260},
+        {0x0000b160, 0x0341027e},
+        {0x0000b164, 0x035f0340},
+        {0x0000b168, 0x037f0360},
+        {0x0000b16c, 0x04400441},
+        {0x0000b170, 0x0460045f},
+        {0x0000b174, 0x0541047f},
+        {0x0000b178, 0x055f0540},
+        {0x0000b17c, 0x057f0560},
+        {0x0000b180, 0x06400641},
+        {0x0000b184, 0x0660065f},
+        {0x0000b188, 0x067e067f},
+        {0x0000b18c, 0x07410742},
+        {0x0000b190, 0x075f0740},
+        {0x0000b194, 0x077f0760},
+        {0x0000b198, 0x07800781},
+        {0x0000b19c, 0x07a0079f},
+        {0x0000b1a0, 0x07c107bf},
+        {0x0000b1a4, 0x000007c0},
+        {0x0000b1a8, 0x00000000},
+        {0x0000b1ac, 0x00000000},
+        {0x0000b1b0, 0x00000000},
+        {0x0000b1b4, 0x00000000},
+        {0x0000b1b8, 0x00000000},
+        {0x0000b1bc, 0x00000000},
+        {0x0000b1c0, 0x00000000},
+        {0x0000b1c4, 0x00000000},
+        {0x0000b1c8, 0x00000000},
+        {0x0000b1cc, 0x00000000},
+        {0x0000b1d0, 0x00000000},
+        {0x0000b1d4, 0x00000000},
+        {0x0000b1d8, 0x00000000},
+        {0x0000b1dc, 0x00000000},
+        {0x0000b1e0, 0x00000000},
+        {0x0000b1e4, 0x00000000},
+        {0x0000b1e8, 0x00000000},
+        {0x0000b1ec, 0x00000000},
+        {0x0000b1f0, 0x00000396},
+        {0x0000b1f4, 0x00000396},
+        {0x0000b1f8, 0x00000396},
+        {0x0000b1fc, 0x00000196},
+};
+static const u32 ar9580_1p0_radio_core[][2] = {
+        /* Addr      allmodes  */
+        {0x00016000, 0x36db6db6},
+        {0x00016004, 0x6db6db40},
+        {0x00016008, 0x73f00000},
+        {0x0001600c, 0x00000000},
+        {0x00016040, 0x7f80fff8},
+        {0x0001604c, 0x76d005b5},
+        {0x00016050, 0x556cf031},
+        {0x00016054, 0x13449440},
+        {0x00016058, 0x0c51c92c},
+        {0x0001605c, 0x3db7fffc},
+        {0x00016060, 0xfffffffc},
+        {0x00016064, 0x000f0278},
+        {0x0001606c, 0x6db60000},
+        {0x00016080, 0x00000000},
+        {0x00016084, 0x0e48048c},
+        {0x00016088, 0x54214514},
+        {0x0001608c, 0x119f481e},
+        {0x00016090, 0x24926490},
+        {0x00016098, 0xd2888888},
+        {0x000160a0, 0x0a108ffe},
+        {0x000160a4, 0x812fc370},
+        {0x000160a8, 0x423c8000},
+        {0x000160b4, 0x92480080},
+        {0x000160c0, 0x00adb6d0},
+        {0x000160c4, 0x6db6db60},
+        {0x000160c8, 0x6db6db6c},
+        {0x000160cc, 0x01e6c000},
+        {0x00016100, 0x3fffbe01},
+        {0x00016104, 0xfff80000},
+        {0x00016108, 0x00080010},
+        {0x00016144, 0x02084080},
+        {0x00016148, 0x00000000},
+        {0x00016280, 0x058a0001},
+        {0x00016284, 0x3d840208},
+        {0x00016288, 0x05a20408},
+        {0x0001628c, 0x00038c07},
+        {0x00016290, 0x00000004},
+        {0x00016294, 0x458aa14f},
+        {0x00016380, 0x00000000},
+        {0x00016384, 0x00000000},
+        {0x00016388, 0x00800700},
+        {0x0001638c, 0x00800700},
+        {0x00016390, 0x00800700},
+        {0x00016394, 0x00000000},
+        {0x00016398, 0x00000000},
+        {0x0001639c, 0x00000000},
+        {0x000163a0, 0x00000001},
+        {0x000163a4, 0x00000001},
+        {0x000163a8, 0x00000000},
+        {0x000163ac, 0x00000000},
+        {0x000163b0, 0x00000000},
+        {0x000163b4, 0x00000000},
+        {0x000163b8, 0x00000000},
+        {0x000163bc, 0x00000000},
+        {0x000163c0, 0x000000a0},
+        {0x000163c4, 0x000c0000},
+        {0x000163c8, 0x14021402},
+        {0x000163cc, 0x00001402},
+        {0x000163d0, 0x00000000},
+        {0x000163d4, 0x00000000},
+        {0x00016400, 0x36db6db6},
+        {0x00016404, 0x6db6db40},
+        {0x00016408, 0x73f00000},
+        {0x0001640c, 0x00000000},
+        {0x00016440, 0x7f80fff8},
+        {0x0001644c, 0x76d005b5},
+        {0x00016450, 0x556cf031},
+        {0x00016454, 0x13449440},
+        {0x00016458, 0x0c51c92c},
+        {0x0001645c, 0x3db7fffc},
+        {0x00016460, 0xfffffffc},
+        {0x00016464, 0x000f0278},
+        {0x0001646c, 0x6db60000},
+        {0x00016500, 0x3fffbe01},
+        {0x00016504, 0xfff80000},
+        {0x00016508, 0x00080010},
+        {0x00016544, 0x02084080},
+        {0x00016548, 0x00000000},
+        {0x00016780, 0x00000000},
+        {0x00016784, 0x00000000},
+        {0x00016788, 0x00800700},
+        {0x0001678c, 0x00800700},
+        {0x00016790, 0x00800700},
+        {0x00016794, 0x00000000},
+        {0x00016798, 0x00000000},
+        {0x0001679c, 0x00000000},
+        {0x000167a0, 0x00000001},
+        {0x000167a4, 0x00000001},
+        {0x000167a8, 0x00000000},
+        {0x000167ac, 0x00000000},
+        {0x000167b0, 0x00000000},
+        {0x000167b4, 0x00000000},
+        {0x000167b8, 0x00000000},
+        {0x000167bc, 0x00000000},
+        {0x000167c0, 0x000000a0},
+        {0x000167c4, 0x000c0000},
+        {0x000167c8, 0x14021402},
+        {0x000167cc, 0x00001402},
+        {0x000167d0, 0x00000000},
+        {0x000167d4, 0x00000000},
+        {0x00016800, 0x36db6db6},
+        {0x00016804, 0x6db6db40},
+        {0x00016808, 0x73f00000},
+        {0x0001680c, 0x00000000},
+        {0x00016840, 0x7f80fff8},
+        {0x0001684c, 0x76d005b5},
+        {0x00016850, 0x556cf031},
+        {0x00016854, 0x13449440},
+        {0x00016858, 0x0c51c92c},
+        {0x0001685c, 0x3db7fffc},
+        {0x00016860, 0xfffffffc},
+        {0x00016864, 0x000f0278},
+        {0x0001686c, 0x6db60000},
+        {0x00016900, 0x3fffbe01},
+        {0x00016904, 0xfff80000},
+        {0x00016908, 0x00080010},
+        {0x00016944, 0x02084080},
+        {0x00016948, 0x00000000},
+        {0x00016b80, 0x00000000},
+        {0x00016b84, 0x00000000},
+        {0x00016b88, 0x00800700},
+        {0x00016b8c, 0x00800700},
+        {0x00016b90, 0x00800700},
+        {0x00016b94, 0x00000000},
+        {0x00016b98, 0x00000000},
+        {0x00016b9c, 0x00000000},
+        {0x00016ba0, 0x00000001},
+        {0x00016ba4, 0x00000001},
+        {0x00016ba8, 0x00000000},
+        {0x00016bac, 0x00000000},
+        {0x00016bb0, 0x00000000},
+        {0x00016bb4, 0x00000000},
+        {0x00016bb8, 0x00000000},
+        {0x00016bbc, 0x00000000},
+        {0x00016bc0, 0x000000a0},
+        {0x00016bc4, 0x000c0000},
+        {0x00016bc8, 0x14021402},
+        {0x00016bcc, 0x00001402},
+        {0x00016bd0, 0x00000000},
+        {0x00016bd4, 0x00000000},
+};
+static const u32 ar9580_1p0_baseband_postamble[][5] = {
+        /* Addr      5G_HT20     5G_HT40     2G_HT40     2G_HT20   */
+        {0x00009810, 0xd00a8005, 0xd00a8005, 0xd00a8011, 0xd00a8011},
+        {0x00009820, 0x206a022e, 0x206a022e, 0x206a012e, 0x206a012e},
+        {0x00009824, 0x5ac640d0, 0x5ac640d0, 0x5ac640d0, 0x5ac640d0},
+        {0x00009828, 0x06903081, 0x06903081, 0x06903881, 0x06903881},
+        {0x0000982c, 0x05eea6d4, 0x05eea6d4, 0x05eea6d4, 0x05eea6d4},
+        {0x00009830, 0x0000059c, 0x0000059c, 0x0000119c, 0x0000119c},
+        {0x00009c00, 0x000000c4, 0x000000c4, 0x000000c4, 0x000000c4},
+        {0x00009e00, 0x0372111a, 0x0372111a, 0x037216a0, 0x037216a0},
+        {0x00009e04, 0x001c2020, 0x001c2020, 0x001c2020, 0x001c2020},
+        {0x00009e0c, 0x6c4000e2, 0x6d4000e2, 0x6d4000e2, 0x6c4000e2},
+        {0x00009e10, 0x7ec88d2e, 0x7ec88d2e, 0x7ec84d2e, 0x7ec84d2e},
+        {0x00009e14, 0x37b95d5e, 0x37b9605e, 0x3379605e, 0x33795d5e},
+        {0x00009e18, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x00009e1c, 0x0001cf9c, 0x0001cf9c, 0x00021f9c, 0x00021f9c},
+        {0x00009e20, 0x000003b5, 0x000003b5, 0x000003ce, 0x000003ce},
+        {0x00009e2c, 0x0000001c, 0x0000001c, 0x00000021, 0x00000021},
+        {0x00009e3c, 0xcf946220, 0xcf946220, 0xcf946222, 0xcf946222},
+        {0x00009e44, 0x02321e27, 0x02321e27, 0x02291e27, 0x02291e27},
+        {0x00009e48, 0x5030201a, 0x5030201a, 0x50302012, 0x50302012},
+        {0x00009fc8, 0x0003f000, 0x0003f000, 0x0001a000, 0x0001a000},
+        {0x0000a204, 0x000036c0, 0x000036c4, 0x000036c4, 0x000036c0},
+        {0x0000a208, 0x00000104, 0x00000104, 0x00000004, 0x00000004},
+        {0x0000a22c, 0x07e26a2f, 0x07e26a2f, 0x01026a2f, 0x01026a2f},
+        {0x0000a230, 0x0000000a, 0x00000014, 0x00000016, 0x0000000b},
+        {0x0000a234, 0x00000fff, 0x10000fff, 0x10000fff, 0x00000fff},
+        {0x0000a238, 0xffb01018, 0xffb01018, 0xffb01018, 0xffb01018},
+        {0x0000a250, 0x00000000, 0x00000000, 0x00000210, 0x00000108},
+        {0x0000a254, 0x000007d0, 0x00000fa0, 0x00001130, 0x00000898},
+        {0x0000a258, 0x02020002, 0x02020002, 0x02020002, 0x02020002},
+        {0x0000a25c, 0x01000e0e, 0x01000e0e, 0x01000e0e, 0x01000e0e},
+        {0x0000a260, 0x0a021501, 0x0a021501, 0x3a021501, 0x3a021501},
+        {0x0000a264, 0x00000e0e, 0x00000e0e, 0x00000e0e, 0x00000e0e},
+        {0x0000a280, 0x00000007, 0x00000007, 0x0000000b, 0x0000000b},
+        {0x0000a284, 0x00000000, 0x00000000, 0x00000150, 0x00000150},
+        {0x0000a288, 0x00000110, 0x00000110, 0x00000110, 0x00000110},
+        {0x0000a28c, 0x00022222, 0x00022222, 0x00022222, 0x00022222},
+        {0x0000a2c4, 0x00158d18, 0x00158d18, 0x00158d18, 0x00158d18},
+        {0x0000a2d0, 0x00041981, 0x00041981, 0x00041981, 0x00041982},
+        {0x0000a2d8, 0x7999a83b, 0x7999a83b, 0x7999a83b, 0x7999a83b},
+        {0x0000a358, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000a830, 0x0000019c, 0x0000019c, 0x0000019c, 0x0000019c},
+        {0x0000ae04, 0x001c0000, 0x001c0000, 0x001c0000, 0x001c0000},
+        {0x0000ae18, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000ae1c, 0x0000019c, 0x0000019c, 0x0000019c, 0x0000019c},
+        {0x0000ae20, 0x000001b5, 0x000001b5, 0x000001ce, 0x000001ce},
+        {0x0000b284, 0x00000000, 0x00000000, 0x00000150, 0x00000150},
+        {0x0000b830, 0x0000019c, 0x0000019c, 0x0000019c, 0x0000019c},
+        {0x0000be04, 0x001c0000, 0x001c0000, 0x001c0000, 0x001c0000},
+        {0x0000be18, 0x00000000, 0x00000000, 0x00000000, 0x00000000},
+        {0x0000be1c, 0x0000019c, 0x0000019c, 0x0000019c, 0x0000019c},
+        {0x0000be20, 0x000001b5, 0x000001b5, 0x000001ce, 0x000001ce},
+        {0x0000c284, 0x00000000, 0x00000000, 0x00000150, 0x00000150},
+};
+static const u32 ar9580_1p0_pcie_phy_clkreq_enable_L1[][2] = {
+        /* Addr      allmodes  */
+        {0x00004040, 0x0835365e},
+        {0x00004040, 0x0008003b},
+        {0x00004044, 0x00000000},
+};
+static const u32 ar9580_1p0_pcie_phy_clkreq_disable_L1[][2] = {
+        /* Addr      allmodes  */
+        {0x00004040, 0x0831365e},
+        {0x00004040, 0x0008003b},
+        {0x00004044, 0x00000000},
+};
+static const u32 ar9580_1p0_pcie_phy_pll_on_clkreq[][2] = {
+        /* Addr      allmodes  */
+        {0x00004040, 0x0831265e},
+        {0x00004040, 0x0008003b},
+        {0x00004044, 0x00000000},
+};
+#endif /* INITVALS_9580_1P0_H */
diff --git a/drivers/net/wireless/ath/ath9k/ath9k.h b/drivers/net/wireless/ath/ath9k/ath9k.h
index c03949eb37c8..3a893e19d6c3 100644
--- a/drivers/net/wireless/ath/ath9k/ath9k.h
+++ b/drivers/net/wireless/ath/ath9k/ath9k.h
@@ -558,8 +558,7 @@ struct ath_ant_comb {
 #define SC_OP_BT_PRIORITY_DETECTED   BIT(12)
 #define SC_OP_BT_SCAN                BIT(13)
 #define SC_OP_ANI_RUN                BIT(14)
-#define SC_OP_ENABLE_APM             BIT(15)
+#define SC_OP_PRIM_STA_VIF           BIT(15)
-#define SC_OP_PRIM_STA_VIF           BIT(16)
 /* Powersave flags */
 #define PS_WAIT_FOR_BEACON        BIT(0)
@@ -664,7 +663,6 @@ extern int led_blink;
 extern bool is_ath9k_unloaded;
 irqreturn_t ath_isr(int irq, void *dev);
-void ath9k_init_crypto(struct ath_softc *sc);
 int ath9k_init_device(u16 devid, struct ath_softc *sc,
                    const struct ath_bus_ops *bus_ops);
 void ath9k_deinit_device(struct ath_softc *sc);
diff --git a/drivers/net/wireless/ath/ath9k/calib.c b/drivers/net/wireless/ath/ath9k/calib.c
index ac2da3cce788..ebaf304f464b 100644
--- a/drivers/net/wireless/ath/ath9k/calib.c
+++ b/drivers/net/wireless/ath/ath9k/calib.c
@@ -82,7 +82,6 @@ static void ath9k_hw_update_nfcal_hist_buffer(struct ath_hw *ah,
                                              int16_t *nfarray)
 {
        struct ath_common *common = ath9k_hw_common(ah);
-        struct ieee80211_conf *conf = &common->hw->conf;
        struct ath_nf_limits *limit;
        struct ath9k_nfcal_hist *h;
        bool high_nf_mid = false;
@@ -94,7 +93,7 @@ static void ath9k_hw_update_nfcal_hist_buffer(struct ath_hw *ah,
        for (i = 0; i < NUM_NF_READINGS; i++) {
                if (!(chainmask & (1 << i)) ||
-                    ((i >= AR5416_MAX_CHAINS) && !conf_is_ht40(conf)))
+                    ((i >= AR5416_MAX_CHAINS) && !IS_CHAN_HT40(ah->curchan)))
                        continue;
                h[i].nfCalBuffer[h[i].currIndex] = nfarray[i];
diff --git a/drivers/net/wireless/ath/ath9k/common.c b/drivers/net/wireless/ath/ath9k/common.c
index fa6bd2d189e5..dc705a224952 100644
--- a/drivers/net/wireless/ath/ath9k/common.c
+++ b/drivers/net/wireless/ath/ath9k/common.c
@@ -169,6 +169,32 @@ void ath9k_cmn_update_txpow(struct ath_hw *ah, u16 cur_txpow,
 }
 EXPORT_SYMBOL(ath9k_cmn_update_txpow);
+void ath9k_cmn_init_crypto(struct ath_hw *ah)
+{
+        struct ath_common *common = ath9k_hw_common(ah);
+        int i = 0;
+        /* Get the hardware key cache size. */
+        common->keymax = AR_KEYTABLE_SIZE;
+        /*
+         * Check whether the separate key cache entries
+         * are required to handle both tx+rx MIC keys.
+         * With split mic keys the number of stations is limited
+         * to 27 otherwise 59.
+         */
+        if (ah->misc_mode & AR_PCU_MIC_NEW_LOC_ENA)
+                common->crypt_caps |= ATH_CRYPT_CAP_MIC_COMBINED;
+        /*
+         * Reset the key cache since some parts do not
+         * reset the contents on initial power up.
+         */
+        for (i = 0; i < common->keymax; i++)
+                ath_hw_keyreset(common, (u16) i);
+}
+EXPORT_SYMBOL(ath9k_cmn_init_crypto);
 static int __init ath9k_cmn_init(void)
 {
        return 0;
diff --git a/drivers/net/wireless/ath/ath9k/common.h b/drivers/net/wireless/ath/ath9k/common.h
index 77ec288b5a70..ad14fecc76c6 100644
--- a/drivers/net/wireless/ath/ath9k/common.h
+++ b/drivers/net/wireless/ath/ath9k/common.h
@@ -62,3 +62,4 @@ void ath9k_cmn_btcoex_bt_stomp(struct ath_common *common,
                                  enum ath_stomp_type stomp_type);
 void ath9k_cmn_update_txpow(struct ath_hw *ah, u16 cur_txpow,
                            u16 new_txpow, u16 *txpower);
+void ath9k_cmn_init_crypto(struct ath_hw *ah);
diff --git a/drivers/net/wireless/ath/ath9k/debug.c b/drivers/net/wireless/ath/ath9k/debug.c
index 9bec3b89fb68..da45f325be7d 100644
--- a/drivers/net/wireless/ath/ath9k/debug.c
+++ b/drivers/net/wireless/ath/ath9k/debug.c
@@ -1163,6 +1163,59 @@ static const struct file_operations fops_regdump = {
        .llseek = default_llseek,/* read accesses f_pos */
 };
+static ssize_t read_file_dump_nfcal(struct file *file, char __user *user_buf,
+                                    size_t count, loff_t *ppos)
+{
+        struct ath_softc *sc = file->private_data;
+        struct ath_hw *ah = sc->sc_ah;
+        struct ath9k_nfcal_hist *h = sc->caldata.nfCalHist;
+        struct ath_common *common = ath9k_hw_common(ah);
+        struct ieee80211_conf *conf = &common->hw->conf;
+        u32 len = 0, size = 1500;
+        u32 i, j;
+        ssize_t retval = 0;
+        char *buf;
+        u8 chainmask = (ah->rxchainmask << 3) | ah->rxchainmask;
+        u8 nread;
+        buf = kzalloc(size, GFP_KERNEL);
+        if (!buf)
+                return -ENOMEM;
+        len += snprintf(buf + len, size - len,
+                        "Channel Noise Floor : %d\n", ah->noise);
+        len += snprintf(buf + len, size - len,
+                        "Chain | privNF | # Readings | NF Readings\n");
+        for (i = 0; i < NUM_NF_READINGS; i++) {
+                if (!(chainmask & (1 << i)) ||
+                    ((i >= AR5416_MAX_CHAINS) && !conf_is_ht40(conf)))
+                        continue;
+                nread = AR_PHY_CCA_FILTERWINDOW_LENGTH - h[i].invalidNFcount;
+                len += snprintf(buf + len, size - len, " %d\t %d\t %d\t\t",
+                                i, h[i].privNF, nread);
+                for (j = 0; j < nread; j++)
+                        len += snprintf(buf + len, size - len,
+                                        " %d", h[i].nfCalBuffer[j]);
+                len += snprintf(buf + len, size - len, "\n");
+        }
+        if (len > size)
+                len = size;
+        retval = simple_read_from_buffer(user_buf, count, ppos, buf, len);
+        kfree(buf);
+        return retval;
+}
+static const struct file_operations fops_dump_nfcal = {
+        .read = read_file_dump_nfcal,
+        .open = ath9k_debugfs_open,
+        .owner = THIS_MODULE,
+        .llseek = default_llseek,
+};
 static ssize_t read_file_base_eeprom(struct file *file, char __user *user_buf,
                                     size_t count, loff_t *ppos)
 {
@@ -1262,6 +1315,8 @@ int ath9k_init_debug(struct ath_hw *ah)
                            &ah->config.cwm_ignore_extcca);
        debugfs_create_file("regdump", S_IRUSR, sc->debug.debugfs_phy, sc,
                            &fops_regdump);
+        debugfs_create_file("dump_nfcal", S_IRUSR, sc->debug.debugfs_phy, sc,
+                            &fops_dump_nfcal);
        debugfs_create_file("base_eeprom", S_IRUSR, sc->debug.debugfs_phy, sc,
                            &fops_base_eeprom);
        debugfs_create_file("modal_eeprom", S_IRUSR, sc->debug.debugfs_phy, sc,
diff --git a/drivers/net/wireless/ath/ath9k/htc_drv_init.c b/drivers/net/wireless/ath/ath9k/htc_drv_init.c
index 19aa5b724887..9cf42f6973aa 100644
--- a/drivers/net/wireless/ath/ath9k/htc_drv_init.c
+++ b/drivers/net/wireless/ath/ath9k/htc_drv_init.c
@@ -572,25 +572,6 @@ err:
        return -EINVAL;
 }
-static void ath9k_init_crypto(struct ath9k_htc_priv *priv)
-{
-        struct ath_common *common = ath9k_hw_common(priv->ah);
-        int i = 0;
-        /* Get the hardware key cache size. */
-        common->keymax = AR_KEYTABLE_SIZE;
-        if (priv->ah->misc_mode & AR_PCU_MIC_NEW_LOC_ENA)
-                common->crypt_caps |= ATH_CRYPT_CAP_MIC_COMBINED;
-        /*
-         * Reset the key cache since some parts do not
-         * reset the contents on initial power up.
-         */
-        for (i = 0; i < common->keymax; i++)
-                ath_hw_keyreset(common, (u16) i);
-}
 static void ath9k_init_channels_rates(struct ath9k_htc_priv *priv)
 {
        if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_2GHZ) {
@@ -720,7 +701,7 @@ static int ath9k_init_priv(struct ath9k_htc_priv *priv,
        for (i = 0; i < ATH9K_HTC_MAX_BCN_VIF; i++)
                priv->cur_beacon_conf.bslot[i] = NULL;
-        ath9k_init_crypto(priv);
+        ath9k_cmn_init_crypto(ah);
        ath9k_init_channels_rates(priv);
        ath9k_init_misc(priv);
diff --git a/drivers/net/wireless/ath/ath9k/htc_drv_main.c b/drivers/net/wireless/ath/ath9k/htc_drv_main.c
index 7212acb2bd6c..0248024da56a 100644
--- a/drivers/net/wireless/ath/ath9k/htc_drv_main.c
+++ b/drivers/net/wireless/ath/ath9k/htc_drv_main.c
@@ -1736,6 +1736,22 @@ out:
        return ret;
 }
+static int ath9k_htc_get_stats(struct ieee80211_hw *hw,
+                               struct ieee80211_low_level_stats *stats)
+{
+        struct ath9k_htc_priv *priv = hw->priv;
+        struct ath_hw *ah = priv->ah;
+        struct ath9k_mib_stats *mib_stats = &ah->ah_mibStats;
+        stats->dot11ACKFailureCount = mib_stats->ackrcv_bad;
+        stats->dot11RTSFailureCount = mib_stats->rts_bad;
+        stats->dot11FCSErrorCount = mib_stats->fcs_bad;
+        stats->dot11RTSSuccessCount = mib_stats->rts_good;
+        return 0;
+}
 struct ieee80211_ops ath9k_htc_ops = {
        .tx                 = ath9k_htc_tx,
        .start              = ath9k_htc_start,
@@ -1759,4 +1775,5 @@ struct ieee80211_ops ath9k_htc_ops = {
        .rfkill_poll        = ath9k_htc_rfkill_poll_state,
        .set_coverage_class = ath9k_htc_set_coverage_class,
        .set_bitrate_mask   = ath9k_htc_set_bitrate_mask,
+        .get_stats          = ath9k_htc_get_stats,
 };
diff --git a/drivers/net/wireless/ath/ath9k/hw-ops.h b/drivers/net/wireless/ath/ath9k/hw-ops.h
index cb29e8875386..dd9003ee123b 100644
--- a/drivers/net/wireless/ath/ath9k/hw-ops.h
+++ b/drivers/net/wireless/ath/ath9k/hw-ops.h
@@ -22,10 +22,12 @@
 /* Hardware core and driver accessible callbacks */
 static inline void ath9k_hw_configpcipowersave(struct ath_hw *ah,
-                                               int restore,
+                                               bool power_off)
-                                               int power_off)
 {
-        ath9k_hw_ops(ah)->config_pci_powersave(ah, restore, power_off);
+        if (ah->aspm_enabled != true)
+                return;
+        ath9k_hw_ops(ah)->config_pci_powersave(ah, power_off);
 }
 static inline void ath9k_hw_rxena(struct ath_hw *ah)
diff --git a/drivers/net/wireless/ath/ath9k/hw.c b/drivers/net/wireless/ath/ath9k/hw.c
index db44e5b0c98b..a0d1147844fb 100644
--- a/drivers/net/wireless/ath/ath9k/hw.c
+++ b/drivers/net/wireless/ath/ath9k/hw.c
@@ -603,10 +603,7 @@ static int __ath9k_hw_init(struct ath_hw *ah)
        ath9k_hw_init_mode_regs(ah);
+        if (!ah->is_pciexpress)
-        if (ah->is_pciexpress)
-                ath9k_hw_aspm_init(ah);
-        else
                ath9k_hw_disablepcie(ah);
        if (!AR_SREV_9300_20_OR_LATER(ah))
@@ -621,6 +618,9 @@ static int __ath9k_hw_init(struct ath_hw *ah)
        if (r)
                return r;
+        if (ah->is_pciexpress)
+                ath9k_hw_aspm_init(ah);
        r = ath9k_hw_init_macaddr(ah);
        if (r) {
                ath_err(common, "Failed to initialize MAC address\n");
@@ -663,6 +663,7 @@ int ath9k_hw_init(struct ath_hw *ah)
        case AR9300_DEVID_AR9485_PCIE:
        case AR9300_DEVID_AR9330:
        case AR9300_DEVID_AR9340:
+        case AR9300_DEVID_AR9580:
                break;
        default:
                if (common->bus_ops->ath_bus_type == ATH_USB)
@@ -996,7 +997,7 @@ void ath9k_hw_init_global_settings(struct ath_hw *ah)
                slottime = 21;
                sifstime = 64;
        } else {
-                eifs = REG_READ(ah, AR_D_GBL_IFS_EIFS);
+                eifs = REG_READ(ah, AR_D_GBL_IFS_EIFS)/common->clockrate;
                reg = REG_READ(ah, AR_USEC);
                rx_lat = MS(reg, AR_USEC_RX_LAT);
                tx_lat = MS(reg, AR_USEC_TX_LAT);
diff --git a/drivers/net/wireless/ath/ath9k/hw.h b/drivers/net/wireless/ath/ath9k/hw.h
index 4fbcced2828c..3aa3fb191775 100644
--- a/drivers/net/wireless/ath/ath9k/hw.h
+++ b/drivers/net/wireless/ath/ath9k/hw.h
@@ -45,6 +45,7 @@
 #define AR9300_DEVID_PCIE       0x0030
 #define AR9300_DEVID_AR9340     0x0031
 #define AR9300_DEVID_AR9485_PCIE 0x0032
+#define AR9300_DEVID_AR9580     0x0033
 #define AR9300_DEVID_AR9330     0x0035
 #define AR5416_AR9100_DEVID     0x000b
@@ -606,8 +607,7 @@ struct ath_hw_private_ops {
 */
 struct ath_hw_ops {
        void (*config_pci_powersave)(struct ath_hw *ah,
-                                     int restore,
+                                     bool power_off);
-                                     int power_off);
        void (*rx_enable)(struct ath_hw *ah);
        void (*set_desc_link)(void *ds, u32 link);
        bool (*calibrate)(struct ath_hw *ah,
@@ -1037,10 +1037,6 @@ void ath9k_ani_reset(struct ath_hw *ah, bool is_scanning);
 void ath9k_hw_proc_mib_event(struct ath_hw *ah);
 void ath9k_hw_ani_monitor(struct ath_hw *ah, struct ath9k_channel *chan);
-#define ATH_PCIE_CAP_LINK_CTRL  0x70
-#define ATH_PCIE_CAP_LINK_L0S   1
-#define ATH_PCIE_CAP_LINK_L1    2
 #define ATH9K_CLOCK_RATE_CCK            22
 #define ATH9K_CLOCK_RATE_5GHZ_OFDM      40
 #define ATH9K_CLOCK_RATE_2GHZ_OFDM      44
diff --git a/drivers/net/wireless/ath/ath9k/init.c b/drivers/net/wireless/ath/ath9k/init.c
index db38a58e752d..d7761d1fc5ba 100644
--- a/drivers/net/wireless/ath/ath9k/init.c
+++ b/drivers/net/wireless/ath/ath9k/init.c
@@ -404,31 +404,6 @@ fail:
        return error;
 }
-void ath9k_init_crypto(struct ath_softc *sc)
-{
-        struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-        int i = 0;
-        /* Get the hardware key cache size. */
-        common->keymax = AR_KEYTABLE_SIZE;
-        /*
-         * Reset the key cache since some parts do not
-         * reset the contents on initial power up.
-         */
-        for (i = 0; i < common->keymax; i++)
-                ath_hw_keyreset(common, (u16) i);
-        /*
-         * Check whether the separate key cache entries
-         * are required to handle both tx+rx MIC keys.
-         * With split mic keys the number of stations is limited
-         * to 27 otherwise 59.
-         */
-        if (sc->sc_ah->misc_mode & AR_PCU_MIC_NEW_LOC_ENA)
-                common->crypt_caps |= ATH_CRYPT_CAP_MIC_COMBINED;
-}
 static int ath9k_init_btcoex(struct ath_softc *sc)
 {
        struct ath_txq *txq;
@@ -630,7 +605,7 @@ static int ath9k_init_softc(u16 devid, struct ath_softc *sc,
        if (ret)
                goto err_btcoex;
-        ath9k_init_crypto(sc);
+        ath9k_cmn_init_crypto(sc->sc_ah);
        ath9k_init_misc(sc);
        return 0;
diff --git a/drivers/net/wireless/ath/ath9k/mac.c b/drivers/net/wireless/ath/ath9k/mac.c
index 0f90e1521ffe..7ce9b320f0d9 100644
--- a/drivers/net/wireless/ath/ath9k/mac.c
+++ b/drivers/net/wireless/ath/ath9k/mac.c
@@ -345,21 +345,8 @@ int ath9k_hw_setuptxqueue(struct ath_hw *ah, enum ath9k_tx_queue type,
        }
        memset(qi, 0, sizeof(struct ath9k_tx_queue_info));
        qi->tqi_type = type;
-        if (qinfo == NULL) {
+        qi->tqi_physCompBuf = qinfo->tqi_physCompBuf;
-                qi->tqi_qflags =
+        (void) ath9k_hw_set_txq_props(ah, q, qinfo);
-                        TXQ_FLAG_TXOKINT_ENABLE
-                        | TXQ_FLAG_TXERRINT_ENABLE
-                        | TXQ_FLAG_TXDESCINT_ENABLE | TXQ_FLAG_TXURNINT_ENABLE;
-                qi->tqi_aifs = INIT_AIFS;
-                qi->tqi_cwmin = ATH9K_TXQ_USEDEFAULT;
-                qi->tqi_cwmax = INIT_CWMAX;
-                qi->tqi_shretry = INIT_SH_RETRY;
-                qi->tqi_lgretry = INIT_LG_RETRY;
-                qi->tqi_physCompBuf = 0;
-        } else {
-                qi->tqi_physCompBuf = qinfo->tqi_physCompBuf;
-                (void) ath9k_hw_set_txq_props(ah, q, qinfo);
-        }
        return q;
 }
@@ -564,7 +551,7 @@ bool ath9k_hw_resettxqueue(struct ath_hw *ah, u32 q)
 EXPORT_SYMBOL(ath9k_hw_resettxqueue);
 int ath9k_hw_rxprocdesc(struct ath_hw *ah, struct ath_desc *ds,
-                        struct ath_rx_status *rs, u64 tsf)
+                        struct ath_rx_status *rs)
 {
        struct ar5416_desc ads;
        struct ar5416_desc *adsp = AR5416DESC(ds);
diff --git a/drivers/net/wireless/ath/ath9k/mac.h b/drivers/net/wireless/ath/ath9k/mac.h
index 8e848c4d16ba..153859ccc2a1 100644
--- a/drivers/net/wireless/ath/ath9k/mac.h
+++ b/drivers/net/wireless/ath/ath9k/mac.h
@@ -687,7 +687,7 @@ int ath9k_hw_setuptxqueue(struct ath_hw *ah, enum ath9k_tx_queue type,
 bool ath9k_hw_releasetxqueue(struct ath_hw *ah, u32 q);
 bool ath9k_hw_resettxqueue(struct ath_hw *ah, u32 q);
 int ath9k_hw_rxprocdesc(struct ath_hw *ah, struct ath_desc *ds,
-                        struct ath_rx_status *rs, u64 tsf);
+                        struct ath_rx_status *rs);
 void ath9k_hw_setuprxdesc(struct ath_hw *ah, struct ath_desc *ds,
                          u32 size, u32 flags);
 bool ath9k_hw_setrxabort(struct ath_hw *ah, bool set);
diff --git a/drivers/net/wireless/ath/ath9k/main.c b/drivers/net/wireless/ath/ath9k/main.c
index 1e7fe8c0e119..5ac4f3f2ad60 100644
--- a/drivers/net/wireless/ath/ath9k/main.c
+++ b/drivers/net/wireless/ath/ath9k/main.c
@@ -565,7 +565,6 @@ set_timer:
 static void ath_node_attach(struct ath_softc *sc, struct ieee80211_sta *sta)
 {
        struct ath_node *an;
-        struct ath_hw *ah = sc->sc_ah;
        an = (struct ath_node *)sta->drv_priv;
 #ifdef CONFIG_ATH9K_DEBUGFS
@@ -574,9 +573,6 @@ static void ath_node_attach(struct ath_softc *sc, struct ieee80211_sta *sta)
        spin_unlock(&sc->nodes_lock);
        an->sta = sta;
 #endif
-        if ((ah->caps.hw_caps) & ATH9K_HW_CAP_APM)
-                sc->sc_flags |= SC_OP_ENABLE_APM;
        if (sc->sc_flags & SC_OP_TXAGGR) {
                ath_tx_node_init(sc, an);
                an->maxampdu = 1 << (IEEE80211_HT_MAX_AMPDU_FACTOR +
@@ -826,11 +822,9 @@ irqreturn_t ath_isr(int irq, void *dev)
        if (status & ATH9K_INT_TXURN)
                ath9k_hw_updatetxtriglevel(ah, true);
-        if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
+        if (status & ATH9K_INT_RXEOL) {
-                if (status & ATH9K_INT_RXEOL) {
+                ah->imask &= ~(ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
-                        ah->imask &= ~(ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
+                ath9k_hw_set_interrupts(ah, ah->imask);
-                        ath9k_hw_set_interrupts(ah, ah->imask);
-                }
        }
        if (status & ATH9K_INT_MIB) {
@@ -888,7 +882,7 @@ static void ath_radio_enable(struct ath_softc *sc, struct ieee80211_hw *hw)
        spin_lock_bh(&sc->sc_pcu_lock);
        atomic_set(&ah->intr_ref_cnt, -1);
-        ath9k_hw_configpcipowersave(ah, 0, 0);
+        ath9k_hw_configpcipowersave(ah, false);
        if (!ah->curchan)
                ah->curchan = ath9k_cmn_get_curchannel(sc->hw, ah);
@@ -969,7 +963,7 @@ void ath_radio_disable(struct ath_softc *sc, struct ieee80211_hw *hw)
        ath9k_hw_phy_disable(ah);
-        ath9k_hw_configpcipowersave(ah, 1, 1);
+        ath9k_hw_configpcipowersave(ah, true);
        spin_unlock_bh(&sc->sc_pcu_lock);
        ath9k_ps_restore(sc);
@@ -1069,7 +1063,7 @@ static int ath9k_start(struct ieee80211_hw *hw)
        init_channel = ath9k_cmn_get_curchannel(hw, ah);
        /* Reset SERDES registers */
-        ath9k_hw_configpcipowersave(ah, 0, 0);
+        ath9k_hw_configpcipowersave(ah, false);
        /*
         * The basic interface to setting the hardware in a good
@@ -1145,8 +1139,6 @@ static int ath9k_start(struct ieee80211_hw *hw)
                                           AR_STOMP_LOW_WLAN_WGHT);
                ath9k_hw_btcoex_enable(ah);
-                if (common->bus_ops->bt_coex_prep)
-                        common->bus_ops->bt_coex_prep(common);
                if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
                        ath9k_btcoex_timer_resume(sc);
        }
@@ -1680,6 +1672,7 @@ static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
        if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
                struct ieee80211_channel *curchan = hw->conf.channel;
+                struct ath9k_channel old_chan;
                int pos = curchan->hw_value;
                int old_pos = -1;
                unsigned long flags;
@@ -1696,15 +1689,25 @@ static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
                        "Set channel: %d MHz type: %d\n",
                        curchan->center_freq, conf->channel_type);
-                ath9k_cmn_update_ichannel(&sc->sc_ah->channels[pos],
-                                          curchan, conf->channel_type);
                /* update survey stats for the old channel before switching */
                spin_lock_irqsave(&common->cc_lock, flags);
                ath_update_survey_stats(sc);
                spin_unlock_irqrestore(&common->cc_lock, flags);
                /*
+                 * Preserve the current channel values, before updating
+                 * the same channel
+                 */
+                if (old_pos == pos) {
+                        memcpy(&old_chan, &sc->sc_ah->channels[pos],
+                                sizeof(struct ath9k_channel));
+                        ah->curchan = &old_chan;
+                }
+                ath9k_cmn_update_ichannel(&sc->sc_ah->channels[pos],
+                                          curchan, conf->channel_type);
+                /*
                 * If the operating channel changes, change the survey in-use flags
                 * along with it.
                 * Reset the survey data for the new channel, unless we're switching
@@ -2400,6 +2403,20 @@ skip:
        return sc->beacon.tx_last;
 }
+static int ath9k_get_stats(struct ieee80211_hw *hw,
+                           struct ieee80211_low_level_stats *stats)
+{
+        struct ath_softc *sc = hw->priv;
+        struct ath_hw *ah = sc->sc_ah;
+        struct ath9k_mib_stats *mib_stats = &ah->ah_mibStats;
+        stats->dot11ACKFailureCount = mib_stats->ackrcv_bad;
+        stats->dot11RTSFailureCount = mib_stats->rts_bad;
+        stats->dot11FCSErrorCount = mib_stats->fcs_bad;
+        stats->dot11RTSSuccessCount = mib_stats->rts_good;
+        return 0;
+}
 struct ieee80211_ops ath9k_ops = {
        .tx                 = ath9k_tx,
        .start              = ath9k_start,
@@ -2424,5 +2441,6 @@ struct ieee80211_ops ath9k_ops = {
        .set_coverage_class = ath9k_set_coverage_class,
        .flush              = ath9k_flush,
        .tx_frames_pending  = ath9k_tx_frames_pending,
-        .tx_last_beacon = ath9k_tx_last_beacon,
+        .tx_last_beacon     = ath9k_tx_last_beacon,
+        .get_stats          = ath9k_get_stats,
 };
diff --git a/drivers/net/wireless/ath/ath9k/pci.c b/drivers/net/wireless/ath/ath9k/pci.c
index 5685cf11cfe3..891661a61513 100644
--- a/drivers/net/wireless/ath/ath9k/pci.c
+++ b/drivers/net/wireless/ath/ath9k/pci.c
@@ -32,9 +32,11 @@ static DEFINE_PCI_DEVICE_TABLE(ath_pci_id_table) = {
        { PCI_VDEVICE(ATHEROS, 0x002E) }, /* PCI-E */
        { PCI_VDEVICE(ATHEROS, 0x0030) }, /* PCI-E  AR9300 */
        { PCI_VDEVICE(ATHEROS, 0x0032) }, /* PCI-E  AR9485 */
+        { PCI_VDEVICE(ATHEROS, 0x0033) }, /* PCI-E  AR9580 */
        { 0 }
 };
 /* return bus cachesize in 4B word units */
 static void ath_pci_read_cachesize(struct ath_common *common, int *csz)
 {
@@ -88,23 +90,6 @@ static bool ath_pci_eeprom_read(struct ath_common *common, u32 off, u16 *data)
        return true;
 }
-/*
- * Bluetooth coexistance requires disabling ASPM.
- */
-static void ath_pci_bt_coex_prep(struct ath_common *common)
-{
-        struct ath_softc *sc = (struct ath_softc *) common->priv;
-        struct pci_dev *pdev = to_pci_dev(sc->dev);
-        u8 aspm;
-        if (!pci_is_pcie(pdev))
-                return;
-        pci_read_config_byte(pdev, ATH_PCIE_CAP_LINK_CTRL, &aspm);
-        aspm &= ~(ATH_PCIE_CAP_LINK_L0S | ATH_PCIE_CAP_LINK_L1);
-        pci_write_config_byte(pdev, ATH_PCIE_CAP_LINK_CTRL, aspm);
-}
 static void ath_pci_extn_synch_enable(struct ath_common *common)
 {
        struct ath_softc *sc = (struct ath_softc *) common->priv;
@@ -116,6 +101,7 @@ static void ath_pci_extn_synch_enable(struct ath_common *common)
        pci_write_config_byte(pdev, sc->sc_ah->caps.pcie_lcr_offset, lnkctl);
 }
+/* Need to be called after we discover btcoex capabilities */
 static void ath_pci_aspm_init(struct ath_common *common)
 {
        struct ath_softc *sc = (struct ath_softc *) common->priv;
@@ -125,19 +111,38 @@ static void ath_pci_aspm_init(struct ath_common *common)
        int pos;
        u8 aspm;
-        if (!pci_is_pcie(pdev))
+        pos = pci_pcie_cap(pdev);
+        if (!pos)
                return;
        parent = pdev->bus->self;
-        if (WARN_ON(!parent))
+        if (!parent)
                return;
+        if (ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE) {
+                /* Bluetooth coexistance requires disabling ASPM. */
+                pci_read_config_byte(pdev, pos + PCI_EXP_LNKCTL, &aspm);
+                aspm &= ~(PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1);
+                pci_write_config_byte(pdev, pos + PCI_EXP_LNKCTL, aspm);
+                /*
+                 * Both upstream and downstream PCIe components should
+                 * have the same ASPM settings.
+                 */
+                pos = pci_pcie_cap(parent);
+                pci_read_config_byte(parent, pos + PCI_EXP_LNKCTL, &aspm);
+                aspm &= ~(PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1);
+                pci_write_config_byte(parent, pos + PCI_EXP_LNKCTL, aspm);
+                return;
+        }
        pos = pci_pcie_cap(parent);
        pci_read_config_byte(parent, pos +  PCI_EXP_LNKCTL, &aspm);
        if (aspm & (PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1)) {
                ah->aspm_enabled = true;
                /* Initialize PCIe PM and SERDES registers. */
-                ath9k_hw_configpcipowersave(ah, 0, 0);
+                ath9k_hw_configpcipowersave(ah, false);
        }
 }
@@ -145,7 +150,6 @@ static const struct ath_bus_ops ath_pci_bus_ops = {
        .ath_bus_type = ATH_PCI,
        .read_cachesize = ath_pci_read_cachesize,
        .eeprom_read = ath_pci_eeprom_read,
-        .bt_coex_prep = ath_pci_bt_coex_prep,
        .extn_synch_en = ath_pci_extn_synch_enable,
        .aspm_init = ath_pci_aspm_init,
 };
@@ -338,7 +342,7 @@ static int ath_pci_resume(struct device *device)
           * semi-random values after suspend/resume.
           */
        ath9k_ps_wakeup(sc);
-        ath9k_init_crypto(sc);
+        ath9k_cmn_init_crypto(sc->sc_ah);
        ath9k_ps_restore(sc);
        sc->ps_idle = true;
diff --git a/drivers/net/wireless/ath/ath9k/rc.c b/drivers/net/wireless/ath/ath9k/rc.c
index 9e3649a3d5ca..4f1301881137 100644
--- a/drivers/net/wireless/ath/ath9k/rc.c
+++ b/drivers/net/wireless/ath/ath9k/rc.c
@@ -603,7 +603,8 @@ static u8 ath_rc_setvalid_htrates(struct ath_rate_priv *ath_rc_priv,
 static u8 ath_rc_get_highest_rix(struct ath_softc *sc,
                                 struct ath_rate_priv *ath_rc_priv,
                                 const struct ath_rate_table *rate_table,
-                                 int *is_probing)
+                                 int *is_probing,
+                                 bool legacy)
 {
        u32 best_thruput, this_thruput, now_msec;
        u8 rate, next_rate, best_rate, maxindex, minindex;
@@ -624,6 +625,8 @@ static u8 ath_rc_get_highest_rix(struct ath_softc *sc,
                u8 per_thres;
                rate = ath_rc_priv->valid_rate_index[index];
+                if (legacy && !(rate_table->info[rate].rate_flags & RC_LEGACY))
+                        continue;
                if (rate > ath_rc_priv->rate_max_phy)
                        continue;
@@ -767,7 +770,7 @@ static void ath_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
        struct ieee80211_tx_rate *rates = tx_info->control.rates;
        struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
        __le16 fc = hdr->frame_control;
-        u8 try_per_rate, i = 0, rix;
+        u8 try_per_rate, i = 0, rix, high_rix;
        int is_probe = 0;
        if (rate_control_send_low(sta, priv_sta, txrc))
@@ -786,7 +789,9 @@ static void ath_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
        try_per_rate = 4;
        rate_table = ath_rc_priv->rate_table;
-        rix = ath_rc_get_highest_rix(sc, ath_rc_priv, rate_table, &is_probe);
+        rix = ath_rc_get_highest_rix(sc, ath_rc_priv, rate_table,
+                                     &is_probe, false);
+        high_rix = rix;
        /*
         * If we're in HT mode and both us and our peer supports LDPC.
@@ -822,10 +827,7 @@ static void ath_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
        }
        /* Fill in the other rates for multirate retry */
-        for ( ; i < 4; i++) {
+        for ( ; i < 3; i++) {
-                /* Use twice the number of tries for the last MRR segment. */
-                if (i + 1 == 4)
-                        try_per_rate = 8;
                ath_rc_get_lower_rix(rate_table, ath_rc_priv, rix, &rix);
                /* All other rates in the series have RTS enabled */
@@ -833,6 +835,24 @@ static void ath_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
                                       try_per_rate, rix, 1);
        }
+        /* Use twice the number of tries for the last MRR segment. */
+        try_per_rate = 8;
+        /*
+         * Use a legacy rate as last retry to ensure that the frame
+         * is tried in both MCS and legacy rates.
+         */
+        if ((rates[2].flags & IEEE80211_TX_RC_MCS) &&
+            (!(tx_info->flags & IEEE80211_TX_CTL_AMPDU) ||
+            (ath_rc_priv->per[high_rix] > 45)))
+                rix = ath_rc_get_highest_rix(sc, ath_rc_priv, rate_table,
+                                &is_probe, true);
+        else
+                ath_rc_get_lower_rix(rate_table, ath_rc_priv, rix, &rix);
+        /* All other rates in the series have RTS enabled */
+        ath_rc_rate_set_series(rate_table, &rates[i], txrc,
+                               try_per_rate, rix, 1);
        /*
         * NB:Change rate series to enable aggregation when operating
         * at lower MCS rates. When first rate in series is MCS2
diff --git a/drivers/net/wireless/ath/ath9k/recv.c b/drivers/net/wireless/ath/ath9k/recv.c
index 74094022b654..ad5f9bd2f0b9 100644
--- a/drivers/net/wireless/ath/ath9k/recv.c
+++ b/drivers/net/wireless/ath/ath9k/recv.c
@@ -761,7 +761,7 @@ static struct ath_buf *ath_get_next_rx_buf(struct ath_softc *sc,
         * on.  All this is necessary because of our use of
         * a self-linked list to avoid rx overruns.
         */
-        ret = ath9k_hw_rxprocdesc(ah, ds, rs, 0);
+        ret = ath9k_hw_rxprocdesc(ah, ds, rs);
        if (ret == -EINPROGRESS) {
                struct ath_rx_status trs;
                struct ath_buf *tbf;
@@ -787,7 +787,7 @@ static struct ath_buf *ath_get_next_rx_buf(struct ath_softc *sc,
                 */
                tds = tbf->bf_desc;
-                ret = ath9k_hw_rxprocdesc(ah, tds, &trs, 0);
+                ret = ath9k_hw_rxprocdesc(ah, tds, &trs);
                if (ret == -EINPROGRESS)
                        return NULL;
        }
@@ -824,7 +824,8 @@ static bool ath9k_rx_accept(struct ath_common *common,
        is_mc = !!is_multicast_ether_addr(hdr->addr1);
        is_valid_tkip = rx_stats->rs_keyix != ATH9K_RXKEYIX_INVALID &&
                test_bit(rx_stats->rs_keyix, common->tkip_keymap);
-        strip_mic = is_valid_tkip && !(rx_stats->rs_status &
+        strip_mic = is_valid_tkip && ieee80211_is_data(fc) &&
+                !(rx_stats->rs_status &
                (ATH9K_RXERR_DECRYPT | ATH9K_RXERR_CRC | ATH9K_RXERR_MIC));
        if (!rx_stats->rs_datalen)
@@ -1978,5 +1979,10 @@ requeue:
        spin_unlock_bh(&sc->rx.rxbuflock);
+        if (!(ah->imask & ATH9K_INT_RXEOL)) {
+                ah->imask |= (ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
+                ath9k_hw_set_interrupts(ah, ah->imask);
+        }
        return 0;
 }
diff --git a/drivers/net/wireless/ath/ath9k/reg.h b/drivers/net/wireless/ath/ath9k/reg.h
index fa4c0bbce6b9..a3b8bbc6c063 100644
--- a/drivers/net/wireless/ath/ath9k/reg.h
+++ b/drivers/net/wireless/ath/ath9k/reg.h
@@ -793,6 +793,8 @@
 #define AR_SREV_REVISION_9485_10        0
 #define AR_SREV_REVISION_9485_11        1
 #define AR_SREV_VERSION_9340            0x300
+#define AR_SREV_VERSION_9580            0x1C0
+#define AR_SREV_REVISION_9580_10        4 /* AR9580 1.0 */
 #define AR_SREV_5416(_ah) \
        (((_ah)->hw_version.macVersion == AR_SREV_VERSION_5416_PCI) || \
@@ -893,6 +895,18 @@
    (AR_SREV_9285_12_OR_LATER(_ah) && \
     ((REG_READ(_ah, AR_AN_SYNTH9) & 0x7) == 0x1))
+#define AR_SREV_9580(_ah) \
+        (((_ah)->hw_version.macVersion == AR_SREV_VERSION_9580) && \
+        ((_ah)->hw_version.macRev >= AR_SREV_REVISION_9580_10))
+#define AR_SREV_9580_10(_ah) \
+        (((_ah)->hw_version.macVersion == AR_SREV_VERSION_9580) && \
+        ((_ah)->hw_version.macRev == AR_SREV_REVISION_9580_10))
+/* NOTE: When adding chips newer than Peacock, add chip check here */
+#define AR_SREV_9580_10_OR_LATER(_ah) \
+        (AR_SREV_9580(_ah))
 enum ath_usb_dev {
        AR9280_USB = 1, /* AR7010 + AR9280, UB94 */
        AR9287_USB = 2, /* AR7010 + AR9287, UB95 */
diff --git a/drivers/net/wireless/ath/ath9k/xmit.c b/drivers/net/wireless/ath/ath9k/xmit.c
index e1d1e903229b..5e2982938ffc 100644
--- a/drivers/net/wireless/ath/ath9k/xmit.c
+++ b/drivers/net/wireless/ath/ath9k/xmit.c
@@ -571,6 +571,25 @@ static void ath_tx_complete_aggr(struct ath_softc *sc, struct ath_txq *txq,
                ath_reset(sc, false);
 }
+static bool ath_lookup_legacy(struct ath_buf *bf)
+{
+        struct sk_buff *skb;
+        struct ieee80211_tx_info *tx_info;
+        struct ieee80211_tx_rate *rates;
+        int i;
+        skb = bf->bf_mpdu;
+        tx_info = IEEE80211_SKB_CB(skb);
+        rates = tx_info->control.rates;
+        for (i = 3; i >= 0; i--) {
+                if (!(rates[i].flags & IEEE80211_TX_RC_MCS))
+                        return true;
+        }
+        return false;
+}
 static u32 ath_lookup_rate(struct ath_softc *sc, struct ath_buf *bf,
                           struct ath_atx_tid *tid)
 {
@@ -644,8 +663,10 @@ static u32 ath_lookup_rate(struct ath_softc *sc, struct ath_buf *bf,
 * meet the minimum required mpdudensity.
 */
 static int ath_compute_num_delims(struct ath_softc *sc, struct ath_atx_tid *tid,
-                                  struct ath_buf *bf, u16 frmlen)
+                                  struct ath_buf *bf, u16 frmlen,
+                                  bool first_subfrm)
 {
+#define FIRST_DESC_NDELIMS 60
        struct sk_buff *skb = bf->bf_mpdu;
        struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
        u32 nsymbits, nsymbols;
@@ -668,6 +689,13 @@ static int ath_compute_num_delims(struct ath_softc *sc, struct ath_atx_tid *tid,
                ndelim += ATH_AGGR_ENCRYPTDELIM;
        /*
+         * Add delimiter when using RTS/CTS with aggregation
+         * and non enterprise AR9003 card
+         */
+        if (first_subfrm)
+                ndelim = max(ndelim, FIRST_DESC_NDELIMS);
+        /*
         * Convert desired mpdu density from microeconds to bytes based
         * on highest rate in rate series (i.e. first rate) to determine
         * required minimum length for subframe. Take into account
@@ -741,7 +769,8 @@ static enum ATH_AGGR_STATUS ath_tx_form_aggr(struct ath_softc *sc,
                al_delta = ATH_AGGR_DELIM_SZ + fi->framelen;
                if (nframes &&
-                    (aggr_limit < (al + bpad + al_delta + prev_al))) {
+                    ((aggr_limit < (al + bpad + al_delta + prev_al)) ||
+                     ath_lookup_legacy(bf))) {
                        status = ATH_AGGR_LIMITED;
                        break;
                }
@@ -756,7 +785,6 @@ static enum ATH_AGGR_STATUS ath_tx_form_aggr(struct ath_softc *sc,
                        status = ATH_AGGR_LIMITED;
                        break;
                }
-                nframes++;
                /* add padding for previous frame to aggregation length */
                al += bpad + al_delta;
@@ -765,9 +793,11 @@ static enum ATH_AGGR_STATUS ath_tx_form_aggr(struct ath_softc *sc,
                 * Get the delimiters needed to meet the MPDU
                 * density for this node.
                 */
-                ndelim = ath_compute_num_delims(sc, tid, bf_first, fi->framelen);
+                ndelim = ath_compute_num_delims(sc, tid, bf_first, fi->framelen,
+                                                !nframes);
                bpad = PADBYTES(al_delta) + (ndelim << 2);
+                nframes++;
                bf->bf_next = NULL;
                ath9k_hw_set_desc_link(sc->sc_ah, bf->bf_desc, 0);
@@ -1574,9 +1604,9 @@ u8 ath_txchainmask_reduction(struct ath_softc *sc, u8 chainmask, u32 rate)
 {
        struct ath_hw *ah = sc->sc_ah;
        struct ath9k_channel *curchan = ah->curchan;
-        if ((sc->sc_flags & SC_OP_ENABLE_APM) &&
+        if ((ah->caps.hw_caps & ATH9K_HW_CAP_APM) &&
-                        (curchan->channelFlags & CHANNEL_5GHZ) &&
+            (curchan->channelFlags & CHANNEL_5GHZ) &&
-                        (chainmask == 0x7) && (rate < 0x90))
+            (chainmask == 0x7) && (rate < 0x90))
                return 0x3;
        else
                return chainmask;
diff --git a/drivers/net/wireless/ath/carl9170/Kconfig b/drivers/net/wireless/ath/carl9170/Kconfig
index 2d1b821b440d..267d5dcf82dc 100644
--- a/drivers/net/wireless/ath/carl9170/Kconfig
+++ b/drivers/net/wireless/ath/carl9170/Kconfig
@@ -39,3 +39,17 @@ config CARL9170_WPC
        bool
        depends on CARL9170 && (INPUT = y || INPUT = CARL9170)
        default y
+config CARL9170_HWRNG
+        bool "Random number generator"
+        depends on CARL9170 && (HW_RANDOM = y || HW_RANDOM = CARL9170)
+        default n
+        help
+          Provides a hardware random number generator to the kernel.
+          SECURITY WARNING: It's relatively easy to eavesdrop all
+          generated random numbers from the transport stream with
+          usbmon [software] or special usb sniffer hardware.
+          Say N, unless your setup[i.e.: embedded system] has no
+          other rng source and you can afford to take the risk.
diff --git a/drivers/net/wireless/ath/carl9170/carl9170.h b/drivers/net/wireless/ath/carl9170/carl9170.h
index c5427a72a1e2..6cfbb419e2f6 100644
--- a/drivers/net/wireless/ath/carl9170/carl9170.h
+++ b/drivers/net/wireless/ath/carl9170/carl9170.h
@@ -43,6 +43,7 @@
 #include <linux/firmware.h>
 #include <linux/completion.h>
 #include <linux/spinlock.h>
+#include <linux/hw_random.h>
 #include <net/cfg80211.h>
 #include <net/mac80211.h>
 #include <linux/usb.h>
@@ -151,6 +152,7 @@ struct carl9170_sta_tid {
 #define CARL9170_TX_TIMEOUT             2500
 #define CARL9170_JANITOR_DELAY          128
 #define CARL9170_QUEUE_STUCK_TIMEOUT    5500
+#define CARL9170_STAT_WORK              30000
 #define CARL9170_NUM_TX_AGG_MAX         30
@@ -282,6 +284,7 @@ struct ar9170 {
                bool rx_stream;
                bool tx_stream;
                bool rx_filter;
+                bool hw_counters;
                unsigned int mem_blocks;
                unsigned int mem_block_size;
                unsigned int rx_size;
@@ -331,11 +334,21 @@ struct ar9170 {
        /* PHY */
        struct ieee80211_channel *channel;
+        unsigned int num_channels;
        int noise[4];
        unsigned int chan_fail;
        unsigned int total_chan_fail;
        u8 heavy_clip;
        u8 ht_settings;
+        struct {
+                u64 active;     /* usec */
+                u64 cca;        /* usec */
+                u64 tx_time;    /* usec */
+                u64 rx_total;
+                u64 rx_overrun;
+        } tally;
+        struct delayed_work stat_work;
+        struct survey_info *survey;
        /* power calibration data */
        u8 power_5G_leg[4];
@@ -437,6 +450,17 @@ struct ar9170 {
                unsigned int off_override;
                bool state;
        } ps;
+#ifdef CONFIG_CARL9170_HWRNG
+# define CARL9170_HWRNG_CACHE_SIZE      CARL9170_MAX_CMD_PAYLOAD_LEN
+        struct {
+                struct hwrng rng;
+                bool initialized;
+                char name[30 + 1];
+                u16 cache[CARL9170_HWRNG_CACHE_SIZE / sizeof(u16)];
+                unsigned int cache_idx;
+        } rng;
+#endif /* CONFIG_CARL9170_HWRNG */
 };
 enum carl9170_ps_off_override_reasons {
diff --git a/drivers/net/wireless/ath/carl9170/cmd.c b/drivers/net/wireless/ath/carl9170/cmd.c
index cdfc94c371b4..195dc6538110 100644
--- a/drivers/net/wireless/ath/carl9170/cmd.c
+++ b/drivers/net/wireless/ath/carl9170/cmd.c
@@ -36,6 +36,7 @@
 *    OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */
+#include <asm/div64.h>
 #include "carl9170.h"
 #include "cmd.h"
@@ -165,6 +166,39 @@ int carl9170_bcn_ctrl(struct ar9170 *ar, const unsigned int vif_id,
        return __carl9170_exec_cmd(ar, cmd, true);
 }
+int carl9170_collect_tally(struct ar9170 *ar)
+{
+        struct carl9170_tally_rsp tally;
+        struct survey_info *info;
+        unsigned int tick;
+        int err;
+        err = carl9170_exec_cmd(ar, CARL9170_CMD_TALLY, 0, NULL,
+                                sizeof(tally), (u8 *)&tally);
+        if (err)
+                return err;
+        tick = le32_to_cpu(tally.tick);
+        if (tick) {
+                ar->tally.active += le32_to_cpu(tally.active) / tick;
+                ar->tally.cca += le32_to_cpu(tally.cca) / tick;
+                ar->tally.tx_time += le32_to_cpu(tally.tx_time) / tick;
+                ar->tally.rx_total += le32_to_cpu(tally.rx_total);
+                ar->tally.rx_overrun += le32_to_cpu(tally.rx_overrun);
+                if (ar->channel) {
+                        info = &ar->survey[ar->channel->hw_value];
+                        info->channel_time = ar->tally.active;
+                        info->channel_time_busy = ar->tally.cca;
+                        info->channel_time_tx = ar->tally.tx_time;
+                        do_div(info->channel_time, 1000);
+                        do_div(info->channel_time_busy, 1000);
+                        do_div(info->channel_time_tx, 1000);
+                }
+        }
+        return 0;
+}
 int carl9170_powersave(struct ar9170 *ar, const bool ps)
 {
        struct carl9170_cmd *cmd;
diff --git a/drivers/net/wireless/ath/carl9170/cmd.h b/drivers/net/wireless/ath/carl9170/cmd.h
index d5f95bdc75c1..885c42778b8b 100644
--- a/drivers/net/wireless/ath/carl9170/cmd.h
+++ b/drivers/net/wireless/ath/carl9170/cmd.h
@@ -50,6 +50,7 @@ int carl9170_echo_test(struct ar9170 *ar, u32 v);
 int carl9170_reboot(struct ar9170 *ar);
 int carl9170_mac_reset(struct ar9170 *ar);
 int carl9170_powersave(struct ar9170 *ar, const bool power_on);
+int carl9170_collect_tally(struct ar9170 *ar);
 int carl9170_bcn_ctrl(struct ar9170 *ar, const unsigned int vif_id,
                       const u32 mode, const u32 addr, const u32 len);
diff --git a/drivers/net/wireless/ath/carl9170/fw.c b/drivers/net/wireless/ath/carl9170/fw.c
index 39ddea5794f7..f4cae1cccbff 100644
--- a/drivers/net/wireless/ath/carl9170/fw.c
+++ b/drivers/net/wireless/ath/carl9170/fw.c
@@ -266,6 +266,9 @@ static int carl9170_fw(struct ar9170 *ar, const __u8 *data, size_t len)
                        FIF_PROMISC_IN_BSS;
        }
+        if (SUPP(CARL9170FW_HW_COUNTERS))
+                ar->fw.hw_counters = true;
        if (SUPP(CARL9170FW_WOL))
                device_set_wakeup_enable(&ar->udev->dev, true);
diff --git a/drivers/net/wireless/ath/carl9170/fwcmd.h b/drivers/net/wireless/ath/carl9170/fwcmd.h
index 0a6dec529b59..9443c802b25b 100644
--- a/drivers/net/wireless/ath/carl9170/fwcmd.h
+++ b/drivers/net/wireless/ath/carl9170/fwcmd.h
@@ -55,6 +55,7 @@ enum carl9170_cmd_oids {
        CARL9170_CMD_READ_TSF           = 0x06,
        CARL9170_CMD_RX_FILTER          = 0x07,
        CARL9170_CMD_WOL                = 0x08,
+        CARL9170_CMD_TALLY              = 0x09,
        /* CAM */
        CARL9170_CMD_EKEY               = 0x10,
@@ -286,6 +287,15 @@ struct carl9170_tsf_rsp {
 } __packed;
 #define CARL9170_TSF_RSP_SIZE           8
+struct carl9170_tally_rsp {
+        __le32 active;
+        __le32 cca;
+        __le32 tx_time;
+        __le32 rx_total;
+        __le32 rx_overrun;
+        __le32 tick;
+} __packed;
 struct carl9170_rsp {
        struct carl9170_cmd_head hdr;
@@ -300,6 +310,7 @@ struct carl9170_rsp {
                struct carl9170_gpio            gpio;
                struct carl9170_tsf_rsp         tsf;
                struct carl9170_psm             psm;
+                struct carl9170_tally_rsp       tally;
                u8 data[CARL9170_MAX_CMD_PAYLOAD_LEN];
        } __packed;
 } __packed __aligned(4);
diff --git a/drivers/net/wireless/ath/carl9170/main.c b/drivers/net/wireless/ath/carl9170/main.c
index 0122930b14c7..782b8f3ae58f 100644
--- a/drivers/net/wireless/ath/carl9170/main.c
+++ b/drivers/net/wireless/ath/carl9170/main.c
@@ -413,6 +413,9 @@ static int carl9170_op_start(struct ieee80211_hw *hw)
        carl9170_set_state_when(ar, CARL9170_IDLE, CARL9170_STARTED);
+        ieee80211_queue_delayed_work(ar->hw, &ar->stat_work,
+                round_jiffies(msecs_to_jiffies(CARL9170_STAT_WORK)));
        ieee80211_wake_queues(ar->hw);
        err = 0;
@@ -423,6 +426,7 @@ out:
 static void carl9170_cancel_worker(struct ar9170 *ar)
 {
+        cancel_delayed_work_sync(&ar->stat_work);
        cancel_delayed_work_sync(&ar->tx_janitor);
 #ifdef CONFIG_CARL9170_LEDS
        cancel_delayed_work_sync(&ar->led_work);
@@ -794,6 +798,43 @@ static void carl9170_ps_work(struct work_struct *work)
        mutex_unlock(&ar->mutex);
 }
+static int carl9170_update_survey(struct ar9170 *ar, bool flush, bool noise)
+{
+        int err;
+        if (noise) {
+                err = carl9170_get_noisefloor(ar);
+                if (err)
+                        return err;
+        }
+        if (ar->fw.hw_counters) {
+                err = carl9170_collect_tally(ar);
+                if (err)
+                        return err;
+        }
+        if (flush)
+                memset(&ar->tally, 0, sizeof(ar->tally));
+        return 0;
+}
+static void carl9170_stat_work(struct work_struct *work)
+{
+        struct ar9170 *ar = container_of(work, struct ar9170, stat_work.work);
+        int err;
+        mutex_lock(&ar->mutex);
+        err = carl9170_update_survey(ar, false, true);
+        mutex_unlock(&ar->mutex);
+        if (err)
+                return;
+        ieee80211_queue_delayed_work(ar->hw, &ar->stat_work,
+                round_jiffies(msecs_to_jiffies(CARL9170_STAT_WORK)));
+}
 static int carl9170_op_config(struct ieee80211_hw *hw, u32 changed)
 {
@@ -828,11 +869,19 @@ static int carl9170_op_config(struct ieee80211_hw *hw, u32 changed)
                if (err)
                        goto out;
+                err = carl9170_update_survey(ar, true, false);
+                if (err)
+                        goto out;
                err = carl9170_set_channel(ar, hw->conf.channel,
                        hw->conf.channel_type, CARL9170_RFI_NONE);
                if (err)
                        goto out;
+                err = carl9170_update_survey(ar, false, true);
+                if (err)
+                        goto out;
                err = carl9170_set_dyn_sifs_ack(ar);
                if (err)
                        goto out;
@@ -1419,24 +1468,159 @@ static int carl9170_register_wps_button(struct ar9170 *ar)
 }
 #endif /* CONFIG_CARL9170_WPC */
-static int carl9170_op_get_survey(struct ieee80211_hw *hw, int idx,
+#ifdef CONFIG_CARL9170_HWRNG
-                                struct survey_info *survey)
+static int carl9170_rng_get(struct ar9170 *ar)
 {
-        struct ar9170 *ar = hw->priv;
+#define RW      (CARL9170_MAX_CMD_PAYLOAD_LEN / sizeof(u32))
+#define RB      (CARL9170_MAX_CMD_PAYLOAD_LEN)
+        static const __le32 rng_load[RW] = {
+                [0 ... (RW - 1)] = cpu_to_le32(AR9170_RAND_REG_NUM)};
+        u32 buf[RW];
+        unsigned int i, off = 0, transfer, count;
        int err;
-        if (idx != 0)
+        BUILD_BUG_ON(RB > CARL9170_MAX_CMD_PAYLOAD_LEN);
-                return -ENOENT;
+        if (!IS_ACCEPTING_CMD(ar) || !ar->rng.initialized)
+                return -EAGAIN;
+        count = ARRAY_SIZE(ar->rng.cache);
+        while (count) {
+                err = carl9170_exec_cmd(ar, CARL9170_CMD_RREG,
+                                        RB, (u8 *) rng_load,
+                                        RB, (u8 *) buf);
+                if (err)
+                        return err;
+                transfer = min_t(unsigned int, count, RW);
+                for (i = 0; i < transfer; i++)
+                        ar->rng.cache[off + i] = buf[i];
+                off += transfer;
+                count -= transfer;
+        }
+        ar->rng.cache_idx = 0;
+#undef RW
+#undef RB
+        return 0;
+}
+static int carl9170_rng_read(struct hwrng *rng, u32 *data)
+{
+        struct ar9170 *ar = (struct ar9170 *)rng->priv;
+        int ret = -EIO;
        mutex_lock(&ar->mutex);
-        err = carl9170_get_noisefloor(ar);
+        if (ar->rng.cache_idx >= ARRAY_SIZE(ar->rng.cache)) {
+                ret = carl9170_rng_get(ar);
+                if (ret) {
+                        mutex_unlock(&ar->mutex);
+                        return ret;
+                }
+        }
+        *data = ar->rng.cache[ar->rng.cache_idx++];
        mutex_unlock(&ar->mutex);
-        if (err)
+        return sizeof(u16);
+}
+static void carl9170_unregister_hwrng(struct ar9170 *ar)
+{
+        if (ar->rng.initialized) {
+                hwrng_unregister(&ar->rng.rng);
+                ar->rng.initialized = false;
+        }
+}
+static int carl9170_register_hwrng(struct ar9170 *ar)
+{
+        int err;
+        snprintf(ar->rng.name, ARRAY_SIZE(ar->rng.name),
+                 "%s_%s", KBUILD_MODNAME, wiphy_name(ar->hw->wiphy));
+        ar->rng.rng.name = ar->rng.name;
+        ar->rng.rng.data_read = carl9170_rng_read;
+        ar->rng.rng.priv = (unsigned long)ar;
+        if (WARN_ON(ar->rng.initialized))
+                return -EALREADY;
+        err = hwrng_register(&ar->rng.rng);
+        if (err) {
+                dev_err(&ar->udev->dev, "Failed to register the random "
+                        "number generator (%d)\n", err);
                return err;
+        }
+        ar->rng.initialized = true;
+        err = carl9170_rng_get(ar);
+        if (err) {
+                carl9170_unregister_hwrng(ar);
+                return err;
+        }
+        return 0;
+}
+#endif /* CONFIG_CARL9170_HWRNG */
+static int carl9170_op_get_survey(struct ieee80211_hw *hw, int idx,
+                                struct survey_info *survey)
+{
+        struct ar9170 *ar = hw->priv;
+        struct ieee80211_channel *chan;
+        struct ieee80211_supported_band *band;
+        int err, b, i;
+        chan = ar->channel;
+        if (!chan)
+                return -ENODEV;
+        if (idx == chan->hw_value) {
+                mutex_lock(&ar->mutex);
+                err = carl9170_update_survey(ar, false, true);
+                mutex_unlock(&ar->mutex);
+                if (err)
+                        return err;
+        }
+        for (b = 0; b < IEEE80211_NUM_BANDS; b++) {
+                band = ar->hw->wiphy->bands[b];
+                if (!band)
+                        continue;
+                for (i = 0; i < band->n_channels; i++) {
+                        if (band->channels[i].hw_value == idx) {
+                                chan = &band->channels[i];
+                                goto found;
+                        }
+                }
+        }
+        return -ENOENT;
+found:
+        memcpy(survey, &ar->survey[idx], sizeof(*survey));
-        survey->channel = ar->channel;
+        survey->channel = chan;
        survey->filled = SURVEY_INFO_NOISE_DBM;
-        survey->noise = ar->noise[0];
+        if (ar->channel == chan)
+                survey->filled |= SURVEY_INFO_IN_USE;
+        if (ar->fw.hw_counters) {
+                survey->filled |= SURVEY_INFO_CHANNEL_TIME |
+                                  SURVEY_INFO_CHANNEL_TIME_BUSY |
+                                  SURVEY_INFO_CHANNEL_TIME_TX;
+        }
        return 0;
 }
@@ -1569,6 +1753,7 @@ void *carl9170_alloc(size_t priv_size)
        INIT_WORK(&ar->ping_work, carl9170_ping_work);
        INIT_WORK(&ar->restart_work, carl9170_restart_work);
        INIT_WORK(&ar->ampdu_work, carl9170_ampdu_work);
+        INIT_DELAYED_WORK(&ar->stat_work, carl9170_stat_work);
        INIT_DELAYED_WORK(&ar->tx_janitor, carl9170_tx_janitor);
        INIT_LIST_HEAD(&ar->tx_ampdu_list);
        rcu_assign_pointer(ar->tx_ampdu_iter,
@@ -1652,6 +1837,7 @@ static int carl9170_parse_eeprom(struct ar9170 *ar)
        struct ath_regulatory *regulatory = &ar->common.regulatory;
        unsigned int rx_streams, tx_streams, tx_params = 0;
        int bands = 0;
+        int chans = 0;
        if (ar->eeprom.length == cpu_to_le16(0xffff))
                return -ENODATA;
@@ -1675,14 +1861,24 @@ static int carl9170_parse_eeprom(struct ar9170 *ar)
        if (ar->eeprom.operating_flags & AR9170_OPFLAG_2GHZ) {
                ar->hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
                        &carl9170_band_2GHz;
+                chans += carl9170_band_2GHz.n_channels;
                bands++;
        }
        if (ar->eeprom.operating_flags & AR9170_OPFLAG_5GHZ) {
                ar->hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
                        &carl9170_band_5GHz;
+                chans += carl9170_band_5GHz.n_channels;
                bands++;
        }
+        if (!bands)
+                return -EINVAL;
+        ar->survey = kzalloc(sizeof(struct survey_info) * chans, GFP_KERNEL);
+        if (!ar->survey)
+                return -ENOMEM;
+        ar->num_channels = chans;
        /*
         * I measured this, a bandswitch takes roughly
         * 135 ms and a frequency switch about 80.
@@ -1701,7 +1897,7 @@ static int carl9170_parse_eeprom(struct ar9170 *ar)
        /* second part of wiphy init */
        SET_IEEE80211_PERM_ADDR(ar->hw, ar->eeprom.mac_address);
-        return bands ? 0 : -EINVAL;
+        return 0;
 }
 static int carl9170_reg_notifier(struct wiphy *wiphy,
@@ -1785,6 +1981,12 @@ int carl9170_register(struct ar9170 *ar)
                goto err_unreg;
 #endif /* CONFIG_CARL9170_WPC */
+#ifdef CONFIG_CARL9170_HWRNG
+        err = carl9170_register_hwrng(ar);
+        if (err)
+                goto err_unreg;
+#endif /* CONFIG_CARL9170_HWRNG */
        dev_info(&ar->udev->dev, "Atheros AR9170 is registered as '%s'\n",
                 wiphy_name(ar->hw->wiphy));
@@ -1817,6 +2019,10 @@ void carl9170_unregister(struct ar9170 *ar)
        }
 #endif /* CONFIG_CARL9170_WPC */
+#ifdef CONFIG_CARL9170_HWRNG
+        carl9170_unregister_hwrng(ar);
+#endif /* CONFIG_CARL9170_HWRNG */
        carl9170_cancel_worker(ar);
        cancel_work_sync(&ar->restart_work);
@@ -1834,6 +2040,9 @@ void carl9170_free(struct ar9170 *ar)
        kfree(ar->mem_bitmap);
        ar->mem_bitmap = NULL;
+        kfree(ar->survey);
+        ar->survey = NULL;
        mutex_destroy(&ar->mutex);
        ieee80211_free_hw(ar->hw);
diff --git a/drivers/net/wireless/ath/carl9170/phy.c b/drivers/net/wireless/ath/carl9170/phy.c
index aa147a9120b6..472efc7e3402 100644
--- a/drivers/net/wireless/ath/carl9170/phy.c
+++ b/drivers/net/wireless/ath/carl9170/phy.c
@@ -578,11 +578,10 @@ static int carl9170_init_phy(struct ar9170 *ar, enum ieee80211_band band)
        if (err)
                return err;
-        /* XXX: remove magic! */
+        if (!ar->fw.hw_counters) {
-        if (is_2ghz)
+                err = carl9170_write_reg(ar, AR9170_PWR_REG_PLL_ADDAC,
-                err = carl9170_write_reg(ar, AR9170_PWR_REG_PLL_ADDAC, 0x5163);
+                                         is_2ghz ? 0x5163 : 0x5143);
-        else
+        }
-                err = carl9170_write_reg(ar, AR9170_PWR_REG_PLL_ADDAC, 0x5143);
        return err;
 }
@@ -1574,6 +1573,9 @@ int carl9170_get_noisefloor(struct ar9170 *ar)
                        AR9170_PHY_EXT_CCA_MIN_PWR, phy_res[i + 2]), 8);
        }
+        if (ar->channel)
+                ar->survey[ar->channel->hw_value].noise = ar->noise[0];
        return 0;
 }
@@ -1766,10 +1768,6 @@ int carl9170_set_channel(struct ar9170 *ar, struct ieee80211_channel *channel,
                ar->chan_fail = 0;
        }
-        err = carl9170_get_noisefloor(ar);
-        if (err)
-                return err;
        if (ar->heavy_clip) {
                err = carl9170_write_reg(ar, AR9170_PHY_REG_HEAVY_CLIP_ENABLE,
                                         0x200 | ar->heavy_clip);
diff --git a/drivers/net/wireless/ath/carl9170/version.h b/drivers/net/wireless/ath/carl9170/version.h
index 64703778cfea..e651db856344 100644
--- a/drivers/net/wireless/ath/carl9170/version.h
+++ b/drivers/net/wireless/ath/carl9170/version.h
@@ -1,7 +1,7 @@
 #ifndef __CARL9170_SHARED_VERSION_H
 #define __CARL9170_SHARED_VERSION_H
 #define CARL9170FW_VERSION_YEAR 11
-#define CARL9170FW_VERSION_MONTH 6
+#define CARL9170FW_VERSION_MONTH 8
-#define CARL9170FW_VERSION_DAY 30
+#define CARL9170FW_VERSION_DAY 15
 #define CARL9170FW_VERSION_GIT "1.9.4"
 #endif /* __CARL9170_SHARED_VERSION_H */
diff --git a/drivers/net/wireless/b43/Kconfig b/drivers/net/wireless/b43/Kconfig
index b81a2a1c2618..df2b7c0856ed 100644
--- a/drivers/net/wireless/b43/Kconfig
+++ b/drivers/net/wireless/b43/Kconfig
@@ -169,13 +169,3 @@ config B43_DEBUG
          Say N, if you are a distributor or user building a release kernel
          for production use.
          Only say Y, if you are debugging a problem in the b43 driver sourcecode.
-config B43_FORCE_PIO
-        bool "Force usage of PIO instead of DMA"
-        depends on B43 && B43_DEBUG
-        ---help---
-          This will disable DMA and always enable PIO instead.
-          Say N!
-          This is only for debugging the PIO engine code. You do
-          _NOT_ want to enable this.
diff --git a/drivers/net/wireless/b43/b43.h b/drivers/net/wireless/b43/b43.h
index c818b0bc88ec..8ff706289b5d 100644
--- a/drivers/net/wireless/b43/b43.h
+++ b/drivers/net/wireless/b43/b43.h
@@ -17,11 +17,6 @@
 #include "phy_common.h"
-/* The unique identifier of the firmware that's officially supported by
- * this driver version. */
-#define B43_SUPPORTED_FIRMWARE_ID       "FW13"
 #ifdef CONFIG_B43_DEBUG
 # define B43_DEBUG      1
 #else
@@ -594,6 +589,7 @@ struct b43_dma {
        struct b43_dmaring *rx_ring;
        u32 translation; /* Routing bits */
+        bool translation_in_low; /* Should translation bit go into low addr? */
        bool parity; /* Check for parity */
 };
@@ -694,6 +690,12 @@ struct b43_firmware_file {
        enum b43_firmware_file_type type;
 };
+enum b43_firmware_hdr_format {
+        B43_FW_HDR_598,
+        B43_FW_HDR_410,
+        B43_FW_HDR_351,
+};
 /* Pointers to the firmware data and meta information about it. */
 struct b43_firmware {
        /* Microcode */
@@ -710,6 +712,9 @@ struct b43_firmware {
        /* Firmware patchlevel */
        u16 patch;
+        /* Format of header used by firmware */
+        enum b43_firmware_hdr_format hdr_format;
        /* Set to true, if we are using an opensource firmware.
         * Use this to check for proprietary vs opensource. */
        bool opensource;
@@ -875,7 +880,7 @@ struct b43_wl {
        struct b43_leds leds;
        /* Kmalloc'ed scratch space for PIO TX/RX. Protected by wl->mutex. */
-        u8 pio_scratchspace[110] __attribute__((__aligned__(8)));
+        u8 pio_scratchspace[118] __attribute__((__aligned__(8)));
        u8 pio_tailspace[4] __attribute__((__aligned__(8)));
 };
@@ -965,12 +970,6 @@ static inline bool b43_using_pio_transfers(struct b43_wldev *dev)
        return dev->__using_pio_transfers;
 }
-#ifdef CONFIG_B43_FORCE_PIO
-# define B43_PIO_DEFAULT 1
-#else
-# define B43_PIO_DEFAULT 0
-#endif
 /* Message printing */
 void b43info(struct b43_wl *wl, const char *fmt, ...)
    __attribute__ ((format(printf, 2, 3)));
diff --git a/drivers/net/wireless/b43/dma.c b/drivers/net/wireless/b43/dma.c
index 481e534534eb..c5d890e74a1e 100644
--- a/drivers/net/wireless/b43/dma.c
+++ b/drivers/net/wireless/b43/dma.c
@@ -47,6 +47,38 @@
 * into separate slots. */
 #define TX_SLOTS_PER_FRAME      2
+static u32 b43_dma_address(struct b43_dma *dma, dma_addr_t dmaaddr,
+                           enum b43_addrtype addrtype)
+{
+        u32 uninitialized_var(addr);
+        switch (addrtype) {
+        case B43_DMA_ADDR_LOW:
+                addr = lower_32_bits(dmaaddr);
+                if (dma->translation_in_low) {
+                        addr &= ~SSB_DMA_TRANSLATION_MASK;
+                        addr |= dma->translation;
+                }
+                break;
+        case B43_DMA_ADDR_HIGH:
+                addr = upper_32_bits(dmaaddr);
+                if (!dma->translation_in_low) {
+                        addr &= ~SSB_DMA_TRANSLATION_MASK;
+                        addr |= dma->translation;
+                }
+                break;
+        case B43_DMA_ADDR_EXT:
+                if (dma->translation_in_low)
+                        addr = lower_32_bits(dmaaddr);
+                else
+                        addr = upper_32_bits(dmaaddr);
+                addr &= SSB_DMA_TRANSLATION_MASK;
+                addr >>= SSB_DMA_TRANSLATION_SHIFT;
+                break;
+        }
+        return addr;
+}
 /* 32bit DMA ops. */
 static
@@ -77,10 +109,9 @@ static void op32_fill_descriptor(struct b43_dmaring *ring,
        slot = (int)(&(desc->dma32) - descbase);
        B43_WARN_ON(!(slot >= 0 && slot < ring->nr_slots));
-        addr = (u32) (dmaaddr & ~SSB_DMA_TRANSLATION_MASK);
+        addr = b43_dma_address(&ring->dev->dma, dmaaddr, B43_DMA_ADDR_LOW);
-        addrext = (u32) (dmaaddr & SSB_DMA_TRANSLATION_MASK)
+        addrext = b43_dma_address(&ring->dev->dma, dmaaddr, B43_DMA_ADDR_EXT);
-            >> SSB_DMA_TRANSLATION_SHIFT;
-        addr |= ring->dev->dma.translation;
        ctl = bufsize & B43_DMA32_DCTL_BYTECNT;
        if (slot == ring->nr_slots - 1)
                ctl |= B43_DMA32_DCTL_DTABLEEND;
@@ -170,11 +201,10 @@ static void op64_fill_descriptor(struct b43_dmaring *ring,
        slot = (int)(&(desc->dma64) - descbase);
        B43_WARN_ON(!(slot >= 0 && slot < ring->nr_slots));
-        addrlo = (u32) (dmaaddr & 0xFFFFFFFF);
+        addrlo = b43_dma_address(&ring->dev->dma, dmaaddr, B43_DMA_ADDR_LOW);
-        addrhi = (((u64) dmaaddr >> 32) & ~SSB_DMA_TRANSLATION_MASK);
+        addrhi = b43_dma_address(&ring->dev->dma, dmaaddr, B43_DMA_ADDR_HIGH);
-        addrext = (((u64) dmaaddr >> 32) & SSB_DMA_TRANSLATION_MASK)
+        addrext = b43_dma_address(&ring->dev->dma, dmaaddr, B43_DMA_ADDR_EXT);
-            >> SSB_DMA_TRANSLATION_SHIFT;
-        addrhi |= ring->dev->dma.translation;
        if (slot == ring->nr_slots - 1)
                ctl0 |= B43_DMA64_DCTL0_DTABLEEND;
        if (start)
@@ -658,41 +688,37 @@ static int dmacontroller_setup(struct b43_dmaring *ring)
        int err = 0;
        u32 value;
        u32 addrext;
-        u32 trans = ring->dev->dma.translation;
        bool parity = ring->dev->dma.parity;
+        u32 addrlo;
+        u32 addrhi;
        if (ring->tx) {
                if (ring->type == B43_DMA_64BIT) {
                        u64 ringbase = (u64) (ring->dmabase);
+                        addrext = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_EXT);
+                        addrlo = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_LOW);
+                        addrhi = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_HIGH);
-                        addrext = ((ringbase >> 32) & SSB_DMA_TRANSLATION_MASK)
-                            >> SSB_DMA_TRANSLATION_SHIFT;
                        value = B43_DMA64_TXENABLE;
                        value |= (addrext << B43_DMA64_TXADDREXT_SHIFT)
                            & B43_DMA64_TXADDREXT_MASK;
                        if (!parity)
                                value |= B43_DMA64_TXPARITYDISABLE;
                        b43_dma_write(ring, B43_DMA64_TXCTL, value);
-                        b43_dma_write(ring, B43_DMA64_TXRINGLO,
+                        b43_dma_write(ring, B43_DMA64_TXRINGLO, addrlo);
-                                      (ringbase & 0xFFFFFFFF));
+                        b43_dma_write(ring, B43_DMA64_TXRINGHI, addrhi);
-                        b43_dma_write(ring, B43_DMA64_TXRINGHI,
-                                      ((ringbase >> 32) &
-                                       ~SSB_DMA_TRANSLATION_MASK)
-                                      | trans);
                } else {
                        u32 ringbase = (u32) (ring->dmabase);
+                        addrext = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_EXT);
+                        addrlo = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_LOW);
-                        addrext = (ringbase & SSB_DMA_TRANSLATION_MASK)
-                            >> SSB_DMA_TRANSLATION_SHIFT;
                        value = B43_DMA32_TXENABLE;
                        value |= (addrext << B43_DMA32_TXADDREXT_SHIFT)
                            & B43_DMA32_TXADDREXT_MASK;
                        if (!parity)
                                value |= B43_DMA32_TXPARITYDISABLE;
                        b43_dma_write(ring, B43_DMA32_TXCTL, value);
-                        b43_dma_write(ring, B43_DMA32_TXRING,
+                        b43_dma_write(ring, B43_DMA32_TXRING, addrlo);
-                                      (ringbase & ~SSB_DMA_TRANSLATION_MASK)
-                                      | trans);
                }
        } else {
                err = alloc_initial_descbuffers(ring);
@@ -700,9 +726,10 @@ static int dmacontroller_setup(struct b43_dmaring *ring)
                        goto out;
                if (ring->type == B43_DMA_64BIT) {
                        u64 ringbase = (u64) (ring->dmabase);
+                        addrext = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_EXT);
+                        addrlo = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_LOW);
+                        addrhi = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_HIGH);
-                        addrext = ((ringbase >> 32) & SSB_DMA_TRANSLATION_MASK)
-                            >> SSB_DMA_TRANSLATION_SHIFT;
                        value = (ring->frameoffset << B43_DMA64_RXFROFF_SHIFT);
                        value |= B43_DMA64_RXENABLE;
                        value |= (addrext << B43_DMA64_RXADDREXT_SHIFT)
@@ -710,19 +737,15 @@ static int dmacontroller_setup(struct b43_dmaring *ring)
                        if (!parity)
                                value |= B43_DMA64_RXPARITYDISABLE;
                        b43_dma_write(ring, B43_DMA64_RXCTL, value);
-                        b43_dma_write(ring, B43_DMA64_RXRINGLO,
+                        b43_dma_write(ring, B43_DMA64_RXRINGLO, addrlo);
-                                      (ringbase & 0xFFFFFFFF));
+                        b43_dma_write(ring, B43_DMA64_RXRINGHI, addrhi);
-                        b43_dma_write(ring, B43_DMA64_RXRINGHI,
-                                      ((ringbase >> 32) &
-                                       ~SSB_DMA_TRANSLATION_MASK)
-                                      | trans);
                        b43_dma_write(ring, B43_DMA64_RXINDEX, ring->nr_slots *
                                      sizeof(struct b43_dmadesc64));
                } else {
                        u32 ringbase = (u32) (ring->dmabase);
+                        addrext = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_EXT);
+                        addrlo = b43_dma_address(&ring->dev->dma, ringbase, B43_DMA_ADDR_LOW);
-                        addrext = (ringbase & SSB_DMA_TRANSLATION_MASK)
-                            >> SSB_DMA_TRANSLATION_SHIFT;
                        value = (ring->frameoffset << B43_DMA32_RXFROFF_SHIFT);
                        value |= B43_DMA32_RXENABLE;
                        value |= (addrext << B43_DMA32_RXADDREXT_SHIFT)
@@ -730,9 +753,7 @@ static int dmacontroller_setup(struct b43_dmaring *ring)
                        if (!parity)
                                value |= B43_DMA32_RXPARITYDISABLE;
                        b43_dma_write(ring, B43_DMA32_RXCTL, value);
-                        b43_dma_write(ring, B43_DMA32_RXRING,
+                        b43_dma_write(ring, B43_DMA32_RXRING, addrlo);
-                                      (ringbase & ~SSB_DMA_TRANSLATION_MASK)
-                                      | trans);
                        b43_dma_write(ring, B43_DMA32_RXINDEX, ring->nr_slots *
                                      sizeof(struct b43_dmadesc32));
                }
@@ -872,8 +893,17 @@ struct b43_dmaring *b43_setup_dmaring(struct b43_wldev *dev,
                ring->current_slot = -1;
        } else {
                if (ring->index == 0) {
-                        ring->rx_buffersize = B43_DMA0_RX_BUFFERSIZE;
+                        switch (dev->fw.hdr_format) {
-                        ring->frameoffset = B43_DMA0_RX_FRAMEOFFSET;
+                        case B43_FW_HDR_598:
+                                ring->rx_buffersize = B43_DMA0_RX_FW598_BUFSIZE;
+                                ring->frameoffset = B43_DMA0_RX_FW598_FO;
+                                break;
+                        case B43_FW_HDR_410:
+                        case B43_FW_HDR_351:
+                                ring->rx_buffersize = B43_DMA0_RX_FW351_BUFSIZE;
+                                ring->frameoffset = B43_DMA0_RX_FW351_FO;
+                                break;
+                        }
                } else
                        B43_WARN_ON(1);
        }
@@ -1066,6 +1096,25 @@ static int b43_dma_set_mask(struct b43_wldev *dev, u64 mask)
        return 0;
 }
+/* Some hardware with 64-bit DMA seems to be bugged and looks for translation
+ * bit in low address word instead of high one.
+ */
+static bool b43_dma_translation_in_low_word(struct b43_wldev *dev,
+                                            enum b43_dmatype type)
+{
+        if (type != B43_DMA_64BIT)
+                return 1;
+#ifdef CONFIG_B43_SSB
+        if (dev->dev->bus_type == B43_BUS_SSB &&
+            dev->dev->sdev->bus->bustype == SSB_BUSTYPE_PCI &&
+            !(dev->dev->sdev->bus->host_pci->is_pcie &&
+              ssb_read32(dev->dev->sdev, SSB_TMSHIGH) & SSB_TMSHIGH_DMA64))
+                        return 1;
+#endif
+        return 0;
+}
 int b43_dma_init(struct b43_wldev *dev)
 {
        struct b43_dma *dma = &dev->dma;
@@ -1091,6 +1140,7 @@ int b43_dma_init(struct b43_wldev *dev)
                break;
 #endif
        }
+        dma->translation_in_low = b43_dma_translation_in_low_word(dev, type);
        dma->parity = true;
 #ifdef CONFIG_B43_BCMA
diff --git a/drivers/net/wireless/b43/dma.h b/drivers/net/wireless/b43/dma.h
index cdf87094efe8..7e20b04fa51a 100644
--- a/drivers/net/wireless/b43/dma.h
+++ b/drivers/net/wireless/b43/dma.h
@@ -162,12 +162,15 @@ struct b43_dmadesc_generic {
 /* Misc DMA constants */
 #define B43_DMA_RINGMEMSIZE             PAGE_SIZE
-#define B43_DMA0_RX_FRAMEOFFSET         30
+/* Offset of frame with actual data */
+#define B43_DMA0_RX_FW598_FO            38
+#define B43_DMA0_RX_FW351_FO            30
 /* DMA engine tuning knobs */
 #define B43_TXRING_SLOTS                256
 #define B43_RXRING_SLOTS                64
-#define B43_DMA0_RX_BUFFERSIZE          (B43_DMA0_RX_FRAMEOFFSET + IEEE80211_MAX_FRAME_LEN)
+#define B43_DMA0_RX_FW598_BUFSIZE       (B43_DMA0_RX_FW598_FO + IEEE80211_MAX_FRAME_LEN)
+#define B43_DMA0_RX_FW351_BUFSIZE       (B43_DMA0_RX_FW351_FO + IEEE80211_MAX_FRAME_LEN)
 /* Pointer poison */
 #define B43_DMA_PTR_POISON              ((void *)ERR_PTR(-ENOMEM))
@@ -212,6 +215,12 @@ enum b43_dmatype {
        B43_DMA_64BIT   = 64,
 };
+enum b43_addrtype {
+        B43_DMA_ADDR_LOW,
+        B43_DMA_ADDR_HIGH,
+        B43_DMA_ADDR_EXT,
+};
 struct b43_dmaring {
        /* Lowlevel DMA ops. */
        const struct b43_dma_ops *ops;
diff --git a/drivers/net/wireless/b43/main.c b/drivers/net/wireless/b43/main.c
index d2661aaff50f..d2b1d1fe202b 100644
--- a/drivers/net/wireless/b43/main.c
+++ b/drivers/net/wireless/b43/main.c
@@ -66,7 +66,6 @@ MODULE_AUTHOR("Michael Buesch");
 MODULE_AUTHOR("Gábor Stefanik");
 MODULE_LICENSE("GPL");
-MODULE_FIRMWARE(B43_SUPPORTED_FIRMWARE_ID);
 MODULE_FIRMWARE("b43/ucode11.fw");
 MODULE_FIRMWARE("b43/ucode13.fw");
 MODULE_FIRMWARE("b43/ucode14.fw");
@@ -108,7 +107,7 @@ int b43_modparam_verbose = B43_VERBOSITY_DEFAULT;
 module_param_named(verbose, b43_modparam_verbose, int, 0644);
 MODULE_PARM_DESC(verbose, "Log message verbosity: 0=error, 1=warn, 2=info(default), 3=debug");
-static int b43_modparam_pio = B43_PIO_DEFAULT;
+static int b43_modparam_pio = 0;
 module_param_named(pio, b43_modparam_pio, int, 0644);
 MODULE_PARM_DESC(pio, "Use PIO accesses by default: 0=DMA, 1=PIO");
@@ -320,6 +319,10 @@ static void b43_wireless_core_exit(struct b43_wldev *dev);
 static int b43_wireless_core_init(struct b43_wldev *dev);
 static struct b43_wldev * b43_wireless_core_stop(struct b43_wldev *dev);
 static int b43_wireless_core_start(struct b43_wldev *dev);
+static void b43_op_bss_info_changed(struct ieee80211_hw *hw,
+                                    struct ieee80211_vif *vif,
+                                    struct ieee80211_bss_conf *conf,
+                                    u32 changed);
 static int b43_ratelimit(struct b43_wl *wl)
 {
@@ -2510,6 +2513,12 @@ static int b43_upload_microcode(struct b43_wldev *dev)
        }
        dev->fw.rev = fwrev;
        dev->fw.patch = fwpatch;
+        if (dev->fw.rev >= 598)
+                dev->fw.hdr_format = B43_FW_HDR_598;
+        else if (dev->fw.rev >= 410)
+                dev->fw.hdr_format = B43_FW_HDR_410;
+        else
+                dev->fw.hdr_format = B43_FW_HDR_351;
        dev->fw.opensource = (fwdate == 0xFFFF);
        /* Default to use-all-queues. */
@@ -2557,7 +2566,7 @@ static int b43_upload_microcode(struct b43_wldev *dev)
                        dev->fw.rev, dev->fw.patch);
        wiphy->hw_version = dev->dev->core_id;
-        if (b43_is_old_txhdr_format(dev)) {
+        if (dev->fw.hdr_format == B43_FW_HDR_351) {
                /* We're over the deadline, but we keep support for old fw
                 * until it turns out to be in major conflict with something new. */
                b43warn(dev->wl, "You are using an old firmware image. "
@@ -2943,6 +2952,7 @@ static void b43_rate_memory_init(struct b43_wldev *dev)
        case B43_PHYTYPE_G:
        case B43_PHYTYPE_N:
        case B43_PHYTYPE_LP:
+        case B43_PHYTYPE_HT:
                b43_rate_memory_write(dev, B43_OFDM_RATE_6MB, 1);
                b43_rate_memory_write(dev, B43_OFDM_RATE_12MB, 1);
                b43_rate_memory_write(dev, B43_OFDM_RATE_18MB, 1);
@@ -3778,14 +3788,24 @@ static int b43_op_config(struct ieee80211_hw *hw, u32 changed)
        struct ieee80211_conf *conf = &hw->conf;
        int antenna;
        int err = 0;
+        bool reload_bss = false;
        mutex_lock(&wl->mutex);
+        dev = wl->current_dev;
        /* Switch the band (if necessary). This might change the active core. */
        err = b43_switch_band(wl, conf->channel);
        if (err)
                goto out_unlock_mutex;
-        dev = wl->current_dev;
+        /* Need to reload all settings if the core changed */
+        if (dev != wl->current_dev) {
+                dev = wl->current_dev;
+                changed = ~0;
+                reload_bss = true;
+        }
        phy = &dev->phy;
        if (conf_is_ht(conf))
@@ -3846,6 +3866,9 @@ out_mac_enable:
 out_unlock_mutex:
        mutex_unlock(&wl->mutex);
+        if (wl->vif && reload_bss)
+                b43_op_bss_info_changed(hw, wl->vif, &wl->vif->bss_conf, ~0);
        return err;
 }
@@ -3934,7 +3957,8 @@ static void b43_op_bss_info_changed(struct ieee80211_hw *hw,
        if (changed & BSS_CHANGED_BEACON_INT &&
            (b43_is_mode(wl, NL80211_IFTYPE_AP) ||
             b43_is_mode(wl, NL80211_IFTYPE_MESH_POINT) ||
-             b43_is_mode(wl, NL80211_IFTYPE_ADHOC)))
+             b43_is_mode(wl, NL80211_IFTYPE_ADHOC)) &&
+            conf->beacon_int)
                b43_set_beacon_int(dev, conf->beacon_int);
        if (changed & BSS_CHANGED_BASIC_RATES)
@@ -4629,8 +4653,13 @@ static int b43_wireless_core_init(struct b43_wldev *dev)
        b43_shm_write16(dev, B43_SHM_SCRATCH, B43_SHM_SC_MAXCONT, 0x3FF);
        if (b43_bus_host_is_pcmcia(dev->dev) ||
-            b43_bus_host_is_sdio(dev->dev) ||
+            b43_bus_host_is_sdio(dev->dev)) {
-            dev->use_pio) {
+                dev->__using_pio_transfers = 1;
+                err = b43_pio_init(dev);
+        } else if (dev->use_pio) {
+                b43warn(dev->wl, "Forced PIO by use_pio module parameter. "
+                        "This should not be needed and will result in lower "
+                        "performance.\n");
                dev->__using_pio_transfers = 1;
                err = b43_pio_init(dev);
        } else {
@@ -4702,6 +4731,9 @@ static int b43_op_add_interface(struct ieee80211_hw *hw,
 out_mutex_unlock:
        mutex_unlock(&wl->mutex);
+        if (err == 0)
+                b43_op_bss_info_changed(hw, vif, &vif->bss_conf, ~0);
        return err;
 }
@@ -4772,6 +4804,9 @@ static int b43_op_start(struct ieee80211_hw *hw)
 out_mutex_unlock:
        mutex_unlock(&wl->mutex);
+        /* reload configuration */
+        b43_op_config(hw, ~0);
        return err;
 }
@@ -4928,10 +4963,18 @@ out:
        if (err)
                wl->current_dev = NULL; /* Failed to init the dev. */
        mutex_unlock(&wl->mutex);
-        if (err)
+        if (err) {
                b43err(wl, "Controller restart FAILED\n");
-        else
+                return;
-                b43info(wl, "Controller restarted\n");
+        }
+        /* reload configuration */
+        b43_op_config(wl->hw, ~0);
+        if (wl->vif)
+                b43_op_bss_info_changed(wl->hw, wl->vif, &wl->vif->bss_conf, ~0);
+        b43info(wl, "Controller restarted\n");
 }
 static int b43_setup_bands(struct b43_wldev *dev,
@@ -5416,8 +5459,7 @@ static void b43_print_driverinfo(void)
        feat_sdio = "S";
 #endif
        printk(KERN_INFO "Broadcom 43xx driver loaded "
-               "[ Features: %s%s%s%s%s, Firmware-ID: "
+               "[ Features: %s%s%s%s%s ]\n",
-               B43_SUPPORTED_FIRMWARE_ID " ]\n",
               feat_pci, feat_pcmcia, feat_nphy,
               feat_leds, feat_sdio);
 }
diff --git a/drivers/net/wireless/b43/phy_common.c b/drivers/net/wireless/b43/phy_common.c
index 07f009ff5ee2..3ea44bb03684 100644
--- a/drivers/net/wireless/b43/phy_common.c
+++ b/drivers/net/wireless/b43/phy_common.c
@@ -448,6 +448,38 @@ bool b43_channel_type_is_40mhz(enum nl80211_channel_type channel_type)
                channel_type == NL80211_CHAN_HT40PLUS);
 }
+/* http://bcm-v4.sipsolutions.net/802.11/PHY/N/BmacPhyClkFgc */
+void b43_phy_force_clock(struct b43_wldev *dev, bool force)
+{
+        u32 tmp;
+        WARN_ON(dev->phy.type != B43_PHYTYPE_N &&
+                dev->phy.type != B43_PHYTYPE_HT);
+        switch (dev->dev->bus_type) {
+#ifdef CONFIG_B43_BCMA
+        case B43_BUS_BCMA:
+                tmp = bcma_aread32(dev->dev->bdev, BCMA_IOCTL);
+                if (force)
+                        tmp |= BCMA_IOCTL_FGC;
+                else
+                        tmp &= ~BCMA_IOCTL_FGC;
+                bcma_awrite32(dev->dev->bdev, BCMA_IOCTL, tmp);
+                break;
+#endif
+#ifdef CONFIG_B43_SSB
+        case B43_BUS_SSB:
+                tmp = ssb_read32(dev->dev->sdev, SSB_TMSLOW);
+                if (force)
+                        tmp |= SSB_TMSLOW_FGC;
+                else
+                        tmp &= ~SSB_TMSLOW_FGC;
+                ssb_write32(dev->dev->sdev, SSB_TMSLOW, tmp);
+                break;
+#endif
+        }
+}
 /* http://bcm-v4.sipsolutions.net/802.11/PHY/Cordic */
 struct b43_c32 b43_cordic(int theta)
 {
diff --git a/drivers/net/wireless/b43/phy_common.h b/drivers/net/wireless/b43/phy_common.h
index aa77ba612a92..9233b13fc16d 100644
--- a/drivers/net/wireless/b43/phy_common.h
+++ b/drivers/net/wireless/b43/phy_common.h
@@ -444,6 +444,8 @@ void b43_phyop_switch_analog_generic(struct b43_wldev *dev, bool on);
 bool b43_channel_type_is_40mhz(enum nl80211_channel_type channel_type);
+void b43_phy_force_clock(struct b43_wldev *dev, bool force);
 struct b43_c32 b43_cordic(int theta);
 #endif /* LINUX_B43_PHY_COMMON_H_ */
diff --git a/drivers/net/wireless/b43/phy_ht.c b/drivers/net/wireless/b43/phy_ht.c
index 7c40919651a7..4d6345e8ee6b 100644
--- a/drivers/net/wireless/b43/phy_ht.c
+++ b/drivers/net/wireless/b43/phy_ht.c
@@ -152,6 +152,92 @@ static void b43_radio_2059_init(struct b43_wldev *dev)
 }
 /**************************************************
+ * Various PHY ops
+ **************************************************/
+static void b43_phy_ht_zero_extg(struct b43_wldev *dev)
+{
+        u8 i, j;
+        u16 base[] = { 0x40, 0x60, 0x80 };
+        for (i = 0; i < ARRAY_SIZE(base); i++) {
+                for (j = 0; j < 4; j++)
+                        b43_phy_write(dev, B43_PHY_EXTG(base[i] + j), 0);
+        }
+        for (i = 0; i < ARRAY_SIZE(base); i++)
+                b43_phy_write(dev, B43_PHY_EXTG(base[i] + 0xc), 0);
+}
+/* Some unknown AFE (Analog Frondned) op */
+static void b43_phy_ht_afe_unk1(struct b43_wldev *dev)
+{
+        u8 i;
+        const u16 ctl_regs[3][2] = {
+                { B43_PHY_HT_AFE_CTL1, B43_PHY_HT_AFE_CTL2 },
+                { B43_PHY_HT_AFE_CTL3, B43_PHY_HT_AFE_CTL4 },
+                { B43_PHY_HT_AFE_CTL5, B43_PHY_HT_AFE_CTL6},
+        };
+        for (i = 0; i < 3; i++) {
+                /* TODO: verify masks&sets */
+                b43_phy_set(dev, ctl_regs[i][1], 0x4);
+                b43_phy_set(dev, ctl_regs[i][0], 0x4);
+                b43_phy_mask(dev, ctl_regs[i][1], ~0x1);
+                b43_phy_set(dev, ctl_regs[i][0], 0x1);
+                b43_httab_write(dev, B43_HTTAB16(8, 5 + (i * 0x10)), 0);
+                b43_phy_mask(dev, ctl_regs[i][0], ~0x4);
+        }
+}
+static void b43_phy_ht_force_rf_sequence(struct b43_wldev *dev, u16 rf_seq)
+{
+        u8 i;
+        u16 save_seq_mode = b43_phy_read(dev, B43_PHY_HT_RF_SEQ_MODE);
+        b43_phy_set(dev, B43_PHY_HT_RF_SEQ_MODE, 0x3);
+        b43_phy_set(dev, B43_PHY_HT_RF_SEQ_TRIG, rf_seq);
+        for (i = 0; i < 200; i++) {
+                if (!(b43_phy_read(dev, B43_PHY_HT_RF_SEQ_STATUS) & rf_seq)) {
+                        i = 0;
+                        break;
+                }
+                msleep(1);
+        }
+        if (i)
+                b43err(dev->wl, "Forcing RF sequence timeout\n");
+        b43_phy_write(dev, B43_PHY_HT_RF_SEQ_MODE, save_seq_mode);
+}
+static void b43_phy_ht_read_clip_detection(struct b43_wldev *dev, u16 *clip_st)
+{
+        clip_st[0] = b43_phy_read(dev, B43_PHY_HT_C1_CLIP1THRES);
+        clip_st[1] = b43_phy_read(dev, B43_PHY_HT_C2_CLIP1THRES);
+        clip_st[2] = b43_phy_read(dev, B43_PHY_HT_C3_CLIP1THRES);
+}
+static void b43_phy_ht_bphy_init(struct b43_wldev *dev)
+{
+        unsigned int i;
+        u16 val;
+        val = 0x1E1F;
+        for (i = 0; i < 16; i++) {
+                b43_phy_write(dev, B43_PHY_N_BMODE(0x88 + i), val);
+                val -= 0x202;
+        }
+        val = 0x3E3F;
+        for (i = 0; i < 16; i++) {
+                b43_phy_write(dev, B43_PHY_N_BMODE(0x98 + i), val);
+                val -= 0x202;
+        }
+        b43_phy_write(dev, B43_PHY_N_BMODE(0x38), 0x668);
+}
+/**************************************************
 * Channel switching ops.
 **************************************************/
@@ -255,8 +341,125 @@ static void b43_phy_ht_op_prepare_structs(struct b43_wldev *dev)
 static int b43_phy_ht_op_init(struct b43_wldev *dev)
 {
+        u16 tmp;
+        u16 clip_state[3];
        b43_phy_ht_tables_init(dev);
+        b43_phy_mask(dev, 0x0be, ~0x2);
+        b43_phy_set(dev, 0x23f, 0x7ff);
+        b43_phy_set(dev, 0x240, 0x7ff);
+        b43_phy_set(dev, 0x241, 0x7ff);
+        b43_phy_ht_zero_extg(dev);
+        b43_phy_mask(dev, B43_PHY_EXTG(0), ~0x3);
+        b43_phy_write(dev, B43_PHY_HT_AFE_CTL1, 0);
+        b43_phy_write(dev, B43_PHY_HT_AFE_CTL3, 0);
+        b43_phy_write(dev, B43_PHY_HT_AFE_CTL5, 0);
+        b43_phy_write(dev, B43_PHY_EXTG(0x103), 0x20);
+        b43_phy_write(dev, B43_PHY_EXTG(0x101), 0x20);
+        b43_phy_write(dev, 0x20d, 0xb8);
+        b43_phy_write(dev, B43_PHY_EXTG(0x14f), 0xc8);
+        b43_phy_write(dev, 0x70, 0x50);
+        b43_phy_write(dev, 0x1ff, 0x30);
+        if (0) /* TODO: condition */
+                ; /* TODO: PHY op on reg 0x217 */
+        b43_phy_read(dev, 0xb0); /* TODO: what for? */
+        b43_phy_set(dev, 0xb0, 0x1);
+        b43_phy_set(dev, 0xb1, 0x91);
+        b43_phy_write(dev, 0x32f, 0x0003);
+        b43_phy_write(dev, 0x077, 0x0010);
+        b43_phy_write(dev, 0x0b4, 0x0258);
+        b43_phy_mask(dev, 0x17e, ~0x4000);
+        b43_phy_write(dev, 0x0b9, 0x0072);
+        b43_httab_write_few(dev, B43_HTTAB16(7, 0x14e), 2, 0x010f, 0x010f);
+        b43_httab_write_few(dev, B43_HTTAB16(7, 0x15e), 2, 0x010f, 0x010f);
+        b43_httab_write_few(dev, B43_HTTAB16(7, 0x16e), 2, 0x010f, 0x010f);
+        b43_phy_ht_afe_unk1(dev);
+        b43_httab_write_few(dev, B43_HTTAB16(7, 0x130), 9, 0x777, 0x111, 0x111,
+                            0x777, 0x111, 0x111, 0x777, 0x111, 0x111);
+        b43_httab_write(dev, B43_HTTAB16(7, 0x120), 0x0777);
+        b43_httab_write(dev, B43_HTTAB16(7, 0x124), 0x0777);
+        b43_httab_write(dev, B43_HTTAB16(8, 0x00), 0x02);
+        b43_httab_write(dev, B43_HTTAB16(8, 0x10), 0x02);
+        b43_httab_write(dev, B43_HTTAB16(8, 0x20), 0x02);
+        b43_httab_write_few(dev, B43_HTTAB16(8, 0x08), 4,
+                            0x8e, 0x96, 0x96, 0x96);
+        b43_httab_write_few(dev, B43_HTTAB16(8, 0x18), 4,
+                            0x8f, 0x9f, 0x9f, 0x9f);
+        b43_httab_write_few(dev, B43_HTTAB16(8, 0x28), 4,
+                            0x8f, 0x9f, 0x9f, 0x9f);
+        b43_httab_write_few(dev, B43_HTTAB16(8, 0x0c), 4, 0x2, 0x2, 0x2, 0x2);
+        b43_httab_write_few(dev, B43_HTTAB16(8, 0x1c), 4, 0x2, 0x2, 0x2, 0x2);
+        b43_httab_write_few(dev, B43_HTTAB16(8, 0x2c), 4, 0x2, 0x2, 0x2, 0x2);
+        b43_phy_maskset(dev, 0x0280, 0xff00, 0x3e);
+        b43_phy_maskset(dev, 0x0283, 0xff00, 0x3e);
+        b43_phy_maskset(dev, B43_PHY_OFDM(0x0141), 0xff00, 0x46);
+        b43_phy_maskset(dev, 0x0283, 0xff00, 0x40);
+        b43_httab_write_few(dev, B43_HTTAB16(00, 0x8), 4,
+                            0x09, 0x0e, 0x13, 0x18);
+        b43_httab_write_few(dev, B43_HTTAB16(01, 0x8), 4,
+                            0x09, 0x0e, 0x13, 0x18);
+        /* TODO: Did wl mean 2 instead of 40? */
+        b43_httab_write_few(dev, B43_HTTAB16(40, 0x8), 4,
+                            0x09, 0x0e, 0x13, 0x18);
+        b43_phy_maskset(dev, B43_PHY_OFDM(0x24), 0x3f, 0xd);
+        b43_phy_maskset(dev, B43_PHY_OFDM(0x64), 0x3f, 0xd);
+        b43_phy_maskset(dev, B43_PHY_OFDM(0xa4), 0x3f, 0xd);
+        b43_phy_set(dev, B43_PHY_EXTG(0x060), 0x1);
+        b43_phy_set(dev, B43_PHY_EXTG(0x064), 0x1);
+        b43_phy_set(dev, B43_PHY_EXTG(0x080), 0x1);
+        b43_phy_set(dev, B43_PHY_EXTG(0x084), 0x1);
+        /* Copy some tables entries */
+        tmp = b43_httab_read(dev, B43_HTTAB16(7, 0x144));
+        b43_httab_write(dev, B43_HTTAB16(7, 0x14a), tmp);
+        tmp = b43_httab_read(dev, B43_HTTAB16(7, 0x154));
+        b43_httab_write(dev, B43_HTTAB16(7, 0x15a), tmp);
+        tmp = b43_httab_read(dev, B43_HTTAB16(7, 0x164));
+        b43_httab_write(dev, B43_HTTAB16(7, 0x16a), tmp);
+        /* Reset CCA */
+        b43_phy_force_clock(dev, true);
+        tmp = b43_phy_read(dev, B43_PHY_HT_BBCFG);
+        b43_phy_write(dev, B43_PHY_HT_BBCFG, tmp | B43_PHY_HT_BBCFG_RSTCCA);
+        b43_phy_write(dev, B43_PHY_HT_BBCFG, tmp & ~B43_PHY_HT_BBCFG_RSTCCA);
+        b43_phy_force_clock(dev, false);
+        b43_mac_phy_clock_set(dev, true);
+        b43_phy_ht_force_rf_sequence(dev, B43_PHY_HT_RF_SEQ_TRIG_RX2TX);
+        b43_phy_ht_force_rf_sequence(dev, B43_PHY_HT_RF_SEQ_TRIG_RST2RX);
+        /* TODO: PHY op on reg 0xb0 */
+        /* TODO: Should we restore it? Or store it in global PHY info? */
+        b43_phy_ht_read_clip_detection(dev, clip_state);
+        if (b43_current_band(dev->wl) == IEEE80211_BAND_2GHZ)
+                b43_phy_ht_bphy_init(dev);
+        b43_httab_write_bulk(dev, B43_HTTAB32(0x1a, 0xc0),
+                        B43_HTTAB_1A_C0_LATE_SIZE, b43_httab_0x1a_0xc0_late);
        return 0;
 }
diff --git a/drivers/net/wireless/b43/phy_ht.h b/drivers/net/wireless/b43/phy_ht.h
index 7ad7affc8df0..6544c4293b34 100644
--- a/drivers/net/wireless/b43/phy_ht.h
+++ b/drivers/net/wireless/b43/phy_ht.h
@@ -4,7 +4,11 @@
 #include "phy_common.h"
+#define B43_PHY_HT_BBCFG                        0x001 /* BB config */
+#define  B43_PHY_HT_BBCFG_RSTCCA                0x4000 /* Reset CCA */
+#define  B43_PHY_HT_BBCFG_RSTRX                 0x8000 /* Reset RX */
 #define B43_PHY_HT_BANDCTL                      0x009 /* Band control */
+#define  B43_PHY_HT_BANDCTL_5GHZ                0x0001 /* Use the 5GHz band */
 #define B43_PHY_HT_TABLE_ADDR                   0x072 /* Table address */
 #define B43_PHY_HT_TABLE_DATALO                 0x073 /* Table data low */
 #define B43_PHY_HT_TABLE_DATAHI                 0x074 /* Table data high */
@@ -15,6 +19,21 @@
 #define B43_PHY_HT_BW5                          0x1D2
 #define B43_PHY_HT_BW6                          0x1D3
+#define B43_PHY_HT_C1_CLIP1THRES                B43_PHY_OFDM(0x00E)
+#define B43_PHY_HT_C2_CLIP1THRES                B43_PHY_OFDM(0x04E)
+#define B43_PHY_HT_C3_CLIP1THRES                B43_PHY_OFDM(0x08E)
+#define B43_PHY_HT_RF_SEQ_MODE                  B43_PHY_EXTG(0x000)
+#define B43_PHY_HT_RF_SEQ_TRIG                  B43_PHY_EXTG(0x003)
+#define  B43_PHY_HT_RF_SEQ_TRIG_RX2TX           0x0001 /* RX2TX */
+#define  B43_PHY_HT_RF_SEQ_TRIG_TX2RX           0x0002 /* TX2RX */
+#define  B43_PHY_HT_RF_SEQ_TRIG_UPGH            0x0004 /* Update gain H */
+#define  B43_PHY_HT_RF_SEQ_TRIG_UPGL            0x0008 /* Update gain L */
+#define  B43_PHY_HT_RF_SEQ_TRIG_UPGU            0x0010 /* Update gain U */
+#define  B43_PHY_HT_RF_SEQ_TRIG_RST2RX          0x0020 /* Reset to RX */
+#define B43_PHY_HT_RF_SEQ_STATUS                B43_PHY_EXTG(0x004)
+/* Values for the status are the same as for the trigger */
 #define B43_PHY_HT_RF_CTL1                      B43_PHY_EXTG(0x010)
 #define B43_PHY_HT_AFE_CTL1                     B43_PHY_EXTG(0x110)
diff --git a/drivers/net/wireless/b43/phy_lcn.c b/drivers/net/wireless/b43/phy_lcn.c
index 9f7dbbd5ced6..4b2cd6d24ce9 100644
--- a/drivers/net/wireless/b43/phy_lcn.c
+++ b/drivers/net/wireless/b43/phy_lcn.c
@@ -28,25 +28,232 @@
 #include "main.h"
 /**************************************************
+ * Radio 2064.
+ **************************************************/
+static void b43_radio_2064_init(struct b43_wldev *dev)
+{
+        b43_radio_write(dev, 0x09c, 0x0020);
+        b43_radio_write(dev, 0x105, 0x0008);
+        b43_radio_write(dev, 0x032, 0x0062);
+        b43_radio_write(dev, 0x033, 0x0019);
+        b43_radio_write(dev, 0x090, 0x0010);
+        b43_radio_write(dev, 0x010, 0x0000);
+        b43_radio_write(dev, 0x060, 0x007f);
+        b43_radio_write(dev, 0x061, 0x0072);
+        b43_radio_write(dev, 0x062, 0x007f);
+        b43_radio_write(dev, 0x01d, 0x0002);
+        b43_radio_write(dev, 0x01e, 0x0006);
+        b43_phy_write(dev, 0x4ea, 0x4688);
+        b43_phy_maskset(dev, 0x4eb, ~0x7, 0x2);
+        b43_phy_mask(dev, 0x4eb, ~0x01c0);
+        b43_phy_maskset(dev, 0x4eb, 0xff00, 0x19);
+        b43_lcntab_write(dev, B43_LCNTAB16(0x00, 0x55), 0);
+        b43_radio_mask(dev, 0x05b, (u16) ~0xff02);
+        b43_radio_set(dev, 0x004, 0x40);
+        b43_radio_set(dev, 0x120, 0x10);
+        b43_radio_set(dev, 0x078, 0x80);
+        b43_radio_set(dev, 0x129, 0x2);
+        b43_radio_set(dev, 0x057, 0x1);
+        b43_radio_set(dev, 0x05b, 0x2);
+        /* TODO: wait for some bit to be set */
+        b43_radio_read(dev, 0x05c);
+        b43_radio_mask(dev, 0x05b, (u16) ~0xff02);
+        b43_radio_mask(dev, 0x057, (u16) ~0xff01);
+        b43_phy_write(dev, 0x933, 0x2d6b);
+        b43_phy_write(dev, 0x934, 0x2d6b);
+        b43_phy_write(dev, 0x935, 0x2d6b);
+        b43_phy_write(dev, 0x936, 0x2d6b);
+        b43_phy_write(dev, 0x937, 0x016b);
+        b43_radio_mask(dev, 0x057, (u16) ~0xff02);
+        b43_radio_write(dev, 0x0c2, 0x006f);
+}
+/**************************************************
+ * Various PHY ops
+ **************************************************/
+static void b43_phy_lcn_afe_set_unset(struct b43_wldev *dev)
+{
+        u16 afe_ctl2 = b43_phy_read(dev, B43_PHY_LCN_AFE_CTL2);
+        u16 afe_ctl1 = b43_phy_read(dev, B43_PHY_LCN_AFE_CTL1);
+        b43_phy_write(dev, B43_PHY_LCN_AFE_CTL2, afe_ctl2 | 0x1);
+        b43_phy_write(dev, B43_PHY_LCN_AFE_CTL1, afe_ctl1 | 0x1);
+        b43_phy_write(dev, B43_PHY_LCN_AFE_CTL2, afe_ctl2 & ~0x1);
+        b43_phy_write(dev, B43_PHY_LCN_AFE_CTL1, afe_ctl1 & ~0x1);
+        b43_phy_write(dev, B43_PHY_LCN_AFE_CTL2, afe_ctl2);
+        b43_phy_write(dev, B43_PHY_LCN_AFE_CTL1, afe_ctl1);
+}
+static void b43_phy_lcn_clean_0x18_table(struct b43_wldev *dev)
+{
+        u8 i;
+        for (i = 0; i < 0x80; i++)
+                b43_lcntab_write(dev, B43_LCNTAB32(0x18, i), 0x80000);
+}
+static void b43_phy_lcn_clear_0x07_table(struct b43_wldev *dev)
+{
+        u8 i;
+        b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, (0x7 << 10) | 0x340);
+        for (i = 0; i < 30; i++) {
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATAHI, 0);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, 0);
+        }
+        b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, (0x7 << 10) | 0x80);
+        for (i = 0; i < 64; i++) {
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATAHI, 0);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, 0);
+        }
+}
+/**************************************************
+ * Basic PHY ops.
+ **************************************************/
+static int b43_phy_lcn_op_allocate(struct b43_wldev *dev)
+{
+        struct b43_phy_lcn *phy_lcn;
+        phy_lcn = kzalloc(sizeof(*phy_lcn), GFP_KERNEL);
+        if (!phy_lcn)
+                return -ENOMEM;
+        dev->phy.lcn = phy_lcn;
+        return 0;
+}
+static void b43_phy_lcn_op_free(struct b43_wldev *dev)
+{
+        struct b43_phy *phy = &dev->phy;
+        struct b43_phy_lcn *phy_lcn = phy->lcn;
+        kfree(phy_lcn);
+        phy->lcn = NULL;
+}
+static void b43_phy_lcn_op_prepare_structs(struct b43_wldev *dev)
+{
+        struct b43_phy *phy = &dev->phy;
+        struct b43_phy_lcn *phy_lcn = phy->lcn;
+        memset(phy_lcn, 0, sizeof(*phy_lcn));
+}
+static int b43_phy_lcn_op_init(struct b43_wldev *dev)
+{
+        b43_phy_set(dev, 0x44a, 0x80);
+        b43_phy_mask(dev, 0x44a, 0x7f);
+        b43_phy_set(dev, 0x6d1, 0x80);
+        b43_phy_write(dev, 0x6d0, 0x7);
+        b43_phy_lcn_afe_set_unset(dev);
+        b43_phy_write(dev, 0x60a, 0xa0);
+        b43_phy_write(dev, 0x46a, 0x19);
+        b43_phy_maskset(dev, 0x663, 0xFF00, 0x64);
+        b43_phy_lcn_tables_init(dev);
+        /* TODO: various tables ops here */
+        b43_phy_lcn_clean_0x18_table(dev);
+        /* TODO: some ops here */
+        b43_phy_lcn_clear_0x07_table(dev);
+        if (dev->phy.radio_ver == 0x2064)
+                b43_radio_2064_init(dev);
+        else
+                B43_WARN_ON(1);
+        return 0;
+}
+static void b43_phy_lcn_op_software_rfkill(struct b43_wldev *dev,
+                                        bool blocked)
+{
+        if (b43_read32(dev, B43_MMIO_MACCTL) & B43_MACCTL_ENABLED)
+                b43err(dev->wl, "MAC not suspended\n");
+        if (blocked) {
+                b43_phy_mask(dev, B43_PHY_LCN_RF_CTL2, ~0x7c00);
+                b43_phy_set(dev, B43_PHY_LCN_RF_CTL1, 0x1f00);
+                b43_phy_mask(dev, B43_PHY_LCN_RF_CTL5, ~0x7f00);
+                b43_phy_mask(dev, B43_PHY_LCN_RF_CTL4, ~0x2);
+                b43_phy_set(dev, B43_PHY_LCN_RF_CTL3, 0x808);
+                b43_phy_mask(dev, B43_PHY_LCN_RF_CTL7, ~0x8);
+                b43_phy_set(dev, B43_PHY_LCN_RF_CTL6, 0x8);
+        } else {
+                b43_phy_mask(dev, B43_PHY_LCN_RF_CTL1, ~0x1f00);
+                b43_phy_mask(dev, B43_PHY_LCN_RF_CTL3, ~0x808);
+                b43_phy_mask(dev, B43_PHY_LCN_RF_CTL6, ~0x8);
+        }
+}
+static void b43_phy_lcn_op_switch_analog(struct b43_wldev *dev, bool on)
+{
+        if (on) {
+                b43_phy_mask(dev, B43_PHY_LCN_AFE_CTL1, ~0x7);
+        } else {
+                b43_phy_set(dev, B43_PHY_LCN_AFE_CTL2, 0x7);
+                b43_phy_set(dev, B43_PHY_LCN_AFE_CTL1, 0x7);
+        }
+}
+static unsigned int b43_phy_lcn_op_get_default_chan(struct b43_wldev *dev)
+{
+        if (b43_current_band(dev->wl) == IEEE80211_BAND_2GHZ)
+                return 1;
+        return 36;
+}
+static enum b43_txpwr_result
+b43_phy_lcn_op_recalc_txpower(struct b43_wldev *dev, bool ignore_tssi)
+{
+        return B43_TXPWR_RES_DONE;
+}
+static void b43_phy_lcn_op_adjust_txpower(struct b43_wldev *dev)
+{
+}
+/**************************************************
 * PHY ops struct.
 **************************************************/
 const struct b43_phy_operations b43_phyops_lcn = {
-        /*
        .allocate               = b43_phy_lcn_op_allocate,
        .free                   = b43_phy_lcn_op_free,
        .prepare_structs        = b43_phy_lcn_op_prepare_structs,
        .init                   = b43_phy_lcn_op_init,
+        /*
        .phy_read               = b43_phy_lcn_op_read,
        .phy_write              = b43_phy_lcn_op_write,
        .phy_maskset            = b43_phy_lcn_op_maskset,
        .radio_read             = b43_phy_lcn_op_radio_read,
        .radio_write            = b43_phy_lcn_op_radio_write,
+        */
        .software_rfkill        = b43_phy_lcn_op_software_rfkill,
        .switch_analog          = b43_phy_lcn_op_switch_analog,
+        /*
        .switch_channel         = b43_phy_lcn_op_switch_channel,
+        */
        .get_default_chan       = b43_phy_lcn_op_get_default_chan,
        .recalc_txpower         = b43_phy_lcn_op_recalc_txpower,
        .adjust_txpower         = b43_phy_lcn_op_adjust_txpower,
-        */
 };
diff --git a/drivers/net/wireless/b43/phy_lcn.h b/drivers/net/wireless/b43/phy_lcn.h
index c046c2a6cab4..25f06e8d4531 100644
--- a/drivers/net/wireless/b43/phy_lcn.h
+++ b/drivers/net/wireless/b43/phy_lcn.h
@@ -4,6 +4,20 @@
 #include "phy_common.h"
+#define B43_PHY_LCN_AFE_CTL1                    B43_PHY_OFDM(0x03B)
+#define B43_PHY_LCN_AFE_CTL2                    B43_PHY_OFDM(0x03C)
+#define B43_PHY_LCN_RF_CTL1                     B43_PHY_OFDM(0x04C)
+#define B43_PHY_LCN_RF_CTL2                     B43_PHY_OFDM(0x04D)
+#define B43_PHY_LCN_TABLE_ADDR                  B43_PHY_OFDM(0x055) /* Table address */
+#define B43_PHY_LCN_TABLE_DATALO                B43_PHY_OFDM(0x056) /* Table data low */
+#define B43_PHY_LCN_TABLE_DATAHI                B43_PHY_OFDM(0x057) /* Table data high */
+#define B43_PHY_LCN_RF_CTL3                     B43_PHY_OFDM(0x0B0)
+#define B43_PHY_LCN_RF_CTL4                     B43_PHY_OFDM(0x0B1)
+#define B43_PHY_LCN_RF_CTL5                     B43_PHY_OFDM(0x0B7)
+#define B43_PHY_LCN_RF_CTL6                     B43_PHY_OFDM(0x0F9)
+#define B43_PHY_LCN_RF_CTL7                     B43_PHY_OFDM(0x0FA)
 struct b43_phy_lcn {
 };
@@ -11,4 +25,4 @@ struct b43_phy_lcn {
 struct b43_phy_operations;
 extern const struct b43_phy_operations b43_phyops_lcn;
-#endif /* B43_PHY_LCN_H_ */
-\ No newline at end of file
+#endif /* B43_PHY_LCN_H_ */
diff --git a/drivers/net/wireless/b43/phy_n.c b/drivers/net/wireless/b43/phy_n.c
index 3b46360da99b..2eadadf5f4fc 100644
--- a/drivers/net/wireless/b43/phy_n.c
+++ b/drivers/net/wireless/b43/phy_n.c
@@ -600,49 +600,17 @@ static void b43_nphy_tx_lp_fbw(struct b43_wldev *dev)
        }
 }
-/* http://bcm-v4.sipsolutions.net/802.11/PHY/N/BmacPhyClkFgc */
-static void b43_nphy_bmac_clock_fgc(struct b43_wldev *dev, bool force)
-{
-        u32 tmp;
-        if (dev->phy.type != B43_PHYTYPE_N)
-                return;
-        switch (dev->dev->bus_type) {
-#ifdef CONFIG_B43_BCMA
-        case B43_BUS_BCMA:
-                tmp = bcma_aread32(dev->dev->bdev, BCMA_IOCTL);
-                if (force)
-                        tmp |= BCMA_IOCTL_FGC;
-                else
-                        tmp &= ~BCMA_IOCTL_FGC;
-                bcma_awrite32(dev->dev->bdev, BCMA_IOCTL, tmp);
-                break;
-#endif
-#ifdef CONFIG_B43_SSB
-        case B43_BUS_SSB:
-                tmp = ssb_read32(dev->dev->sdev, SSB_TMSLOW);
-                if (force)
-                        tmp |= SSB_TMSLOW_FGC;
-                else
-                        tmp &= ~SSB_TMSLOW_FGC;
-                ssb_write32(dev->dev->sdev, SSB_TMSLOW, tmp);
-                break;
-#endif
-        }
-}
 /* http://bcm-v4.sipsolutions.net/802.11/PHY/N/CCA */
 static void b43_nphy_reset_cca(struct b43_wldev *dev)
 {
        u16 bbcfg;
-        b43_nphy_bmac_clock_fgc(dev, 1);
+        b43_phy_force_clock(dev, 1);
        bbcfg = b43_phy_read(dev, B43_NPHY_BBCFG);
        b43_phy_write(dev, B43_NPHY_BBCFG, bbcfg | B43_NPHY_BBCFG_RSTCCA);
        udelay(1);
        b43_phy_write(dev, B43_NPHY_BBCFG, bbcfg & ~B43_NPHY_BBCFG_RSTCCA);
-        b43_nphy_bmac_clock_fgc(dev, 0);
+        b43_phy_force_clock(dev, 0);
        b43_nphy_force_rf_sequence(dev, B43_RFSEQ_RESET2RX);
 }
@@ -3715,11 +3683,11 @@ int b43_phy_initn(struct b43_wldev *dev)
        b43_nphy_workarounds(dev);
        /* Reset CCA, in init code it differs a little from standard way */
-        b43_nphy_bmac_clock_fgc(dev, 1);
+        b43_phy_force_clock(dev, 1);
        tmp = b43_phy_read(dev, B43_NPHY_BBCFG);
        b43_phy_write(dev, B43_NPHY_BBCFG, tmp | B43_NPHY_BBCFG_RSTCCA);
        b43_phy_write(dev, B43_NPHY_BBCFG, tmp & ~B43_NPHY_BBCFG_RSTCCA);
-        b43_nphy_bmac_clock_fgc(dev, 0);
+        b43_phy_force_clock(dev, 0);
        b43_mac_phy_clock_set(dev, true);
diff --git a/drivers/net/wireless/b43/pio.c b/drivers/net/wireless/b43/pio.c
index 6e4228c3ed1b..fcff923b3c18 100644
--- a/drivers/net/wireless/b43/pio.c
+++ b/drivers/net/wireless/b43/pio.c
@@ -611,7 +611,7 @@ static bool pio_rx_frame(struct b43_pio_rxqueue *q)
        struct b43_wldev *dev = q->dev;
        struct b43_wl *wl = dev->wl;
        u16 len;
-        u32 macstat;
+        u32 macstat = 0;
        unsigned int i, padding;
        struct sk_buff *skb;
        const char *err_msg = NULL;
@@ -676,7 +676,15 @@ data_ready:
                goto rx_error;
        }
-        macstat = le32_to_cpu(rxhdr->mac_status);
+        switch (dev->fw.hdr_format) {
+        case B43_FW_HDR_598:
+                macstat = le32_to_cpu(rxhdr->format_598.mac_status);
+                break;
+        case B43_FW_HDR_410:
+        case B43_FW_HDR_351:
+                macstat = le32_to_cpu(rxhdr->format_351.mac_status);
+                break;
+        }
        if (macstat & B43_RX_MAC_FCSERR) {
                if (!(q->dev->wl->filter_flags & FIF_FCSFAIL)) {
                        /* Drop frames with failed FCS. */
diff --git a/drivers/net/wireless/b43/tables_phy_ht.c b/drivers/net/wireless/b43/tables_phy_ht.c
index 603938657b15..677d217b5fb3 100644
--- a/drivers/net/wireless/b43/tables_phy_ht.c
+++ b/drivers/net/wireless/b43/tables_phy_ht.c
@@ -574,6 +574,42 @@ static const u32 b43_httab_0x24[] = {
        0x005d0582, 0x005805d6, 0x0053062e, 0x004e068c,
 };
+/* Some late-init table */
+const u32 b43_httab_0x1a_0xc0_late[] = {
+        0x10f90040, 0x10e10040, 0x10e1003c, 0x10c9003d,
+        0x10b9003c, 0x10a9003d, 0x10a1003c, 0x1099003b,
+        0x1091003b, 0x1089003a, 0x1081003a, 0x10790039,
+        0x10710039, 0x1069003a, 0x1061003b, 0x1059003d,
+        0x1051003f, 0x10490042, 0x1049003e, 0x1049003b,
+        0x1041003e, 0x1041003b, 0x1039003e, 0x1039003b,
+        0x10390038, 0x10390035, 0x1031003a, 0x10310036,
+        0x10310033, 0x1029003a, 0x10290037, 0x10290034,
+        0x10290031, 0x10210039, 0x10210036, 0x10210033,
+        0x10210030, 0x1019003c, 0x10190039, 0x10190036,
+        0x10190033, 0x10190030, 0x1019002d, 0x1019002b,
+        0x10190028, 0x1011003a, 0x10110036, 0x10110033,
+        0x10110030, 0x1011002e, 0x1011002b, 0x10110029,
+        0x10110027, 0x10110024, 0x10110022, 0x10110020,
+        0x1011001f, 0x1011001d, 0x1009003a, 0x10090037,
+        0x10090034, 0x10090031, 0x1009002e, 0x1009002c,
+        0x10090029, 0x10090027, 0x10090025, 0x10090023,
+        0x10090021, 0x1009001f, 0x1009001d, 0x1009001b,
+        0x1009001a, 0x10090018, 0x10090017, 0x10090016,
+        0x10090015, 0x10090013, 0x10090012, 0x10090011,
+        0x10090010, 0x1009000f, 0x1009000f, 0x1009000e,
+        0x1009000d, 0x1009000c, 0x1009000c, 0x1009000b,
+        0x1009000a, 0x1009000a, 0x10090009, 0x10090009,
+        0x10090008, 0x10090008, 0x10090007, 0x10090007,
+        0x10090007, 0x10090006, 0x10090006, 0x10090005,
+        0x10090005, 0x10090005, 0x10090005, 0x10090004,
+        0x10090004, 0x10090004, 0x10090004, 0x10090003,
+        0x10090003, 0x10090003, 0x10090003, 0x10090003,
+        0x10090003, 0x10090002, 0x10090002, 0x10090002,
+        0x10090002, 0x10090002, 0x10090002, 0x10090002,
+        0x10090002, 0x10090002, 0x10090001, 0x10090001,
+        0x10090001, 0x10090001, 0x10090001, 0x10090001,
+};
 /**************************************************
 * R/W ops.
 **************************************************/
@@ -674,6 +710,51 @@ void b43_httab_write(struct b43_wldev *dev, u32 offset, u32 value)
        return;
 }
+void b43_httab_write_few(struct b43_wldev *dev, u32 offset, size_t num, ...)
+{
+        va_list args;
+        u32 type, value;
+        unsigned int i;
+        type = offset & B43_HTTAB_TYPEMASK;
+        offset &= 0xFFFF;
+        va_start(args, num);
+        switch (type) {
+        case B43_HTTAB_8BIT:
+                b43_phy_write(dev, B43_PHY_HT_TABLE_ADDR, offset);
+                for (i = 0; i < num; i++) {
+                        value = va_arg(args, int);
+                        B43_WARN_ON(value & ~0xFF);
+                        b43_phy_write(dev, B43_PHY_HT_TABLE_DATALO, value);
+                }
+                break;
+        case B43_HTTAB_16BIT:
+                b43_phy_write(dev, B43_PHY_HT_TABLE_ADDR, offset);
+                for (i = 0; i < num; i++) {
+                        value = va_arg(args, int);
+                        B43_WARN_ON(value & ~0xFFFF);
+                        b43_phy_write(dev, B43_PHY_HT_TABLE_DATALO, value);
+                }
+                break;
+        case B43_HTTAB_32BIT:
+                b43_phy_write(dev, B43_PHY_HT_TABLE_ADDR, offset);
+                for (i = 0; i < num; i++) {
+                        value = va_arg(args, int);
+                        b43_phy_write(dev, B43_PHY_HT_TABLE_DATAHI,
+                                      value >> 16);
+                        b43_phy_write(dev, B43_PHY_HT_TABLE_DATALO,
+                                      value & 0xFFFF);
+                }
+                break;
+        default:
+                B43_WARN_ON(1);
+        }
+        va_end(args);
+        return;
+}
 void b43_httab_write_bulk(struct b43_wldev *dev, u32 offset,
                          unsigned int nr_elements, const void *_data)
 {
@@ -723,6 +804,9 @@ void b43_httab_write_bulk(struct b43_wldev *dev, u32 offset,
        } while (0)
 void b43_phy_ht_tables_init(struct b43_wldev *dev)
 {
+        BUILD_BUG_ON(ARRAY_SIZE(b43_httab_0x1a_0xc0_late) !=
+                        B43_HTTAB_1A_C0_LATE_SIZE);
        httab_upload(dev, B43_HTTAB16(0x12, 0), b43_httab_0x12);
        httab_upload(dev, B43_HTTAB16(0x27, 0), b43_httab_0x27);
        httab_upload(dev, B43_HTTAB16(0x26, 0), b43_httab_0x26);
diff --git a/drivers/net/wireless/b43/tables_phy_ht.h b/drivers/net/wireless/b43/tables_phy_ht.h
index ea3be382c894..1b5ef2bc770c 100644
--- a/drivers/net/wireless/b43/tables_phy_ht.h
+++ b/drivers/net/wireless/b43/tables_phy_ht.h
@@ -14,9 +14,13 @@ u32 b43_httab_read(struct b43_wldev *dev, u32 offset);
 void b43_httab_read_bulk(struct b43_wldev *dev, u32 offset,
                         unsigned int nr_elements, void *_data);
 void b43_httab_write(struct b43_wldev *dev, u32 offset, u32 value);
+void b43_httab_write_few(struct b43_wldev *dev, u32 offset, size_t num, ...);
 void b43_httab_write_bulk(struct b43_wldev *dev, u32 offset,
                          unsigned int nr_elements, const void *_data);
 void b43_phy_ht_tables_init(struct b43_wldev *dev);
+#define B43_HTTAB_1A_C0_LATE_SIZE               128
+extern const u32 b43_httab_0x1a_0xc0_late[];
 #endif /* B43_TABLES_PHY_HT_H_ */
diff --git a/drivers/net/wireless/b43/tables_phy_lcn.c b/drivers/net/wireless/b43/tables_phy_lcn.c
index 40c1d0915dd3..0a5842808a78 100644
--- a/drivers/net/wireless/b43/tables_phy_lcn.c
+++ b/drivers/net/wireless/b43/tables_phy_lcn.c
@@ -25,10 +25,442 @@
 #include "phy_common.h"
 #include "phy_lcn.h"
+static const u16 b43_lcntab_0x02[] = {
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d, 0x014d, 0x014d,
+        0x014d, 0x014d, 0x014d, 0x014d,
+};
+static const u16 b43_lcntab_0x01[] = {
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000,
+};
+static const u32 b43_lcntab_0x0b[] = {
+        0x000141f8, 0x000021f8, 0x000021fb, 0x000041fb,
+        0x0001fedb, 0x0000217b, 0x00002133, 0x000040eb,
+        0x0001fea3, 0x0000024b,
+};
+static const u32 b43_lcntab_0x0c[] = {
+        0x00100001, 0x00200010, 0x00300001, 0x00400010,
+        0x00500022, 0x00600122, 0x00700222, 0x00800322,
+        0x00900422, 0x00a00522, 0x00b00622, 0x00c00722,
+        0x00d00822, 0x00f00922, 0x00100a22, 0x00200b22,
+        0x00300c22, 0x00400d22, 0x00500e22, 0x00600f22,
+};
+static const u32 b43_lcntab_0x0d[] = {
+        0x00000000, 0x00000000, 0x10000000, 0x00000000,
+        0x20000000, 0x00000000, 0x30000000, 0x00000000,
+        0x40000000, 0x00000000, 0x50000000, 0x00000000,
+        0x60000000, 0x00000000, 0x70000000, 0x00000000,
+        0x80000000, 0x00000000, 0x90000000, 0x00000008,
+        0xa0000000, 0x00000008, 0xb0000000, 0x00000008,
+        0xc0000000, 0x00000008, 0xd0000000, 0x00000008,
+        0xe0000000, 0x00000008, 0xf0000000, 0x00000008,
+        0x00000000, 0x00000009, 0x10000000, 0x00000009,
+        0x20000000, 0x00000019, 0x30000000, 0x00000019,
+        0x40000000, 0x00000019, 0x50000000, 0x00000019,
+        0x60000000, 0x00000019, 0x70000000, 0x00000019,
+        0x80000000, 0x00000019, 0x90000000, 0x00000019,
+        0xa0000000, 0x00000019, 0xb0000000, 0x00000019,
+        0xc0000000, 0x00000019, 0xd0000000, 0x00000019,
+        0xe0000000, 0x00000019, 0xf0000000, 0x00000019,
+        0x00000000, 0x0000001a, 0x10000000, 0x0000001a,
+        0x20000000, 0x0000001a, 0x30000000, 0x0000001a,
+        0x40000000, 0x0000001a, 0x50000000, 0x00000002,
+        0x60000000, 0x00000002, 0x70000000, 0x00000002,
+        0x80000000, 0x00000002, 0x90000000, 0x00000002,
+        0xa0000000, 0x00000002, 0xb0000000, 0x00000002,
+        0xc0000000, 0x0000000a, 0xd0000000, 0x0000000a,
+        0xe0000000, 0x0000000a, 0xf0000000, 0x0000000a,
+        0x00000000, 0x0000000b, 0x10000000, 0x0000000b,
+        0x20000000, 0x0000000b, 0x30000000, 0x0000000b,
+        0x40000000, 0x0000000b, 0x50000000, 0x0000001b,
+        0x60000000, 0x0000001b, 0x70000000, 0x0000001b,
+        0x80000000, 0x0000001b, 0x90000000, 0x0000001b,
+        0xa0000000, 0x0000001b, 0xb0000000, 0x0000001b,
+        0xc0000000, 0x0000001b, 0xd0000000, 0x0000001b,
+        0xe0000000, 0x0000001b, 0xf0000000, 0x0000001b,
+        0x00000000, 0x0000001c, 0x10000000, 0x0000001c,
+        0x20000000, 0x0000001c, 0x30000000, 0x0000001c,
+        0x40000000, 0x0000001c, 0x50000000, 0x0000001c,
+        0x60000000, 0x0000001c, 0x70000000, 0x0000001c,
+        0x80000000, 0x0000001c, 0x90000000, 0x0000001c,
+};
+static const u16 b43_lcntab_0x0e[] = {
+        0x0401, 0x0402, 0x0403, 0x0404, 0x0405, 0x0406,
+        0x0407, 0x0408, 0x0409, 0x040a, 0x058b, 0x058c,
+        0x058d, 0x058e, 0x058f, 0x0090, 0x0091, 0x0092,
+        0x0193, 0x0194, 0x0195, 0x0196, 0x0197, 0x0198,
+        0x0199, 0x019a, 0x019b, 0x019c, 0x019d, 0x019e,
+        0x019f, 0x01a0, 0x01a1, 0x01a2, 0x01a3, 0x01a4,
+        0x01a5, 0x0000,
+};
+static const u16 b43_lcntab_0x0f[] = {
+        0x000a, 0x0009, 0x0006, 0x0005, 0x000a, 0x0009,
+        0x0006, 0x0005, 0x000a, 0x0009, 0x0006, 0x0005,
+        0x000a, 0x0009, 0x0006, 0x0005, 0x000a, 0x0009,
+        0x0006, 0x0005, 0x000a, 0x0009, 0x0006, 0x0005,
+        0x000a, 0x0009, 0x0006, 0x0005, 0x000a, 0x0009,
+        0x0006, 0x0005, 0x000a, 0x0009, 0x0006, 0x0005,
+        0x000a, 0x0009, 0x0006, 0x0005, 0x000a, 0x0009,
+        0x0006, 0x0005, 0x000a, 0x0009, 0x0006, 0x0005,
+        0x000a, 0x0009, 0x0006, 0x0005, 0x000a, 0x0009,
+        0x0006, 0x0005, 0x000a, 0x0009, 0x0006, 0x0005,
+        0x000a, 0x0009, 0x0006, 0x0005,
+};
+static const u16 b43_lcntab_0x10[] = {
+        0x005f, 0x0036, 0x0029, 0x001f, 0x005f, 0x0036,
+        0x0029, 0x001f, 0x005f, 0x0036, 0x0029, 0x001f,
+        0x005f, 0x0036, 0x0029, 0x001f,
+};
+static const u16 b43_lcntab_0x11[] = {
+        0x0009, 0x000f, 0x0014, 0x0018, 0x00fe, 0x0007,
+        0x000b, 0x000f, 0x00fb, 0x00fe, 0x0001, 0x0005,
+        0x0008, 0x000b, 0x000e, 0x0011, 0x0014, 0x0017,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0003, 0x0006, 0x0009, 0x000c, 0x000f,
+        0x0012, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0003,
+        0x0006, 0x0009, 0x000c, 0x000f, 0x0012, 0x0015,
+        0x0018, 0x001b, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0003, 0x00eb, 0x0000, 0x0000,
+};
+static const u32 b43_lcntab_0x12[] = {
+        0x00000000, 0x00000000, 0x00000000, 0x00000000,
+        0x00000000, 0x00000000, 0x00000000, 0x00000000,
+        0x00000004, 0x00000000, 0x00000004, 0x00000008,
+        0x00000001, 0x00000005, 0x00000009, 0x0000000d,
+        0x0000004d, 0x0000008d, 0x0000000d, 0x0000004d,
+        0x0000008d, 0x000000cd, 0x0000004f, 0x0000008f,
+        0x000000cf, 0x000000d3, 0x00000113, 0x00000513,
+        0x00000913, 0x00000953, 0x00000d53, 0x00001153,
+        0x00001193, 0x00005193, 0x00009193, 0x0000d193,
+        0x00011193, 0x00000000, 0x00000000, 0x00000000,
+        0x00000000, 0x00000000, 0x00000000, 0x00000004,
+        0x00000000, 0x00000004, 0x00000008, 0x00000001,
+        0x00000005, 0x00000009, 0x0000000d, 0x0000004d,
+        0x0000008d, 0x0000000d, 0x0000004d, 0x0000008d,
+        0x000000cd, 0x0000004f, 0x0000008f, 0x000000cf,
+        0x000000d3, 0x00000113, 0x00000513, 0x00000913,
+        0x00000953, 0x00000d53, 0x00001153, 0x00005153,
+        0x00009153, 0x0000d153, 0x00011153, 0x00015153,
+        0x00019153, 0x0001d153, 0x00000000, 0x00000000,
+        0x00000000, 0x00000000, 0x00000000, 0x00000000,
+        0x00000000, 0x00000000, 0x00000000, 0x00000000,
+        0x00000000, 0x00000000, 0x00000000, 0x00000000,
+        0x00000000, 0x00000000, 0x00000000, 0x00000000,
+        0x00000000, 0x00000000, 0x00000000, 0x00000000,
+};
+static const u16 b43_lcntab_0x14[] = {
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0002, 0x0003, 0x0001, 0x0003, 0x0002, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0002, 0x0003,
+        0x0001, 0x0003, 0x0002, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001, 0x0001, 0x0001, 0x0001, 0x0001,
+        0x0001, 0x0001,
+};
+static const u16 b43_lcntab_0x17[] = {
+        0x001a, 0x0034, 0x004e, 0x0068, 0x009c, 0x00d0,
+        0x00ea, 0x0104, 0x0034, 0x0068, 0x009c, 0x00d0,
+        0x0138, 0x01a0, 0x01d4, 0x0208, 0x004e, 0x009c,
+        0x00ea, 0x0138, 0x01d4, 0x0270, 0x02be, 0x030c,
+        0x0068, 0x00d0, 0x0138, 0x01a0, 0x0270, 0x0340,
+        0x03a8, 0x0410, 0x0018, 0x009c, 0x00d0, 0x0104,
+        0x00ea, 0x0138, 0x0186, 0x00d0, 0x0104, 0x0104,
+        0x0138, 0x016c, 0x016c, 0x01a0, 0x0138, 0x0186,
+        0x0186, 0x01d4, 0x0222, 0x0222, 0x0270, 0x0104,
+        0x0138, 0x016c, 0x0138, 0x016c, 0x01a0, 0x01d4,
+        0x01a0, 0x01d4, 0x0208, 0x0208, 0x023c, 0x0186,
+        0x01d4, 0x0222, 0x01d4, 0x0222, 0x0270, 0x02be,
+        0x0270, 0x02be, 0x030c, 0x030c, 0x035a, 0x0036,
+        0x006c, 0x00a2, 0x00d8, 0x0144, 0x01b0, 0x01e6,
+        0x021c, 0x006c, 0x00d8, 0x0144, 0x01b0, 0x0288,
+        0x0360, 0x03cc, 0x0438, 0x00a2, 0x0144, 0x01e6,
+        0x0288, 0x03cc, 0x0510, 0x05b2, 0x0654, 0x00d8,
+        0x01b0, 0x0288, 0x0360, 0x0510, 0x06c0, 0x0798,
+        0x0870, 0x0018, 0x0144, 0x01b0, 0x021c, 0x01e6,
+        0x0288, 0x032a, 0x01b0, 0x021c, 0x021c, 0x0288,
+        0x02f4, 0x02f4, 0x0360, 0x0288, 0x032a, 0x032a,
+        0x03cc, 0x046e, 0x046e, 0x0510, 0x021c, 0x0288,
+        0x02f4, 0x0288, 0x02f4, 0x0360, 0x03cc, 0x0360,
+        0x03cc, 0x0438, 0x0438, 0x04a4, 0x032a, 0x03cc,
+        0x046e, 0x03cc, 0x046e, 0x0510, 0x05b2, 0x0510,
+        0x05b2, 0x0654, 0x0654, 0x06f6,
+};
+static const u16 b43_lcntab_0x00[] = {
+        0x0200, 0x0300, 0x0400, 0x0600, 0x0800, 0x0b00,
+        0x1000, 0x1001, 0x1002, 0x1003, 0x1004, 0x1005,
+        0x1006, 0x1007, 0x1707, 0x2007, 0x2d07, 0x4007,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0200, 0x0300, 0x0400, 0x0600,
+        0x0800, 0x0b00, 0x1000, 0x1001, 0x1002, 0x1003,
+        0x1004, 0x1005, 0x1006, 0x1007, 0x1707, 0x2007,
+        0x2d07, 0x4007, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x4000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+        0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
+};
+static const u32 b43_lcntab_0x18[] = {
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+        0x00080000, 0x00080000, 0x00080000, 0x00080000,
+};
+/**************************************************
+ * R/W ops.
+ **************************************************/
+u32 b43_lcntab_read(struct b43_wldev *dev, u32 offset)
+{
+        u32 type, value;
+        type = offset & B43_LCNTAB_TYPEMASK;
+        offset &= ~B43_LCNTAB_TYPEMASK;
+        B43_WARN_ON(offset > 0xFFFF);
+        switch (type) {
+        case B43_LCNTAB_8BIT:
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+                value = b43_phy_read(dev, B43_PHY_LCN_TABLE_DATALO) & 0xFF;
+                break;
+        case B43_LCNTAB_16BIT:
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+                value = b43_phy_read(dev, B43_PHY_LCN_TABLE_DATALO);
+                break;
+        case B43_LCNTAB_32BIT:
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+                value = b43_phy_read(dev, B43_PHY_LCN_TABLE_DATAHI);
+                value <<= 16;
+                value |= b43_phy_read(dev, B43_PHY_LCN_TABLE_DATALO);
+                break;
+        default:
+                B43_WARN_ON(1);
+                value = 0;
+        }
+        return value;
+}
+void b43_lcntab_read_bulk(struct b43_wldev *dev, u32 offset,
+                          unsigned int nr_elements, void *_data)
+{
+        u32 type;
+        u8 *data = _data;
+        unsigned int i;
+        type = offset & B43_LCNTAB_TYPEMASK;
+        offset &= ~B43_LCNTAB_TYPEMASK;
+        B43_WARN_ON(offset > 0xFFFF);
+        b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+        for (i = 0; i < nr_elements; i++) {
+                switch (type) {
+                case B43_LCNTAB_8BIT:
+                        *data = b43_phy_read(dev,
+                                             B43_PHY_LCN_TABLE_DATALO) & 0xFF;
+                        data++;
+                        break;
+                case B43_LCNTAB_16BIT:
+                        *((u16 *)data) = b43_phy_read(dev,
+                                                      B43_PHY_LCN_TABLE_DATALO);
+                        data += 2;
+                        break;
+                case B43_LCNTAB_32BIT:
+                        *((u32 *)data) = b43_phy_read(dev,
+                                                      B43_PHY_LCN_TABLE_DATAHI);
+                        *((u32 *)data) <<= 16;
+                        *((u32 *)data) |= b43_phy_read(dev,
+                                                B43_PHY_LCN_TABLE_DATALO);
+                        data += 4;
+                        break;
+                default:
+                        B43_WARN_ON(1);
+                }
+        }
+}
+void b43_lcntab_write(struct b43_wldev *dev, u32 offset, u32 value)
+{
+        u32 type;
+        type = offset & B43_LCNTAB_TYPEMASK;
+        offset &= 0xFFFF;
+        switch (type) {
+        case B43_LCNTAB_8BIT:
+                B43_WARN_ON(value & ~0xFF);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, value);
+                break;
+        case B43_LCNTAB_16BIT:
+                B43_WARN_ON(value & ~0xFFFF);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, value);
+                break;
+        case B43_LCNTAB_32BIT:
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATAHI, value >> 16);
+                b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, value & 0xFFFF);
+                break;
+        default:
+                B43_WARN_ON(1);
+        }
+        return;
+}
+void b43_lcntab_write_bulk(struct b43_wldev *dev, u32 offset,
+                           unsigned int nr_elements, const void *_data)
+{
+        u32 type, value;
+        const u8 *data = _data;
+        unsigned int i;
+        type = offset & B43_LCNTAB_TYPEMASK;
+        offset &= ~B43_LCNTAB_TYPEMASK;
+        B43_WARN_ON(offset > 0xFFFF);
+        b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, offset);
+        for (i = 0; i < nr_elements; i++) {
+                switch (type) {
+                case B43_LCNTAB_8BIT:
+                        value = *data;
+                        data++;
+                        B43_WARN_ON(value & ~0xFF);
+                        b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, value);
+                        break;
+                case B43_LCNTAB_16BIT:
+                        value = *((u16 *)data);
+                        data += 2;
+                        B43_WARN_ON(value & ~0xFFFF);
+                        b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, value);
+                        break;
+                case B43_LCNTAB_32BIT:
+                        value = *((u32 *)data);
+                        data += 4;
+                        b43_phy_write(dev, B43_PHY_LCN_TABLE_DATAHI,
+                                      value >> 16);
+                        b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO,
+                                      value & 0xFFFF);
+                        break;
+                default:
+                        B43_WARN_ON(1);
+                }
+        }
+}
 /**************************************************
 * Tables ops.
 **************************************************/
+#define lcntab_upload(dev, offset, data) do { \
+                b43_lcntab_write_bulk(dev, offset, ARRAY_SIZE(data), data); \
+        } while (0)
 void b43_phy_lcn_tables_init(struct b43_wldev *dev)
 {
+        lcntab_upload(dev, B43_LCNTAB16(0x02, 0), b43_lcntab_0x02);
+        lcntab_upload(dev, B43_LCNTAB16(0x01, 0), b43_lcntab_0x01);
+        lcntab_upload(dev, B43_LCNTAB32(0x0b, 0), b43_lcntab_0x0b);
+        lcntab_upload(dev, B43_LCNTAB32(0x0c, 0), b43_lcntab_0x0c);
+        lcntab_upload(dev, B43_LCNTAB32(0x0d, 0), b43_lcntab_0x0d);
+        lcntab_upload(dev, B43_LCNTAB16(0x0e, 0), b43_lcntab_0x0e);
+        lcntab_upload(dev, B43_LCNTAB16(0x0f, 0), b43_lcntab_0x0f);
+        lcntab_upload(dev, B43_LCNTAB16(0x10, 0), b43_lcntab_0x10);
+        lcntab_upload(dev, B43_LCNTAB16(0x11, 0), b43_lcntab_0x11);
+        lcntab_upload(dev, B43_LCNTAB32(0x12, 0), b43_lcntab_0x12);
+        lcntab_upload(dev, B43_LCNTAB16(0x14, 0), b43_lcntab_0x14);
+        lcntab_upload(dev, B43_LCNTAB16(0x17, 0), b43_lcntab_0x17);
+        lcntab_upload(dev, B43_LCNTAB16(0x00, 0), b43_lcntab_0x00);
+        lcntab_upload(dev, B43_LCNTAB32(0x18, 0), b43_lcntab_0x18);
 }
diff --git a/drivers/net/wireless/b43/tables_phy_lcn.h b/drivers/net/wireless/b43/tables_phy_lcn.h
index 5e31b15b81ec..b6471e89c36f 100644
--- a/drivers/net/wireless/b43/tables_phy_lcn.h
+++ b/drivers/net/wireless/b43/tables_phy_lcn.h
@@ -1,6 +1,22 @@
 #ifndef B43_TABLES_PHY_LCN_H_
 #define B43_TABLES_PHY_LCN_H_
+/* The LCN-PHY tables. */
+#define B43_LCNTAB_TYPEMASK             0xF0000000
+#define B43_LCNTAB_8BIT                 0x10000000
+#define B43_LCNTAB_16BIT                0x20000000
+#define B43_LCNTAB_32BIT                0x30000000
+#define B43_LCNTAB8(table, offset)      (((table) << 10) | (offset) | B43_LCNTAB_8BIT)
+#define B43_LCNTAB16(table, offset)     (((table) << 10) | (offset) | B43_LCNTAB_16BIT)
+#define B43_LCNTAB32(table, offset)     (((table) << 10) | (offset) | B43_LCNTAB_32BIT)
+u32 b43_lcntab_read(struct b43_wldev *dev, u32 offset);
+void b43_lcntab_read_bulk(struct b43_wldev *dev, u32 offset,
+                          unsigned int nr_elements, void *_data);
+void b43_lcntab_write(struct b43_wldev *dev, u32 offset, u32 value);
+void b43_lcntab_write_bulk(struct b43_wldev *dev, u32 offset,
+                           unsigned int nr_elements, const void *_data);
 void b43_phy_lcn_tables_init(struct b43_wldev *dev);
 #endif /* B43_TABLES_PHY_LCN_H_ */
diff --git a/drivers/net/wireless/b43/xmit.c b/drivers/net/wireless/b43/xmit.c
index b74f25ec1ab4..b8de62c22479 100644
--- a/drivers/net/wireless/b43/xmit.c
+++ b/drivers/net/wireless/b43/xmit.c
@@ -337,12 +337,19 @@ int b43_generate_txhdr(struct b43_wldev *dev,
                        memcpy(txhdr->iv, ((u8 *) wlhdr) + wlhdr_len, iv_len);
                }
        }
-        if (b43_is_old_txhdr_format(dev)) {
+        switch (dev->fw.hdr_format) {
-                b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)(&txhdr->old_format.plcp),
+        case B43_FW_HDR_598:
+                b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)(&txhdr->format_598.plcp),
                                      plcp_fragment_len, rate);
-        } else {
+                break;
-                b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)(&txhdr->new_format.plcp),
+        case B43_FW_HDR_351:
+                b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)(&txhdr->format_351.plcp),
+                                      plcp_fragment_len, rate);
+                break;
+        case B43_FW_HDR_410:
+                b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)(&txhdr->format_410.plcp),
                                      plcp_fragment_len, rate);
+                break;
        }
        b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)(&txhdr->plcp_fb),
                              plcp_fragment_len, rate_fb);
@@ -415,10 +422,10 @@ int b43_generate_txhdr(struct b43_wldev *dev,
        if ((rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS) ||
            (rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT)) {
                unsigned int len;
-                struct ieee80211_hdr *hdr;
+                struct ieee80211_hdr *uninitialized_var(hdr);
                int rts_rate, rts_rate_fb;
                int rts_rate_ofdm, rts_rate_fb_ofdm;
-                struct b43_plcp_hdr6 *plcp;
+                struct b43_plcp_hdr6 *uninitialized_var(plcp);
                struct ieee80211_rate *rts_cts_rate;
                rts_cts_rate = ieee80211_get_rts_cts_rate(dev->wl->hw, info);
@@ -429,14 +436,21 @@ int b43_generate_txhdr(struct b43_wldev *dev,
                rts_rate_fb_ofdm = b43_is_ofdm_rate(rts_rate_fb);
                if (rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT) {
-                        struct ieee80211_cts *cts;
+                        struct ieee80211_cts *uninitialized_var(cts);
-                        if (b43_is_old_txhdr_format(dev)) {
+                        switch (dev->fw.hdr_format) {
+                        case B43_FW_HDR_598:
                                cts = (struct ieee80211_cts *)
-                                        (txhdr->old_format.rts_frame);
+                                        (txhdr->format_598.rts_frame);
-                        } else {
+                                break;
+                        case B43_FW_HDR_351:
                                cts = (struct ieee80211_cts *)
-                                        (txhdr->new_format.rts_frame);
+                                        (txhdr->format_351.rts_frame);
+                                break;
+                        case B43_FW_HDR_410:
+                                cts = (struct ieee80211_cts *)
+                                        (txhdr->format_410.rts_frame);
+                                break;
                        }
                        ieee80211_ctstoself_get(dev->wl->hw, info->control.vif,
                                                fragment_data, fragment_len,
@@ -444,14 +458,21 @@ int b43_generate_txhdr(struct b43_wldev *dev,
                        mac_ctl |= B43_TXH_MAC_SENDCTS;
                        len = sizeof(struct ieee80211_cts);
                } else {
-                        struct ieee80211_rts *rts;
+                        struct ieee80211_rts *uninitialized_var(rts);
-                        if (b43_is_old_txhdr_format(dev)) {
+                        switch (dev->fw.hdr_format) {
+                        case B43_FW_HDR_598:
                                rts = (struct ieee80211_rts *)
-                                        (txhdr->old_format.rts_frame);
+                                        (txhdr->format_598.rts_frame);
-                        } else {
+                                break;
+                        case B43_FW_HDR_351:
+                                rts = (struct ieee80211_rts *)
+                                        (txhdr->format_351.rts_frame);
+                                break;
+                        case B43_FW_HDR_410:
                                rts = (struct ieee80211_rts *)
-                                        (txhdr->new_format.rts_frame);
+                                        (txhdr->format_410.rts_frame);
+                                break;
                        }
                        ieee80211_rts_get(dev->wl->hw, info->control.vif,
                                          fragment_data, fragment_len,
@@ -462,22 +483,36 @@ int b43_generate_txhdr(struct b43_wldev *dev,
                len += FCS_LEN;
                /* Generate the PLCP headers for the RTS/CTS frame */
-                if (b43_is_old_txhdr_format(dev))
+                switch (dev->fw.hdr_format) {
-                        plcp = &txhdr->old_format.rts_plcp;
+                case B43_FW_HDR_598:
-                else
+                        plcp = &txhdr->format_598.rts_plcp;
-                        plcp = &txhdr->new_format.rts_plcp;
+                        break;
+                case B43_FW_HDR_351:
+                        plcp = &txhdr->format_351.rts_plcp;
+                        break;
+                case B43_FW_HDR_410:
+                        plcp = &txhdr->format_410.rts_plcp;
+                        break;
+                }
                b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)plcp,
                                      len, rts_rate);
                plcp = &txhdr->rts_plcp_fb;
                b43_generate_plcp_hdr((struct b43_plcp_hdr4 *)plcp,
                                      len, rts_rate_fb);
-                if (b43_is_old_txhdr_format(dev)) {
+                switch (dev->fw.hdr_format) {
+                case B43_FW_HDR_598:
                        hdr = (struct ieee80211_hdr *)
-                                (&txhdr->old_format.rts_frame);
+                                (&txhdr->format_598.rts_frame);
-                } else {
+                        break;
+                case B43_FW_HDR_351:
+                        hdr = (struct ieee80211_hdr *)
+                                (&txhdr->format_351.rts_frame);
+                        break;
+                case B43_FW_HDR_410:
                        hdr = (struct ieee80211_hdr *)
-                                (&txhdr->new_format.rts_frame);
+                                (&txhdr->format_410.rts_frame);
+                        break;
                }
                txhdr->rts_dur_fb = hdr->duration_id;
@@ -505,10 +540,17 @@ int b43_generate_txhdr(struct b43_wldev *dev,
        }
        /* Magic cookie */
-        if (b43_is_old_txhdr_format(dev))
+        switch (dev->fw.hdr_format) {
-                txhdr->old_format.cookie = cpu_to_le16(cookie);
+        case B43_FW_HDR_598:
-        else
+                txhdr->format_598.cookie = cpu_to_le16(cookie);
-                txhdr->new_format.cookie = cpu_to_le16(cookie);
+                break;
+        case B43_FW_HDR_351:
+                txhdr->format_351.cookie = cpu_to_le16(cookie);
+                break;
+        case B43_FW_HDR_410:
+                txhdr->format_410.cookie = cpu_to_le16(cookie);
+                break;
+        }
        if (phy->type == B43_PHYTYPE_N) {
                txhdr->phy_ctl1 =
@@ -611,8 +653,9 @@ void b43_rx(struct b43_wldev *dev, struct sk_buff *skb, const void *_rxhdr)
        struct ieee80211_hdr *wlhdr;
        const struct b43_rxhdr_fw4 *rxhdr = _rxhdr;
        __le16 fctl;
-        u16 phystat0, phystat3, chanstat, mactime;
+        u16 phystat0, phystat3;
-        u32 macstat;
+        u16 uninitialized_var(chanstat), uninitialized_var(mactime);
+        u32 uninitialized_var(macstat);
        u16 chanid;
        u16 phytype;
        int padding;
@@ -622,9 +665,19 @@ void b43_rx(struct b43_wldev *dev, struct sk_buff *skb, const void *_rxhdr)
        /* Get metadata about the frame from the header. */
        phystat0 = le16_to_cpu(rxhdr->phy_status0);
        phystat3 = le16_to_cpu(rxhdr->phy_status3);
-        macstat = le32_to_cpu(rxhdr->mac_status);
+        switch (dev->fw.hdr_format) {
-        mactime = le16_to_cpu(rxhdr->mac_time);
+        case B43_FW_HDR_598:
-        chanstat = le16_to_cpu(rxhdr->channel);
+                macstat = le32_to_cpu(rxhdr->format_598.mac_status);
+                mactime = le16_to_cpu(rxhdr->format_598.mac_time);
+                chanstat = le16_to_cpu(rxhdr->format_598.channel);
+                break;
+        case B43_FW_HDR_410:
+        case B43_FW_HDR_351:
+                macstat = le32_to_cpu(rxhdr->format_351.mac_status);
+                mactime = le16_to_cpu(rxhdr->format_351.mac_time);
+                chanstat = le16_to_cpu(rxhdr->format_351.channel);
+                break;
+        }
        phytype = chanstat & B43_RX_CHAN_PHYTYPE;
        if (unlikely(macstat & B43_RX_MAC_FCSERR)) {
@@ -744,6 +797,7 @@ void b43_rx(struct b43_wldev *dev, struct sk_buff *skb, const void *_rxhdr)
                break;
        case B43_PHYTYPE_N:
        case B43_PHYTYPE_LP:
+        case B43_PHYTYPE_HT:
                /* chanid is the SHM channel cookie. Which is the plain
                 * channel number in b43. */
                if (chanstat & B43_RX_CHAN_5GHZ) {
diff --git a/drivers/net/wireless/b43/xmit.h b/drivers/net/wireless/b43/xmit.h
index 42debb5cd6fa..f6e8bc436d5a 100644
--- a/drivers/net/wireless/b43/xmit.h
+++ b/drivers/net/wireless/b43/xmit.h
@@ -46,7 +46,24 @@ struct b43_txhdr {
        __le32 timeout;                 /* Timeout */
        union {
-                /* The new r410 format. */
+                /* Tested with 598.314, 644.1001 and 666.2 */
+                struct {
+                        __le16 mimo_antenna;            /* MIMO antenna select */
+                        __le16 preload_size;            /* Preload size */
+                        PAD_BYTES(2);
+                        __le16 cookie;                  /* TX frame cookie */
+                        __le16 tx_status;               /* TX status */
+                        __le16 max_n_mpdus;
+                        __le16 max_a_bytes_mrt;
+                        __le16 max_a_bytes_fbr;
+                        __le16 min_m_bytes;
+                        struct b43_plcp_hdr6 rts_plcp;  /* RTS PLCP header */
+                        __u8 rts_frame[16];             /* The RTS frame (if used) */
+                        PAD_BYTES(2);
+                        struct b43_plcp_hdr6 plcp;      /* Main PLCP header */
+                } format_598 __packed;
+                /* Tested with 410.2160, 478.104 and 508.* */
                struct {
                        __le16 mimo_antenna;            /* MIMO antenna select */
                        __le16 preload_size;            /* Preload size */
@@ -57,9 +74,9 @@ struct b43_txhdr {
                        __u8 rts_frame[16];             /* The RTS frame (if used) */
                        PAD_BYTES(2);
                        struct b43_plcp_hdr6 plcp;      /* Main PLCP header */
-                } new_format __packed;
+                } format_410 __packed;
-                /* The old r351 format. */
+                /* Tested with 351.126 */
                struct {
                        PAD_BYTES(2);
                        __le16 cookie;                  /* TX frame cookie */
@@ -68,7 +85,7 @@ struct b43_txhdr {
                        __u8 rts_frame[16];             /* The RTS frame (if used) */
                        PAD_BYTES(2);
                        struct b43_plcp_hdr6 plcp;      /* Main PLCP header */
-                } old_format __packed;
+                } format_351 __packed;
        } __packed;
 } __packed;
@@ -166,19 +183,18 @@ struct b43_tx_legacy_rate_phy_ctl_entry {
 #define  B43_TXH_PHY1_MODUL_QAM256      0x2000 /* QAM256 */
-/* r351 firmware compatibility stuff. */
-static inline
-bool b43_is_old_txhdr_format(struct b43_wldev *dev)
-{
-        return (dev->fw.rev <= 351);
-}
 static inline
 size_t b43_txhdr_size(struct b43_wldev *dev)
 {
-        if (b43_is_old_txhdr_format(dev))
+        switch (dev->fw.hdr_format) {
+        case B43_FW_HDR_598:
+                return 112 + sizeof(struct b43_plcp_hdr6);
+        case B43_FW_HDR_410:
+                return 104 + sizeof(struct b43_plcp_hdr6);
+        case B43_FW_HDR_351:
                return 100 + sizeof(struct b43_plcp_hdr6);
-        return 104 + sizeof(struct b43_plcp_hdr6);
+        }
+        return 0;
 }
@@ -234,9 +250,23 @@ struct b43_rxhdr_fw4 {
        } __packed;
        __le16 phy_status2;     /* PHY RX Status 2 */
        __le16 phy_status3;     /* PHY RX Status 3 */
-        __le32 mac_status;      /* MAC RX status */
+        union {
-        __le16 mac_time;
+                /* Tested with 598.314, 644.1001 and 666.2 */
-        __le16 channel;
+                struct {
+                        __le16 phy_status4;     /* PHY RX Status 4 */
+                        __le16 phy_status5;     /* PHY RX Status 5 */
+                        __le32 mac_status;      /* MAC RX status */
+                        __le16 mac_time;
+                        __le16 channel;
+                } format_598 __packed;
+                /* Tested with 351.126, 410.2160, 478.104 and 508.* */
+                struct {
+                        __le32 mac_status;      /* MAC RX status */
+                        __le16 mac_time;
+                        __le16 channel;
+                } format_351 __packed;
+        } __packed;
 } __packed;
 /* PHY RX Status 0 */
diff --git a/drivers/net/wireless/b43legacy/b43legacy.h b/drivers/net/wireless/b43legacy/b43legacy.h
index ad4e743e4765..12b518251581 100644
--- a/drivers/net/wireless/b43legacy/b43legacy.h
+++ b/drivers/net/wireless/b43legacy/b43legacy.h
@@ -22,10 +22,6 @@
 #include "phy.h"
-/* The unique identifier of the firmware that's officially supported by this
- * driver version. */
-#define B43legacy_SUPPORTED_FIRMWARE_ID "FW10"
 #define B43legacy_IRQWAIT_MAX_RETRIES   20
 /* MMIO offsets */
diff --git a/drivers/net/wireless/b43legacy/main.c b/drivers/net/wireless/b43legacy/main.c
index aae8dfcb852e..468d1836548e 100644
--- a/drivers/net/wireless/b43legacy/main.c
+++ b/drivers/net/wireless/b43legacy/main.c
@@ -60,7 +60,6 @@ MODULE_AUTHOR("Stefano Brivio");
 MODULE_AUTHOR("Michael Buesch");
 MODULE_LICENSE("GPL");
-MODULE_FIRMWARE(B43legacy_SUPPORTED_FIRMWARE_ID);
 MODULE_FIRMWARE("b43legacy/ucode2.fw");
 MODULE_FIRMWARE("b43legacy/ucode4.fw");
@@ -3947,8 +3946,7 @@ static void b43legacy_print_driverinfo(void)
        feat_dma = "D";
 #endif
        printk(KERN_INFO "Broadcom 43xx-legacy driver loaded "
-               "[ Features: %s%s%s%s, Firmware-ID: "
+               "[ Features: %s%s%s%s ]\n",
-               B43legacy_SUPPORTED_FIRMWARE_ID " ]\n",
               feat_pci, feat_leds, feat_pio, feat_dma);
 }
diff --git a/drivers/net/wireless/libertas/README b/drivers/net/wireless/libertas/README
index 1453eec82a99..91f2ca90c70f 100644
--- a/drivers/net/wireless/libertas/README
+++ b/drivers/net/wireless/libertas/README
@@ -238,28 +238,3 @@ hostsleep
                echo "1" > hostsleep : enable host sleep.
                echo "0" > hostsleep : disable host sleep
-========================
-IWCONFIG COMMANDS
-========================
-power period
-        This command is used to configure the station in deep sleep mode /
-        auto deep sleep mode.
-        The timer is implemented to monitor the activities (command, event,
-        etc.). When an activity is detected station will exit from deep
-        sleep mode automatically and restart the timer. At timer expiry
-        (no activity for defined time period) the deep sleep mode is entered
-        automatically.
-        Note: this command is for SDIO interface only.
-        Usage:
-        To enable deep sleep mode do:
-                iwconfig wlan0 power period 0
-        To enable auto deep sleep mode with idle time period 5 seconds do:
-                iwconfig wlan0 power period 5
-        To disable deep sleep/auto deep sleep mode do:
-                iwconfig wlan0 power period -1
-==============================================================================
diff --git a/drivers/net/wireless/libertas/dev.h b/drivers/net/wireless/libertas/dev.h
index 814838916b82..b9ff0dc53e8d 100644
--- a/drivers/net/wireless/libertas/dev.h
+++ b/drivers/net/wireless/libertas/dev.h
@@ -190,8 +190,8 @@ static inline int lbs_iface_active(struct lbs_private *priv)
        int r;
        r = netif_running(priv->dev);
-        if (priv->mesh_dev);
+        if (priv->mesh_dev)
-                r |= netif_running(priv->dev);
+                r |= netif_running(priv->mesh_dev);
        return r;
 }
diff --git a/drivers/net/wireless/mwifiex/scan.c b/drivers/net/wireless/mwifiex/scan.c
index b28241c6e737..37ca2f90ad63 100644
--- a/drivers/net/wireless/mwifiex/scan.c
+++ b/drivers/net/wireless/mwifiex/scan.c
@@ -1480,8 +1480,8 @@ mwifiex_update_curr_bss_params(struct mwifiex_private *priv,
                return -ENOMEM;
        }
        beacon_ie = kzalloc(ie_len, GFP_KERNEL);
-        if (!bss_desc) {
+        if (!beacon_ie) {
-                dev_err(priv->adapter->dev, " failed to alloc bss_desc\n");
+                dev_err(priv->adapter->dev, " failed to alloc beacon_ie\n");
                return -ENOMEM;
        }
        memcpy(beacon_ie, ie_buf, ie_len);
diff --git a/drivers/net/wireless/mwl8k.c b/drivers/net/wireless/mwl8k.c
index da36dbf8d871..771280a47ea7 100644
--- a/drivers/net/wireless/mwl8k.c
+++ b/drivers/net/wireless/mwl8k.c
@@ -4097,9 +4097,6 @@ static int mwl8k_set_key(struct ieee80211_hw *hw,
                if (rc)
                        goto out;
-                mwl8k_vif->is_hw_crypto_enabled = false;
        }
 out:
        return rc;
diff --git a/drivers/net/wireless/p54/eeprom.c b/drivers/net/wireless/p54/eeprom.c
index 54cc0bba66b9..8b6f363b3f7d 100644
--- a/drivers/net/wireless/p54/eeprom.c
+++ b/drivers/net/wireless/p54/eeprom.c
@@ -145,6 +145,7 @@ static int p54_fill_band_bitrates(struct ieee80211_hw *dev,
 static int p54_generate_band(struct ieee80211_hw *dev,
                             struct p54_channel_list *list,
+                             unsigned int *chan_num,
                             enum ieee80211_band band)
 {
        struct p54_common *priv = dev->priv;
@@ -190,7 +191,14 @@ static int p54_generate_band(struct ieee80211_hw *dev,
                tmp->channels[j].band = chan->band;
                tmp->channels[j].center_freq = chan->freq;
+                priv->survey[*chan_num].channel = &tmp->channels[j];
+                priv->survey[*chan_num].filled = SURVEY_INFO_NOISE_DBM |
+                        SURVEY_INFO_CHANNEL_TIME |
+                        SURVEY_INFO_CHANNEL_TIME_BUSY |
+                        SURVEY_INFO_CHANNEL_TIME_TX;
+                tmp->channels[j].hw_value = (*chan_num);
                j++;
+                (*chan_num)++;
        }
        if (j == 0) {
@@ -263,7 +271,7 @@ static int p54_generate_channel_lists(struct ieee80211_hw *dev)
 {
        struct p54_common *priv = dev->priv;
        struct p54_channel_list *list;
-        unsigned int i, j, max_channel_num;
+        unsigned int i, j, k, max_channel_num;
        int ret = 0;
        u16 freq;
@@ -283,6 +291,13 @@ static int p54_generate_channel_lists(struct ieee80211_hw *dev)
                ret = -ENOMEM;
                goto free;
        }
+        priv->chan_num = max_channel_num;
+        priv->survey = kzalloc(sizeof(struct survey_info) * max_channel_num,
+                               GFP_KERNEL);
+        if (!priv->survey) {
+                ret = -ENOMEM;
+                goto free;
+        }
        list->max_entries = max_channel_num;
        list->channels = kzalloc(sizeof(struct p54_channel_entry) *
@@ -321,8 +336,9 @@ static int p54_generate_channel_lists(struct ieee80211_hw *dev)
        sort(list->channels, list->entries, sizeof(struct p54_channel_entry),
             p54_compare_channels, NULL);
+        k = 0;
        for (i = 0, j = 0; i < IEEE80211_NUM_BANDS; i++) {
-                if (p54_generate_band(dev, list, i) == 0)
+                if (p54_generate_band(dev, list, &k, i) == 0)
                        j++;
        }
        if (j == 0) {
@@ -335,6 +351,10 @@ free:
                kfree(list->channels);
                kfree(list);
        }
+        if (ret) {
+                kfree(priv->survey);
+                priv->survey = NULL;
+        }
        return ret;
 }
@@ -853,10 +873,12 @@ err:
        kfree(priv->output_limit);
        kfree(priv->curve_data);
        kfree(priv->rssi_db);
+        kfree(priv->survey);
        priv->iq_autocal = NULL;
        priv->output_limit = NULL;
        priv->curve_data = NULL;
        priv->rssi_db = NULL;
+        priv->survey = NULL;
        wiphy_err(dev->wiphy, "eeprom parse failed!\n");
        return err;
diff --git a/drivers/net/wireless/p54/fwio.c b/drivers/net/wireless/p54/fwio.c
index b6a061cbbdec..53a3408931be 100644
--- a/drivers/net/wireless/p54/fwio.c
+++ b/drivers/net/wireless/p54/fwio.c
@@ -385,6 +385,7 @@ int p54_setup_mac(struct p54_common *priv)
                setup->v2.osc_start_delay = cpu_to_le16(65535);
        }
        p54_tx(priv, skb);
+        priv->phy_idle = mode == P54_FILTER_TYPE_HIBERNATE;
        return 0;
 }
@@ -626,6 +627,7 @@ int p54_set_ps(struct p54_common *priv)
        psm->exclude[0] = WLAN_EID_TIM;
        p54_tx(priv, skb);
+        priv->phy_ps = mode != P54_PSM_CAM;
        return 0;
 }
diff --git a/drivers/net/wireless/p54/main.c b/drivers/net/wireless/p54/main.c
index a5a6d9e647bb..726a9343f514 100644
--- a/drivers/net/wireless/p54/main.c
+++ b/drivers/net/wireless/p54/main.c
@@ -204,13 +204,11 @@ static void p54_stop(struct ieee80211_hw *dev)
        struct p54_common *priv = dev->priv;
        int i;
-        mutex_lock(&priv->conf_mutex);
        priv->mode = NL80211_IFTYPE_UNSPECIFIED;
        priv->softled_state = 0;
-        p54_set_leds(priv);
        cancel_delayed_work_sync(&priv->work);
+        mutex_lock(&priv->conf_mutex);
+        p54_set_leds(priv);
        priv->stop(dev);
        skb_queue_purge(&priv->tx_pending);
        skb_queue_purge(&priv->tx_queue);
@@ -278,6 +276,42 @@ static void p54_remove_interface(struct ieee80211_hw *dev,
        mutex_unlock(&priv->conf_mutex);
 }
+static int p54_wait_for_stats(struct ieee80211_hw *dev)
+{
+        struct p54_common *priv = dev->priv;
+        int ret;
+        priv->update_stats = true;
+        ret = p54_fetch_statistics(priv);
+        if (ret)
+                return ret;
+        ret = wait_for_completion_interruptible_timeout(&priv->stat_comp, HZ);
+        if (ret == 0)
+                return -ETIMEDOUT;
+        return 0;
+}
+static void p54_reset_stats(struct p54_common *priv)
+{
+        struct ieee80211_channel *chan = priv->curchan;
+        if (chan) {
+                struct survey_info *info = &priv->survey[chan->hw_value];
+                /* only reset channel statistics, don't touch .filled, etc. */
+                info->channel_time = 0;
+                info->channel_time_busy = 0;
+                info->channel_time_tx = 0;
+        }
+        priv->update_stats = true;
+        priv->survey_raw.active = 0;
+        priv->survey_raw.cca = 0;
+        priv->survey_raw.tx = 0;
+}
 static int p54_config(struct ieee80211_hw *dev, u32 changed)
 {
        int ret = 0;
@@ -288,19 +322,36 @@ static int p54_config(struct ieee80211_hw *dev, u32 changed)
        if (changed & IEEE80211_CONF_CHANGE_POWER)
                priv->output_power = conf->power_level << 2;
        if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
+                struct ieee80211_channel *oldchan;
+                WARN_ON(p54_wait_for_stats(dev));
+                oldchan = priv->curchan;
+                priv->curchan = NULL;
                ret = p54_scan(priv, P54_SCAN_EXIT, 0);
-                if (ret)
+                if (ret) {
+                        priv->curchan = oldchan;
                        goto out;
+                }
+                /*
+                 * TODO: Use the LM_SCAN_TRAP to determine the current
+                 * operating channel.
+                 */
+                priv->curchan = priv->hw->conf.channel;
+                p54_reset_stats(priv);
+                WARN_ON(p54_fetch_statistics(priv));
        }
        if (changed & IEEE80211_CONF_CHANGE_PS) {
+                WARN_ON(p54_wait_for_stats(dev));
                ret = p54_set_ps(priv);
                if (ret)
                        goto out;
+                WARN_ON(p54_wait_for_stats(dev));
        }
        if (changed & IEEE80211_CONF_CHANGE_IDLE) {
+                WARN_ON(p54_wait_for_stats(dev));
                ret = p54_setup_mac(priv);
                if (ret)
                        goto out;
+                WARN_ON(p54_wait_for_stats(dev));
        }
 out:
@@ -384,7 +435,9 @@ static void p54_work(struct work_struct *work)
         *      2. cancel stuck frames / reset the device if necessary.
         */
-        p54_fetch_statistics(priv);
+        mutex_lock(&priv->conf_mutex);
+        WARN_ON_ONCE(p54_fetch_statistics(priv));
+        mutex_unlock(&priv->conf_mutex);
 }
 static int p54_get_stats(struct ieee80211_hw *dev,
@@ -541,16 +594,47 @@ static int p54_get_survey(struct ieee80211_hw *dev, int idx,
                                struct survey_info *survey)
 {
        struct p54_common *priv = dev->priv;
-        struct ieee80211_conf *conf = &dev->conf;
+        struct ieee80211_channel *chan;
+        int err, tries;
+        bool in_use = false;
-        if (idx != 0)
+        if (idx >= priv->chan_num)
                return -ENOENT;
-        survey->channel = conf->channel;
+#define MAX_TRIES 1
-        survey->filled = SURVEY_INFO_NOISE_DBM;
+        for (tries = 0; tries < MAX_TRIES; tries++) {
-        survey->noise = clamp_t(s8, priv->noise, -128, 127);
+                chan = priv->curchan;
+                if (chan && chan->hw_value == idx) {
+                        mutex_lock(&priv->conf_mutex);
+                        err = p54_wait_for_stats(dev);
+                        mutex_unlock(&priv->conf_mutex);
+                        if (err)
+                                return err;
+                        in_use = true;
+                }
-        return 0;
+                memcpy(survey, &priv->survey[idx], sizeof(*survey));
+                if (in_use) {
+                        /* test if the reported statistics are valid. */
+                        if  (survey->channel_time != 0) {
+                                survey->filled |= SURVEY_INFO_IN_USE;
+                        } else {
+                                /*
+                                 * hw/fw has not accumulated enough sample sets.
+                                 * Wait for 100ms, this ought to be enough to
+                                 * to get at least one non-null set of channel
+                                 * usage statistics.
+                                 */
+                                msleep(100);
+                                continue;
+                        }
+                }
+                return 0;
+        }
+        return -ETIMEDOUT;
+#undef MAX_TRIES
 }
 static unsigned int p54_flush_count(struct p54_common *priv)
@@ -686,11 +770,14 @@ struct ieee80211_hw *p54_init_common(size_t priv_data_len)
        mutex_init(&priv->conf_mutex);
        mutex_init(&priv->eeprom_mutex);
+        init_completion(&priv->stat_comp);
        init_completion(&priv->eeprom_comp);
        init_completion(&priv->beacon_comp);
        INIT_DELAYED_WORK(&priv->work, p54_work);
        memset(&priv->mc_maclist[0], ~0, ETH_ALEN);
+        priv->curchan = NULL;
+        p54_reset_stats(priv);
        return dev;
 }
 EXPORT_SYMBOL_GPL(p54_init_common);
@@ -730,11 +817,13 @@ void p54_free_common(struct ieee80211_hw *dev)
        kfree(priv->curve_data);
        kfree(priv->rssi_db);
        kfree(priv->used_rxkeys);
+        kfree(priv->survey);
        priv->iq_autocal = NULL;
        priv->output_limit = NULL;
        priv->curve_data = NULL;
        priv->rssi_db = NULL;
        priv->used_rxkeys = NULL;
+        priv->survey = NULL;
        ieee80211_free_hw(dev);
 }
 EXPORT_SYMBOL_GPL(p54_free_common);
diff --git a/drivers/net/wireless/p54/p54.h b/drivers/net/wireless/p54/p54.h
index 799d05e12595..452fa3a64aa1 100644
--- a/drivers/net/wireless/p54/p54.h
+++ b/drivers/net/wireless/p54/p54.h
@@ -199,6 +199,22 @@ struct p54_common {
        u8 tx_diversity_mask;
        unsigned int output_power;
        struct p54_rssi_db_entry *cur_rssi;
+        struct ieee80211_channel *curchan;
+        struct survey_info *survey;
+        unsigned int chan_num;
+        struct completion stat_comp;
+        bool update_stats;
+        struct {
+                unsigned int timestamp;
+                unsigned int cached_cca;
+                unsigned int cached_tx;
+                unsigned int cached_rssi;
+                u64 active;
+                u64 cca;
+                u64 tx;
+                u64 rssi;
+        } survey_raw;
        int noise;
        /* calibration, output power limit and rssi<->dBm conversation data */
        struct pda_iq_autocal_entry *iq_autocal;
@@ -220,6 +236,8 @@ struct p54_common {
        u32 basic_rate_mask;
        u16 aid;
        u8 coverage_class;
+        bool phy_idle;
+        bool phy_ps;
        bool powersave_override;
        __le32 beacon_req_id;
        struct completion beacon_comp;
diff --git a/drivers/net/wireless/p54/txrx.c b/drivers/net/wireless/p54/txrx.c
index 042842e704de..44a3bd4b0f43 100644
--- a/drivers/net/wireless/p54/txrx.c
+++ b/drivers/net/wireless/p54/txrx.c
@@ -507,6 +507,8 @@ static void p54_rx_stats(struct p54_common *priv, struct sk_buff *skb)
        struct p54_hdr *hdr = (struct p54_hdr *) skb->data;
        struct p54_statistics *stats = (struct p54_statistics *) hdr->data;
        struct sk_buff *tmp;
+        struct ieee80211_channel *chan;
+        unsigned int i, rssi, tx, cca, dtime, dtotal, dcca, dtx, drssi, unit;
        u32 tsf32;
        if (unlikely(priv->mode == NL80211_IFTYPE_UNSPECIFIED))
@@ -523,8 +525,72 @@ static void p54_rx_stats(struct p54_common *priv, struct sk_buff *skb)
        priv->noise = p54_rssi_to_dbm(priv, le32_to_cpu(stats->noise));
+        /*
+         * STSW450X LMAC API page 26 - 3.8 Statistics
+         * "The exact measurement period can be derived from the
+         * timestamp member".
+         */
+        dtime = tsf32 - priv->survey_raw.timestamp;
+        /*
+         * STSW450X LMAC API page 26 - 3.8.1 Noise histogram
+         * The LMAC samples RSSI, CCA and transmit state at regular
+         * periods (typically 8 times per 1k [as in 1024] usec).
+         */
+        cca = le32_to_cpu(stats->sample_cca);
+        tx = le32_to_cpu(stats->sample_tx);
+        rssi = 0;
+        for (i = 0; i < ARRAY_SIZE(stats->sample_noise); i++)
+                rssi += le32_to_cpu(stats->sample_noise[i]);
+        dcca = cca - priv->survey_raw.cached_cca;
+        drssi = rssi - priv->survey_raw.cached_rssi;
+        dtx = tx - priv->survey_raw.cached_tx;
+        dtotal = dcca + drssi + dtx;
+        /*
+         * update statistics when more than a second is over since the
+         * last call, or when a update is badly needed.
+         */
+        if (dtotal && (priv->update_stats || dtime >= USEC_PER_SEC) &&
+            dtime >= dtotal) {
+                priv->survey_raw.timestamp = tsf32;
+                priv->update_stats = false;
+                unit = dtime / dtotal;
+                if (dcca) {
+                        priv->survey_raw.cca += dcca * unit;
+                        priv->survey_raw.cached_cca = cca;
+                }
+                if (dtx) {
+                        priv->survey_raw.tx += dtx * unit;
+                        priv->survey_raw.cached_tx = tx;
+                }
+                if (drssi) {
+                        priv->survey_raw.rssi += drssi * unit;
+                        priv->survey_raw.cached_rssi = rssi;
+                }
+                /* 1024 usec / 8 times = 128 usec / time */
+                if (!(priv->phy_ps || priv->phy_idle))
+                        priv->survey_raw.active += dtotal * unit;
+                else
+                        priv->survey_raw.active += (dcca + dtx) * unit;
+        }
+        chan = priv->curchan;
+        if (chan) {
+                struct survey_info *survey = &priv->survey[chan->hw_value];
+                survey->noise = clamp_t(s8, priv->noise, -128, 127);
+                survey->channel_time = priv->survey_raw.active / 1024;
+                survey->channel_time_tx = priv->survey_raw.tx / 1024;
+                survey->channel_time_busy = priv->survey_raw.cca / 1024 +
+                        survey->channel_time_tx;
+        }
        tmp = p54_find_and_unlink_skb(priv, hdr->req_id);
        dev_kfree_skb_any(tmp);
+        complete(&priv->stat_comp);
 }
 static void p54_rx_trap(struct p54_common *priv, struct sk_buff *skb)
diff --git a/drivers/net/wireless/rtlwifi/base.c b/drivers/net/wireless/rtlwifi/base.c
index 0b598db38da9..098fc557a88d 100644
--- a/drivers/net/wireless/rtlwifi/base.c
+++ b/drivers/net/wireless/rtlwifi/base.c
@@ -664,6 +664,167 @@ static u8 _rtl_get_highest_n_rate(struct ieee80211_hw *hw)
        return hw_rate;
 }
+/* mac80211's rate_idx is like this:
+ *
+ * 2.4G band:rx_status->band == IEEE80211_BAND_2GHZ
+ *
+ * B/G rate:
+ * (rx_status->flag & RX_FLAG_HT) = 0,
+ * DESC92_RATE1M-->DESC92_RATE54M ==> idx is 0-->11,
+ *
+ * N rate:
+ * (rx_status->flag & RX_FLAG_HT) = 1,
+ * DESC92_RATEMCS0-->DESC92_RATEMCS15 ==> idx is 0-->15
+ *
+ * 5G band:rx_status->band == IEEE80211_BAND_5GHZ
+ * A rate:
+ * (rx_status->flag & RX_FLAG_HT) = 0,
+ * DESC92_RATE6M-->DESC92_RATE54M ==> idx is 0-->7,
+ *
+ * N rate:
+ * (rx_status->flag & RX_FLAG_HT) = 1,
+ * DESC92_RATEMCS0-->DESC92_RATEMCS15 ==> idx is 0-->15
+ */
+int rtlwifi_rate_mapping(struct ieee80211_hw *hw,
+                         bool isht, u8 desc_rate, bool first_ampdu)
+{
+        int rate_idx;
+        if (false == isht) {
+                if (IEEE80211_BAND_2GHZ == hw->conf.channel->band) {
+                        switch (desc_rate) {
+                        case DESC92_RATE1M:
+                                rate_idx = 0;
+                                break;
+                        case DESC92_RATE2M:
+                                rate_idx = 1;
+                                break;
+                        case DESC92_RATE5_5M:
+                                rate_idx = 2;
+                                break;
+                        case DESC92_RATE11M:
+                                rate_idx = 3;
+                                break;
+                        case DESC92_RATE6M:
+                                rate_idx = 4;
+                                break;
+                        case DESC92_RATE9M:
+                                rate_idx = 5;
+                                break;
+                        case DESC92_RATE12M:
+                                rate_idx = 6;
+                                break;
+                        case DESC92_RATE18M:
+                                rate_idx = 7;
+                                break;
+                        case DESC92_RATE24M:
+                                rate_idx = 8;
+                                break;
+                        case DESC92_RATE36M:
+                                rate_idx = 9;
+                                break;
+                        case DESC92_RATE48M:
+                                rate_idx = 10;
+                                break;
+                        case DESC92_RATE54M:
+                                rate_idx = 11;
+                                break;
+                        default:
+                                rate_idx = 0;
+                                break;
+                        }
+                } else {
+                        switch (desc_rate) {
+                        case DESC92_RATE6M:
+                                rate_idx = 0;
+                                break;
+                        case DESC92_RATE9M:
+                                rate_idx = 1;
+                                break;
+                        case DESC92_RATE12M:
+                                rate_idx = 2;
+                                break;
+                        case DESC92_RATE18M:
+                                rate_idx = 3;
+                                break;
+                        case DESC92_RATE24M:
+                                rate_idx = 4;
+                                break;
+                        case DESC92_RATE36M:
+                                rate_idx = 5;
+                                break;
+                        case DESC92_RATE48M:
+                                rate_idx = 6;
+                                break;
+                        case DESC92_RATE54M:
+                                rate_idx = 7;
+                                break;
+                        default:
+                                rate_idx = 0;
+                                break;
+                        }
+                }
+        } else {
+                switch (desc_rate) {
+                case DESC92_RATEMCS0:
+                        rate_idx = 0;
+                        break;
+                case DESC92_RATEMCS1:
+                        rate_idx = 1;
+                        break;
+                case DESC92_RATEMCS2:
+                        rate_idx = 2;
+                        break;
+                case DESC92_RATEMCS3:
+                        rate_idx = 3;
+                        break;
+                case DESC92_RATEMCS4:
+                        rate_idx = 4;
+                        break;
+                case DESC92_RATEMCS5:
+                        rate_idx = 5;
+                        break;
+                case DESC92_RATEMCS6:
+                        rate_idx = 6;
+                        break;
+                case DESC92_RATEMCS7:
+                        rate_idx = 7;
+                        break;
+                case DESC92_RATEMCS8:
+                        rate_idx = 8;
+                        break;
+                case DESC92_RATEMCS9:
+                        rate_idx = 9;
+                        break;
+                case DESC92_RATEMCS10:
+                        rate_idx = 10;
+                        break;
+                case DESC92_RATEMCS11:
+                        rate_idx = 11;
+                        break;
+                case DESC92_RATEMCS12:
+                        rate_idx = 12;
+                        break;
+                case DESC92_RATEMCS13:
+                        rate_idx = 13;
+                        break;
+                case DESC92_RATEMCS14:
+                        rate_idx = 14;
+                        break;
+                case DESC92_RATEMCS15:
+                        rate_idx = 15;
+                        break;
+                default:
+                        rate_idx = 0;
+                        break;
+                }
+        }
+        return rate_idx;
+}
+EXPORT_SYMBOL(rtlwifi_rate_mapping);
 void rtl_get_tcb_desc(struct ieee80211_hw *hw,
                      struct ieee80211_tx_info *info,
                      struct ieee80211_sta *sta,
diff --git a/drivers/net/wireless/rtlwifi/base.h b/drivers/net/wireless/rtlwifi/base.h
index a91f3eee59c8..4ae905983d0d 100644
--- a/drivers/net/wireless/rtlwifi/base.h
+++ b/drivers/net/wireless/rtlwifi/base.h
@@ -140,4 +140,6 @@ u8 *rtl_find_ie(u8 *data, unsigned int len, u8 ie);
 void rtl_recognize_peer(struct ieee80211_hw *hw, u8 *data, unsigned int len);
 u8 rtl_tid_to_ac(struct ieee80211_hw *hw, u8 tid);
 extern struct attribute_group rtl_attribute_group;
+int rtlwifi_rate_mapping(struct ieee80211_hw *hw,
+                         bool isht, u8 desc_rate, bool first_ampdu);
 #endif
diff --git a/drivers/net/wireless/rtlwifi/debug.c b/drivers/net/wireless/rtlwifi/debug.c
index 5fa73852cb66..b2f897acb238 100644
--- a/drivers/net/wireless/rtlwifi/debug.c
+++ b/drivers/net/wireless/rtlwifi/debug.c
@@ -28,12 +28,16 @@
 #include "wifi.h"
+static unsigned int debug = DBG_EMERG;
+module_param(debug, uint, 0);
+MODULE_PARM_DESC(debug, "Set global debug level for rtlwifi (0,2-5)");
 void rtl_dbgp_flag_init(struct ieee80211_hw *hw)
 {
        struct rtl_priv *rtlpriv = rtl_priv(hw);
        u8 i;
-        rtlpriv->dbg.global_debuglevel = DBG_EMERG;
+        rtlpriv->dbg.global_debuglevel = debug;
        rtlpriv->dbg.global_debugcomponents =
            COMP_ERR | COMP_FW | COMP_INIT | COMP_RECV | COMP_SEND |
diff --git a/drivers/net/wireless/rtlwifi/rtl8192ce/def.h b/drivers/net/wireless/rtlwifi/rtl8192ce/def.h
index 35ff7df41a1d..11f43196e61d 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192ce/def.h
+++ b/drivers/net/wireless/rtlwifi/rtl8192ce/def.h
@@ -220,41 +220,6 @@ enum rtl_desc_qsel {
        QSLT_CMD = 0x13,
 };
-enum rtl_desc92c_rate {
-        DESC92C_RATE1M = 0x00,
-        DESC92C_RATE2M = 0x01,
-        DESC92C_RATE5_5M = 0x02,
-        DESC92C_RATE11M = 0x03,
-        DESC92C_RATE6M = 0x04,
-        DESC92C_RATE9M = 0x05,
-        DESC92C_RATE12M = 0x06,
-        DESC92C_RATE18M = 0x07,
-        DESC92C_RATE24M = 0x08,
-        DESC92C_RATE36M = 0x09,
-        DESC92C_RATE48M = 0x0a,
-        DESC92C_RATE54M = 0x0b,
-        DESC92C_RATEMCS0 = 0x0c,
-        DESC92C_RATEMCS1 = 0x0d,
-        DESC92C_RATEMCS2 = 0x0e,
-        DESC92C_RATEMCS3 = 0x0f,
-        DESC92C_RATEMCS4 = 0x10,
-        DESC92C_RATEMCS5 = 0x11,
-        DESC92C_RATEMCS6 = 0x12,
-        DESC92C_RATEMCS7 = 0x13,
-        DESC92C_RATEMCS8 = 0x14,
-        DESC92C_RATEMCS9 = 0x15,
-        DESC92C_RATEMCS10 = 0x16,
-        DESC92C_RATEMCS11 = 0x17,
-        DESC92C_RATEMCS12 = 0x18,
-        DESC92C_RATEMCS13 = 0x19,
-        DESC92C_RATEMCS14 = 0x1a,
-        DESC92C_RATEMCS15 = 0x1b,
-        DESC92C_RATEMCS15_SG = 0x1c,
-        DESC92C_RATEMCS32 = 0x20,
-};
 struct phy_sts_cck_8192s_t {
        u8 adc_pwdb_X[4];
        u8 sq_rpt;
@@ -267,108 +232,4 @@ struct h2c_cmd_8192c {
        u8 *p_cmdbuffer;
 };
-/* NOTE: reference to rtl8192c_rates struct */
-static inline int _rtl92c_rate_mapping(struct ieee80211_hw *hw, bool isHT,
-                                       u8 desc_rate, bool first_ampdu)
-{
-        struct rtl_priv *rtlpriv = rtl_priv(hw);
-        int rate_idx = 0;
-        if (first_ampdu) {
-                if (false == isHT) {
-                        switch (desc_rate) {
-                        case DESC92C_RATE1M:
-                                rate_idx = 0;
-                                break;
-                        case DESC92C_RATE2M:
-                                rate_idx = 1;
-                                break;
-                        case DESC92C_RATE5_5M:
-                                rate_idx = 2;
-                                break;
-                        case DESC92C_RATE11M:
-                                rate_idx = 3;
-                                break;
-                        case DESC92C_RATE6M:
-                                rate_idx = 4;
-                                break;
-                        case DESC92C_RATE9M:
-                                rate_idx = 5;
-                                break;
-                        case DESC92C_RATE12M:
-                                rate_idx = 6;
-                                break;
-                        case DESC92C_RATE18M:
-                                rate_idx = 7;
-                                break;
-                        case DESC92C_RATE24M:
-                                rate_idx = 8;
-                                break;
-                        case DESC92C_RATE36M:
-                                rate_idx = 9;
-                                break;
-                        case DESC92C_RATE48M:
-                                rate_idx = 10;
-                                break;
-                        case DESC92C_RATE54M:
-                                rate_idx = 11;
-                                break;
-                        default:
-                                RT_TRACE(rtlpriv, COMP_ERR, DBG_DMESG,
-                                         ("Rate %d is not support, set to "
-                                        "1M rate.\n", desc_rate));
-                                rate_idx = 0;
-                                break;
-                        }
-                } else {
-                        rate_idx = 11;
-                }
-                return rate_idx;
-        }
-        switch (desc_rate) {
-        case DESC92C_RATE1M:
-                rate_idx = 0;
-                break;
-        case DESC92C_RATE2M:
-                rate_idx = 1;
-                break;
-        case DESC92C_RATE5_5M:
-                rate_idx = 2;
-                break;
-        case DESC92C_RATE11M:
-                rate_idx = 3;
-                break;
-        case DESC92C_RATE6M:
-                rate_idx = 4;
-                break;
-        case DESC92C_RATE9M:
-                rate_idx = 5;
-                break;
-        case DESC92C_RATE12M:
-                rate_idx = 6;
-                break;
-        case DESC92C_RATE18M:
-                rate_idx = 7;
-                break;
-        case DESC92C_RATE24M:
-                rate_idx = 8;
-                break;
-        case DESC92C_RATE36M:
-                rate_idx = 9;
-                break;
-        case DESC92C_RATE48M:
-                rate_idx = 10;
-                break;
-        case DESC92C_RATE54M:
-                rate_idx = 11;
-                break;
-        /* TODO: How to mapping MCS rate? */
-        /*  NOTE: referenc to __ieee80211_rx */
-        default:
-                rate_idx = 11;
-                break;
-        }
-        return rate_idx;
-}
 #endif
diff --git a/drivers/net/wireless/rtlwifi/rtl8192ce/sw.c b/drivers/net/wireless/rtlwifi/rtl8192ce/sw.c
index 373dc78af1dc..4c34c4c1ae56 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192ce/sw.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192ce/sw.c
@@ -318,21 +318,21 @@ static struct rtl_hal_cfg rtl92ce_hal_cfg = {
        .maps[RTL_IMR_ROK] = IMR_ROK,
        .maps[RTL_IBSS_INT_MASKS] = (IMR_BCNINT | IMR_TBDOK | IMR_TBDER),
-        .maps[RTL_RC_CCK_RATE1M] = DESC92C_RATE1M,
+        .maps[RTL_RC_CCK_RATE1M] = DESC92_RATE1M,
-        .maps[RTL_RC_CCK_RATE2M] = DESC92C_RATE2M,
+        .maps[RTL_RC_CCK_RATE2M] = DESC92_RATE2M,
-        .maps[RTL_RC_CCK_RATE5_5M] = DESC92C_RATE5_5M,
+        .maps[RTL_RC_CCK_RATE5_5M] = DESC92_RATE5_5M,
-        .maps[RTL_RC_CCK_RATE11M] = DESC92C_RATE11M,
+        .maps[RTL_RC_CCK_RATE11M] = DESC92_RATE11M,
-        .maps[RTL_RC_OFDM_RATE6M] = DESC92C_RATE6M,
+        .maps[RTL_RC_OFDM_RATE6M] = DESC92_RATE6M,
-        .maps[RTL_RC_OFDM_RATE9M] = DESC92C_RATE9M,
+        .maps[RTL_RC_OFDM_RATE9M] = DESC92_RATE9M,
-        .maps[RTL_RC_OFDM_RATE12M] = DESC92C_RATE12M,
+        .maps[RTL_RC_OFDM_RATE12M] = DESC92_RATE12M,
-        .maps[RTL_RC_OFDM_RATE18M] = DESC92C_RATE18M,
+        .maps[RTL_RC_OFDM_RATE18M] = DESC92_RATE18M,
-        .maps[RTL_RC_OFDM_RATE24M] = DESC92C_RATE24M,
+        .maps[RTL_RC_OFDM_RATE24M] = DESC92_RATE24M,
-        .maps[RTL_RC_OFDM_RATE36M] = DESC92C_RATE36M,
+        .maps[RTL_RC_OFDM_RATE36M] = DESC92_RATE36M,
-        .maps[RTL_RC_OFDM_RATE48M] = DESC92C_RATE48M,
+        .maps[RTL_RC_OFDM_RATE48M] = DESC92_RATE48M,
-        .maps[RTL_RC_OFDM_RATE54M] = DESC92C_RATE54M,
+        .maps[RTL_RC_OFDM_RATE54M] = DESC92_RATE54M,
-        .maps[RTL_RC_HT_RATEMCS7] = DESC92C_RATEMCS7,
+        .maps[RTL_RC_HT_RATEMCS7] = DESC92_RATEMCS7,
-        .maps[RTL_RC_HT_RATEMCS15] = DESC92C_RATEMCS15,
+        .maps[RTL_RC_HT_RATEMCS15] = DESC92_RATEMCS15,
 };
 DEFINE_PCI_DEVICE_TABLE(rtl92ce_pci_ids) = {
diff --git a/drivers/net/wireless/rtlwifi/rtl8192ce/trx.c b/drivers/net/wireless/rtlwifi/rtl8192ce/trx.c
index 230bbe900d8d..4fb5ae24dee0 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192ce/trx.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192ce/trx.c
@@ -48,104 +48,6 @@ static u8 _rtl92ce_map_hwqueue_to_fwqueue(struct sk_buff *skb, u8 hw_queue)
        return skb->priority;
 }
-static int _rtl92ce_rate_mapping(bool isht, u8 desc_rate, bool first_ampdu)
-{
-        int rate_idx;
-        if (first_ampdu) {
-                if (false == isht) {
-                        switch (desc_rate) {
-                        case DESC92C_RATE1M:
-                                rate_idx = 0;
-                                break;
-                        case DESC92C_RATE2M:
-                                rate_idx = 1;
-                                break;
-                        case DESC92C_RATE5_5M:
-                                rate_idx = 2;
-                                break;
-                        case DESC92C_RATE11M:
-                                rate_idx = 3;
-                                break;
-                        case DESC92C_RATE6M:
-                                rate_idx = 4;
-                                break;
-                        case DESC92C_RATE9M:
-                                rate_idx = 5;
-                                break;
-                        case DESC92C_RATE12M:
-                                rate_idx = 6;
-                                break;
-                        case DESC92C_RATE18M:
-                                rate_idx = 7;
-                                break;
-                        case DESC92C_RATE24M:
-                                rate_idx = 8;
-                                break;
-                        case DESC92C_RATE36M:
-                                rate_idx = 9;
-                                break;
-                        case DESC92C_RATE48M:
-                                rate_idx = 10;
-                                break;
-                        case DESC92C_RATE54M:
-                                rate_idx = 11;
-                                break;
-                        default:
-                                rate_idx = 0;
-                                break;
-                        }
-                } else {
-                        rate_idx = 11;
-                }
-                return rate_idx;
-        }
-        switch (desc_rate) {
-        case DESC92C_RATE1M:
-                rate_idx = 0;
-                break;
-        case DESC92C_RATE2M:
-                rate_idx = 1;
-                break;
-        case DESC92C_RATE5_5M:
-                rate_idx = 2;
-                break;
-        case DESC92C_RATE11M:
-                rate_idx = 3;
-                break;
-        case DESC92C_RATE6M:
-                rate_idx = 4;
-                break;
-        case DESC92C_RATE9M:
-                rate_idx = 5;
-                break;
-        case DESC92C_RATE12M:
-                rate_idx = 6;
-                break;
-        case DESC92C_RATE18M:
-                rate_idx = 7;
-                break;
-        case DESC92C_RATE24M:
-                rate_idx = 8;
-                break;
-        case DESC92C_RATE36M:
-                rate_idx = 9;
-                break;
-        case DESC92C_RATE48M:
-                rate_idx = 10;
-                break;
-        case DESC92C_RATE54M:
-                rate_idx = 11;
-                break;
-        default:
-                rate_idx = 11;
-                break;
-        }
-        return rate_idx;
-}
 static u8 _rtl92c_query_rxpwrpercentage(char antpower)
 {
        if ((antpower <= -100) || (antpower >= 20))
@@ -336,8 +238,8 @@ static void _rtl92ce_query_rxphystatus(struct ieee80211_hw *hw,
                pstats->rxpower = rx_pwr_all;
                pstats->recvsignalpower = rx_pwr_all;
-                if (pdesc->rxht && pdesc->rxmcs >= DESC92C_RATEMCS8 &&
+                if (pdesc->rxht && pdesc->rxmcs >= DESC92_RATEMCS8 &&
-                    pdesc->rxmcs <= DESC92C_RATEMCS15)
+                    pdesc->rxmcs <= DESC92_RATEMCS15)
                        max_spatial_stream = 2;
                else
                        max_spatial_stream = 1;
@@ -670,12 +572,10 @@ bool rtl92ce_rx_query_desc(struct ieee80211_hw *hw,
        if (stats->decrypted)
                rx_status->flag |= RX_FLAG_DECRYPTED;
-        rx_status->rate_idx = _rtl92ce_rate_mapping((bool)
+        rx_status->rate_idx = rtlwifi_rate_mapping(hw,
-                                                    GET_RX_DESC_RXHT(pdesc),
+                                (bool)GET_RX_DESC_RXHT(pdesc),
-                                                    (u8)
+                                (u8)GET_RX_DESC_RXMCS(pdesc),
-                                                    GET_RX_DESC_RXMCS(pdesc),
+                                (bool)GET_RX_DESC_PAGGR(pdesc));
-                                                    (bool)
-                                                    GET_RX_DESC_PAGGR(pdesc));
        rx_status->mactime = GET_RX_DESC_TSFL(pdesc);
        if (phystatus) {
@@ -768,7 +668,7 @@ void rtl92ce_tx_fill_desc(struct ieee80211_hw *hw,
                SET_TX_DESC_RTS_BW(pdesc, 0);
                SET_TX_DESC_RTS_SC(pdesc, tcb_desc->rts_sc);
                SET_TX_DESC_RTS_SHORT(pdesc,
-                                      ((tcb_desc->rts_rate <= DESC92C_RATE54M) ?
+                                      ((tcb_desc->rts_rate <= DESC92_RATE54M) ?
                                       (tcb_desc->rts_use_shortpreamble ? 1 : 0)
                                       : (tcb_desc->rts_use_shortgi ? 1 : 0)));
@@ -886,7 +786,7 @@ void rtl92ce_tx_fill_cmddesc(struct ieee80211_hw *hw,
        if (firstseg)
                SET_TX_DESC_OFFSET(pdesc, USB_HWDESC_HEADER_LEN);
-        SET_TX_DESC_TX_RATE(pdesc, DESC92C_RATE1M);
+        SET_TX_DESC_TX_RATE(pdesc, DESC92_RATE1M);
        SET_TX_DESC_SEQ(pdesc, 0);
diff --git a/drivers/net/wireless/rtlwifi/rtl8192ce/trx.h b/drivers/net/wireless/rtlwifi/rtl8192ce/trx.h
index 0f1177137501..81ae64234f80 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192ce/trx.h
+++ b/drivers/net/wireless/rtlwifi/rtl8192ce/trx.h
@@ -538,10 +538,10 @@ do {							\
 } while (0);
 #define RX_HAL_IS_CCK_RATE(_pdesc)\
-        (_pdesc->rxmcs == DESC92C_RATE1M ||             \
+        (_pdesc->rxmcs == DESC92_RATE1M ||              \
-         _pdesc->rxmcs == DESC92C_RATE2M ||             \
+         _pdesc->rxmcs == DESC92_RATE2M ||              \
-         _pdesc->rxmcs == DESC92C_RATE5_5M ||           \
+         _pdesc->rxmcs == DESC92_RATE5_5M ||            \
-         _pdesc->rxmcs == DESC92C_RATE11M)
+         _pdesc->rxmcs == DESC92_RATE11M)
 struct rx_fwinfo_92c {
        u8 gain_trsw[4];
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c b/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c
index 194fc693c1fa..060a06f4a885 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192cu/mac.c
@@ -892,8 +892,8 @@ static void _rtl92c_query_rxphystatus(struct ieee80211_hw *hw,
                pstats->rxpower = rx_pwr_all;
                pstats->recvsignalpower = rx_pwr_all;
                if (GET_RX_DESC_RX_MCS(pdesc) &&
-                    GET_RX_DESC_RX_MCS(pdesc) >= DESC92C_RATEMCS8 &&
+                    GET_RX_DESC_RX_MCS(pdesc) >= DESC92_RATEMCS8 &&
-                    GET_RX_DESC_RX_MCS(pdesc) <= DESC92C_RATEMCS15)
+                    GET_RX_DESC_RX_MCS(pdesc) <= DESC92_RATEMCS15)
                        max_spatial_stream = 2;
                else
                        max_spatial_stream = 1;
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/mac.h b/drivers/net/wireless/rtlwifi/rtl8192cu/mac.h
index 298fdb724aa5..35529f701fc0 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192cu/mac.h
+++ b/drivers/net/wireless/rtlwifi/rtl8192cu/mac.h
@@ -88,10 +88,10 @@ void rtl92c_set_data_filter(struct ieee80211_hw *hw, u16 filter);
 u32 rtl92c_get_txdma_status(struct ieee80211_hw *hw);
 #define RX_HAL_IS_CCK_RATE(_pdesc)\
-        (GET_RX_DESC_RX_MCS(_pdesc) == DESC92C_RATE1M ||\
+        (GET_RX_DESC_RX_MCS(_pdesc) == DESC92_RATE1M ||\
-         GET_RX_DESC_RX_MCS(_pdesc) == DESC92C_RATE2M ||\
+         GET_RX_DESC_RX_MCS(_pdesc) == DESC92_RATE2M ||\
-         GET_RX_DESC_RX_MCS(_pdesc) == DESC92C_RATE5_5M ||\
+         GET_RX_DESC_RX_MCS(_pdesc) == DESC92_RATE5_5M ||\
-         GET_RX_DESC_RX_MCS(_pdesc) == DESC92C_RATE11M)
+         GET_RX_DESC_RX_MCS(_pdesc) == DESC92_RATE11M)
 struct rx_fwinfo_92c {
        u8 gain_trsw[4];
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/rf.c b/drivers/net/wireless/rtlwifi/rtl8192cu/rf.c
index 17a8e9628512..1e851aae58db 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192cu/rf.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192cu/rf.c
@@ -104,7 +104,7 @@ void rtl92cu_phy_rf6052_set_cck_txpower(struct ieee80211_hw *hw,
                        tx_agc[RF90_PATH_A] = 0x10101010;
                        tx_agc[RF90_PATH_B] = 0x10101010;
                } else if (rtlpriv->dm.dynamic_txhighpower_lvl ==
-                           TXHIGHPWRLEVEL_LEVEL2) {
+                           TXHIGHPWRLEVEL_LEVEL1) {
                        tx_agc[RF90_PATH_A] = 0x00000000;
                        tx_agc[RF90_PATH_B] = 0x00000000;
                } else{
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c b/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c
index ef63c0df006a..424b8a0323e2 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192cu/sw.c
@@ -241,20 +241,20 @@ static struct rtl_hal_cfg rtl92cu_hal_cfg = {
        .maps[RTL_IMR_ROK] = IMR_ROK,
        .maps[RTL_IBSS_INT_MASKS] = (IMR_BCNINT | IMR_TBDOK | IMR_TBDER),
-        .maps[RTL_RC_CCK_RATE1M] = DESC92C_RATE1M,
+        .maps[RTL_RC_CCK_RATE1M] = DESC92_RATE1M,
-        .maps[RTL_RC_CCK_RATE2M] = DESC92C_RATE2M,
+        .maps[RTL_RC_CCK_RATE2M] = DESC92_RATE2M,
-        .maps[RTL_RC_CCK_RATE5_5M] = DESC92C_RATE5_5M,
+        .maps[RTL_RC_CCK_RATE5_5M] = DESC92_RATE5_5M,
-        .maps[RTL_RC_CCK_RATE11M] = DESC92C_RATE11M,
+        .maps[RTL_RC_CCK_RATE11M] = DESC92_RATE11M,
-        .maps[RTL_RC_OFDM_RATE6M] = DESC92C_RATE6M,
+        .maps[RTL_RC_OFDM_RATE6M] = DESC92_RATE6M,
-        .maps[RTL_RC_OFDM_RATE9M] = DESC92C_RATE9M,
+        .maps[RTL_RC_OFDM_RATE9M] = DESC92_RATE9M,
-        .maps[RTL_RC_OFDM_RATE12M] = DESC92C_RATE12M,
+        .maps[RTL_RC_OFDM_RATE12M] = DESC92_RATE12M,
-        .maps[RTL_RC_OFDM_RATE18M] = DESC92C_RATE18M,
+        .maps[RTL_RC_OFDM_RATE18M] = DESC92_RATE18M,
-        .maps[RTL_RC_OFDM_RATE24M] = DESC92C_RATE24M,
+        .maps[RTL_RC_OFDM_RATE24M] = DESC92_RATE24M,
-        .maps[RTL_RC_OFDM_RATE36M] = DESC92C_RATE36M,
+        .maps[RTL_RC_OFDM_RATE36M] = DESC92_RATE36M,
-        .maps[RTL_RC_OFDM_RATE48M] = DESC92C_RATE48M,
+        .maps[RTL_RC_OFDM_RATE48M] = DESC92_RATE48M,
-        .maps[RTL_RC_OFDM_RATE54M] = DESC92C_RATE54M,
+        .maps[RTL_RC_OFDM_RATE54M] = DESC92_RATE54M,
-        .maps[RTL_RC_HT_RATEMCS7] = DESC92C_RATEMCS7,
+        .maps[RTL_RC_HT_RATEMCS7] = DESC92_RATEMCS7,
-        .maps[RTL_RC_HT_RATEMCS15] = DESC92C_RATEMCS15,
+        .maps[RTL_RC_HT_RATEMCS15] = DESC92_RATEMCS15,
 };
 #define USB_VENDER_ID_REALTEK           0x0bda
diff --git a/drivers/net/wireless/rtlwifi/rtl8192cu/trx.c b/drivers/net/wireless/rtlwifi/rtl8192cu/trx.c
index 906e7aa55bc3..c4161148e0d8 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192cu/trx.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192cu/trx.c
@@ -337,10 +337,10 @@ bool rtl92cu_rx_query_desc(struct ieee80211_hw *hw,
        rx_status->flag |= RX_FLAG_MACTIME_MPDU;
        if (stats->decrypted)
                rx_status->flag |= RX_FLAG_DECRYPTED;
-        rx_status->rate_idx = _rtl92c_rate_mapping(hw,
+        rx_status->rate_idx = rtlwifi_rate_mapping(hw,
-                                                (bool)GET_RX_DESC_RX_HT(pdesc),
+                                        (bool)GET_RX_DESC_RX_HT(pdesc),
-                                                (u8)GET_RX_DESC_RX_MCS(pdesc),
+                                        (u8)GET_RX_DESC_RX_MCS(pdesc),
-                                                (bool)GET_RX_DESC_PAGGR(pdesc));
+                                        (bool)GET_RX_DESC_PAGGR(pdesc));
        rx_status->mactime = GET_RX_DESC_TSFL(pdesc);
        if (phystatus) {
                p_drvinfo = (struct rx_fwinfo_92c *)(pdesc + RTL_RX_DESC_SIZE);
@@ -406,11 +406,10 @@ static void _rtl_rx_process(struct ieee80211_hw *hw, struct sk_buff *skb)
        if (GET_RX_DESC_RX_HT(rxdesc))
                rx_status->flag |= RX_FLAG_HT;
        /* Data rate */
-        rx_status->rate_idx = _rtl92c_rate_mapping(hw,
+        rx_status->rate_idx = rtlwifi_rate_mapping(hw,
-                                                (bool)GET_RX_DESC_RX_HT(rxdesc),
+                                        (bool)GET_RX_DESC_RX_HT(rxdesc),
-                                                (u8)GET_RX_DESC_RX_MCS(rxdesc),
+                                        (u8)GET_RX_DESC_RX_MCS(rxdesc),
-                                                (bool)GET_RX_DESC_PAGGR(rxdesc)
+                                        (bool)GET_RX_DESC_PAGGR(rxdesc));
-                                                );
        /*  There is a phy status after this rx descriptor. */
        if (GET_RX_DESC_PHY_STATUS(rxdesc)) {
                p_drvinfo = (struct rx_fwinfo_92c *)(rxdesc + RTL_RX_DESC_SIZE);
@@ -545,7 +544,7 @@ void rtl92cu_tx_fill_desc(struct ieee80211_hw *hw,
        SET_TX_DESC_RTS_BW(txdesc, 0);
        SET_TX_DESC_RTS_SC(txdesc, tcb_desc->rts_sc);
        SET_TX_DESC_RTS_SHORT(txdesc,
-                              ((tcb_desc->rts_rate <= DESC92C_RATE54M) ?
+                              ((tcb_desc->rts_rate <= DESC92_RATE54M) ?
                               (tcb_desc->rts_use_shortpreamble ? 1 : 0)
                               : (tcb_desc->rts_use_shortgi ? 1 : 0)));
        if (mac->bw_40) {
@@ -643,7 +642,7 @@ void rtl92cu_fill_fake_txdesc(struct ieee80211_hw *hw, u8 * pDesc,
        }
        SET_TX_DESC_USE_RATE(pDesc, 1); /* use data rate which is set by Sw */
        SET_TX_DESC_OWN(pDesc, 1);
-        SET_TX_DESC_TX_RATE(pDesc, DESC92C_RATE1M);
+        SET_TX_DESC_TX_RATE(pDesc, DESC92_RATE1M);
        _rtl_tx_desc_checksum(pDesc);
 }
@@ -659,7 +658,7 @@ void rtl92cu_tx_fill_cmddesc(struct ieee80211_hw *hw,
        memset((void *)pdesc, 0, RTL_TX_HEADER_SIZE);
        if (firstseg)
                SET_TX_DESC_OFFSET(pdesc, RTL_TX_HEADER_SIZE);
-        SET_TX_DESC_TX_RATE(pdesc, DESC92C_RATE1M);
+        SET_TX_DESC_TX_RATE(pdesc, DESC92_RATE1M);
        SET_TX_DESC_SEQ(pdesc, 0);
        SET_TX_DESC_LINIP(pdesc, 0);
        SET_TX_DESC_QUEUE_SEL(pdesc, fw_queue);
diff --git a/drivers/net/wireless/rtlwifi/rtl8192de/def.h b/drivers/net/wireless/rtlwifi/rtl8192de/def.h
index f0f5f9bfbb7b..aff7e19714ff 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192de/def.h
+++ b/drivers/net/wireless/rtlwifi/rtl8192de/def.h
@@ -193,41 +193,6 @@ enum rtl_desc_qsel {
        QSLT_CMD = 0x13,
 };
-enum rtl_desc92d_rate {
-        DESC92D_RATE1M = 0x00,
-        DESC92D_RATE2M = 0x01,
-        DESC92D_RATE5_5M = 0x02,
-        DESC92D_RATE11M = 0x03,
-        DESC92D_RATE6M = 0x04,
-        DESC92D_RATE9M = 0x05,
-        DESC92D_RATE12M = 0x06,
-        DESC92D_RATE18M = 0x07,
-        DESC92D_RATE24M = 0x08,
-        DESC92D_RATE36M = 0x09,
-        DESC92D_RATE48M = 0x0a,
-        DESC92D_RATE54M = 0x0b,
-        DESC92D_RATEMCS0 = 0x0c,
-        DESC92D_RATEMCS1 = 0x0d,
-        DESC92D_RATEMCS2 = 0x0e,
-        DESC92D_RATEMCS3 = 0x0f,
-        DESC92D_RATEMCS4 = 0x10,
-        DESC92D_RATEMCS5 = 0x11,
-        DESC92D_RATEMCS6 = 0x12,
-        DESC92D_RATEMCS7 = 0x13,
-        DESC92D_RATEMCS8 = 0x14,
-        DESC92D_RATEMCS9 = 0x15,
-        DESC92D_RATEMCS10 = 0x16,
-        DESC92D_RATEMCS11 = 0x17,
-        DESC92D_RATEMCS12 = 0x18,
-        DESC92D_RATEMCS13 = 0x19,
-        DESC92D_RATEMCS14 = 0x1a,
-        DESC92D_RATEMCS15 = 0x1b,
-        DESC92D_RATEMCS15_SG = 0x1c,
-        DESC92D_RATEMCS32 = 0x20,
-};
 enum channel_plan {
        CHPL_FCC        = 0,
        CHPL_IC         = 1,
diff --git a/drivers/net/wireless/rtlwifi/rtl8192de/sw.c b/drivers/net/wireless/rtlwifi/rtl8192de/sw.c
index 351765df517d..f6419b7ed2f4 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192de/sw.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192de/sw.c
@@ -340,21 +340,21 @@ static struct rtl_hal_cfg rtl92de_hal_cfg = {
        .maps[RTL_IMR_ROK] = IMR_ROK,
        .maps[RTL_IBSS_INT_MASKS] = (IMR_BcnInt | IMR_TBDOK | IMR_TBDER),
-        .maps[RTL_RC_CCK_RATE1M] = DESC92D_RATE1M,
+        .maps[RTL_RC_CCK_RATE1M] = DESC92_RATE1M,
-        .maps[RTL_RC_CCK_RATE2M] = DESC92D_RATE2M,
+        .maps[RTL_RC_CCK_RATE2M] = DESC92_RATE2M,
-        .maps[RTL_RC_CCK_RATE5_5M] = DESC92D_RATE5_5M,
+        .maps[RTL_RC_CCK_RATE5_5M] = DESC92_RATE5_5M,
-        .maps[RTL_RC_CCK_RATE11M] = DESC92D_RATE11M,
+        .maps[RTL_RC_CCK_RATE11M] = DESC92_RATE11M,
-        .maps[RTL_RC_OFDM_RATE6M] = DESC92D_RATE6M,
+        .maps[RTL_RC_OFDM_RATE6M] = DESC92_RATE6M,
-        .maps[RTL_RC_OFDM_RATE9M] = DESC92D_RATE9M,
+        .maps[RTL_RC_OFDM_RATE9M] = DESC92_RATE9M,
-        .maps[RTL_RC_OFDM_RATE12M] = DESC92D_RATE12M,
+        .maps[RTL_RC_OFDM_RATE12M] = DESC92_RATE12M,
-        .maps[RTL_RC_OFDM_RATE18M] = DESC92D_RATE18M,
+        .maps[RTL_RC_OFDM_RATE18M] = DESC92_RATE18M,
-        .maps[RTL_RC_OFDM_RATE24M] = DESC92D_RATE24M,
+        .maps[RTL_RC_OFDM_RATE24M] = DESC92_RATE24M,
-        .maps[RTL_RC_OFDM_RATE36M] = DESC92D_RATE36M,
+        .maps[RTL_RC_OFDM_RATE36M] = DESC92_RATE36M,
-        .maps[RTL_RC_OFDM_RATE48M] = DESC92D_RATE48M,
+        .maps[RTL_RC_OFDM_RATE48M] = DESC92_RATE48M,
-        .maps[RTL_RC_OFDM_RATE54M] = DESC92D_RATE54M,
+        .maps[RTL_RC_OFDM_RATE54M] = DESC92_RATE54M,
-        .maps[RTL_RC_HT_RATEMCS7] = DESC92D_RATEMCS7,
+        .maps[RTL_RC_HT_RATEMCS7] = DESC92_RATEMCS7,
-        .maps[RTL_RC_HT_RATEMCS15] = DESC92D_RATEMCS15,
+        .maps[RTL_RC_HT_RATEMCS15] = DESC92_RATEMCS15,
 };
 static struct pci_device_id rtl92de_pci_ids[] __devinitdata = {
diff --git a/drivers/net/wireless/rtlwifi/rtl8192de/trx.c b/drivers/net/wireless/rtlwifi/rtl8192de/trx.c
index dc86fcb0b3a3..3637c0c33525 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192de/trx.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192de/trx.c
@@ -48,99 +48,6 @@ static u8 _rtl92de_map_hwqueue_to_fwqueue(struct sk_buff *skb, u8 hw_queue)
        return skb->priority;
 }
-static int _rtl92de_rate_mapping(bool isht, u8 desc_rate)
-{
-        int rate_idx;
-        if (false == isht) {
-                switch (desc_rate) {
-                case DESC92D_RATE1M:
-                        rate_idx = 0;
-                        break;
-                case DESC92D_RATE2M:
-                        rate_idx = 1;
-                        break;
-                case DESC92D_RATE5_5M:
-                        rate_idx = 2;
-                        break;
-                case DESC92D_RATE11M:
-                        rate_idx = 3;
-                        break;
-                case DESC92D_RATE6M:
-                        rate_idx = 4;
-                        break;
-                case DESC92D_RATE9M:
-                        rate_idx = 5;
-                        break;
-                case DESC92D_RATE12M:
-                        rate_idx = 6;
-                        break;
-                case DESC92D_RATE18M:
-                        rate_idx = 7;
-                        break;
-                case DESC92D_RATE24M:
-                        rate_idx = 8;
-                        break;
-                case DESC92D_RATE36M:
-                        rate_idx = 9;
-                        break;
-                case DESC92D_RATE48M:
-                        rate_idx = 10;
-                        break;
-                case DESC92D_RATE54M:
-                        rate_idx = 11;
-                        break;
-                default:
-                        rate_idx = 0;
-                        break;
-                }
-                return rate_idx;
-        } else {
-                switch (desc_rate) {
-                case DESC92D_RATE1M:
-                        rate_idx = 0;
-                        break;
-                case DESC92D_RATE2M:
-                        rate_idx = 1;
-                        break;
-                case DESC92D_RATE5_5M:
-                        rate_idx = 2;
-                        break;
-                case DESC92D_RATE11M:
-                        rate_idx = 3;
-                        break;
-                case DESC92D_RATE6M:
-                        rate_idx = 4;
-                        break;
-                case DESC92D_RATE9M:
-                        rate_idx = 5;
-                        break;
-                case DESC92D_RATE12M:
-                        rate_idx = 6;
-                        break;
-                case DESC92D_RATE18M:
-                        rate_idx = 7;
-                        break;
-                case DESC92D_RATE24M:
-                        rate_idx = 8;
-                        break;
-                case DESC92D_RATE36M:
-                        rate_idx = 9;
-                        break;
-                case DESC92D_RATE48M:
-                        rate_idx = 10;
-                        break;
-                case DESC92D_RATE54M:
-                        rate_idx = 11;
-                        break;
-                default:
-                        rate_idx = 11;
-                        break;
-                }
-                return rate_idx;
-        }
-}
 static u8 _rtl92d_query_rxpwrpercentage(char antpower)
 {
        if ((antpower <= -100) || (antpower >= 20))
@@ -328,8 +235,8 @@ static void _rtl92de_query_rxphystatus(struct ieee80211_hw *hw,
                pstats->rx_pwdb_all = pwdb_all;
                pstats->rxpower = rx_pwr_all;
                pstats->recvsignalpower = rx_pwr_all;
-                if (pdesc->rxht && pdesc->rxmcs >= DESC92D_RATEMCS8 &&
+                if (pdesc->rxht && pdesc->rxmcs >= DESC92_RATEMCS8 &&
-                    pdesc->rxmcs <= DESC92D_RATEMCS15)
+                    pdesc->rxmcs <= DESC92_RATEMCS15)
                        max_spatial_stream = 2;
                else
                        max_spatial_stream = 1;
@@ -609,10 +516,10 @@ bool rtl92de_rx_query_desc(struct ieee80211_hw *hw,	struct rtl_stats *stats,
        rx_status->flag |= RX_FLAG_MACTIME_MPDU;
        if (stats->decrypted)
                rx_status->flag |= RX_FLAG_DECRYPTED;
-        rx_status->rate_idx = _rtl92de_rate_mapping((bool)
+        rx_status->rate_idx = rtlwifi_rate_mapping(hw,
-                                                    GET_RX_DESC_RXHT(pdesc),
+                                        (bool)GET_RX_DESC_RXHT(pdesc),
-                                                    (u8)
+                                        (u8)GET_RX_DESC_RXMCS(pdesc),
-                                                    GET_RX_DESC_RXMCS(pdesc));
+                                        (bool)GET_RX_DESC_PAGGR(pdesc));
        rx_status->mactime = GET_RX_DESC_TSFL(pdesc);
        if (phystatus) {
                p_drvinfo = (struct rx_fwinfo_92d *)(skb->data +
@@ -705,14 +612,14 @@ void rtl92de_tx_fill_desc(struct ieee80211_hw *hw,
                }
                /* 5G have no CCK rate */
                if (rtlhal->current_bandtype == BAND_ON_5G)
-                        if (ptcb_desc->hw_rate < DESC92D_RATE6M)
+                        if (ptcb_desc->hw_rate < DESC92_RATE6M)
-                                ptcb_desc->hw_rate = DESC92D_RATE6M;
+                                ptcb_desc->hw_rate = DESC92_RATE6M;
                SET_TX_DESC_TX_RATE(pdesc, ptcb_desc->hw_rate);
                if (ptcb_desc->use_shortgi || ptcb_desc->use_shortpreamble)
                        SET_TX_DESC_DATA_SHORTGI(pdesc, 1);
                if (rtlhal->macphymode == DUALMAC_DUALPHY &&
-                        ptcb_desc->hw_rate == DESC92D_RATEMCS7)
+                        ptcb_desc->hw_rate == DESC92_RATEMCS7)
                        SET_TX_DESC_DATA_SHORTGI(pdesc, 1);
                if (info->flags & IEEE80211_TX_CTL_AMPDU) {
@@ -728,13 +635,13 @@ void rtl92de_tx_fill_desc(struct ieee80211_hw *hw,
                SET_TX_DESC_RTS_STBC(pdesc, ((ptcb_desc->rts_stbc) ? 1 : 0));
                /* 5G have no CCK rate */
                if (rtlhal->current_bandtype == BAND_ON_5G)
-                        if (ptcb_desc->rts_rate < DESC92D_RATE6M)
+                        if (ptcb_desc->rts_rate < DESC92_RATE6M)
-                                ptcb_desc->rts_rate = DESC92D_RATE6M;
+                                ptcb_desc->rts_rate = DESC92_RATE6M;
                SET_TX_DESC_RTS_RATE(pdesc, ptcb_desc->rts_rate);
                SET_TX_DESC_RTS_BW(pdesc, 0);
                SET_TX_DESC_RTS_SC(pdesc, ptcb_desc->rts_sc);
                SET_TX_DESC_RTS_SHORT(pdesc, ((ptcb_desc->rts_rate <=
-                        DESC92D_RATE54M) ?
+                        DESC92_RATE54M) ?
                        (ptcb_desc->rts_use_shortpreamble ? 1 : 0) :
                        (ptcb_desc->rts_use_shortgi ? 1 : 0)));
                if (bw_40) {
@@ -844,9 +751,9 @@ void rtl92de_tx_fill_cmddesc(struct ieee80211_hw *hw,
         * The braces are needed no matter what checkpatch says
         */
        if (rtlhal->current_bandtype == BAND_ON_5G) {
-                SET_TX_DESC_TX_RATE(pdesc, DESC92D_RATE6M);
+                SET_TX_DESC_TX_RATE(pdesc, DESC92_RATE6M);
        } else {
-                SET_TX_DESC_TX_RATE(pdesc, DESC92D_RATE1M);
+                SET_TX_DESC_TX_RATE(pdesc, DESC92_RATE1M);
        }
        SET_TX_DESC_SEQ(pdesc, 0);
        SET_TX_DESC_LINIP(pdesc, 0);
diff --git a/drivers/net/wireless/rtlwifi/rtl8192de/trx.h b/drivers/net/wireless/rtlwifi/rtl8192de/trx.h
index 992d6766e667..6c2236868c9a 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192de/trx.h
+++ b/drivers/net/wireless/rtlwifi/rtl8192de/trx.h
@@ -538,10 +538,10 @@ do {							\
 } while (0);
 #define RX_HAL_IS_CCK_RATE(_pdesc)\
-        (_pdesc->rxmcs == DESC92D_RATE1M ||             \
+        (_pdesc->rxmcs == DESC92_RATE1M ||              \
-         _pdesc->rxmcs == DESC92D_RATE2M ||             \
+         _pdesc->rxmcs == DESC92_RATE2M ||              \
-         _pdesc->rxmcs == DESC92D_RATE5_5M ||           \
+         _pdesc->rxmcs == DESC92_RATE5_5M ||            \
-         _pdesc->rxmcs == DESC92D_RATE11M)
+         _pdesc->rxmcs == DESC92_RATE11M)
 /* For 92D early mode */
 #define SET_EARLYMODE_PKTNUM(__paddr, __value)          \
diff --git a/drivers/net/wireless/rtlwifi/rtl8192se/def.h b/drivers/net/wireless/rtlwifi/rtl8192se/def.h
index 69828f2b3fab..68204ea175dd 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192se/def.h
+++ b/drivers/net/wireless/rtlwifi/rtl8192se/def.h
@@ -33,37 +33,6 @@
 #define RX_CMD_QUEUE                            1
 #define RX_MAX_QUEUE                            2
-#define DESC92S_RATE1M                          0x00
-#define DESC92S_RATE2M                          0x01
-#define DESC92S_RATE5_5M                        0x02
-#define DESC92S_RATE11M                         0x03
-#define DESC92S_RATE6M                          0x04
-#define DESC92S_RATE9M                          0x05
-#define DESC92S_RATE12M                         0x06
-#define DESC92S_RATE18M                         0x07
-#define DESC92S_RATE24M                         0x08
-#define DESC92S_RATE36M                         0x09
-#define DESC92S_RATE48M                         0x0a
-#define DESC92S_RATE54M                         0x0b
-#define DESC92S_RATEMCS0                        0x0c
-#define DESC92S_RATEMCS1                        0x0d
-#define DESC92S_RATEMCS2                        0x0e
-#define DESC92S_RATEMCS3                        0x0f
-#define DESC92S_RATEMCS4                        0x10
-#define DESC92S_RATEMCS5                        0x11
-#define DESC92S_RATEMCS6                        0x12
-#define DESC92S_RATEMCS7                        0x13
-#define DESC92S_RATEMCS8                        0x14
-#define DESC92S_RATEMCS9                        0x15
-#define DESC92S_RATEMCS10                       0x16
-#define DESC92S_RATEMCS11                       0x17
-#define DESC92S_RATEMCS12                       0x18
-#define DESC92S_RATEMCS13                       0x19
-#define DESC92S_RATEMCS14                       0x1a
-#define DESC92S_RATEMCS15                       0x1b
-#define DESC92S_RATEMCS15_SG                    0x1c
-#define DESC92S_RATEMCS32                       0x20
 #define SHORT_SLOT_TIME                         9
 #define NON_SHORT_SLOT_TIME                     20
@@ -491,10 +460,10 @@ do {								\
        SET_BITS_OFFSET_LE(__pdesc + 24, 0, 32, __val)
 #define RX_HAL_IS_CCK_RATE(_pdesc)\
-        (GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92S_RATE1M || \
+        (GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92_RATE1M ||  \
-         GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92S_RATE2M || \
+         GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92_RATE2M ||  \
-         GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92S_RATE5_5M ||\
+         GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92_RATE5_5M ||\
-         GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92S_RATE11M)
+         GET_RX_STATUS_DESC_RX_MCS(_pdesc) == DESC92_RATE11M)
 enum rf_optype {
        RF_OP_BY_SW_3WIRE = 0,
diff --git a/drivers/net/wireless/rtlwifi/rtl8192se/sw.c b/drivers/net/wireless/rtlwifi/rtl8192se/sw.c
index 3876078a63de..0055a1c845a2 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192se/sw.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192se/sw.c
@@ -348,21 +348,21 @@ static struct rtl_hal_cfg rtl92se_hal_cfg = {
        .maps[RTL_IMR_ROK] = IMR_ROK,
        .maps[RTL_IBSS_INT_MASKS] = (IMR_BCNINT | IMR_TBDOK | IMR_TBDER),
-        .maps[RTL_RC_CCK_RATE1M] = DESC92S_RATE1M,
+        .maps[RTL_RC_CCK_RATE1M] = DESC92_RATE1M,
-        .maps[RTL_RC_CCK_RATE2M] = DESC92S_RATE2M,
+        .maps[RTL_RC_CCK_RATE2M] = DESC92_RATE2M,
-        .maps[RTL_RC_CCK_RATE5_5M] = DESC92S_RATE5_5M,
+        .maps[RTL_RC_CCK_RATE5_5M] = DESC92_RATE5_5M,
-        .maps[RTL_RC_CCK_RATE11M] = DESC92S_RATE11M,
+        .maps[RTL_RC_CCK_RATE11M] = DESC92_RATE11M,
-        .maps[RTL_RC_OFDM_RATE6M] = DESC92S_RATE6M,
+        .maps[RTL_RC_OFDM_RATE6M] = DESC92_RATE6M,
-        .maps[RTL_RC_OFDM_RATE9M] = DESC92S_RATE9M,
+        .maps[RTL_RC_OFDM_RATE9M] = DESC92_RATE9M,
-        .maps[RTL_RC_OFDM_RATE12M] = DESC92S_RATE12M,
+        .maps[RTL_RC_OFDM_RATE12M] = DESC92_RATE12M,
-        .maps[RTL_RC_OFDM_RATE18M] = DESC92S_RATE18M,
+        .maps[RTL_RC_OFDM_RATE18M] = DESC92_RATE18M,
-        .maps[RTL_RC_OFDM_RATE24M] = DESC92S_RATE24M,
+        .maps[RTL_RC_OFDM_RATE24M] = DESC92_RATE24M,
-        .maps[RTL_RC_OFDM_RATE36M] = DESC92S_RATE36M,
+        .maps[RTL_RC_OFDM_RATE36M] = DESC92_RATE36M,
-        .maps[RTL_RC_OFDM_RATE48M] = DESC92S_RATE48M,
+        .maps[RTL_RC_OFDM_RATE48M] = DESC92_RATE48M,
-        .maps[RTL_RC_OFDM_RATE54M] = DESC92S_RATE54M,
+        .maps[RTL_RC_OFDM_RATE54M] = DESC92_RATE54M,
-        .maps[RTL_RC_HT_RATEMCS7] = DESC92S_RATEMCS7,
+        .maps[RTL_RC_HT_RATEMCS7] = DESC92_RATEMCS7,
-        .maps[RTL_RC_HT_RATEMCS15] = DESC92S_RATEMCS15,
+        .maps[RTL_RC_HT_RATEMCS15] = DESC92_RATEMCS15,
 };
 static struct pci_device_id rtl92se_pci_ids[] __devinitdata = {
diff --git a/drivers/net/wireless/rtlwifi/rtl8192se/trx.c b/drivers/net/wireless/rtlwifi/rtl8192se/trx.c
index cffe30851f79..d9aeae7f8bdb 100644
--- a/drivers/net/wireless/rtlwifi/rtl8192se/trx.c
+++ b/drivers/net/wireless/rtlwifi/rtl8192se/trx.c
@@ -51,104 +51,6 @@ static u8 _rtl92se_map_hwqueue_to_fwqueue(struct sk_buff *skb,	u8 skb_queue)
        return skb->priority;
 }
-static int _rtl92se_rate_mapping(bool isht, u8 desc_rate, bool first_ampdu)
-{
-        int rate_idx = 0;
-        if (first_ampdu) {
-                if (false == isht) {
-                        switch (desc_rate) {
-                        case DESC92S_RATE1M:
-                                rate_idx = 0;
-                                break;
-                        case DESC92S_RATE2M:
-                                rate_idx = 1;
-                                break;
-                        case DESC92S_RATE5_5M:
-                                rate_idx = 2;
-                                break;
-                        case DESC92S_RATE11M:
-                                rate_idx = 3;
-                                break;
-                        case DESC92S_RATE6M:
-                                rate_idx = 4;
-                                break;
-                        case DESC92S_RATE9M:
-                                rate_idx = 5;
-                                break;
-                        case DESC92S_RATE12M:
-                                rate_idx = 6;
-                                break;
-                        case DESC92S_RATE18M:
-                                rate_idx = 7;
-                                break;
-                        case DESC92S_RATE24M:
-                                rate_idx = 8;
-                                break;
-                        case DESC92S_RATE36M:
-                                rate_idx = 9;
-                                break;
-                        case DESC92S_RATE48M:
-                                rate_idx = 10;
-                                break;
-                        case DESC92S_RATE54M:
-                                rate_idx = 11;
-                                break;
-                        default:
-                                rate_idx = 0;
-                                break;
-                        }
-                } else {
-                        rate_idx = 11;
-                }
-                return rate_idx;
-        }
-        switch (desc_rate) {
-        case DESC92S_RATE1M:
-                rate_idx = 0;
-                break;
-        case DESC92S_RATE2M:
-                rate_idx = 1;
-                break;
-        case DESC92S_RATE5_5M:
-                rate_idx = 2;
-                break;
-        case DESC92S_RATE11M:
-                rate_idx = 3;
-                break;
-        case DESC92S_RATE6M:
-                rate_idx = 4;
-                break;
-        case DESC92S_RATE9M:
-                rate_idx = 5;
-                break;
-        case DESC92S_RATE12M:
-                rate_idx = 6;
-                break;
-        case DESC92S_RATE18M:
-                rate_idx = 7;
-                break;
-        case DESC92S_RATE24M:
-                rate_idx = 8;
-                break;
-        case DESC92S_RATE36M:
-                rate_idx = 9;
-                break;
-        case DESC92S_RATE48M:
-                rate_idx = 10;
-                break;
-        case DESC92S_RATE54M:
-                rate_idx = 11;
-                break;
-        default:
-                rate_idx = 11;
-                break;
-        }
-        return rate_idx;
-}
 static u8 _rtl92s_query_rxpwrpercentage(char antpower)
 {
        if ((antpower <= -100) || (antpower >= 20))
@@ -345,8 +247,8 @@ static void _rtl92se_query_rxphystatus(struct ieee80211_hw *hw,
                pstats->recvsignalpower = rx_pwr_all;
                if (GET_RX_STATUS_DESC_RX_HT(pdesc) &&
-                        GET_RX_STATUS_DESC_RX_MCS(pdesc) >= DESC92S_RATEMCS8 &&
+                        GET_RX_STATUS_DESC_RX_MCS(pdesc) >= DESC92_RATEMCS8 &&
-                    GET_RX_STATUS_DESC_RX_MCS(pdesc) <= DESC92S_RATEMCS15)
+                    GET_RX_STATUS_DESC_RX_MCS(pdesc) <= DESC92_RATEMCS15)
                        max_spatial_stream = 2;
                else
                        max_spatial_stream = 1;
@@ -654,10 +556,10 @@ bool rtl92se_rx_query_desc(struct ieee80211_hw *hw, struct rtl_stats *stats,
        if (stats->decrypted)
                rx_status->flag |= RX_FLAG_DECRYPTED;
-        rx_status->rate_idx = _rtl92se_rate_mapping((bool)
+        rx_status->rate_idx = rtlwifi_rate_mapping(hw,
-                        GET_RX_STATUS_DESC_RX_HT(pdesc),
+                                (bool)GET_RX_STATUS_DESC_RX_HT(pdesc),
-                        (u8)GET_RX_STATUS_DESC_RX_MCS(pdesc),
+                                (u8)GET_RX_STATUS_DESC_RX_MCS(pdesc),
-                        (bool)GET_RX_STATUS_DESC_PAGGR(pdesc));
+                                (bool)GET_RX_STATUS_DESC_PAGGR(pdesc));
        rx_status->mactime = GET_RX_STATUS_DESC_TSFL(pdesc);
@@ -723,14 +625,14 @@ void rtl92se_tx_fill_desc(struct ieee80211_hw *hw,
                SET_TX_DESC_RSVD_MACID(pdesc, reserved_macid);
                SET_TX_DESC_TXHT(pdesc, ((ptcb_desc->hw_rate >=
-                                 DESC92S_RATEMCS0) ? 1 : 0));
+                                 DESC92_RATEMCS0) ? 1 : 0));
                if (rtlhal->version == VERSION_8192S_ACUT) {
-                        if (ptcb_desc->hw_rate == DESC92S_RATE1M ||
+                        if (ptcb_desc->hw_rate == DESC92_RATE1M ||
-                                ptcb_desc->hw_rate  == DESC92S_RATE2M ||
+                                ptcb_desc->hw_rate  == DESC92_RATE2M ||
-                                ptcb_desc->hw_rate == DESC92S_RATE5_5M ||
+                                ptcb_desc->hw_rate == DESC92_RATE5_5M ||
-                                ptcb_desc->hw_rate == DESC92S_RATE11M) {
+                                ptcb_desc->hw_rate == DESC92_RATE11M) {
-                                ptcb_desc->hw_rate = DESC92S_RATE12M;
+                                ptcb_desc->hw_rate = DESC92_RATE12M;
                        }
                }
@@ -759,7 +661,7 @@ void rtl92se_tx_fill_desc(struct ieee80211_hw *hw,
                SET_TX_DESC_RTS_BANDWIDTH(pdesc, 0);
                SET_TX_DESC_RTS_SUB_CARRIER(pdesc, ptcb_desc->rts_sc);
                SET_TX_DESC_RTS_SHORT(pdesc, ((ptcb_desc->rts_rate <=
-                       DESC92S_RATE54M) ?
+                       DESC92_RATE54M) ?
                       (ptcb_desc->rts_use_shortpreamble ? 1 : 0)
                       : (ptcb_desc->rts_use_shortgi ? 1 : 0)));
diff --git a/drivers/net/wireless/rtlwifi/wifi.h b/drivers/net/wireless/rtlwifi/wifi.h
index d3c3ffd38984..8a9091968f31 100644
--- a/drivers/net/wireless/rtlwifi/wifi.h
+++ b/drivers/net/wireless/rtlwifi/wifi.h
@@ -386,6 +386,41 @@ enum rtl_hal_state {
        _HAL_STATE_START = 1,
 };
+enum rtl_desc92_rate {
+        DESC92_RATE1M = 0x00,
+        DESC92_RATE2M = 0x01,
+        DESC92_RATE5_5M = 0x02,
+        DESC92_RATE11M = 0x03,
+        DESC92_RATE6M = 0x04,
+        DESC92_RATE9M = 0x05,
+        DESC92_RATE12M = 0x06,
+        DESC92_RATE18M = 0x07,
+        DESC92_RATE24M = 0x08,
+        DESC92_RATE36M = 0x09,
+        DESC92_RATE48M = 0x0a,
+        DESC92_RATE54M = 0x0b,
+        DESC92_RATEMCS0 = 0x0c,
+        DESC92_RATEMCS1 = 0x0d,
+        DESC92_RATEMCS2 = 0x0e,
+        DESC92_RATEMCS3 = 0x0f,
+        DESC92_RATEMCS4 = 0x10,
+        DESC92_RATEMCS5 = 0x11,
+        DESC92_RATEMCS6 = 0x12,
+        DESC92_RATEMCS7 = 0x13,
+        DESC92_RATEMCS8 = 0x14,
+        DESC92_RATEMCS9 = 0x15,
+        DESC92_RATEMCS10 = 0x16,
+        DESC92_RATEMCS11 = 0x17,
+        DESC92_RATEMCS12 = 0x18,
+        DESC92_RATEMCS13 = 0x19,
+        DESC92_RATEMCS14 = 0x1a,
+        DESC92_RATEMCS15 = 0x1b,
+        DESC92_RATEMCS15_SG = 0x1c,
+        DESC92_RATEMCS32 = 0x20,
+};
 enum rtl_var_map {
        /*reg map */
        SYS_ISO_CTRL = 0,