ath9k: fix some issues in PA predistortion (still disabled by default)
[openwrt/svn-archive/archive.git] / package / mac80211 / patches / 300-pending_work.patch
index 4f61ff7370dc6938df22744efd3394828bce6346..33120a09031da29bea6717e2b2c5769cbbbac25d 100644 (file)
---- a/drivers/net/wireless/ath/ath5k/mac80211-ops.c
-+++ b/drivers/net/wireless/ath/ath5k/mac80211-ops.c
-@@ -210,8 +210,8 @@ ath5k_config(struct ieee80211_hw *hw, u3
-       }
+--- a/drivers/net/wireless/ath/ath9k/ath9k.h
++++ b/drivers/net/wireless/ath/ath9k/ath9k.h
+@@ -234,6 +234,7 @@ struct ath_buf {
+       dma_addr_t bf_daddr;            /* physical addr of desc */
+       dma_addr_t bf_buf_addr; /* physical addr of data buffer, for DMA */
+       bool bf_stale;
++      struct ieee80211_tx_rate rates[4];
+       struct ath_buf_state bf_state;
+ };
  
-       if ((changed & IEEE80211_CONF_CHANGE_POWER) &&
--      (ah->power_level != conf->power_level)) {
--              ah->power_level = conf->power_level;
-+      (ah->ah_txpower.txp_requested != conf->power_level)) {
-+              ah->ah_txpower.txp_requested = conf->power_level;
-               /* Half dB steps */
-               ath5k_hw_set_txpower_limit(ah, (conf->power_level * 2));
-@@ -622,7 +622,7 @@ ath5k_conf_tx(struct ieee80211_hw *hw, s
-       qi.tqi_aifs = params->aifs;
-       qi.tqi_cw_min = params->cw_min;
-       qi.tqi_cw_max = params->cw_max;
--      qi.tqi_burst_time = params->txop;
-+      qi.tqi_burst_time = params->txop * 32;
-       ATH5K_DBG(ah, ATH5K_DEBUG_ANY,
-                 "Configure tx [queue %d],  "
---- a/drivers/net/wireless/ath/ath9k/ar9002_hw.c
-+++ b/drivers/net/wireless/ath/ath9k/ar9002_hw.c
-@@ -26,106 +26,74 @@
- static void ar9002_hw_init_mode_regs(struct ath_hw *ah)
- {
-       if (AR_SREV_9271(ah)) {
--              INIT_INI_ARRAY(&ah->iniModes, ar9271Modes_9271,
--                             ARRAY_SIZE(ar9271Modes_9271), 5);
--              INIT_INI_ARRAY(&ah->iniCommon, ar9271Common_9271,
--                             ARRAY_SIZE(ar9271Common_9271), 2);
--              INIT_INI_ARRAY(&ah->iniModes_9271_ANI_reg, ar9271Modes_9271_ANI_reg,
--                             ARRAY_SIZE(ar9271Modes_9271_ANI_reg), 5);
-+              INIT_INI_ARRAY(&ah->iniModes, ar9271Modes_9271);
-+              INIT_INI_ARRAY(&ah->iniCommon, ar9271Common_9271);
-+              INIT_INI_ARRAY(&ah->iniModes_9271_ANI_reg, ar9271Modes_9271_ANI_reg);
-               return;
-       }
+@@ -250,9 +251,9 @@ struct ath_atx_tid {
+       int tidno;
+       int baw_head;   /* first un-acked tx buffer */
+       int baw_tail;   /* next unused tx buffer slot */
+-      int sched;
+-      int paused;
+-      u8 state;
++      bool sched;
++      bool paused;
++      bool active;
+ };
  
-       if (ah->config.pcie_clock_req)
-               INIT_INI_ARRAY(&ah->iniPcieSerdes,
--                         ar9280PciePhy_clkreq_off_L1_9280,
--                         ARRAY_SIZE(ar9280PciePhy_clkreq_off_L1_9280), 2);
-+                         ar9280PciePhy_clkreq_off_L1_9280);
-       else
-               INIT_INI_ARRAY(&ah->iniPcieSerdes,
--                         ar9280PciePhy_clkreq_always_on_L1_9280,
--                         ARRAY_SIZE(ar9280PciePhy_clkreq_always_on_L1_9280), 2);
-+                         ar9280PciePhy_clkreq_always_on_L1_9280);
- #ifdef CONFIG_PM_SLEEP
-               INIT_INI_ARRAY(&ah->iniPcieSerdesWow,
--                             ar9280PciePhy_awow,
--                             ARRAY_SIZE(ar9280PciePhy_awow), 2);
-+                             ar9280PciePhy_awow);
+ struct ath_node {
+@@ -273,10 +274,6 @@ struct ath_node {
  #endif
+ };
  
-       if (AR_SREV_9287_11_OR_LATER(ah)) {
--              INIT_INI_ARRAY(&ah->iniModes, ar9287Modes_9287_1_1,
--                              ARRAY_SIZE(ar9287Modes_9287_1_1), 5);
--              INIT_INI_ARRAY(&ah->iniCommon, ar9287Common_9287_1_1,
--                              ARRAY_SIZE(ar9287Common_9287_1_1), 2);
-+              INIT_INI_ARRAY(&ah->iniModes, ar9287Modes_9287_1_1);
-+              INIT_INI_ARRAY(&ah->iniCommon, ar9287Common_9287_1_1);
-       } else if (AR_SREV_9285_12_OR_LATER(ah)) {
--              INIT_INI_ARRAY(&ah->iniModes, ar9285Modes_9285_1_2,
--                             ARRAY_SIZE(ar9285Modes_9285_1_2), 5);
--              INIT_INI_ARRAY(&ah->iniCommon, ar9285Common_9285_1_2,
--                             ARRAY_SIZE(ar9285Common_9285_1_2), 2);
-+              INIT_INI_ARRAY(&ah->iniModes, ar9285Modes_9285_1_2);
-+              INIT_INI_ARRAY(&ah->iniCommon, ar9285Common_9285_1_2);
-       } else if (AR_SREV_9280_20_OR_LATER(ah)) {
--              INIT_INI_ARRAY(&ah->iniModes, ar9280Modes_9280_2,
--                             ARRAY_SIZE(ar9280Modes_9280_2), 5);
--              INIT_INI_ARRAY(&ah->iniCommon, ar9280Common_9280_2,
--                             ARRAY_SIZE(ar9280Common_9280_2), 2);
-+              INIT_INI_ARRAY(&ah->iniModes, ar9280Modes_9280_2);
-+              INIT_INI_ARRAY(&ah->iniCommon, ar9280Common_9280_2);
-               INIT_INI_ARRAY(&ah->iniModesFastClock,
--                             ar9280Modes_fast_clock_9280_2,
--                             ARRAY_SIZE(ar9280Modes_fast_clock_9280_2), 3);
-+                             ar9280Modes_fast_clock_9280_2);
-       } else if (AR_SREV_9160_10_OR_LATER(ah)) {
--              INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9160,
--                             ARRAY_SIZE(ar5416Modes_9160), 5);
--              INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9160,
--                             ARRAY_SIZE(ar5416Common_9160), 2);
-+              INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9160);
-+              INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9160);
-               if (AR_SREV_9160_11(ah)) {
-                       INIT_INI_ARRAY(&ah->iniAddac,
--                                     ar5416Addac_9160_1_1,
--                                     ARRAY_SIZE(ar5416Addac_9160_1_1), 2);
-+                                     ar5416Addac_9160_1_1);
-               } else {
--                      INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9160,
--                                     ARRAY_SIZE(ar5416Addac_9160), 2);
-+                      INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9160);
-               }
-       } else if (AR_SREV_9100_OR_LATER(ah)) {
--              INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9100,
--                             ARRAY_SIZE(ar5416Modes_9100), 5);
--              INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9100,
--                             ARRAY_SIZE(ar5416Common_9100), 2);
--              INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6_9100,
--                             ARRAY_SIZE(ar5416Bank6_9100), 3);
--              INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9100,
--                             ARRAY_SIZE(ar5416Addac_9100), 2);
-+              INIT_INI_ARRAY(&ah->iniModes, ar5416Modes_9100);
-+              INIT_INI_ARRAY(&ah->iniCommon, ar5416Common_9100);
-+              INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6_9100);
-+              INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac_9100);
-       } else {
--              INIT_INI_ARRAY(&ah->iniModes, ar5416Modes,
--                             ARRAY_SIZE(ar5416Modes), 5);
--              INIT_INI_ARRAY(&ah->iniCommon, ar5416Common,
--                             ARRAY_SIZE(ar5416Common), 2);
--              INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC,
--                             ARRAY_SIZE(ar5416Bank6TPC), 3);
--              INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac,
--                             ARRAY_SIZE(ar5416Addac), 2);
-+              INIT_INI_ARRAY(&ah->iniModes, ar5416Modes);
-+              INIT_INI_ARRAY(&ah->iniCommon, ar5416Common);
-+              INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC);
-+              INIT_INI_ARRAY(&ah->iniAddac, ar5416Addac);
-       }
-       if (!AR_SREV_9280_20_OR_LATER(ah)) {
-               /* Common for AR5416, AR913x, AR9160 */
--              INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain,
--                             ARRAY_SIZE(ar5416BB_RfGain), 3);
-+              INIT_INI_ARRAY(&ah->iniBB_RfGain, ar5416BB_RfGain);
--              INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0,
--                             ARRAY_SIZE(ar5416Bank0), 2);
--              INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1,
--                             ARRAY_SIZE(ar5416Bank1), 2);
--              INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2,
--                             ARRAY_SIZE(ar5416Bank2), 2);
--              INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3,
--                             ARRAY_SIZE(ar5416Bank3), 3);
--              INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7,
--                             ARRAY_SIZE(ar5416Bank7), 2);
-+              INIT_INI_ARRAY(&ah->iniBank0, ar5416Bank0);
-+              INIT_INI_ARRAY(&ah->iniBank1, ar5416Bank1);
-+              INIT_INI_ARRAY(&ah->iniBank2, ar5416Bank2);
-+              INIT_INI_ARRAY(&ah->iniBank3, ar5416Bank3);
-+              INIT_INI_ARRAY(&ah->iniBank7, ar5416Bank7);
-               /* Common for AR5416, AR9160 */
-               if (!AR_SREV_9100(ah))
--                      INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6,
--                                     ARRAY_SIZE(ar5416Bank6), 3);
-+                      INIT_INI_ARRAY(&ah->iniBank6, ar5416Bank6);
-               /* Common for AR913x, AR9160 */
-               if (!AR_SREV_5416(ah))
--                      INIT_INI_ARRAY(&ah->iniBank6TPC, ar5416Bank6TPC_9100,
--                                     ARRAY_SIZE(ar5416Bank6TPC_9100), 3);
-+                      INIT_INI_ARRAY(&ah->iniBank6TPC,
-+                                    ar5416Bank6TPC_9100);
-       }
-       /* iniAddac needs to be modified for these chips */
-@@ -148,13 +116,9 @@ static void ar9002_hw_init_mode_regs(str
-       }
-       if (AR_SREV_9287_11_OR_LATER(ah)) {
-               INIT_INI_ARRAY(&ah->iniCckfirNormal,
--                     ar9287Common_normal_cck_fir_coeff_9287_1_1,
--                     ARRAY_SIZE(ar9287Common_normal_cck_fir_coeff_9287_1_1),
--                     2);
-+                     ar9287Common_normal_cck_fir_coeff_9287_1_1);
-               INIT_INI_ARRAY(&ah->iniCckfirJapan2484,
--                     ar9287Common_japan_2484_cck_fir_coeff_9287_1_1,
--                     ARRAY_SIZE(ar9287Common_japan_2484_cck_fir_coeff_9287_1_1),
--                     2);
-+                     ar9287Common_japan_2484_cck_fir_coeff_9287_1_1);
+-#define AGGR_CLEANUP         BIT(1)
+-#define AGGR_ADDBA_COMPLETE  BIT(2)
+-#define AGGR_ADDBA_PROGRESS  BIT(3)
+-
+ struct ath_tx_control {
+       struct ath_txq *txq;
+       struct ath_node *an;
+@@ -658,11 +655,10 @@ enum sc_op_flags {
+ struct ath_rate_table;
+ struct ath9k_vif_iter_data {
+-      const u8 *hw_macaddr; /* phy's hardware address, set
+-                             * before starting iteration for
+-                             * valid bssid mask.
+-                             */
++      u8 hw_macaddr[ETH_ALEN]; /* address of the first vif */
+       u8 mask[ETH_ALEN]; /* bssid mask */
++      bool has_hw_macaddr;
++
+       int naps;      /* number of AP vifs */
+       int nmeshes;   /* number of mesh vifs */
+       int nstations; /* number of station vifs */
+--- a/drivers/net/wireless/ath/ath9k/hw.c
++++ b/drivers/net/wireless/ath/ath9k/hw.c
+@@ -1171,6 +1171,7 @@ u32 ath9k_regd_get_ctl(struct ath_regula
+ static inline void ath9k_hw_set_dma(struct ath_hw *ah)
+ {
+       struct ath_common *common = ath9k_hw_common(ah);
++      int txbuf_size;
+       ENABLE_REGWRITE_BUFFER(ah);
+@@ -1224,13 +1225,17 @@ static inline void ath9k_hw_set_dma(stru
+                * So set the usable tx buf size also to half to
+                * avoid data/delimiter underruns
+                */
+-              REG_WRITE(ah, AR_PCU_TXBUF_CTRL,
+-                        AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE);
+-      } else if (!AR_SREV_9271(ah)) {
+-              REG_WRITE(ah, AR_PCU_TXBUF_CTRL,
+-                        AR_PCU_TXBUF_CTRL_USABLE_SIZE);
++              txbuf_size = AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE;
++      } else if (AR_SREV_9340_13_OR_LATER(ah)) {
++              /* Uses fewer entries for AR934x v1.3+ to prevent rx overruns */
++              txbuf_size = AR_9340_PCU_TXBUF_CTRL_USABLE_SIZE;
++      } else {
++              txbuf_size = AR_PCU_TXBUF_CTRL_USABLE_SIZE;
        }
- }
  
-@@ -168,20 +132,16 @@ static void ar9280_20_hw_init_rxgain_ini
-               if (rxgain_type == AR5416_EEP_RXGAIN_13DB_BACKOFF)
-                       INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9280Modes_backoff_13db_rxgain_9280_2,
--                      ARRAY_SIZE(ar9280Modes_backoff_13db_rxgain_9280_2), 5);
-+                                     ar9280Modes_backoff_13db_rxgain_9280_2);
-               else if (rxgain_type == AR5416_EEP_RXGAIN_23DB_BACKOFF)
-                       INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9280Modes_backoff_23db_rxgain_9280_2,
--                      ARRAY_SIZE(ar9280Modes_backoff_23db_rxgain_9280_2), 5);
-+                                     ar9280Modes_backoff_23db_rxgain_9280_2);
-               else
-                       INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9280Modes_original_rxgain_9280_2,
--                      ARRAY_SIZE(ar9280Modes_original_rxgain_9280_2), 5);
-+                                     ar9280Modes_original_rxgain_9280_2);
-       } else {
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9280Modes_original_rxgain_9280_2,
--                      ARRAY_SIZE(ar9280Modes_original_rxgain_9280_2), 5);
-+                             ar9280Modes_original_rxgain_9280_2);
-       }
- }
++      if (!AR_SREV_9271(ah))
++              REG_WRITE(ah, AR_PCU_TXBUF_CTRL, txbuf_size);
++
+       REGWRITE_BUFFER_FLUSH(ah);
  
-@@ -191,16 +151,13 @@ static void ar9280_20_hw_init_txgain_ini
-           AR5416_EEP_MINOR_VER_19) {
-               if (txgain_type == AR5416_EEP_TXGAIN_HIGH_POWER)
-                       INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9280Modes_high_power_tx_gain_9280_2,
--                      ARRAY_SIZE(ar9280Modes_high_power_tx_gain_9280_2), 5);
-+                                     ar9280Modes_high_power_tx_gain_9280_2);
-               else
-                       INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9280Modes_original_tx_gain_9280_2,
--                      ARRAY_SIZE(ar9280Modes_original_tx_gain_9280_2), 5);
-+                                     ar9280Modes_original_tx_gain_9280_2);
+       if (AR_SREV_9300_20_OR_LATER(ah))
+@@ -1305,9 +1310,13 @@ static bool ath9k_hw_set_reset(struct at
+                       AR_RTC_RC_COLD_RESET | AR_RTC_RC_WARM_RESET;
        } else {
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--              ar9280Modes_original_tx_gain_9280_2,
--              ARRAY_SIZE(ar9280Modes_original_tx_gain_9280_2), 5);
-+                             ar9280Modes_original_tx_gain_9280_2);
-       }
- }
+               tmpReg = REG_READ(ah, AR_INTR_SYNC_CAUSE);
+-              if (tmpReg &
+-                  (AR_INTR_SYNC_LOCAL_TIMEOUT |
+-                   AR_INTR_SYNC_RADM_CPL_TIMEOUT)) {
++              if (AR_SREV_9340(ah))
++                      tmpReg &= AR9340_INTR_SYNC_LOCAL_TIMEOUT;
++              else
++                      tmpReg &= AR_INTR_SYNC_LOCAL_TIMEOUT |
++                                AR_INTR_SYNC_RADM_CPL_TIMEOUT;
++
++              if (tmpReg) {
+                       u32 val;
+                       REG_WRITE(ah, AR_INTR_SYNC_ENABLE, 0);
  
-@@ -208,12 +165,10 @@ static void ar9271_hw_init_txgain_ini(st
- {
-       if (txgain_type == AR5416_EEP_TXGAIN_HIGH_POWER)
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                             ar9271Modes_high_power_tx_gain_9271,
--                             ARRAY_SIZE(ar9271Modes_high_power_tx_gain_9271), 5);
-+                             ar9271Modes_high_power_tx_gain_9271);
-       else
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                             ar9271Modes_normal_power_tx_gain_9271,
--                             ARRAY_SIZE(ar9271Modes_normal_power_tx_gain_9271), 5);
-+                             ar9271Modes_normal_power_tx_gain_9271);
- }
+@@ -1366,7 +1375,10 @@ static bool ath9k_hw_set_reset(struct at
  
- static void ar9002_hw_init_mode_gain_regs(struct ath_hw *ah)
-@@ -222,8 +177,7 @@ static void ar9002_hw_init_mode_gain_reg
-       if (AR_SREV_9287_11_OR_LATER(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--              ar9287Modes_rx_gain_9287_1_1,
--              ARRAY_SIZE(ar9287Modes_rx_gain_9287_1_1), 5);
-+                             ar9287Modes_rx_gain_9287_1_1);
-       else if (AR_SREV_9280_20(ah))
-               ar9280_20_hw_init_rxgain_ini(ah);
-@@ -231,8 +185,7 @@ static void ar9002_hw_init_mode_gain_reg
-               ar9271_hw_init_txgain_ini(ah, txgain_type);
-       } else if (AR_SREV_9287_11_OR_LATER(ah)) {
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--              ar9287Modes_tx_gain_9287_1_1,
--              ARRAY_SIZE(ar9287Modes_tx_gain_9287_1_1), 5);
-+                             ar9287Modes_tx_gain_9287_1_1);
-       } else if (AR_SREV_9280_20(ah)) {
-               ar9280_20_hw_init_txgain_ini(ah, txgain_type);
-       } else if (AR_SREV_9285_12_OR_LATER(ah)) {
-@@ -240,26 +193,18 @@ static void ar9002_hw_init_mode_gain_reg
-               if (txgain_type == AR5416_EEP_TXGAIN_HIGH_POWER) {
-                       if (AR_SREV_9285E_20(ah)) {
-                               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9285Modes_XE2_0_high_power,
--                              ARRAY_SIZE(
--                                ar9285Modes_XE2_0_high_power), 5);
-+                                             ar9285Modes_XE2_0_high_power);
-                       } else {
-                               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9285Modes_high_power_tx_gain_9285_1_2,
--                              ARRAY_SIZE(
--                                ar9285Modes_high_power_tx_gain_9285_1_2), 5);
-+                                      ar9285Modes_high_power_tx_gain_9285_1_2);
-                       }
-               } else {
-                       if (AR_SREV_9285E_20(ah)) {
-                               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9285Modes_XE2_0_normal_power,
--                              ARRAY_SIZE(
--                                ar9285Modes_XE2_0_normal_power), 5);
-+                                             ar9285Modes_XE2_0_normal_power);
-                       } else {
-                               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9285Modes_original_tx_gain_9285_1_2,
--                              ARRAY_SIZE(
--                                ar9285Modes_original_tx_gain_9285_1_2), 5);
-+                                      ar9285Modes_original_tx_gain_9285_1_2);
-                       }
-               }
-       }
---- a/drivers/net/wireless/ath/ath9k/ar9003_eeprom.c
-+++ b/drivers/net/wireless/ath/ath9k/ar9003_eeprom.c
-@@ -131,8 +131,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0cf0e0e0),
-               .papdRateMaskHt40 = LE32(0x6cf0e0e0),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-        },
-       .base_ext1 = {
-@@ -331,8 +332,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0c80c080),
-               .papdRateMaskHt40 = LE32(0x0080c080),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-        },
-       .base_ext2 = {
-@@ -704,8 +706,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0c80c080),
-               .papdRateMaskHt40 = LE32(0x0080c080),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-        },
-        .base_ext1 = {
-@@ -904,8 +907,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0cf0e0e0),
-               .papdRateMaskHt40 = LE32(0x6cf0e0e0),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-        },
-       .base_ext2 = {
-@@ -1278,8 +1282,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0c80c080),
-               .papdRateMaskHt40 = LE32(0x0080c080),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-       },
-       .base_ext1 = {
-@@ -1478,8 +1483,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0cf0e0e0),
-               .papdRateMaskHt40 = LE32(0x6cf0e0e0),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-       },
-       .base_ext2 = {
-@@ -1852,8 +1858,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0c80c080),
-               .papdRateMaskHt40 = LE32(0x0080c080),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-       },
-       .base_ext1 = {
-@@ -2052,8 +2059,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0cf0e0e0),
-               .papdRateMaskHt40 = LE32(0x6cf0e0e0),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-       },
-       .base_ext2 = {
-@@ -2425,8 +2433,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0c80C080),
-               .papdRateMaskHt40 = LE32(0x0080C080),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-        },
-        .base_ext1 = {
-@@ -2625,8 +2634,9 @@ static const struct ar9300_eeprom ar9300
-               .thresh62 = 28,
-               .papdRateMaskHt20 = LE32(0x0cf0e0e0),
-               .papdRateMaskHt40 = LE32(0x6cf0e0e0),
-+              .xlna_bias_strength = 0,
-               .futureModal = {
--                      0, 0, 0, 0, 0, 0, 0, 0,
-+                      0, 0, 0, 0, 0, 0, 0,
-               },
-        },
-       .base_ext2 = {
-@@ -2971,14 +2981,6 @@ static u32 ath9k_hw_ar9300_get_eeprom(st
-               return (pBase->txrxMask >> 4) & 0xf;
-       case EEP_RX_MASK:
-               return pBase->txrxMask & 0xf;
--      case EEP_DRIVE_STRENGTH:
--#define AR9300_EEP_BASE_DRIV_STRENGTH 0x1
--              return pBase->miscConfiguration & AR9300_EEP_BASE_DRIV_STRENGTH;
--      case EEP_INTERNAL_REGULATOR:
--              /* Bit 4 is internal regulator flag */
--              return (pBase->featureEnable & 0x10) >> 4;
--      case EEP_SWREG:
--              return le32_to_cpu(pBase->swreg);
-       case EEP_PAPRD:
-               return !!(pBase->featureEnable & BIT(5));
-       case EEP_CHAIN_MASK_REDUCE:
-@@ -2989,8 +2991,6 @@ static u32 ath9k_hw_ar9300_get_eeprom(st
-               return eep->modalHeader5G.antennaGain;
-       case EEP_ANTENNA_GAIN_2G:
-               return eep->modalHeader2G.antennaGain;
--      case EEP_QUICK_DROP:
--              return pBase->miscConfiguration & BIT(1);
-       default:
-               return 0;
-       }
-@@ -3260,10 +3260,20 @@ static int ar9300_eeprom_restore_interna
-       int it;
-       u16 checksum, mchecksum;
-       struct ath_common *common = ath9k_hw_common(ah);
-+      struct ar9300_eeprom *eep;
-       eeprom_read_op read;
+       REGWRITE_BUFFER_FLUSH(ah);
  
--      if (ath9k_hw_use_flash(ah))
--              return ar9300_eeprom_restore_flash(ah, mptr, mdata_size);
-+      if (ath9k_hw_use_flash(ah)) {
-+              u8 txrx;
-+
-+              ar9300_eeprom_restore_flash(ah, mptr, mdata_size);
+-      udelay(50);
++      if (AR_SREV_9100(ah))
++              mdelay(10);
++      else
++              udelay(50);
+       REG_WRITE(ah, AR_RTC_RC, 0);
+       if (!ath9k_hw_wait(ah, AR_RTC_RC, AR_RTC_RC_M, 0, AH_WAIT_TIMEOUT)) {
+@@ -1377,8 +1389,12 @@ static bool ath9k_hw_set_reset(struct at
+       if (!AR_SREV_9100(ah))
+               REG_WRITE(ah, AR_RC, 0);
+-      if (AR_SREV_9100(ah))
++      if (AR_SREV_9100(ah) && type != ATH9K_RESET_WARM) {
++              if (ah->external_reset)
++                      ah->external_reset();
 +
-+              /* check if eeprom contains valid data */
-+              eep = (struct ar9300_eeprom *) mptr;
-+              txrx = eep->baseEepHeader.txrxMask;
-+              if (txrx != 0 && txrx != 0xff)
-+                      return 0;
+               udelay(50);
 +      }
  
-       word = kzalloc(2048, GFP_KERNEL);
-       if (!word)
-@@ -3493,19 +3503,20 @@ static int ath9k_hw_ar9300_get_eeprom_re
-       return 0;
+       return true;
  }
+@@ -1464,7 +1480,8 @@ static bool ath9k_hw_chip_reset(struct a
+                       reset_type = ATH9K_RESET_POWER_ON;
+               else
+                       reset_type = ATH9K_RESET_COLD;
+-      } else if (ah->chip_fullsleep || REG_READ(ah, AR_Q_TXE) ||
++      } else if (ah->chip_fullsleep ||
++                 REG_READ(ah, AR_Q_TXE) ||
+                  (REG_READ(ah, AR_CR) & AR_CR_RXE))
+               reset_type = ATH9K_RESET_COLD;
+@@ -1698,12 +1715,11 @@ static void ath9k_hw_reset_opmode(struct
+       ENABLE_REGWRITE_BUFFER(ah);
+-      REG_WRITE(ah, AR_STA_ID0, get_unaligned_le32(common->macaddr));
+-      REG_WRITE(ah, AR_STA_ID1, get_unaligned_le16(common->macaddr + 4)
+-                | macStaId1
++      REG_RMW(ah, AR_STA_ID1, macStaId1
+                 | AR_STA_ID1_RTS_USE_DEF
+                 | (ah->config.ack_6mb ? AR_STA_ID1_ACKCTS_6MB : 0)
+-                | ah->sta_id1_defaults);
++                | ah->sta_id1_defaults,
++                ~AR_STA_ID1_SADH_MASK);
+       ath_hw_setbssidmask(common);
+       REG_WRITE(ah, AR_DEF_ANTENNA, saveDefAntenna);
+       ath9k_hw_write_associd(ah);
+--- a/drivers/net/wireless/ath/ath9k/main.c
++++ b/drivers/net/wireless/ath/ath9k/main.c
+@@ -839,10 +839,14 @@ static void ath9k_vif_iter(void *data, u
+       struct ath9k_vif_iter_data *iter_data = data;
+       int i;
  
--static s32 ar9003_hw_xpa_bias_level_get(struct ath_hw *ah, bool is2ghz)
-+static struct ar9300_modal_eep_header *ar9003_modal_header(struct ath_hw *ah,
-+                                                         bool is2ghz)
- {
-       struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
+-      if (iter_data->hw_macaddr)
++      if (iter_data->has_hw_macaddr) {
+               for (i = 0; i < ETH_ALEN; i++)
+                       iter_data->mask[i] &=
+                               ~(iter_data->hw_macaddr[i] ^ mac[i]);
++      } else {
++              memcpy(iter_data->hw_macaddr, mac, ETH_ALEN);
++              iter_data->has_hw_macaddr = true;
++      }
  
-       if (is2ghz)
--              return eep->modalHeader2G.xpaBiasLvl;
-+              return &eep->modalHeader2G;
-       else
--              return eep->modalHeader5G.xpaBiasLvl;
-+              return &eep->modalHeader5G;
+       switch (vif->type) {
+       case NL80211_IFTYPE_AP:
+@@ -891,7 +895,6 @@ void ath9k_calculate_iter_data(struct ie
+        * together with the BSSID mask when matching addresses.
+        */
+       memset(iter_data, 0, sizeof(*iter_data));
+-      iter_data->hw_macaddr = common->macaddr;
+       memset(&iter_data->mask, 0xff, ETH_ALEN);
+       if (vif)
+@@ -901,6 +904,8 @@ void ath9k_calculate_iter_data(struct ie
+       ieee80211_iterate_active_interfaces_atomic(
+               sc->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
+               ath9k_vif_iter, iter_data);
++
++      memcpy(common->macaddr, iter_data->hw_macaddr, ETH_ALEN);
  }
  
- static void ar9003_hw_xpa_bias_level_apply(struct ath_hw *ah, bool is2ghz)
- {
--      int bias = ar9003_hw_xpa_bias_level_get(ah, is2ghz);
-+      int bias = ar9003_modal_header(ah, is2ghz)->xpaBiasLvl;
+ /* Called with sc->mutex held. */
+@@ -1327,6 +1332,7 @@ static int ath9k_sta_add(struct ieee8021
+       struct ath_common *common = ath9k_hw_common(sc->sc_ah);
+       struct ath_node *an = (struct ath_node *) sta->drv_priv;
+       struct ieee80211_key_conf ps_key = { };
++      int key;
  
-       if (AR_SREV_9485(ah) || AR_SREV_9330(ah) || AR_SREV_9340(ah))
-               REG_RMW_FIELD(ah, AR_CH0_TOP2, AR_CH0_TOP2_XPABIASLVL, bias);
-@@ -3521,57 +3532,26 @@ static void ar9003_hw_xpa_bias_level_app
-       }
- }
+       ath_node_attach(sc, sta, vif);
  
--static u16 ar9003_switch_com_spdt_get(struct ath_hw *ah, bool is_2ghz)
-+static u16 ar9003_switch_com_spdt_get(struct ath_hw *ah, bool is2ghz)
- {
--      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
--      __le16 val;
--
--      if (is_2ghz)
--              val = eep->modalHeader2G.switchcomspdt;
--      else
--              val = eep->modalHeader5G.switchcomspdt;
--      return le16_to_cpu(val);
-+      return le16_to_cpu(ar9003_modal_header(ah, is2ghz)->switchcomspdt);
- }
+@@ -1334,7 +1340,9 @@ static int ath9k_sta_add(struct ieee8021
+           vif->type != NL80211_IFTYPE_AP_VLAN)
+               return 0;
  
+-      an->ps_key = ath_key_config(common, vif, sta, &ps_key);
++      key = ath_key_config(common, vif, sta, &ps_key);
++      if (key > 0)
++              an->ps_key = key;
  
- static u32 ar9003_hw_ant_ctrl_common_get(struct ath_hw *ah, bool is2ghz)
- {
--      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
--      __le32 val;
--
--      if (is2ghz)
--              val = eep->modalHeader2G.antCtrlCommon;
--      else
--              val = eep->modalHeader5G.antCtrlCommon;
--      return le32_to_cpu(val);
-+      return le32_to_cpu(ar9003_modal_header(ah, is2ghz)->antCtrlCommon);
+       return 0;
  }
+@@ -1351,6 +1359,7 @@ static void ath9k_del_ps_key(struct ath_
+           return;
  
- static u32 ar9003_hw_ant_ctrl_common_2_get(struct ath_hw *ah, bool is2ghz)
- {
--      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
--      __le32 val;
--
--      if (is2ghz)
--              val = eep->modalHeader2G.antCtrlCommon2;
--      else
--              val = eep->modalHeader5G.antCtrlCommon2;
--      return le32_to_cpu(val);
-+      return le32_to_cpu(ar9003_modal_header(ah, is2ghz)->antCtrlCommon2);
+       ath_key_delete(common, &ps_key);
++      an->ps_key = 0;
  }
  
--static u16 ar9003_hw_ant_ctrl_chain_get(struct ath_hw *ah,
--                                      int chain,
-+static u16 ar9003_hw_ant_ctrl_chain_get(struct ath_hw *ah, int chain,
-                                       bool is2ghz)
+ static int ath9k_sta_remove(struct ieee80211_hw *hw,
+@@ -1678,6 +1687,7 @@ static int ath9k_ampdu_action(struct iee
+                             u16 tid, u16 *ssn, u8 buf_size)
  {
--      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
--      __le16 val = 0;
--
--      if (chain >= 0 && chain < AR9300_MAX_CHAINS) {
--              if (is2ghz)
--                      val = eep->modalHeader2G.antCtrlChain[chain];
--              else
--                      val = eep->modalHeader5G.antCtrlChain[chain];
--      }
--
-+      __le16 val = ar9003_modal_header(ah, is2ghz)->antCtrlChain[chain];
-       return le16_to_cpu(val);
- }
+       struct ath_softc *sc = hw->priv;
++      bool flush = false;
+       int ret = 0;
  
-@@ -3681,11 +3661,12 @@ static void ar9003_hw_ant_ctrl_apply(str
+       local_bh_disable();
+@@ -1694,12 +1704,14 @@ static int ath9k_ampdu_action(struct iee
+                       ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
+               ath9k_ps_restore(sc);
+               break;
+-      case IEEE80211_AMPDU_TX_STOP_CONT:
+       case IEEE80211_AMPDU_TX_STOP_FLUSH:
+       case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT:
++              flush = true;
++      case IEEE80211_AMPDU_TX_STOP_CONT:
+               ath9k_ps_wakeup(sc);
+               ath_tx_aggr_stop(sc, sta, tid);
+-              ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
++              if (!flush)
++                      ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
+               ath9k_ps_restore(sc);
+               break;
+       case IEEE80211_AMPDU_TX_OPERATIONAL:
+--- a/drivers/net/wireless/ath/ath9k/reg.h
++++ b/drivers/net/wireless/ath/ath9k/reg.h
+@@ -798,6 +798,10 @@
+ #define AR_SREV_REVISION_9485_10      0
+ #define AR_SREV_REVISION_9485_11        1
+ #define AR_SREV_VERSION_9340          0x300
++#define AR_SREV_REVISION_9340_10      0
++#define AR_SREV_REVISION_9340_11      1
++#define AR_SREV_REVISION_9340_12      2
++#define AR_SREV_REVISION_9340_13      3
+ #define AR_SREV_VERSION_9580          0x1C0
+ #define AR_SREV_REVISION_9580_10      4 /* AR9580 1.0 */
+ #define AR_SREV_VERSION_9462          0x280
+@@ -897,6 +901,10 @@
+ #define AR_SREV_9340(_ah) \
+       (((_ah)->hw_version.macVersion == AR_SREV_VERSION_9340))
++#define AR_SREV_9340_13_OR_LATER(_ah) \
++      (AR_SREV_9340((_ah)) && \
++       ((_ah)->hw_version.macRev >= AR_SREV_REVISION_9340_13))
++
+ #define AR_SREV_9285E_20(_ah) \
+     (AR_SREV_9285_12_OR_LATER(_ah) && \
+      ((REG_READ(_ah, AR_AN_SYNTH9) & 0x7) == 0x1))
+@@ -1007,6 +1015,8 @@ enum {
+                               AR_INTR_SYNC_LOCAL_TIMEOUT |
+                               AR_INTR_SYNC_MAC_SLEEP_ACCESS),
++      AR9340_INTR_SYNC_LOCAL_TIMEOUT = 0x00000010,
++
+       AR_INTR_SYNC_SPURIOUS = 0xFFFFFFFF,
  
- static void ar9003_hw_drive_strength_apply(struct ath_hw *ah)
+ };
+@@ -1493,9 +1503,6 @@ enum {
+ #define AR9271_RADIO_RF_RST                   0x20
+ #define AR9271_GATE_MAC_CTL                   0x4000
+-#define AR_STA_ID0                 0x8000
+-#define AR_STA_ID1                 0x8004
+-#define AR_STA_ID1_SADH_MASK       0x0000FFFF
+ #define AR_STA_ID1_STA_AP          0x00010000
+ #define AR_STA_ID1_ADHOC           0x00020000
+ #define AR_STA_ID1_PWR_SAV         0x00040000
+@@ -1884,6 +1891,7 @@ enum {
+ #define AR_PCU_TXBUF_CTRL_SIZE_MASK     0x7FF
+ #define AR_PCU_TXBUF_CTRL_USABLE_SIZE   0x700
+ #define AR_9285_PCU_TXBUF_CTRL_USABLE_SIZE   0x380
++#define AR_9340_PCU_TXBUF_CTRL_USABLE_SIZE   0x500
+ #define AR_PCU_MISC_MODE2               0x8344
+ #define AR_PCU_MISC_MODE2_MGMT_CRYPTO_ENABLE           0x00000002
+--- a/drivers/net/wireless/ath/hw.c
++++ b/drivers/net/wireless/ath/hw.c
+@@ -118,6 +118,12 @@
+ void ath_hw_setbssidmask(struct ath_common *common)
  {
-+      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
-+      struct ar9300_base_eep_hdr *pBase = &eep->baseEepHeader;
-       int drive_strength;
-       unsigned long reg;
--      drive_strength = ath9k_hw_ar9300_get_eeprom(ah, EEP_DRIVE_STRENGTH);
--
-+      drive_strength = pBase->miscConfiguration & BIT(0);
-       if (!drive_strength)
-               return;
+       void *ah = common->ah;
++      u32 id1;
++
++      REG_WRITE(ah, AR_STA_ID0, get_unaligned_le32(common->macaddr));
++      id1 = REG_READ(ah, AR_STA_ID1) & ~AR_STA_ID1_SADH_MASK;
++      id1 |= get_unaligned_le16(common->macaddr + 4);
++      REG_WRITE(ah, AR_STA_ID1, id1);
+       REG_WRITE(ah, AR_BSSMSKL, get_unaligned_le32(common->bssidmask));
+       REG_WRITE(ah, AR_BSSMSKU, get_unaligned_le16(common->bssidmask + 4));
+--- a/drivers/net/wireless/ath/reg.h
++++ b/drivers/net/wireless/ath/reg.h
+@@ -23,6 +23,10 @@
+ #define AR_MIBC_CMC           0x00000004
+ #define AR_MIBC_MCS           0x00000008
++#define AR_STA_ID0            0x8000
++#define AR_STA_ID1            0x8004
++#define AR_STA_ID1_SADH_MASK  0x0000ffff
++
+ /*
+  * BSSID mask registers. See ath_hw_set_bssid_mask()
+  * for detailed documentation about these registers.
+--- a/drivers/net/wireless/iwlegacy/4965-mac.c
++++ b/drivers/net/wireless/iwlegacy/4965-mac.c
+@@ -6059,7 +6059,7 @@ il4965_mac_channel_switch(struct ieee802
+       struct il_priv *il = hw->priv;
+       const struct il_channel_info *ch_info;
+       struct ieee80211_conf *conf = &hw->conf;
+-      struct ieee80211_channel *channel = ch_switch->channel;
++      struct ieee80211_channel *channel = ch_switch->chandef.chan;
+       struct il_ht_config *ht_conf = &il->current_ht_config;
+       u16 ch;
+@@ -6096,23 +6096,21 @@ il4965_mac_channel_switch(struct ieee802
+       il->current_ht_config.smps = conf->smps_mode;
+       /* Configure HT40 channels */
+-      il->ht.enabled = conf_is_ht(conf);
+-      if (il->ht.enabled) {
+-              if (conf_is_ht40_minus(conf)) {
+-                      il->ht.extension_chan_offset =
+-                          IEEE80211_HT_PARAM_CHA_SEC_BELOW;
+-                      il->ht.is_40mhz = true;
+-              } else if (conf_is_ht40_plus(conf)) {
+-                      il->ht.extension_chan_offset =
+-                          IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
+-                      il->ht.is_40mhz = true;
+-              } else {
+-                      il->ht.extension_chan_offset =
+-                          IEEE80211_HT_PARAM_CHA_SEC_NONE;
+-                      il->ht.is_40mhz = false;
+-              }
+-      } else
++      switch (cfg80211_get_chandef_type(&ch_switch->chandef)) {
++      case NL80211_CHAN_NO_HT:
++      case NL80211_CHAN_HT20:
+               il->ht.is_40mhz = false;
++              il->ht.extension_chan_offset = IEEE80211_HT_PARAM_CHA_SEC_NONE;
++              break;
++      case NL80211_CHAN_HT40MINUS:
++              il->ht.extension_chan_offset = IEEE80211_HT_PARAM_CHA_SEC_BELOW;
++              il->ht.is_40mhz = true;
++              break;
++      case NL80211_CHAN_HT40PLUS:
++              il->ht.extension_chan_offset = IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
++              il->ht.is_40mhz = true;
++              break;
++      }
  
-@@ -3815,11 +3796,11 @@ static bool is_pmu_set(struct ath_hw *ah
+       if ((le16_to_cpu(il->staging.channel) != ch))
+               il->staging.flags = 0;
+--- a/drivers/net/wireless/iwlegacy/4965.c
++++ b/drivers/net/wireless/iwlegacy/4965.c
+@@ -1493,7 +1493,7 @@ il4965_hw_channel_switch(struct il_priv 
+       cmd.band = band;
+       cmd.expect_beacon = 0;
+-      ch = ch_switch->channel->hw_value;
++      ch = ch_switch->chandef.chan->hw_value;
+       cmd.channel = cpu_to_le16(ch);
+       cmd.rxon_flags = il->staging.flags;
+       cmd.rxon_filter_flags = il->staging.filter_flags;
+--- a/drivers/net/wireless/iwlwifi/dvm/devices.c
++++ b/drivers/net/wireless/iwlwifi/dvm/devices.c
+@@ -379,7 +379,7 @@ static int iwl5000_hw_channel_switch(str
+       };
+       cmd.band = priv->band == IEEE80211_BAND_2GHZ;
+-      ch = ch_switch->channel->hw_value;
++      ch = ch_switch->chandef.chan->hw_value;
+       IWL_DEBUG_11H(priv, "channel switch from %d to %d\n",
+                     ctx->active.channel, ch);
+       cmd.channel = cpu_to_le16(ch);
+@@ -414,7 +414,8 @@ static int iwl5000_hw_channel_switch(str
+       }
+       IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
+                     cmd.switch_time);
+-      cmd.expect_beacon = ch_switch->channel->flags & IEEE80211_CHAN_RADAR;
++      cmd.expect_beacon =
++              ch_switch->chandef.chan->flags & IEEE80211_CHAN_RADAR;
  
- void ar9003_hw_internal_regulator_apply(struct ath_hw *ah)
- {
--      int internal_regulator =
--              ath9k_hw_ar9300_get_eeprom(ah, EEP_INTERNAL_REGULATOR);
-+      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
-+      struct ar9300_base_eep_hdr *pBase = &eep->baseEepHeader;
-       u32 reg_val;
--      if (internal_regulator) {
-+      if (pBase->featureEnable & BIT(4)) {
-               if (AR_SREV_9330(ah) || AR_SREV_9485(ah)) {
-                       int reg_pmu_set;
-@@ -3863,11 +3844,11 @@ void ar9003_hw_internal_regulator_apply(
-                       if (!is_pmu_set(ah, AR_PHY_PMU2, reg_pmu_set))
-                               return;
-               } else if (AR_SREV_9462(ah)) {
--                      reg_val = ath9k_hw_ar9300_get_eeprom(ah, EEP_SWREG);
-+                      reg_val = le32_to_cpu(pBase->swreg);
-                       REG_WRITE(ah, AR_PHY_PMU1, reg_val);
-               } else {
-                       /* Internal regulator is ON. Write swreg register. */
--                      reg_val = ath9k_hw_ar9300_get_eeprom(ah, EEP_SWREG);
-+                      reg_val = le32_to_cpu(pBase->swreg);
-                       REG_WRITE(ah, AR_RTC_REG_CONTROL1,
-                                 REG_READ(ah, AR_RTC_REG_CONTROL1) &
-                                 (~AR_RTC_REG_CONTROL1_SWREG_PROGRAM));
-@@ -3909,6 +3890,9 @@ static void ar9003_hw_apply_tuning_caps(
-       struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
-       u8 tuning_caps_param = eep->baseEepHeader.params_for_tuning_caps[0];
-+      if (AR_SREV_9485(ah) || AR_SREV_9330(ah) || AR_SREV_9340(ah))
-+              return;
-+
-       if (eep->baseEepHeader.featureEnable & 0x40) {
-               tuning_caps_param &= 0x7f;
-               REG_RMW_FIELD(ah, AR_CH0_XTAL, AR_CH0_XTAL_CAPINDAC,
-@@ -3921,10 +3905,11 @@ static void ar9003_hw_apply_tuning_caps(
- static void ar9003_hw_quick_drop_apply(struct ath_hw *ah, u16 freq)
+       return iwl_dvm_send_cmd(priv, &hcmd);
+ }
+@@ -540,7 +541,7 @@ static int iwl6000_hw_channel_switch(str
+       hcmd.data[0] = cmd;
+       cmd->band = priv->band == IEEE80211_BAND_2GHZ;
+-      ch = ch_switch->channel->hw_value;
++      ch = ch_switch->chandef.chan->hw_value;
+       IWL_DEBUG_11H(priv, "channel switch from %u to %u\n",
+                     ctx->active.channel, ch);
+       cmd->channel = cpu_to_le16(ch);
+@@ -575,7 +576,8 @@ static int iwl6000_hw_channel_switch(str
+       }
+       IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
+                     cmd->switch_time);
+-      cmd->expect_beacon = ch_switch->channel->flags & IEEE80211_CHAN_RADAR;
++      cmd->expect_beacon =
++              ch_switch->chandef.chan->flags & IEEE80211_CHAN_RADAR;
+       err = iwl_dvm_send_cmd(priv, &hcmd);
+       kfree(cmd);
+--- a/drivers/net/wireless/iwlwifi/dvm/mac80211.c
++++ b/drivers/net/wireless/iwlwifi/dvm/mac80211.c
+@@ -970,7 +970,7 @@ static void iwlagn_mac_channel_switch(st
  {
-       struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
--      int quick_drop = ath9k_hw_ar9300_get_eeprom(ah, EEP_QUICK_DROP);
-+      struct ar9300_base_eep_hdr *pBase = &eep->baseEepHeader;
-+      int quick_drop;
-       s32 t[3], f[3] = {5180, 5500, 5785};
--      if (!quick_drop)
-+      if (!(pBase->miscConfiguration & BIT(1)))
-               return;
+       struct iwl_priv *priv = IWL_MAC80211_GET_DVM(hw);
+       struct ieee80211_conf *conf = &hw->conf;
+-      struct ieee80211_channel *channel = ch_switch->channel;
++      struct ieee80211_channel *channel = ch_switch->chandef.chan;
+       struct iwl_ht_config *ht_conf = &priv->current_ht_config;
+       /*
+        * MULTI-FIXME
+@@ -1008,11 +1008,21 @@ static void iwlagn_mac_channel_switch(st
+       priv->current_ht_config.smps = conf->smps_mode;
+       /* Configure HT40 channels */
+-      ctx->ht.enabled = conf_is_ht(conf);
+-      if (ctx->ht.enabled)
+-              iwlagn_config_ht40(conf, ctx);
+-      else
++      switch (cfg80211_get_chandef_type(&ch_switch->chandef)) {
++      case NL80211_CHAN_NO_HT:
++      case NL80211_CHAN_HT20:
+               ctx->ht.is_40mhz = false;
++              ctx->ht.extension_chan_offset = IEEE80211_HT_PARAM_CHA_SEC_NONE;
++              break;
++      case NL80211_CHAN_HT40MINUS:
++              ctx->ht.extension_chan_offset = IEEE80211_HT_PARAM_CHA_SEC_BELOW;
++              ctx->ht.is_40mhz = true;
++              break;
++      case NL80211_CHAN_HT40PLUS:
++              ctx->ht.extension_chan_offset = IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
++              ctx->ht.is_40mhz = true;
++              break;
++      }
  
-       if (freq < 4000)
-@@ -3938,13 +3923,11 @@ static void ar9003_hw_quick_drop_apply(s
-       REG_RMW_FIELD(ah, AR_PHY_AGC, AR_PHY_AGC_QUICK_DROP, quick_drop);
+       if ((le16_to_cpu(ctx->staging.channel) != ch))
+               ctx->staging.flags = 0;
+--- a/drivers/net/wireless/iwlwifi/dvm/rxon.c
++++ b/drivers/net/wireless/iwlwifi/dvm/rxon.c
+@@ -1160,7 +1160,7 @@ int iwlagn_commit_rxon(struct iwl_priv *
  }
  
--static void ar9003_hw_txend_to_xpa_off_apply(struct ath_hw *ah, u16 freq)
-+static void ar9003_hw_txend_to_xpa_off_apply(struct ath_hw *ah, bool is2ghz)
+ void iwlagn_config_ht40(struct ieee80211_conf *conf,
+-      struct iwl_rxon_context *ctx)
++                      struct iwl_rxon_context *ctx)
  {
--      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
-       u32 value;
+       if (conf_is_ht40_minus(conf)) {
+               ctx->ht.extension_chan_offset =
+--- a/drivers/net/wireless/mac80211_hwsim.c
++++ b/drivers/net/wireless/mac80211_hwsim.c
+@@ -25,6 +25,7 @@
+ #include <linux/if_arp.h>
+ #include <linux/rtnetlink.h>
+ #include <linux/etherdevice.h>
++#include <linux/platform_device.h>
+ #include <linux/debugfs.h>
+ #include <linux/module.h>
+ #include <linux/ktime.h>
+@@ -717,9 +718,17 @@ static bool mac80211_hwsim_tx_frame_no_n
+       rx_status.flag |= RX_FLAG_MACTIME_START;
+       rx_status.freq = chan->center_freq;
+       rx_status.band = chan->band;
+-      rx_status.rate_idx = info->control.rates[0].idx;
+-      if (info->control.rates[0].flags & IEEE80211_TX_RC_MCS)
+-              rx_status.flag |= RX_FLAG_HT;
++      if (info->control.rates[0].flags & IEEE80211_TX_RC_VHT_MCS) {
++              rx_status.rate_idx =
++                      ieee80211_rate_get_vht_mcs(&info->control.rates[0]);
++              rx_status.vht_nss =
++                      ieee80211_rate_get_vht_nss(&info->control.rates[0]);
++              rx_status.flag |= RX_FLAG_VHT;
++      } else {
++              rx_status.rate_idx = info->control.rates[0].idx;
++              if (info->control.rates[0].flags & IEEE80211_TX_RC_MCS)
++                      rx_status.flag |= RX_FLAG_HT;
++      }
+       if (info->control.rates[0].flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
+               rx_status.flag |= RX_FLAG_40MHZ;
+       if (info->control.rates[0].flags & IEEE80211_TX_RC_SHORT_GI)
+@@ -1687,6 +1696,7 @@ static void mac80211_hwsim_free(void)
+               debugfs_remove(data->debugfs_ps);
+               debugfs_remove(data->debugfs);
+               ieee80211_unregister_hw(data->hw);
++              device_release_driver(data->dev);
+               device_unregister(data->dev);
+               ieee80211_free_hw(data->hw);
+       }
+@@ -1695,7 +1705,9 @@ static void mac80211_hwsim_free(void)
  
--      value = (freq < 4000) ? eep->modalHeader2G.txEndToXpaOff :
--                              eep->modalHeader5G.txEndToXpaOff;
-+      value = ar9003_modal_header(ah, is2ghz)->txEndToXpaOff;
  
-       REG_RMW_FIELD(ah, AR_PHY_XPA_TIMING_CTL,
-                     AR_PHY_XPA_TIMING_CTL_TX_END_XPAB_OFF, value);
-@@ -3952,19 +3935,63 @@ static void ar9003_hw_txend_to_xpa_off_a
-                     AR_PHY_XPA_TIMING_CTL_TX_END_XPAA_OFF, value);
- }
+ static struct device_driver mac80211_hwsim_driver = {
+-      .name = "mac80211_hwsim"
++      .name = "mac80211_hwsim",
++      .bus = &platform_bus_type,
++      .owner = THIS_MODULE,
+ };
  
-+static void ar9003_hw_xpa_timing_control_apply(struct ath_hw *ah, bool is2ghz)
-+{
-+      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
-+      u8 xpa_ctl;
-+
-+      if (!(eep->baseEepHeader.featureEnable & 0x80))
-+              return;
-+
-+      if (!AR_SREV_9300(ah) && !AR_SREV_9340(ah) && !AR_SREV_9580(ah))
-+              return;
-+
-+      xpa_ctl = ar9003_modal_header(ah, is2ghz)->txFrameToXpaOn;
-+      if (is2ghz)
-+              REG_RMW_FIELD(ah, AR_PHY_XPA_TIMING_CTL,
-+                            AR_PHY_XPA_TIMING_CTL_FRAME_XPAB_ON, xpa_ctl);
-+      else
-+              REG_RMW_FIELD(ah, AR_PHY_XPA_TIMING_CTL,
-+                            AR_PHY_XPA_TIMING_CTL_FRAME_XPAA_ON, xpa_ctl);
-+}
-+
-+static void ar9003_hw_xlna_bias_strength_apply(struct ath_hw *ah, bool is2ghz)
-+{
-+      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
-+      u8 bias;
-+
-+      if (!(eep->baseEepHeader.featureEnable & 0x40))
-+              return;
-+
-+      if (!AR_SREV_9300(ah))
-+              return;
+ static const struct net_device_ops hwsim_netdev_ops = {
+@@ -2187,9 +2199,15 @@ static int __init init_mac80211_hwsim(vo
+       spin_lock_init(&hwsim_radio_lock);
+       INIT_LIST_HEAD(&hwsim_radios);
++      err = driver_register(&mac80211_hwsim_driver);
++      if (err)
++              return err;
 +
-+      bias = ar9003_modal_header(ah, is2ghz)->xlna_bias_strength;
-+      REG_RMW_FIELD(ah, AR_PHY_65NM_CH0_RXTX4, AR_PHY_65NM_RXTX4_XLNA_BIAS,
-+                    bias & 0x3);
-+      bias >>= 2;
-+      REG_RMW_FIELD(ah, AR_PHY_65NM_CH1_RXTX4, AR_PHY_65NM_RXTX4_XLNA_BIAS,
-+                    bias & 0x3);
-+      bias >>= 2;
-+      REG_RMW_FIELD(ah, AR_PHY_65NM_CH2_RXTX4, AR_PHY_65NM_RXTX4_XLNA_BIAS,
-+                    bias & 0x3);
-+}
+       hwsim_class = class_create(THIS_MODULE, "mac80211_hwsim");
+-      if (IS_ERR(hwsim_class))
+-              return PTR_ERR(hwsim_class);
++      if (IS_ERR(hwsim_class)) {
++              err = PTR_ERR(hwsim_class);
++              goto failed_unregister_driver;
++      }
+       memset(addr, 0, ETH_ALEN);
+       addr[0] = 0x02;
+@@ -2211,12 +2229,20 @@ static int __init init_mac80211_hwsim(vo
+                                         "hwsim%d", i);
+               if (IS_ERR(data->dev)) {
+                       printk(KERN_DEBUG
+-                             "mac80211_hwsim: device_create "
+-                             "failed (%ld)\n", PTR_ERR(data->dev));
++                             "mac80211_hwsim: device_create failed (%ld)\n",
++                             PTR_ERR(data->dev));
+                       err = -ENOMEM;
+                       goto failed_drvdata;
+               }
+               data->dev->driver = &mac80211_hwsim_driver;
++              err = device_bind_driver(data->dev);
++              if (err != 0) {
++                      printk(KERN_DEBUG
++                             "mac80211_hwsim: device_bind_driver failed (%d)\n",
++                             err);
++                      goto failed_hw;
++              }
 +
- static void ath9k_hw_ar9300_set_board_values(struct ath_hw *ah,
-                                            struct ath9k_channel *chan)
- {
--      ar9003_hw_xpa_bias_level_apply(ah, IS_CHAN_2GHZ(chan));
--      ar9003_hw_ant_ctrl_apply(ah, IS_CHAN_2GHZ(chan));
-+      bool is2ghz = IS_CHAN_2GHZ(chan);
-+      ar9003_hw_xpa_timing_control_apply(ah, is2ghz);
-+      ar9003_hw_xpa_bias_level_apply(ah, is2ghz);
-+      ar9003_hw_ant_ctrl_apply(ah, is2ghz);
-       ar9003_hw_drive_strength_apply(ah);
-+      ar9003_hw_xlna_bias_strength_apply(ah, is2ghz);
-       ar9003_hw_atten_apply(ah, chan);
-       ar9003_hw_quick_drop_apply(ah, chan->channel);
-       if (!AR_SREV_9330(ah) && !AR_SREV_9340(ah) && !AR_SREV_9550(ah))
-               ar9003_hw_internal_regulator_apply(ah);
--      if (AR_SREV_9485(ah) || AR_SREV_9330(ah) || AR_SREV_9340(ah))
--              ar9003_hw_apply_tuning_caps(ah);
--      ar9003_hw_txend_to_xpa_off_apply(ah, chan->channel);
-+      ar9003_hw_apply_tuning_caps(ah);
-+      ar9003_hw_txend_to_xpa_off_apply(ah, is2ghz);
+               skb_queue_head_init(&data->pending);
+               SET_IEEE80211_DEV(hw, data->dev);
+@@ -2515,6 +2541,8 @@ failed_drvdata:
+       ieee80211_free_hw(hw);
+ failed:
+       mac80211_hwsim_free();
++failed_unregister_driver:
++      driver_unregister(&mac80211_hwsim_driver);
+       return err;
  }
+ module_init(init_mac80211_hwsim);
+@@ -2527,5 +2555,6 @@ static void __exit exit_mac80211_hwsim(v
  
- static void ath9k_hw_ar9300_set_addac(struct ath_hw *ah,
-@@ -5100,14 +5127,9 @@ s32 ar9003_hw_get_rx_gain_idx(struct ath
-       return (eep->baseEepHeader.txrxgain) & 0xf; /* bits 3:0 */
+       mac80211_hwsim_free();
+       unregister_netdev(hwsim_mon);
++      driver_unregister(&mac80211_hwsim_driver);
  }
+ module_exit(exit_mac80211_hwsim);
+--- a/drivers/net/wireless/ti/wl12xx/cmd.c
++++ b/drivers/net/wireless/ti/wl12xx/cmd.c
+@@ -301,7 +301,7 @@ int wl12xx_cmd_channel_switch(struct wl1
+       }
  
--u8 *ar9003_get_spur_chan_ptr(struct ath_hw *ah, bool is_2ghz)
-+u8 *ar9003_get_spur_chan_ptr(struct ath_hw *ah, bool is2ghz)
- {
--      struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep;
--
--      if (is_2ghz)
--              return eep->modalHeader2G.spurChans;
--      else
--              return eep->modalHeader5G.spurChans;
-+      return ar9003_modal_header(ah, is2ghz)->spurChans;
- }
+       cmd->role_id = wlvif->role_id;
+-      cmd->channel = ch_switch->channel->hw_value;
++      cmd->channel = ch_switch->chandef.chan->hw_value;
+       cmd->switch_time = ch_switch->count;
+       cmd->stop_tx = ch_switch->block_tx;
  
- unsigned int ar9003_get_paprd_scale_factor(struct ath_hw *ah,
---- a/drivers/net/wireless/ath/ath9k/ar9003_eeprom.h
-+++ b/drivers/net/wireless/ath/ath9k/ar9003_eeprom.h
-@@ -231,7 +231,8 @@ struct ar9300_modal_eep_header {
-       __le32 papdRateMaskHt20;
-       __le32 papdRateMaskHt40;
-       __le16 switchcomspdt;
--      u8 futureModal[8];
-+      u8 xlna_bias_strength;
-+      u8 futureModal[7];
- } __packed;
+--- a/drivers/net/wireless/ti/wl18xx/cmd.c
++++ b/drivers/net/wireless/ti/wl18xx/cmd.c
+@@ -42,11 +42,11 @@ int wl18xx_cmd_channel_switch(struct wl1
+       }
  
- struct ar9300_cal_data_per_freq_op_loop {
---- a/drivers/net/wireless/ath/ath9k/ar9003_hw.c
-+++ b/drivers/net/wireless/ath/ath9k/ar9003_hw.c
-@@ -44,462 +44,310 @@ static void ar9003_hw_init_mode_regs(str
-               ar9462_2p0_baseband_core_txfir_coeff_japan_2484
-       if (AR_SREV_9330_11(ah)) {
-               /* mac */
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE],
--                              ar9331_1p1_mac_core,
--                              ARRAY_SIZE(ar9331_1p1_mac_core), 2);
-+                              ar9331_1p1_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar9331_1p1_mac_postamble,
--                              ARRAY_SIZE(ar9331_1p1_mac_postamble), 5);
-+                              ar9331_1p1_mac_postamble);
-               /* bb */
--              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
--                              ar9331_1p1_baseband_core,
--                              ARRAY_SIZE(ar9331_1p1_baseband_core), 2);
-+                              ar9331_1p1_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar9331_1p1_baseband_postamble,
--                              ARRAY_SIZE(ar9331_1p1_baseband_postamble), 5);
-+                              ar9331_1p1_baseband_postamble);
-               /* radio */
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
--                              ar9331_1p1_radio_core,
--                              ARRAY_SIZE(ar9331_1p1_radio_core), 2);
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST], NULL, 0, 0);
-+                              ar9331_1p1_radio_core);
-               /* soc */
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
--                              ar9331_1p1_soc_preamble,
--                              ARRAY_SIZE(ar9331_1p1_soc_preamble), 2);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
-+                              ar9331_1p1_soc_preamble);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
--                              ar9331_1p1_soc_postamble,
--                              ARRAY_SIZE(ar9331_1p1_soc_postamble), 2);
-+                              ar9331_1p1_soc_postamble);
-               /* rx/tx gain */
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9331_common_rx_gain_1p1,
--                              ARRAY_SIZE(ar9331_common_rx_gain_1p1), 2);
-+                              ar9331_common_rx_gain_1p1);
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_lowest_ob_db_tx_gain_1p1,
--                      ARRAY_SIZE(ar9331_modes_lowest_ob_db_tx_gain_1p1),
--                      5);
-+                              ar9331_modes_lowest_ob_db_tx_gain_1p1);
-               /* additional clock settings */
-               if (ah->is_clk_25mhz)
-                       INIT_INI_ARRAY(&ah->iniAdditional,
--                                      ar9331_1p1_xtal_25M,
--                                      ARRAY_SIZE(ar9331_1p1_xtal_25M), 2);
-+                                      ar9331_1p1_xtal_25M);
-               else
-                       INIT_INI_ARRAY(&ah->iniAdditional,
--                                      ar9331_1p1_xtal_40M,
--                                      ARRAY_SIZE(ar9331_1p1_xtal_40M), 2);
-+                                      ar9331_1p1_xtal_40M);
-       } else if (AR_SREV_9330_12(ah)) {
-               /* mac */
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE],
--                              ar9331_1p2_mac_core,
--                              ARRAY_SIZE(ar9331_1p2_mac_core), 2);
-+                              ar9331_1p2_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar9331_1p2_mac_postamble,
--                              ARRAY_SIZE(ar9331_1p2_mac_postamble), 5);
-+                              ar9331_1p2_mac_postamble);
-               /* bb */
--              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
--                              ar9331_1p2_baseband_core,
--                              ARRAY_SIZE(ar9331_1p2_baseband_core), 2);
-+                              ar9331_1p2_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar9331_1p2_baseband_postamble,
--                              ARRAY_SIZE(ar9331_1p2_baseband_postamble), 5);
-+                              ar9331_1p2_baseband_postamble);
-               /* radio */
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
--                              ar9331_1p2_radio_core,
--                              ARRAY_SIZE(ar9331_1p2_radio_core), 2);
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST], NULL, 0, 0);
-+                              ar9331_1p2_radio_core);
-               /* soc */
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
--                              ar9331_1p2_soc_preamble,
--                              ARRAY_SIZE(ar9331_1p2_soc_preamble), 2);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
-+                              ar9331_1p2_soc_preamble);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
--                              ar9331_1p2_soc_postamble,
--                              ARRAY_SIZE(ar9331_1p2_soc_postamble), 2);
-+                              ar9331_1p2_soc_postamble);
-               /* rx/tx gain */
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9331_common_rx_gain_1p2,
--                              ARRAY_SIZE(ar9331_common_rx_gain_1p2), 2);
-+                              ar9331_common_rx_gain_1p2);
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_lowest_ob_db_tx_gain_1p2,
--                      ARRAY_SIZE(ar9331_modes_lowest_ob_db_tx_gain_1p2),
--                      5);
-+                              ar9331_modes_lowest_ob_db_tx_gain_1p2);
-               /* additional clock settings */
-               if (ah->is_clk_25mhz)
-                       INIT_INI_ARRAY(&ah->iniAdditional,
--                                      ar9331_1p2_xtal_25M,
--                                      ARRAY_SIZE(ar9331_1p2_xtal_25M), 2);
-+                                      ar9331_1p2_xtal_25M);
-               else
-                       INIT_INI_ARRAY(&ah->iniAdditional,
--                                      ar9331_1p2_xtal_40M,
--                                      ARRAY_SIZE(ar9331_1p2_xtal_40M), 2);
-+                                      ar9331_1p2_xtal_40M);
-       } else if (AR_SREV_9340(ah)) {
-               /* mac */
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE],
--                              ar9340_1p0_mac_core,
--                              ARRAY_SIZE(ar9340_1p0_mac_core), 2);
-+                              ar9340_1p0_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar9340_1p0_mac_postamble,
--                              ARRAY_SIZE(ar9340_1p0_mac_postamble), 5);
-+                              ar9340_1p0_mac_postamble);
-               /* bb */
--              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
--                              ar9340_1p0_baseband_core,
--                              ARRAY_SIZE(ar9340_1p0_baseband_core), 2);
-+                              ar9340_1p0_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar9340_1p0_baseband_postamble,
--                              ARRAY_SIZE(ar9340_1p0_baseband_postamble), 5);
-+                              ar9340_1p0_baseband_postamble);
-               /* radio */
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
--                              ar9340_1p0_radio_core,
--                              ARRAY_SIZE(ar9340_1p0_radio_core), 2);
-+                              ar9340_1p0_radio_core);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST],
--                              ar9340_1p0_radio_postamble,
--                              ARRAY_SIZE(ar9340_1p0_radio_postamble), 5);
-+                              ar9340_1p0_radio_postamble);
-               /* soc */
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
--                              ar9340_1p0_soc_preamble,
--                              ARRAY_SIZE(ar9340_1p0_soc_preamble), 2);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
-+                              ar9340_1p0_soc_preamble);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
--                              ar9340_1p0_soc_postamble,
--                              ARRAY_SIZE(ar9340_1p0_soc_postamble), 5);
-+                              ar9340_1p0_soc_postamble);
-               /* rx/tx gain */
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9340Common_wo_xlna_rx_gain_table_1p0,
--                              ARRAY_SIZE(ar9340Common_wo_xlna_rx_gain_table_1p0),
--                              5);
--              INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9340Modes_high_ob_db_tx_gain_table_1p0,
--                              ARRAY_SIZE(ar9340Modes_high_ob_db_tx_gain_table_1p0),
--                              5);
-+                              ar9340Common_wo_xlna_rx_gain_table_1p0);
-+              INIT_INI_ARRAY(&ah->iniModesTxGain,
-+                              ar9340Modes_high_ob_db_tx_gain_table_1p0);
-               INIT_INI_ARRAY(&ah->iniModesFastClock,
--                              ar9340Modes_fast_clock_1p0,
--                              ARRAY_SIZE(ar9340Modes_fast_clock_1p0),
--                              3);
-+                              ar9340Modes_fast_clock_1p0);
-               if (!ah->is_clk_25mhz)
-                       INIT_INI_ARRAY(&ah->iniAdditional,
--                                     ar9340_1p0_radio_core_40M,
--                                     ARRAY_SIZE(ar9340_1p0_radio_core_40M),
--                                     2);
-+                                     ar9340_1p0_radio_core_40M);
-       } else if (AR_SREV_9485_11(ah)) {
-               /* mac */
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE],
--                              ar9485_1_1_mac_core,
--                              ARRAY_SIZE(ar9485_1_1_mac_core), 2);
-+                              ar9485_1_1_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar9485_1_1_mac_postamble,
--                              ARRAY_SIZE(ar9485_1_1_mac_postamble), 5);
-+                              ar9485_1_1_mac_postamble);
-               /* bb */
--              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], ar9485_1_1,
--                              ARRAY_SIZE(ar9485_1_1), 2);
-+              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], ar9485_1_1);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
--                              ar9485_1_1_baseband_core,
--                              ARRAY_SIZE(ar9485_1_1_baseband_core), 2);
-+                              ar9485_1_1_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar9485_1_1_baseband_postamble,
--                              ARRAY_SIZE(ar9485_1_1_baseband_postamble), 5);
-+                              ar9485_1_1_baseband_postamble);
-               /* radio */
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
--                              ar9485_1_1_radio_core,
--                              ARRAY_SIZE(ar9485_1_1_radio_core), 2);
-+                              ar9485_1_1_radio_core);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST],
--                              ar9485_1_1_radio_postamble,
--                              ARRAY_SIZE(ar9485_1_1_radio_postamble), 2);
-+                              ar9485_1_1_radio_postamble);
-               /* soc */
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
--                              ar9485_1_1_soc_preamble,
--                              ARRAY_SIZE(ar9485_1_1_soc_preamble), 2);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST], NULL, 0, 0);
-+                              ar9485_1_1_soc_preamble);
-               /* rx/tx gain */
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9485Common_wo_xlna_rx_gain_1_1,
--                              ARRAY_SIZE(ar9485Common_wo_xlna_rx_gain_1_1), 2);
-+                              ar9485Common_wo_xlna_rx_gain_1_1);
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9485_modes_lowest_ob_db_tx_gain_1_1,
--                              ARRAY_SIZE(ar9485_modes_lowest_ob_db_tx_gain_1_1),
--                              5);
-+                              ar9485_modes_lowest_ob_db_tx_gain_1_1);
-               /* Load PCIE SERDES settings from INI */
-               /* Awake Setting */
-               INIT_INI_ARRAY(&ah->iniPcieSerdes,
--                              ar9485_1_1_pcie_phy_clkreq_disable_L1,
--                              ARRAY_SIZE(ar9485_1_1_pcie_phy_clkreq_disable_L1),
--                              2);
-+                              ar9485_1_1_pcie_phy_clkreq_disable_L1);
-               /* Sleep Setting */
-               INIT_INI_ARRAY(&ah->iniPcieSerdesLowPower,
--                              ar9485_1_1_pcie_phy_clkreq_disable_L1,
--                              ARRAY_SIZE(ar9485_1_1_pcie_phy_clkreq_disable_L1),
--                              2);
-+                              ar9485_1_1_pcie_phy_clkreq_disable_L1);
-       } else if (AR_SREV_9462_20(ah)) {
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE], ar9462_2p0_mac_core,
--                              ARRAY_SIZE(ar9462_2p0_mac_core), 2);
-+              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE], ar9462_2p0_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar9462_2p0_mac_postamble,
--                              ARRAY_SIZE(ar9462_2p0_mac_postamble), 5);
-+                              ar9462_2p0_mac_postamble);
--              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
--                              ar9462_2p0_baseband_core,
--                              ARRAY_SIZE(ar9462_2p0_baseband_core), 2);
-+                              ar9462_2p0_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar9462_2p0_baseband_postamble,
--                              ARRAY_SIZE(ar9462_2p0_baseband_postamble), 5);
-+                              ar9462_2p0_baseband_postamble);
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
--                              ar9462_2p0_radio_core,
--                              ARRAY_SIZE(ar9462_2p0_radio_core), 2);
-+                              ar9462_2p0_radio_core);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST],
--                              ar9462_2p0_radio_postamble,
--                              ARRAY_SIZE(ar9462_2p0_radio_postamble), 5);
-+                              ar9462_2p0_radio_postamble);
-               INIT_INI_ARRAY(&ah->ini_radio_post_sys2ant,
--                              ar9462_2p0_radio_postamble_sys2ant,
--                              ARRAY_SIZE(ar9462_2p0_radio_postamble_sys2ant),
--                              5);
-+                              ar9462_2p0_radio_postamble_sys2ant);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
--                              ar9462_2p0_soc_preamble,
--                              ARRAY_SIZE(ar9462_2p0_soc_preamble), 2);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
-+                              ar9462_2p0_soc_preamble);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
--                              ar9462_2p0_soc_postamble,
--                              ARRAY_SIZE(ar9462_2p0_soc_postamble), 5);
-+                              ar9462_2p0_soc_postamble);
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9462_common_rx_gain_table_2p0,
--                              ARRAY_SIZE(ar9462_common_rx_gain_table_2p0), 2);
-+                              ar9462_common_rx_gain_table_2p0);
-               /* Awake -> Sleep Setting */
-               INIT_INI_ARRAY(&ah->iniPcieSerdes,
--                              PCIE_PLL_ON_CREQ_DIS_L1_2P0,
--                              ARRAY_SIZE(PCIE_PLL_ON_CREQ_DIS_L1_2P0),
--                              2);
-+                              PCIE_PLL_ON_CREQ_DIS_L1_2P0);
-               /* Sleep -> Awake Setting */
-               INIT_INI_ARRAY(&ah->iniPcieSerdesLowPower,
--                              PCIE_PLL_ON_CREQ_DIS_L1_2P0,
--                              ARRAY_SIZE(PCIE_PLL_ON_CREQ_DIS_L1_2P0),
--                              2);
-+                              PCIE_PLL_ON_CREQ_DIS_L1_2P0);
-               /* Fast clock modal settings */
-               INIT_INI_ARRAY(&ah->iniModesFastClock,
--                              ar9462_modes_fast_clock_2p0,
--                              ARRAY_SIZE(ar9462_modes_fast_clock_2p0), 3);
-+                              ar9462_modes_fast_clock_2p0);
-               INIT_INI_ARRAY(&ah->iniCckfirJapan2484,
--                              AR9462_BB_CTX_COEFJ(2p0),
--                              ARRAY_SIZE(AR9462_BB_CTX_COEFJ(2p0)), 2);
-+                              AR9462_BB_CTX_COEFJ(2p0));
--              INIT_INI_ARRAY(&ah->ini_japan2484, AR9462_BBC_TXIFR_COEFFJ,
--                              ARRAY_SIZE(AR9462_BBC_TXIFR_COEFFJ), 2);
-+              INIT_INI_ARRAY(&ah->ini_japan2484, AR9462_BBC_TXIFR_COEFFJ);
-       } else if (AR_SREV_9550(ah)) {
-               /* mac */
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE],
--                              ar955x_1p0_mac_core,
--                              ARRAY_SIZE(ar955x_1p0_mac_core), 2);
-+                              ar955x_1p0_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar955x_1p0_mac_postamble,
--                              ARRAY_SIZE(ar955x_1p0_mac_postamble), 5);
-+                              ar955x_1p0_mac_postamble);
-               /* bb */
--              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
--                              ar955x_1p0_baseband_core,
--                              ARRAY_SIZE(ar955x_1p0_baseband_core), 2);
-+                              ar955x_1p0_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar955x_1p0_baseband_postamble,
--                              ARRAY_SIZE(ar955x_1p0_baseband_postamble), 5);
-+                              ar955x_1p0_baseband_postamble);
-               /* radio */
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
--                              ar955x_1p0_radio_core,
--                              ARRAY_SIZE(ar955x_1p0_radio_core), 2);
-+                              ar955x_1p0_radio_core);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST],
--                              ar955x_1p0_radio_postamble,
--                              ARRAY_SIZE(ar955x_1p0_radio_postamble), 5);
-+                              ar955x_1p0_radio_postamble);
-               /* soc */
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
--                              ar955x_1p0_soc_preamble,
--                              ARRAY_SIZE(ar955x_1p0_soc_preamble), 2);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
-+                              ar955x_1p0_soc_preamble);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
--                              ar955x_1p0_soc_postamble,
--                              ARRAY_SIZE(ar955x_1p0_soc_postamble), 5);
-+                              ar955x_1p0_soc_postamble);
-               /* rx/tx gain */
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar955x_1p0_common_wo_xlna_rx_gain_table,
--                      ARRAY_SIZE(ar955x_1p0_common_wo_xlna_rx_gain_table),
--                      2);
-+                      ar955x_1p0_common_wo_xlna_rx_gain_table);
-               INIT_INI_ARRAY(&ah->ini_modes_rx_gain_bounds,
--                      ar955x_1p0_common_wo_xlna_rx_gain_bounds,
--                      ARRAY_SIZE(ar955x_1p0_common_wo_xlna_rx_gain_bounds),
--                      5);
--              INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar955x_1p0_modes_xpa_tx_gain_table,
--                              ARRAY_SIZE(ar955x_1p0_modes_xpa_tx_gain_table),
--                              9);
-+                      ar955x_1p0_common_wo_xlna_rx_gain_bounds);
-+              INIT_INI_ARRAY(&ah->iniModesTxGain,
-+                              ar955x_1p0_modes_xpa_tx_gain_table);
-               /* Fast clock modal settings */
-               INIT_INI_ARRAY(&ah->iniModesFastClock,
--                              ar955x_1p0_modes_fast_clock,
--                              ARRAY_SIZE(ar955x_1p0_modes_fast_clock), 3);
-+                              ar955x_1p0_modes_fast_clock);
-       } 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);
-+                              ar9580_1p0_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar9580_1p0_mac_postamble,
--                              ARRAY_SIZE(ar9580_1p0_mac_postamble), 5);
-+                              ar9580_1p0_mac_postamble);
-               /* 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);
-+                              ar9580_1p0_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar9580_1p0_baseband_postamble,
--                              ARRAY_SIZE(ar9580_1p0_baseband_postamble), 5);
-+                              ar9580_1p0_baseband_postamble);
-               /* 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);
-+                              ar9580_1p0_radio_core);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST],
--                              ar9580_1p0_radio_postamble,
--                              ARRAY_SIZE(ar9580_1p0_radio_postamble), 5);
-+                              ar9580_1p0_radio_postamble);
-               /* 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);
-+                              ar9580_1p0_soc_preamble);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
--                              ar9580_1p0_soc_postamble,
--                              ARRAY_SIZE(ar9580_1p0_soc_postamble), 5);
-+                              ar9580_1p0_soc_postamble);
-               /* rx/tx gain */
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9580_1p0_rx_gain_table,
--                              ARRAY_SIZE(ar9580_1p0_rx_gain_table), 2);
-+                              ar9580_1p0_rx_gain_table);
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9580_1p0_low_ob_db_tx_gain_table,
--                              ARRAY_SIZE(ar9580_1p0_low_ob_db_tx_gain_table),
--                              5);
-+                              ar9580_1p0_low_ob_db_tx_gain_table);
-               INIT_INI_ARRAY(&ah->iniModesFastClock,
--                              ar9580_1p0_modes_fast_clock,
--                              ARRAY_SIZE(ar9580_1p0_modes_fast_clock),
--                              3);
-+                              ar9580_1p0_modes_fast_clock);
-       } else {
-               /* mac */
--              INIT_INI_ARRAY(&ah->iniMac[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_CORE],
--                              ar9300_2p2_mac_core,
--                              ARRAY_SIZE(ar9300_2p2_mac_core), 2);
-+                              ar9300_2p2_mac_core);
-               INIT_INI_ARRAY(&ah->iniMac[ATH_INI_POST],
--                              ar9300_2p2_mac_postamble,
--                              ARRAY_SIZE(ar9300_2p2_mac_postamble), 5);
-+                              ar9300_2p2_mac_postamble);
-               /* bb */
--              INIT_INI_ARRAY(&ah->iniBB[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_CORE],
--                              ar9300_2p2_baseband_core,
--                              ARRAY_SIZE(ar9300_2p2_baseband_core), 2);
-+                              ar9300_2p2_baseband_core);
-               INIT_INI_ARRAY(&ah->iniBB[ATH_INI_POST],
--                              ar9300_2p2_baseband_postamble,
--                              ARRAY_SIZE(ar9300_2p2_baseband_postamble), 5);
-+                              ar9300_2p2_baseband_postamble);
-               /* radio */
--              INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_PRE], NULL, 0, 0);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_CORE],
--                              ar9300_2p2_radio_core,
--                              ARRAY_SIZE(ar9300_2p2_radio_core), 2);
-+                              ar9300_2p2_radio_core);
-               INIT_INI_ARRAY(&ah->iniRadio[ATH_INI_POST],
--                              ar9300_2p2_radio_postamble,
--                              ARRAY_SIZE(ar9300_2p2_radio_postamble), 5);
-+                              ar9300_2p2_radio_postamble);
-               /* soc */
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_PRE],
--                              ar9300_2p2_soc_preamble,
--                              ARRAY_SIZE(ar9300_2p2_soc_preamble), 2);
--              INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_CORE], NULL, 0, 0);
-+                              ar9300_2p2_soc_preamble);
-               INIT_INI_ARRAY(&ah->iniSOC[ATH_INI_POST],
--                              ar9300_2p2_soc_postamble,
--                              ARRAY_SIZE(ar9300_2p2_soc_postamble), 5);
-+                              ar9300_2p2_soc_postamble);
-               /* rx/tx gain */
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9300Common_rx_gain_table_2p2,
--                              ARRAY_SIZE(ar9300Common_rx_gain_table_2p2), 2);
-+                              ar9300Common_rx_gain_table_2p2);
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                              ar9300Modes_lowest_ob_db_tx_gain_table_2p2,
--                              ARRAY_SIZE(ar9300Modes_lowest_ob_db_tx_gain_table_2p2),
--                              5);
-+                              ar9300Modes_lowest_ob_db_tx_gain_table_2p2);
-               /* Load PCIE SERDES settings from INI */
-               /* Awake Setting */
-               INIT_INI_ARRAY(&ah->iniPcieSerdes,
--                              ar9300PciePhy_pll_on_clkreq_disable_L1_2p2,
--                              ARRAY_SIZE(ar9300PciePhy_pll_on_clkreq_disable_L1_2p2),
--                              2);
-+                              ar9300PciePhy_pll_on_clkreq_disable_L1_2p2);
-               /* Sleep Setting */
-               INIT_INI_ARRAY(&ah->iniPcieSerdesLowPower,
--                              ar9300PciePhy_pll_on_clkreq_disable_L1_2p2,
--                              ARRAY_SIZE(ar9300PciePhy_pll_on_clkreq_disable_L1_2p2),
--                              2);
-+                              ar9300PciePhy_pll_on_clkreq_disable_L1_2p2);
-               /* Fast clock modal settings */
-               INIT_INI_ARRAY(&ah->iniModesFastClock,
--                              ar9300Modes_fast_clock_2p2,
--                              ARRAY_SIZE(ar9300Modes_fast_clock_2p2),
--                              3);
-+                              ar9300Modes_fast_clock_2p2);
+       cmd->role_id = wlvif->role_id;
+-      cmd->channel = ch_switch->channel->hw_value;
++      cmd->channel = ch_switch->chandef.chan->hw_value;
+       cmd->switch_time = ch_switch->count;
+       cmd->stop_tx = ch_switch->block_tx;
+-      switch (ch_switch->channel->band) {
++      switch (ch_switch->chandef.chan->band) {
+       case IEEE80211_BAND_2GHZ:
+               cmd->band = WLCORE_BAND_2_4GHZ;
+               break;
+@@ -55,7 +55,7 @@ int wl18xx_cmd_channel_switch(struct wl1
+               break;
+       default:
+               wl1271_error("invalid channel switch band: %d",
+-                           ch_switch->channel->band);
++                           ch_switch->chandef.chan->band);
+               ret = -EINVAL;
+               goto out_free;
        }
- }
+--- a/include/linux/ieee80211.h
++++ b/include/linux/ieee80211.h
+@@ -673,6 +673,36 @@ struct ieee80211_channel_sw_ie {
+ } __packed;
  
-@@ -507,156 +355,110 @@ static void ar9003_tx_gain_table_mode0(s
- {
-       if (AR_SREV_9330_12(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_lowest_ob_db_tx_gain_1p2,
--                      ARRAY_SIZE(ar9331_modes_lowest_ob_db_tx_gain_1p2),
--                      5);
-+                      ar9331_modes_lowest_ob_db_tx_gain_1p2);
-       else if (AR_SREV_9330_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_lowest_ob_db_tx_gain_1p1,
--                      ARRAY_SIZE(ar9331_modes_lowest_ob_db_tx_gain_1p1),
--                      5);
-+                      ar9331_modes_lowest_ob_db_tx_gain_1p1);
-       else if (AR_SREV_9340(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9340Modes_lowest_ob_db_tx_gain_table_1p0,
--                      ARRAY_SIZE(ar9340Modes_lowest_ob_db_tx_gain_table_1p0),
--                      5);
-+                      ar9340Modes_lowest_ob_db_tx_gain_table_1p0);
-       else if (AR_SREV_9485_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9485_modes_lowest_ob_db_tx_gain_1_1,
--                      ARRAY_SIZE(ar9485_modes_lowest_ob_db_tx_gain_1_1),
--                      5);
-+                      ar9485_modes_lowest_ob_db_tx_gain_1_1);
-       else if (AR_SREV_9550(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar955x_1p0_modes_xpa_tx_gain_table,
--                      ARRAY_SIZE(ar955x_1p0_modes_xpa_tx_gain_table),
--                      9);
-+                      ar955x_1p0_modes_xpa_tx_gain_table);
-       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);
-+                      ar9580_1p0_lowest_ob_db_tx_gain_table);
-       else if (AR_SREV_9462_20(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9462_modes_low_ob_db_tx_gain_table_2p0,
--                      ARRAY_SIZE(ar9462_modes_low_ob_db_tx_gain_table_2p0),
--                      5);
-+                      ar9462_modes_low_ob_db_tx_gain_table_2p0);
-       else
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9300Modes_lowest_ob_db_tx_gain_table_2p2,
--                      ARRAY_SIZE(ar9300Modes_lowest_ob_db_tx_gain_table_2p2),
--                      5);
-+                      ar9300Modes_lowest_ob_db_tx_gain_table_2p2);
- }
+ /**
++ * struct ieee80211_ext_chansw_ie
++ *
++ * This structure represents the "Extended Channel Switch Announcement element"
++ */
++struct ieee80211_ext_chansw_ie {
++      u8 mode;
++      u8 new_operating_class;
++      u8 new_ch_num;
++      u8 count;
++} __packed;
++
++/**
++ * struct ieee80211_sec_chan_offs_ie - secondary channel offset IE
++ * @sec_chan_offs: secondary channel offset, uses IEEE80211_HT_PARAM_CHA_SEC_*
++ *    values here
++ * This structure represents the "Secondary Channel Offset element"
++ */
++struct ieee80211_sec_chan_offs_ie {
++      u8 sec_chan_offs;
++} __packed;
++
++/**
++ * struct ieee80211_wide_bw_chansw_ie - wide bandwidth channel switch IE
++ */
++struct ieee80211_wide_bw_chansw_ie {
++      u8 new_channel_width;
++      u8 new_center_freq_seg0, new_center_freq_seg1;
++} __packed;
++
++/**
+  * struct ieee80211_tim
+  *
+  * This structure refers to "Traffic Indication Map information element"
+@@ -840,12 +870,15 @@ struct ieee80211_mgmt {
+                               } __packed wme_action;
+                               struct{
+                                       u8 action_code;
+-                                      u8 element_id;
+-                                      u8 length;
+-                                      struct ieee80211_channel_sw_ie sw_elem;
++                                      u8 variable[0];
+                               } __packed chan_switch;
+                               struct{
+                                       u8 action_code;
++                                      struct ieee80211_ext_chansw_ie data;
++                                      u8 variable[0];
++                              } __packed ext_chan_switch;
++                              struct{
++                                      u8 action_code;
+                                       u8 dialog_token;
+                                       u8 element_id;
+                                       u8 length;
+@@ -1638,6 +1671,7 @@ enum ieee80211_eid {
+       WLAN_EID_HT_CAPABILITY = 45,
+       WLAN_EID_HT_OPERATION = 61,
++      WLAN_EID_SECONDARY_CHANNEL_OFFSET = 62,
+       WLAN_EID_RSN = 48,
+       WLAN_EID_MMIE = 76,
+@@ -1672,6 +1706,8 @@ enum ieee80211_eid {
+       WLAN_EID_VHT_CAPABILITY = 191,
+       WLAN_EID_VHT_OPERATION = 192,
+       WLAN_EID_OPMODE_NOTIF = 199,
++      WLAN_EID_WIDE_BW_CHANNEL_SWITCH = 194,
++      WLAN_EID_CHANNEL_SWITCH_WRAPPER = 196,
+       /* 802.11ad */
+       WLAN_EID_NON_TX_BSSID_CAP =  83,
+@@ -1795,6 +1831,7 @@ enum ieee80211_key_len {
+ /* Public action codes */
+ enum ieee80211_pub_actioncode {
++      WLAN_PUB_ACTION_EXT_CHANSW_ANN = 4,
+       WLAN_PUB_ACTION_TDLS_DISCOVER_RES = 14,
+ };
  
- static void ar9003_tx_gain_table_mode1(struct ath_hw *ah)
- {
-       if (AR_SREV_9330_12(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_high_ob_db_tx_gain_1p2,
--                      ARRAY_SIZE(ar9331_modes_high_ob_db_tx_gain_1p2),
--                      5);
-+                      ar9331_modes_high_ob_db_tx_gain_1p2);
-       else if (AR_SREV_9330_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_high_ob_db_tx_gain_1p1,
--                      ARRAY_SIZE(ar9331_modes_high_ob_db_tx_gain_1p1),
--                      5);
-+                      ar9331_modes_high_ob_db_tx_gain_1p1);
-       else if (AR_SREV_9340(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9340Modes_lowest_ob_db_tx_gain_table_1p0,
--                      ARRAY_SIZE(ar9340Modes_lowest_ob_db_tx_gain_table_1p0),
--                      5);
-+                      ar9340Modes_high_ob_db_tx_gain_table_1p0);
-       else if (AR_SREV_9485_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9485Modes_high_ob_db_tx_gain_1_1,
--                      ARRAY_SIZE(ar9485Modes_high_ob_db_tx_gain_1_1),
--                      5);
-+                      ar9485Modes_high_ob_db_tx_gain_1_1);
-       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);
-+                      ar9580_1p0_high_ob_db_tx_gain_table);
-       else if (AR_SREV_9550(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar955x_1p0_modes_no_xpa_tx_gain_table,
--                      ARRAY_SIZE(ar955x_1p0_modes_no_xpa_tx_gain_table),
--                      9);
-+                      ar955x_1p0_modes_no_xpa_tx_gain_table);
-       else if (AR_SREV_9462_20(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9462_modes_high_ob_db_tx_gain_table_2p0,
--                      ARRAY_SIZE(ar9462_modes_high_ob_db_tx_gain_table_2p0),
--                      5);
-+                      ar9462_modes_high_ob_db_tx_gain_table_2p0);
-       else
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9300Modes_high_ob_db_tx_gain_table_2p2,
--                      ARRAY_SIZE(ar9300Modes_high_ob_db_tx_gain_table_2p2),
--                      5);
-+                      ar9300Modes_high_ob_db_tx_gain_table_2p2);
- }
+--- a/include/net/cfg80211.h
++++ b/include/net/cfg80211.h
+@@ -753,6 +753,8 @@ int cfg80211_check_station_change(struct
+  * @STATION_INFO_LOCAL_PM: @local_pm filled
+  * @STATION_INFO_PEER_PM: @peer_pm filled
+  * @STATION_INFO_NONPEER_PM: @nonpeer_pm filled
++ * @STATION_INFO_CHAIN_SIGNAL: @chain_signal filled
++ * @STATION_INFO_CHAIN_SIGNAL_AVG: @chain_signal_avg filled
+  */
+ enum station_info_flags {
+       STATION_INFO_INACTIVE_TIME      = 1<<0,
+@@ -781,6 +783,8 @@ enum station_info_flags {
+       STATION_INFO_NONPEER_PM         = 1<<23,
+       STATION_INFO_RX_BYTES64         = 1<<24,
+       STATION_INFO_TX_BYTES64         = 1<<25,
++      STATION_INFO_CHAIN_SIGNAL       = 1<<26,
++      STATION_INFO_CHAIN_SIGNAL_AVG   = 1<<27,
+ };
  
- static void ar9003_tx_gain_table_mode2(struct ath_hw *ah)
- {
-       if (AR_SREV_9330_12(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_low_ob_db_tx_gain_1p2,
--                      ARRAY_SIZE(ar9331_modes_low_ob_db_tx_gain_1p2),
--                      5);
-+                      ar9331_modes_low_ob_db_tx_gain_1p2);
-       else if (AR_SREV_9330_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_low_ob_db_tx_gain_1p1,
--                      ARRAY_SIZE(ar9331_modes_low_ob_db_tx_gain_1p1),
--                      5);
-+                      ar9331_modes_low_ob_db_tx_gain_1p1);
-       else if (AR_SREV_9340(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9340Modes_lowest_ob_db_tx_gain_table_1p0,
--                      ARRAY_SIZE(ar9340Modes_lowest_ob_db_tx_gain_table_1p0),
--                      5);
-+                      ar9340Modes_low_ob_db_tx_gain_table_1p0);
-       else if (AR_SREV_9485_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9485Modes_low_ob_db_tx_gain_1_1,
--                      ARRAY_SIZE(ar9485Modes_low_ob_db_tx_gain_1_1),
--                      5);
-+                      ar9485Modes_low_ob_db_tx_gain_1_1);
-       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);
-+                      ar9580_1p0_low_ob_db_tx_gain_table);
-       else
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9300Modes_low_ob_db_tx_gain_table_2p2,
--                      ARRAY_SIZE(ar9300Modes_low_ob_db_tx_gain_table_2p2),
--                      5);
-+                      ar9300Modes_low_ob_db_tx_gain_table_2p2);
- }
+ /**
+@@ -857,6 +861,8 @@ struct sta_bss_parameters {
+       u16 beacon_interval;
+ };
  
- static void ar9003_tx_gain_table_mode3(struct ath_hw *ah)
- {
-       if (AR_SREV_9330_12(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_high_power_tx_gain_1p2,
--                      ARRAY_SIZE(ar9331_modes_high_power_tx_gain_1p2),
--                      5);
-+                      ar9331_modes_high_power_tx_gain_1p2);
-       else if (AR_SREV_9330_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9331_modes_high_power_tx_gain_1p1,
--                      ARRAY_SIZE(ar9331_modes_high_power_tx_gain_1p1),
--                      5);
-+                      ar9331_modes_high_power_tx_gain_1p1);
-       else if (AR_SREV_9340(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9340Modes_lowest_ob_db_tx_gain_table_1p0,
--                      ARRAY_SIZE(ar9340Modes_lowest_ob_db_tx_gain_table_1p0),
--                      5);
-+                      ar9340Modes_high_power_tx_gain_table_1p0);
-       else if (AR_SREV_9485_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9485Modes_high_power_tx_gain_1_1,
--                      ARRAY_SIZE(ar9485Modes_high_power_tx_gain_1_1),
--                      5);
-+                      ar9485Modes_high_power_tx_gain_1_1);
-       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);
-+                      ar9580_1p0_high_power_tx_gain_table);
-       else
-               INIT_INI_ARRAY(&ah->iniModesTxGain,
--                      ar9300Modes_high_power_tx_gain_table_2p2,
--                      ARRAY_SIZE(ar9300Modes_high_power_tx_gain_table_2p2),
--                      5);
-+                      ar9300Modes_high_power_tx_gain_table_2p2);
-+}
++#define IEEE80211_MAX_CHAINS  4
 +
-+static void ar9003_tx_gain_table_mode4(struct ath_hw *ah)
-+{
-+      if (AR_SREV_9340(ah))
-+              INIT_INI_ARRAY(&ah->iniModesTxGain,
-+                      ar9340Modes_mixed_ob_db_tx_gain_table_1p0);
-+      else if (AR_SREV_9580(ah))
-+              INIT_INI_ARRAY(&ah->iniModesTxGain,
-+                      ar9580_1p0_mixed_ob_db_tx_gain_table);
- }
- static void ar9003_tx_gain_table_apply(struct ath_hw *ah)
-@@ -675,6 +477,9 @@ static void ar9003_tx_gain_table_apply(s
-       case 3:
-               ar9003_tx_gain_table_mode3(ah);
-               break;
-+      case 4:
-+              ar9003_tx_gain_table_mode4(ah);
-+              break;
-       }
- }
+ /**
+  * struct station_info - station information
+  *
+@@ -874,6 +880,9 @@ struct sta_bss_parameters {
+  *    For CFG80211_SIGNAL_TYPE_MBM, value is expressed in _dBm_.
+  * @signal_avg: Average signal strength, type depends on the wiphy's signal_type.
+  *    For CFG80211_SIGNAL_TYPE_MBM, value is expressed in _dBm_.
++ * @chains: bitmask for filled values in @chain_signal, @chain_signal_avg
++ * @chain_signal: per-chain signal strength of last received packet in dBm
++ * @chain_signal_avg: per-chain signal strength average in dBm
+  * @txrate: current unicast bitrate from this station
+  * @rxrate: current unicast bitrate to this station
+  * @rx_packets: packets received from this station
+@@ -909,6 +918,11 @@ struct station_info {
+       u8 plink_state;
+       s8 signal;
+       s8 signal_avg;
++
++      u8 chains;
++      s8 chain_signal[IEEE80211_MAX_CHAINS];
++      s8 chain_signal_avg[IEEE80211_MAX_CHAINS];
++
+       struct rate_info txrate;
+       struct rate_info rxrate;
+       u32 rx_packets;
+@@ -954,6 +968,7 @@ enum monitor_flags {
+       MONITOR_FLAG_CONTROL            = 1<<NL80211_MNTR_FLAG_CONTROL,
+       MONITOR_FLAG_OTHER_BSS          = 1<<NL80211_MNTR_FLAG_OTHER_BSS,
+       MONITOR_FLAG_COOK_FRAMES        = 1<<NL80211_MNTR_FLAG_COOK_FRAMES,
++      MONITOR_FLAG_ACTIVE             = 1<<NL80211_MNTR_FLAG_ACTIVE,
+ };
  
-@@ -682,104 +487,67 @@ static void ar9003_rx_gain_table_mode0(s
- {
-       if (AR_SREV_9330_12(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9331_common_rx_gain_1p2,
--                              ARRAY_SIZE(ar9331_common_rx_gain_1p2),
--                              2);
-+                              ar9331_common_rx_gain_1p2);
-       else if (AR_SREV_9330_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9331_common_rx_gain_1p1,
--                              ARRAY_SIZE(ar9331_common_rx_gain_1p1),
--                              2);
-+                              ar9331_common_rx_gain_1p1);
-       else if (AR_SREV_9340(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9340Common_rx_gain_table_1p0,
--                              ARRAY_SIZE(ar9340Common_rx_gain_table_1p0),
--                              2);
-+                              ar9340Common_rx_gain_table_1p0);
-       else if (AR_SREV_9485_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9485Common_wo_xlna_rx_gain_1_1,
--                              ARRAY_SIZE(ar9485Common_wo_xlna_rx_gain_1_1),
--                              2);
-+                              ar9485Common_wo_xlna_rx_gain_1_1);
-       else if (AR_SREV_9550(ah)) {
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar955x_1p0_common_rx_gain_table,
--                              ARRAY_SIZE(ar955x_1p0_common_rx_gain_table),
--                              2);
-+                              ar955x_1p0_common_rx_gain_table);
-               INIT_INI_ARRAY(&ah->ini_modes_rx_gain_bounds,
--                              ar955x_1p0_common_rx_gain_bounds,
--                              ARRAY_SIZE(ar955x_1p0_common_rx_gain_bounds),
--                              5);
-+                              ar955x_1p0_common_rx_gain_bounds);
-       } else if (AR_SREV_9580(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9580_1p0_rx_gain_table,
--                              ARRAY_SIZE(ar9580_1p0_rx_gain_table),
--                              2);
-+                              ar9580_1p0_rx_gain_table);
-       else if (AR_SREV_9462_20(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9462_common_rx_gain_table_2p0,
--                              ARRAY_SIZE(ar9462_common_rx_gain_table_2p0),
--                              2);
-+                              ar9462_common_rx_gain_table_2p0);
-       else
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                              ar9300Common_rx_gain_table_2p2,
--                              ARRAY_SIZE(ar9300Common_rx_gain_table_2p2),
--                              2);
-+                              ar9300Common_rx_gain_table_2p2);
- }
+ /**
+@@ -4027,6 +4042,17 @@ bool cfg80211_reg_can_beacon(struct wiph
+ void cfg80211_ch_switch_notify(struct net_device *dev,
+                              struct cfg80211_chan_def *chandef);
  
- static void ar9003_rx_gain_table_mode1(struct ath_hw *ah)
++/**
++ * ieee80211_operating_class_to_band - convert operating class to band
++ *
++ * @operating_class: the operating class to convert
++ * @band: band pointer to fill
++ *
++ * Returns %true if the conversion was successful, %false otherwise.
++ */
++bool ieee80211_operating_class_to_band(u8 operating_class,
++                                     enum ieee80211_band *band);
++
+ /*
+  * cfg80211_tdls_oper_request - request userspace to perform TDLS operation
+  * @dev: the device on which the operation is requested
+--- a/include/net/mac80211.h
++++ b/include/net/mac80211.h
+@@ -210,7 +210,7 @@ struct ieee80211_chanctx_conf {
+  * @BSS_CHANGED_QOS: QoS for this association was enabled/disabled. Note
+  *    that it is only ever disabled for station mode.
+  * @BSS_CHANGED_IDLE: Idle changed for this BSS/interface.
+- * @BSS_CHANGED_SSID: SSID changed for this BSS (AP mode)
++ * @BSS_CHANGED_SSID: SSID changed for this BSS (AP and IBSS mode)
+  * @BSS_CHANGED_AP_PROBE_RESP: Probe Response changed for this BSS (AP mode)
+  * @BSS_CHANGED_PS: PS changed for this BSS (STA mode)
+  * @BSS_CHANGED_TXPOWER: TX power setting changed for this interface
+@@ -327,7 +327,7 @@ enum ieee80211_rssi_event {
+  *    your driver/device needs to do.
+  * @ps: power-save mode (STA only). This flag is NOT affected by
+  *    offchannel/dynamic_ps operations.
+- * @ssid: The SSID of the current vif. Only valid in AP-mode.
++ * @ssid: The SSID of the current vif. Valid in AP and IBSS mode.
+  * @ssid_len: Length of SSID given in @ssid.
+  * @hidden_ssid: The SSID of the current vif is hidden. Only valid in AP-mode.
+  * @txpower: TX power in dBm
+@@ -562,6 +562,9 @@ enum mac80211_rate_control_flags {
+ /* maximum number of rate stages */
+ #define IEEE80211_TX_MAX_RATES        4
++/* maximum number of rate table entries */
++#define IEEE80211_TX_RATE_TABLE_SIZE  4
++
+ /**
+  * struct ieee80211_tx_rate - rate selection/status
+  *
+@@ -602,8 +605,8 @@ static inline void ieee80211_rate_set_vh
+                                         u8 mcs, u8 nss)
  {
-       if (AR_SREV_9330_12(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9331_common_wo_xlna_rx_gain_1p2,
--                      ARRAY_SIZE(ar9331_common_wo_xlna_rx_gain_1p2),
--                      2);
-+                      ar9331_common_wo_xlna_rx_gain_1p2);
-       else if (AR_SREV_9330_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9331_common_wo_xlna_rx_gain_1p1,
--                      ARRAY_SIZE(ar9331_common_wo_xlna_rx_gain_1p1),
--                      2);
-+                      ar9331_common_wo_xlna_rx_gain_1p1);
-       else if (AR_SREV_9340(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9340Common_wo_xlna_rx_gain_table_1p0,
--                      ARRAY_SIZE(ar9340Common_wo_xlna_rx_gain_table_1p0),
--                      2);
-+                      ar9340Common_wo_xlna_rx_gain_table_1p0);
-       else if (AR_SREV_9485_11(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9485Common_wo_xlna_rx_gain_1_1,
--                      ARRAY_SIZE(ar9485Common_wo_xlna_rx_gain_1_1),
--                      2);
-+                      ar9485Common_wo_xlna_rx_gain_1_1);
-       else if (AR_SREV_9462_20(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9462_common_wo_xlna_rx_gain_table_2p0,
--                      ARRAY_SIZE(ar9462_common_wo_xlna_rx_gain_table_2p0),
--                      2);
-+                      ar9462_common_wo_xlna_rx_gain_table_2p0);
-       else if (AR_SREV_9550(ah)) {
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar955x_1p0_common_wo_xlna_rx_gain_table,
--                      ARRAY_SIZE(ar955x_1p0_common_wo_xlna_rx_gain_table),
--                      2);
-+                      ar955x_1p0_common_wo_xlna_rx_gain_table);
-               INIT_INI_ARRAY(&ah->ini_modes_rx_gain_bounds,
--                      ar955x_1p0_common_wo_xlna_rx_gain_bounds,
--                      ARRAY_SIZE(ar955x_1p0_common_wo_xlna_rx_gain_bounds),
--                      5);
-+                      ar955x_1p0_common_wo_xlna_rx_gain_bounds);
-       } 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);
-+                      ar9580_1p0_wo_xlna_rx_gain_table);
-       else
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                      ar9300Common_wo_xlna_rx_gain_table_2p2,
--                      ARRAY_SIZE(ar9300Common_wo_xlna_rx_gain_table_2p2),
--                      2);
-+                      ar9300Common_wo_xlna_rx_gain_table_2p2);
+       WARN_ON(mcs & ~0xF);
+-      WARN_ON(nss & ~0x7);
+-      rate->idx = (nss << 4) | mcs;
++      WARN_ON((nss - 1) & ~0x7);
++      rate->idx = ((nss - 1) << 4) | mcs;
  }
  
- static void ar9003_rx_gain_table_mode2(struct ath_hw *ah)
+ static inline u8
+@@ -615,7 +618,7 @@ ieee80211_rate_get_vht_mcs(const struct 
+ static inline u8
+ ieee80211_rate_get_vht_nss(const struct ieee80211_tx_rate *rate)
  {
-       if (AR_SREV_9462_20(ah))
-               INIT_INI_ARRAY(&ah->iniModesRxGain,
--                             ar9462_common_mixed_rx_gain_table_2p0,
--                             ARRAY_SIZE(ar9462_common_mixed_rx_gain_table_2p0), 2);
-+                             ar9462_common_mixed_rx_gain_table_2p0);
+-      return rate->idx >> 4;
++      return (rate->idx >> 4) + 1;
  }
  
- static void ar9003_rx_gain_table_apply(struct ath_hw *ah)
---- a/drivers/net/wireless/ath/ath9k/ar9003_phy.c
-+++ b/drivers/net/wireless/ath/ath9k/ar9003_phy.c
-@@ -117,8 +117,8 @@ static int ar9003_hw_set_channel(struct 
-                   ah->is_clk_25mhz) {
-                       u32 chan_frac;
--                      channelSel = (freq * 2) / 75;
--                      chan_frac = (((freq * 2) % 75) * 0x20000) / 75;
-+                      channelSel = freq / 75;
-+                      chan_frac = ((freq % 75) * 0x20000) / 75;
-                       channelSel = (channelSel << 17) | chan_frac;
-               } else {
-                       channelSel = CHANSEL_5G(freq);
---- a/drivers/net/wireless/ath/ath9k/ar9003_phy.h
-+++ b/drivers/net/wireless/ath/ath9k/ar9003_phy.h
-@@ -633,6 +633,8 @@
- #define AR_PHY_65NM_CH0_BIAS2       0x160c4
- #define AR_PHY_65NM_CH0_BIAS4       0x160cc
- #define AR_PHY_65NM_CH0_RXTX4       0x1610c
-+#define AR_PHY_65NM_CH1_RXTX4       0x1650c
-+#define AR_PHY_65NM_CH2_RXTX4       0x1690c
- #define AR_CH0_TOP    (AR_SREV_9300(ah) ? 0x16288 : \
-                               ((AR_SREV_9462(ah) ? 0x1628c : 0x16280)))
-@@ -876,6 +878,9 @@
- #define AR_PHY_65NM_CH0_RXTX4_THERM_ON          0x10000000
- #define AR_PHY_65NM_CH0_RXTX4_THERM_ON_S        28
-+#define AR_PHY_65NM_RXTX4_XLNA_BIAS           0xC0000000
-+#define AR_PHY_65NM_RXTX4_XLNA_BIAS_S         30
+ /**
+@@ -656,7 +659,11 @@ struct ieee80211_tx_info {
+                                       struct ieee80211_tx_rate rates[
+                                               IEEE80211_TX_MAX_RATES];
+                                       s8 rts_cts_rate_idx;
+-                                      /* 3 bytes free */
++                                      u8 use_rts:1;
++                                      u8 use_cts_prot:1;
++                                      u8 short_preamble:1;
++                                      u8 skip_table:1;
++                                      /* 2 bytes free */
+                               };
+                               /* only needed before rate control */
+                               unsigned long jiffies;
+@@ -677,6 +684,8 @@ struct ieee80211_tx_info {
+               struct {
+                       struct ieee80211_tx_rate driver_rates[
+                               IEEE80211_TX_MAX_RATES];
++                      u8 pad[4];
 +
- /*
-  * Channel 1 Register Map
+                       void *rate_driver_data[
+                               IEEE80211_TX_INFO_RATE_DRIVER_DATA_SIZE / sizeof(void *)];
+               };
+@@ -840,6 +849,9 @@ enum mac80211_rx_flags {
+  * @signal: signal strength when receiving this frame, either in dBm, in dB or
+  *    unspecified depending on the hardware capabilities flags
+  *    @IEEE80211_HW_SIGNAL_*
++ * @chains: bitmask of receive chains for which separate signal strength
++ *    values were filled.
++ * @chain_signal: per-chain signal strength, same format as @signal
+  * @antenna: antenna used
+  * @rate_idx: index of data rate into band's supported rates or MCS index if
+  *    HT or VHT is used (%RX_FLAG_HT/%RX_FLAG_VHT)
+@@ -871,6 +883,8 @@ struct ieee80211_rx_status {
+       u8 band;
+       u8 antenna;
+       s8 signal;
++      u8 chains;
++      s8 chain_signal[IEEE80211_MAX_CHAINS];
+       u8 ampdu_delimiter_crc;
+       u8 vendor_radiotap_align;
+       u8 vendor_radiotap_oui[3];
+@@ -1018,13 +1032,13 @@ struct ieee80211_conf {
+  *    the driver passed into mac80211.
+  * @block_tx: Indicates whether transmission must be blocked before the
+  *    scheduled channel switch, as indicated by the AP.
+- * @channel: the new channel to switch to
++ * @chandef: the new channel to switch to
+  * @count: the number of TBTT's until the channel switch event
   */
---- a/drivers/net/wireless/ath/ath9k/ath9k.h
-+++ b/drivers/net/wireless/ath/ath9k/ath9k.h
-@@ -297,6 +297,8 @@ struct ath_tx {
-       struct ath_txq txq[ATH9K_NUM_TX_QUEUES];
-       struct ath_descdma txdma;
-       struct ath_txq *txq_map[WME_NUM_AC];
-+      u32 txq_max_pending[WME_NUM_AC];
-+      u16 max_aggr_framelen[WME_NUM_AC][4][32];
+ struct ieee80211_channel_switch {
+       u64 timestamp;
+       bool block_tx;
+-      struct ieee80211_channel *channel;
++      struct cfg80211_chan_def chandef;
+       u8 count;
  };
  
- struct ath_rx_edma {
-@@ -341,6 +343,7 @@ int ath_tx_init(struct ath_softc *sc, in
- void ath_tx_cleanup(struct ath_softc *sc);
- int ath_txq_update(struct ath_softc *sc, int qnum,
-                  struct ath9k_tx_queue_info *q);
-+void ath_update_max_aggr_framelen(struct ath_softc *sc, int queue, int txop);
- int ath_tx_start(struct ieee80211_hw *hw, struct sk_buff *skb,
-                struct ath_tx_control *txctl);
- void ath_tx_tasklet(struct ath_softc *sc);
-@@ -360,7 +363,7 @@ void ath_tx_aggr_sleep(struct ieee80211_
- struct ath_vif {
-       int av_bslot;
--      bool is_bslot_active, primary_sta_vif;
-+      bool primary_sta_vif;
-       __le64 tsf_adjust; /* TSF adjustment for staggered beacons */
-       struct ath_buf *av_bcbuf;
- };
-@@ -386,6 +389,7 @@ struct ath_beacon_config {
-       u16 dtim_period;
-       u16 bmiss_timeout;
-       u8 dtim_count;
-+      bool enable_beacon;
+@@ -1222,6 +1236,24 @@ enum ieee80211_sta_rx_bandwidth {
  };
  
- struct ath_beacon {
-@@ -397,7 +401,6 @@ struct ath_beacon {
-       u32 beaconq;
-       u32 bmisscnt;
--      u32 ast_be_xmit;
-       u32 bc_tstamp;
-       struct ieee80211_vif *bslot[ATH_BCBUF];
-       int slottime;
-@@ -411,12 +414,14 @@ struct ath_beacon {
-       bool tx_last;
+ /**
++ * struct ieee80211_sta_rates - station rate selection table
++ *
++ * @rcu_head: RCU head used for freeing the table on update
++ * @rates: transmit rates/flags to be used by default.
++ *    Overriding entries per-packet is possible by using cb tx control.
++ */
++struct ieee80211_sta_rates {
++      struct rcu_head rcu_head;
++      struct {
++              s8 idx;
++              u8 count;
++              u8 count_cts;
++              u8 count_rts;
++              u16 flags;
++      } rate[IEEE80211_TX_RATE_TABLE_SIZE];
++};
++
++/**
+  * struct ieee80211_sta - station table entry
+  *
+  * A station table entry represents a station we are possibly
+@@ -1248,6 +1280,7 @@ enum ieee80211_sta_rx_bandwidth {
+  *    notifications and capabilities. The value is only valid after
+  *    the station moves to associated state.
+  * @smps_mode: current SMPS mode (off, static or dynamic)
++ * @tx_rates: rate control selection table
+  */
+ struct ieee80211_sta {
+       u32 supp_rates[IEEE80211_NUM_BANDS];
+@@ -1261,6 +1294,7 @@ struct ieee80211_sta {
+       u8 rx_nss;
+       enum ieee80211_sta_rx_bandwidth bandwidth;
+       enum ieee80211_smps_mode smps_mode;
++      struct ieee80211_sta_rates __rcu *rates;
+       /* must be last */
+       u8 drv_priv[0] __aligned(sizeof(void *));
+@@ -1416,6 +1450,9 @@ struct ieee80211_tx_control {
+  *    for different virtual interfaces. See the doc section on HW queue
+  *    control for more details.
+  *
++ * @IEEE80211_HW_SUPPORTS_RC_TABLE: The driver supports using a rate
++ *    selection table provided by the rate control algorithm.
++ *
+  * @IEEE80211_HW_P2P_DEV_ADDR_FOR_INTF: Use the P2P Device address for any
+  *    P2P Interface. This will be honoured even if more than one interface
+  *    is supported.
+@@ -1448,6 +1485,7 @@ enum ieee80211_hw_flags {
+       IEEE80211_HW_SUPPORTS_PER_STA_GTK               = 1<<21,
+       IEEE80211_HW_AP_LINK_PS                         = 1<<22,
+       IEEE80211_HW_TX_AMPDU_SETUP_IN_HW               = 1<<23,
++      IEEE80211_HW_SUPPORTS_RC_TABLE                  = 1<<24,
+       IEEE80211_HW_P2P_DEV_ADDR_FOR_INTF              = 1<<25,
+       IEEE80211_HW_TIMING_BEACON_ONLY                 = 1<<26,
  };
+@@ -3144,6 +3182,25 @@ void ieee80211_sta_set_buffered(struct i
+                               u8 tid, bool buffered);
  
--void ath_beacon_tasklet(unsigned long data);
--void ath_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif);
--int ath_beacon_alloc(struct ath_softc *sc, struct ieee80211_vif *vif);
--void ath_beacon_return(struct ath_softc *sc, struct ath_vif *avp);
--int ath_beaconq_config(struct ath_softc *sc);
--void ath_set_beacon(struct ath_softc *sc);
-+void ath9k_beacon_tasklet(unsigned long data);
-+bool ath9k_allow_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif);
-+void ath9k_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif,
-+                       u32 changed);
-+void ath9k_beacon_assign_slot(struct ath_softc *sc, struct ieee80211_vif *vif);
-+void ath9k_beacon_remove_slot(struct ath_softc *sc, struct ieee80211_vif *vif);
-+void ath9k_set_tsfadjust(struct ath_softc *sc, struct ieee80211_vif *vif);
-+void ath9k_set_beacon(struct ath_softc *sc);
- void ath9k_set_beaconing_status(struct ath_softc *sc, bool status);
- /*******************/
-@@ -442,9 +447,12 @@ void ath_rx_poll(unsigned long data);
- void ath_start_rx_poll(struct ath_softc *sc, u8 nbeacon);
- void ath_paprd_calibrate(struct work_struct *work);
- void ath_ani_calibrate(unsigned long data);
--void ath_start_ani(struct ath_common *common);
-+void ath_start_ani(struct ath_softc *sc);
-+void ath_stop_ani(struct ath_softc *sc);
-+void ath_check_ani(struct ath_softc *sc);
- int ath_update_survey_stats(struct ath_softc *sc);
- void ath_update_survey_nf(struct ath_softc *sc, int channel);
-+void ath9k_queue_reset(struct ath_softc *sc, enum ath_reset_type type);
- /**********/
- /* BTCOEX */
-@@ -619,7 +627,6 @@ enum sc_op_flags {
-       SC_OP_INVALID,
-       SC_OP_BEACONS,
-       SC_OP_RXFLUSH,
--      SC_OP_TSF_RESET,
-       SC_OP_ANI_RUN,
-       SC_OP_PRIM_STA_VIF,
-       SC_OP_HW_RESET,
---- a/drivers/net/wireless/ath/ath9k/beacon.c
-+++ b/drivers/net/wireless/ath/ath9k/beacon.c
-@@ -30,7 +30,7 @@ static void ath9k_reset_beacon_status(st
-  *  the operating mode of the station (AP or AdHoc).  Parameters are AIFS
-  *  settings and channel width min/max
- */
--int ath_beaconq_config(struct ath_softc *sc)
-+static void ath9k_beaconq_config(struct ath_softc *sc)
- {
-       struct ath_hw *ah = sc->sc_ah;
-       struct ath_common *common = ath9k_hw_common(ah);
-@@ -38,6 +38,7 @@ int ath_beaconq_config(struct ath_softc 
-       struct ath_txq *txq;
-       ath9k_hw_get_txq_props(ah, sc->beacon.beaconq, &qi);
+ /**
++ * ieee80211_get_tx_rates - get the selected transmit rates for a packet
++ *
++ * Call this function in a driver with per-packet rate selection support
++ * to combine the rate info in the packet tx info with the most recent
++ * rate selection table for the station entry.
++ *
++ * @vif: &struct ieee80211_vif pointer from the add_interface callback.
++ * @sta: the receiver station to which this packet is sent.
++ * @skb: the frame to be transmitted.
++ * @dest: buffer for extracted rate/retry information
++ * @max_rates: maximum number of rates to fetch
++ */
++void ieee80211_get_tx_rates(struct ieee80211_vif *vif,
++                          struct ieee80211_sta *sta,
++                          struct sk_buff *skb,
++                          struct ieee80211_tx_rate *dest,
++                          int max_rates);
 +
-       if (sc->sc_ah->opmode == NL80211_IFTYPE_AP) {
-               /* Always burst out beacon and CAB traffic. */
-               qi.tqi_aifs = 1;
-@@ -56,12 +57,9 @@ int ath_beaconq_config(struct ath_softc 
-       }
++/**
+  * ieee80211_tx_status - transmit status callback
+  *
+  * Call this function for all transmitted frames after they have been
+@@ -4118,7 +4175,7 @@ void ieee80211_send_bar(struct ieee80211
+  *    (deprecated; this will be removed once drivers get updated to use
+  *    rate_idx_mask)
+  * @rate_idx_mask: user-requested (legacy) rate mask
+- * @rate_idx_mcs_mask: user-requested MCS rate mask
++ * @rate_idx_mcs_mask: user-requested MCS rate mask (NULL if not in use)
+  * @bss: whether this frame is sent out in AP or IBSS mode
+  */
+ struct ieee80211_tx_rate_control {
+@@ -4130,7 +4187,7 @@ struct ieee80211_tx_rate_control {
+       bool rts, short_preamble;
+       u8 max_rate_idx;
+       u32 rate_idx_mask;
+-      u8 rate_idx_mcs_mask[IEEE80211_HT_MCS_MASK_LEN];
++      u8 *rate_idx_mcs_mask;
+       bool bss;
+ };
  
-       if (!ath9k_hw_set_txq_props(ah, sc->beacon.beaconq, &qi)) {
--              ath_err(common,
--                      "Unable to update h/w beacon queue parameters\n");
--              return 0;
-+              ath_err(common, "Unable to update h/w beacon queue parameters\n");
-       } else {
-               ath9k_hw_resettxqueue(ah, sc->beacon.beaconq);
--              return 1;
-       }
+@@ -4219,6 +4276,22 @@ bool rate_usable_index_exists(struct iee
+       return false;
  }
  
-@@ -70,7 +68,7 @@ int ath_beaconq_config(struct ath_softc 
-  *  up rate codes, and channel flags. Beacons are always sent out at the
-  *  lowest rate, and are not retried.
- */
--static void ath_beacon_setup(struct ath_softc *sc, struct ieee80211_vif *vif,
-+static void ath9k_beacon_setup(struct ath_softc *sc, struct ieee80211_vif *vif,
-                            struct ath_buf *bf, int rateidx)
- {
-       struct sk_buff *skb = bf->bf_mpdu;
-@@ -81,8 +79,6 @@ static void ath_beacon_setup(struct ath_
-       u8 chainmask = ah->txchainmask;
-       u8 rate = 0;
++/**
++ * rate_control_set_rates - pass the sta rate selection to mac80211/driver
++ *
++ * When not doing a rate control probe to test rates, rate control should pass
++ * its rate selection to mac80211. If the driver supports receiving a station
++ * rate table, it will use it to ensure that frames are always sent based on
++ * the most recent rate control module decision.
++ *
++ * @hw: pointer as obtained from ieee80211_alloc_hw()
++ * @pubsta: &struct ieee80211_sta pointer to the target destination.
++ * @rates: new tx rate set to be used for this station.
++ */
++int rate_control_set_rates(struct ieee80211_hw *hw,
++                         struct ieee80211_sta *pubsta,
++                         struct ieee80211_sta_rates *rates);
++
+ int ieee80211_rate_control_register(struct rate_control_ops *ops);
+ void ieee80211_rate_control_unregister(struct rate_control_ops *ops);
  
--      ath9k_reset_beacon_status(sc);
--
-       sband = &sc->sbands[common->hw->conf.channel->band];
-       rate = sband->bitrates[rateidx].hw_value;
-       if (vif->bss_conf.use_short_preamble)
-@@ -111,7 +107,7 @@ static void ath_beacon_setup(struct ath_
-       ath9k_hw_set_txdesc(ah, bf->bf_desc, &info);
- }
+--- a/net/mac80211/agg-rx.c
++++ b/net/mac80211/agg-rx.c
+@@ -204,6 +204,8 @@ static void ieee80211_send_addba_resp(st
+               memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
+       else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
+               memcpy(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN);
++      else if (sdata->vif.type == NL80211_IFTYPE_WDS)
++              memcpy(mgmt->bssid, da, ETH_ALEN);
  
--static void ath_tx_cabq(struct ieee80211_hw *hw, struct sk_buff *skb)
-+static void ath9k_tx_cabq(struct ieee80211_hw *hw, struct sk_buff *skb)
- {
-       struct ath_softc *sc = hw->priv;
-       struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-@@ -128,28 +124,22 @@ static void ath_tx_cabq(struct ieee80211
-       }
- }
--static struct ath_buf *ath_beacon_generate(struct ieee80211_hw *hw,
--                                         struct ieee80211_vif *vif)
-+static struct ath_buf *ath9k_beacon_generate(struct ieee80211_hw *hw,
-+                                           struct ieee80211_vif *vif)
- {
-       struct ath_softc *sc = hw->priv;
-       struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-       struct ath_buf *bf;
--      struct ath_vif *avp;
-+      struct ath_vif *avp = (void *)vif->drv_priv;
-       struct sk_buff *skb;
--      struct ath_txq *cabq;
-+      struct ath_txq *cabq = sc->beacon.cabq;
-       struct ieee80211_tx_info *info;
-+      struct ieee80211_mgmt *mgmt_hdr;
-       int cabq_depth;
--      ath9k_reset_beacon_status(sc);
--
--      avp = (void *)vif->drv_priv;
--      cabq = sc->beacon.cabq;
--
--      if ((avp->av_bcbuf == NULL) || !avp->is_bslot_active)
-+      if (avp->av_bcbuf == NULL)
-               return NULL;
+       mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
+                                         IEEE80211_STYPE_ACTION);
+--- a/net/mac80211/agg-tx.c
++++ b/net/mac80211/agg-tx.c
+@@ -81,7 +81,8 @@ static void ieee80211_send_addba_request
+       memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
+       if (sdata->vif.type == NL80211_IFTYPE_AP ||
+           sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
+-          sdata->vif.type == NL80211_IFTYPE_MESH_POINT)
++          sdata->vif.type == NL80211_IFTYPE_MESH_POINT ||
++          sdata->vif.type == NL80211_IFTYPE_WDS)
+               memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
+       else if (sdata->vif.type == NL80211_IFTYPE_STATION)
+               memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
+@@ -527,6 +528,7 @@ int ieee80211_start_tx_ba_session(struct
+           sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
+           sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
+           sdata->vif.type != NL80211_IFTYPE_AP &&
++          sdata->vif.type != NL80211_IFTYPE_WDS &&
+           sdata->vif.type != NL80211_IFTYPE_ADHOC)
+               return -EINVAL;
  
--      /* Release the old beacon first */
--
-       bf = avp->av_bcbuf;
-       skb = bf->bf_mpdu;
-       if (skb) {
-@@ -159,14 +149,14 @@ static struct ath_buf *ath_beacon_genera
-               bf->bf_buf_addr = 0;
-       }
+--- a/net/mac80211/cfg.c
++++ b/net/mac80211/cfg.c
+@@ -73,16 +73,19 @@ static int ieee80211_change_iface(struct
+               struct ieee80211_local *local = sdata->local;
  
--      /* Get a new beacon from mac80211 */
--
-       skb = ieee80211_beacon_get(hw, vif);
--      bf->bf_mpdu = skb;
-       if (skb == NULL)
-               return NULL;
--      ((struct ieee80211_mgmt *)skb->data)->u.beacon.timestamp =
--              avp->tsf_adjust;
-+
-+      bf->bf_mpdu = skb;
+               if (ieee80211_sdata_running(sdata)) {
++                      u32 mask = MONITOR_FLAG_COOK_FRAMES |
++                                 MONITOR_FLAG_ACTIVE;
 +
-+      mgmt_hdr = (struct ieee80211_mgmt *)skb->data;
-+      mgmt_hdr->u.beacon.timestamp = avp->tsf_adjust;
-       info = IEEE80211_SKB_CB(skb);
-       if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) {
-@@ -212,61 +202,52 @@ static struct ath_buf *ath_beacon_genera
-               }
-       }
+                       /*
+-                       * Prohibit MONITOR_FLAG_COOK_FRAMES to be
+-                       * changed while the interface is up.
++                       * Prohibit MONITOR_FLAG_COOK_FRAMES and
++                       * MONITOR_FLAG_ACTIVE to be changed while the
++                       * interface is up.
+                        * Else we would need to add a lot of cruft
+                        * to update everything:
+                        *      cooked_mntrs, monitor and all fif_* counters
+                        *      reconfigure hardware
+                        */
+-                      if ((*flags & MONITOR_FLAG_COOK_FRAMES) !=
+-                          (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES))
++                      if ((*flags & mask) != (sdata->u.mntr_flags & mask))
+                               return -EBUSY;
+                       ieee80211_adjust_monitor_flags(sdata, -1);
+@@ -444,7 +447,7 @@ static void sta_set_sinfo(struct sta_inf
+       struct ieee80211_local *local = sdata->local;
+       struct timespec uptime;
+       u64 packets = 0;
+-      int ac;
++      int i, ac;
  
--      ath_beacon_setup(sc, vif, bf, info->control.rates[0].idx);
-+      ath9k_beacon_setup(sc, vif, bf, info->control.rates[0].idx);
+       sinfo->generation = sdata->local->sta_generation;
  
-       while (skb) {
--              ath_tx_cabq(hw, skb);
-+              ath9k_tx_cabq(hw, skb);
-               skb = ieee80211_get_buffered_bc(hw, vif);
+@@ -488,6 +491,17 @@ static void sta_set_sinfo(struct sta_inf
+                       sinfo->signal = (s8)sta->last_signal;
+               sinfo->signal_avg = (s8) -ewma_read(&sta->avg_signal);
        }
++      if (sta->chains) {
++              sinfo->filled |= STATION_INFO_CHAIN_SIGNAL |
++                               STATION_INFO_CHAIN_SIGNAL_AVG;
++
++              sinfo->chains = sta->chains;
++              for (i = 0; i < ARRAY_SIZE(sinfo->chain_signal); i++) {
++                      sinfo->chain_signal[i] = sta->chain_signal_last[i];
++                      sinfo->chain_signal_avg[i] =
++                              (s8) -ewma_read(&sta->chain_signal_avg[i]);
++              }
++      }
  
-       return bf;
- }
+       sta_set_rate_info_tx(sta, &sta->last_tx_rate, &sinfo->txrate);
+       sta_set_rate_info_rx(sta, &sinfo->rxrate);
+@@ -1052,6 +1066,7 @@ static int ieee80211_stop_ap(struct wiph
+       ieee80211_free_keys(sdata);
  
--int ath_beacon_alloc(struct ath_softc *sc, struct ieee80211_vif *vif)
-+void ath9k_beacon_assign_slot(struct ath_softc *sc, struct ieee80211_vif *vif)
- {
-       struct ath_common *common = ath9k_hw_common(sc->sc_ah);
--      struct ath_vif *avp;
--      struct ath_buf *bf;
--      struct sk_buff *skb;
--      struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
--      __le64 tstamp;
-+      struct ath_vif *avp = (void *)vif->drv_priv;
-+      int slot;
--      avp = (void *)vif->drv_priv;
-+      avp->av_bcbuf = list_first_entry(&sc->beacon.bbuf, struct ath_buf, list);
-+      list_del(&avp->av_bcbuf->list);
--      /* Allocate a beacon descriptor if we haven't done so. */
--      if (!avp->av_bcbuf) {
--              /* Allocate beacon state for hostap/ibss.  We know
--               * a buffer is available. */
--              avp->av_bcbuf = list_first_entry(&sc->beacon.bbuf,
--                                               struct ath_buf, list);
--              list_del(&avp->av_bcbuf->list);
--
--              if (ath9k_uses_beacons(vif->type)) {
--                      int slot;
--                      /*
--                       * Assign the vif to a beacon xmit slot. As
--                       * above, this cannot fail to find one.
--                       */
--                      avp->av_bslot = 0;
--                      for (slot = 0; slot < ATH_BCBUF; slot++)
--                              if (sc->beacon.bslot[slot] == NULL) {
--                                      avp->av_bslot = slot;
--                                      avp->is_bslot_active = false;
--
--                                      /* NB: keep looking for a double slot */
--                                      if (slot == 0 || !sc->beacon.bslot[slot-1])
--                                              break;
--                              }
--                      BUG_ON(sc->beacon.bslot[avp->av_bslot] != NULL);
--                      sc->beacon.bslot[avp->av_bslot] = vif;
--                      sc->nbcnvifs++;
-+      for (slot = 0; slot < ATH_BCBUF; slot++) {
-+              if (sc->beacon.bslot[slot] == NULL) {
-+                      avp->av_bslot = slot;
-+                      break;
-               }
+       sdata->vif.bss_conf.enable_beacon = false;
++      sdata->vif.bss_conf.ssid_len = 0;
+       clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state);
+       ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
+@@ -2416,9 +2431,22 @@ static int ieee80211_set_bitrate_mask(st
        }
  
--      /* release the previous beacon frame, if it already exists. */
--      bf = avp->av_bcbuf;
--      if (bf->bf_mpdu != NULL) {
--              skb = bf->bf_mpdu;
-+      sc->beacon.bslot[avp->av_bslot] = vif;
-+      sc->nbcnvifs++;
-+
-+      ath_dbg(common, CONFIG, "Added interface at beacon slot: %d\n",
-+              avp->av_bslot);
-+}
-+
-+void ath9k_beacon_remove_slot(struct ath_softc *sc, struct ieee80211_vif *vif)
-+{
-+      struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-+      struct ath_vif *avp = (void *)vif->drv_priv;
-+      struct ath_buf *bf = avp->av_bcbuf;
+       for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
++              struct ieee80211_supported_band *sband = wiphy->bands[i];
++              int j;
 +
-+      ath_dbg(common, CONFIG, "Removing interface at beacon slot: %d\n",
-+              avp->av_bslot);
+               sdata->rc_rateidx_mask[i] = mask->control[i].legacy;
+               memcpy(sdata->rc_rateidx_mcs_mask[i], mask->control[i].mcs,
+                      sizeof(mask->control[i].mcs));
 +
-+      tasklet_disable(&sc->bcon_tasklet);
++              sdata->rc_has_mcs_mask[i] = false;
++              if (!sband)
++                      continue;
 +
-+      if (bf && bf->bf_mpdu) {
-+              struct sk_buff *skb = bf->bf_mpdu;
-               dma_unmap_single(sc->dev, bf->bf_buf_addr,
-                                skb->len, DMA_TO_DEVICE);
-               dev_kfree_skb_any(skb);
-@@ -274,99 +255,74 @@ int ath_beacon_alloc(struct ath_softc *s
-               bf->bf_buf_addr = 0;
++              for (j = 0; j < IEEE80211_HT_MCS_MASK_LEN; j++)
++                      if (~sdata->rc_rateidx_mcs_mask[i][j]) {
++                              sdata->rc_has_mcs_mask[i] = true;
++                              break;
++                      }
        }
  
--      /* NB: the beacon data buffer must be 32-bit aligned. */
--      skb = ieee80211_beacon_get(sc->hw, vif);
--      if (skb == NULL)
--              return -ENOMEM;
--
--      tstamp = ((struct ieee80211_mgmt *)skb->data)->u.beacon.timestamp;
--      sc->beacon.bc_tstamp = (u32) le64_to_cpu(tstamp);
--      /* Calculate a TSF adjustment factor required for staggered beacons. */
--      if (avp->av_bslot > 0) {
--              u64 tsfadjust;
--              int intval;
-+      avp->av_bcbuf = NULL;
-+      sc->beacon.bslot[avp->av_bslot] = NULL;
-+      sc->nbcnvifs--;
-+      list_add_tail(&bf->list, &sc->beacon.bbuf);
--              intval = cur_conf->beacon_interval ? : ATH_DEFAULT_BINTVAL;
-+      tasklet_enable(&sc->bcon_tasklet);
-+}
+       return 0;
+--- a/net/mac80211/chan.c
++++ b/net/mac80211/chan.c
+@@ -57,6 +57,22 @@ ieee80211_find_chanctx(struct ieee80211_
+       return NULL;
+ }
  
--              /*
--               * Calculate the TSF offset for this beacon slot, i.e., the
--               * number of usecs that need to be added to the timestamp field
--               * in Beacon and Probe Response frames. Beacon slot 0 is
--               * processed at the correct offset, so it does not require TSF
--               * adjustment. Other slots are adjusted to get the timestamp
--               * close to the TBTT for the BSS.
--               */
--              tsfadjust = TU_TO_USEC(intval * avp->av_bslot) / ATH_BCBUF;
--              avp->tsf_adjust = cpu_to_le64(tsfadjust);
-+static int ath9k_beacon_choose_slot(struct ath_softc *sc)
++static bool ieee80211_is_radar_required(struct ieee80211_local *local)
 +{
-+      struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-+      struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
-+      u16 intval;
-+      u32 tsftu;
-+      u64 tsf;
-+      int slot;
--              ath_dbg(common, BEACON,
--                      "stagger beacons, bslot %d intval %u tsfadjust %llu\n",
--                      avp->av_bslot, intval, (unsigned long long)tsfadjust);
-+      if (sc->sc_ah->opmode != NL80211_IFTYPE_AP) {
-+              ath_dbg(common, BEACON, "slot 0, tsf: %llu\n",
-+                      ath9k_hw_gettsf64(sc->sc_ah));
-+              return 0;
++      struct ieee80211_sub_if_data *sdata;
++
++      rcu_read_lock();
++      list_for_each_entry_rcu(sdata, &local->interfaces, list) {
++              if (sdata->radar_required) {
++                      rcu_read_unlock();
++                      return true;
++              }
 +      }
--              ((struct ieee80211_mgmt *)skb->data)->u.beacon.timestamp =
--                      avp->tsf_adjust;
--      } else
--              avp->tsf_adjust = cpu_to_le64(0);
-+      intval = cur_conf->beacon_interval ? : ATH_DEFAULT_BINTVAL;
-+      tsf = ath9k_hw_gettsf64(sc->sc_ah);
-+      tsf += TU_TO_USEC(sc->sc_ah->config.sw_beacon_response_time);
-+      tsftu = TSF_TO_TU((tsf * ATH_BCBUF) >>32, tsf * ATH_BCBUF);
-+      slot = (tsftu % (intval * ATH_BCBUF)) / intval;
--      bf->bf_mpdu = skb;
--      bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
--                                       skb->len, DMA_TO_DEVICE);
--      if (unlikely(dma_mapping_error(sc->dev, bf->bf_buf_addr))) {
--              dev_kfree_skb_any(skb);
--              bf->bf_mpdu = NULL;
--              bf->bf_buf_addr = 0;
--              ath_err(common, "dma_mapping_error on beacon alloc\n");
--              return -ENOMEM;
--      }
--      avp->is_bslot_active = true;
-+      ath_dbg(common, BEACON, "slot: %d tsf: %llu tsftu: %u\n",
-+              slot, tsf, tsftu / ATH_BCBUF);
--      return 0;
-+      return slot;
- }
--void ath_beacon_return(struct ath_softc *sc, struct ath_vif *avp)
-+void ath9k_set_tsfadjust(struct ath_softc *sc, struct ieee80211_vif *vif)
++      rcu_read_unlock();
++
++      return false;
++}
++
+ static struct ieee80211_chanctx *
+ ieee80211_new_chanctx(struct ieee80211_local *local,
+                     const struct cfg80211_chan_def *chandef,
+@@ -76,6 +92,9 @@ ieee80211_new_chanctx(struct ieee80211_l
+       ctx->conf.rx_chains_static = 1;
+       ctx->conf.rx_chains_dynamic = 1;
+       ctx->mode = mode;
++      ctx->conf.radar_enabled = ieee80211_is_radar_required(local);
++      if (!local->use_chanctx)
++              local->hw.conf.radar_enabled = ctx->conf.radar_enabled;
+       /* acquire mutex to prevent idle from changing */
+       mutex_lock(&local->mtx);
+@@ -110,6 +129,7 @@ ieee80211_new_chanctx(struct ieee80211_l
+ static void ieee80211_free_chanctx(struct ieee80211_local *local,
+                                  struct ieee80211_chanctx *ctx)
  {
--      if (avp->av_bcbuf != NULL) {
--              struct ath_buf *bf;
-+      struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-+      struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
-+      struct ath_vif *avp = (void *)vif->drv_priv;
-+      u64 tsfadjust;
--              avp->is_bslot_active = false;
--              if (avp->av_bslot != -1) {
--                      sc->beacon.bslot[avp->av_bslot] = NULL;
--                      sc->nbcnvifs--;
--                      avp->av_bslot = -1;
--              }
-+      if (avp->av_bslot == 0)
-+              return;
--              bf = avp->av_bcbuf;
--              if (bf->bf_mpdu != NULL) {
--                      struct sk_buff *skb = bf->bf_mpdu;
--                      dma_unmap_single(sc->dev, bf->bf_buf_addr,
--                                       skb->len, DMA_TO_DEVICE);
--                      dev_kfree_skb_any(skb);
--                      bf->bf_mpdu = NULL;
--                      bf->bf_buf_addr = 0;
--              }
--              list_add_tail(&bf->list, &sc->beacon.bbuf);
-+      tsfadjust = cur_conf->beacon_interval * avp->av_bslot / ATH_BCBUF;
-+      avp->tsf_adjust = cpu_to_le64(TU_TO_USEC(tsfadjust));
--              avp->av_bcbuf = NULL;
--      }
-+      ath_dbg(common, CONFIG, "tsfadjust is: %llu for bslot: %d\n",
-+              (unsigned long long)tsfadjust, avp->av_bslot);
- }
++      bool check_single_channel = false;
+       lockdep_assert_held(&local->chanctx_mtx);
+       WARN_ON_ONCE(ctx->refcount != 0);
+@@ -119,6 +139,14 @@ static void ieee80211_free_chanctx(struc
+               chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
+               chandef->center_freq1 = chandef->chan->center_freq;
+               chandef->center_freq2 = 0;
++
++              /* NOTE: Disabling radar is only valid here for
++               * single channel context. To be sure, check it ...
++               */
++              if (local->hw.conf.radar_enabled)
++                      check_single_channel = true;
++              local->hw.conf.radar_enabled = false;
++
+               ieee80211_hw_config(local, 0);
+       } else {
+               drv_remove_chanctx(local, ctx);
+@@ -127,6 +155,9 @@ static void ieee80211_free_chanctx(struc
+       list_del_rcu(&ctx->list);
+       kfree_rcu(ctx, rcu_head);
  
--void ath_beacon_tasklet(unsigned long data)
-+void ath9k_beacon_tasklet(unsigned long data)
- {
-       struct ath_softc *sc = (struct ath_softc *)data;
--      struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
-       struct ath_hw *ah = sc->sc_ah;
-       struct ath_common *common = ath9k_hw_common(ah);
-       struct ath_buf *bf = NULL;
-       struct ieee80211_vif *vif;
-       bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
-       int slot;
--      u32 bfaddr, bc = 0;
--      if (work_pending(&sc->hw_reset_work)) {
-+      if (test_bit(SC_OP_HW_RESET, &sc->sc_flags)) {
-               ath_dbg(common, RESET,
-                       "reset work is pending, skip beaconing now\n");
-               return;
-       }
++      /* throw a warning if this wasn't the only channel context. */
++      WARN_ON(check_single_channel && !list_empty(&local->chanctx_list));
 +
-       /*
-        * Check if the previous beacon has gone out.  If
-        * not don't try to post another, skip this period
-@@ -390,55 +346,25 @@ void ath_beacon_tasklet(unsigned long da
-               } else if (sc->beacon.bmisscnt >= BSTUCK_THRESH) {
-                       ath_dbg(common, BSTUCK, "beacon is officially stuck\n");
-                       sc->beacon.bmisscnt = 0;
--                      set_bit(SC_OP_TSF_RESET, &sc->sc_flags);
--                      ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
-+                      ath9k_queue_reset(sc, RESET_TYPE_BEACON_STUCK);
-               }
+       mutex_lock(&local->mtx);
+       ieee80211_recalc_idle(local);
+       mutex_unlock(&local->mtx);
+@@ -238,19 +269,11 @@ static void __ieee80211_vif_release_chan
+ void ieee80211_recalc_radar_chanctx(struct ieee80211_local *local,
+                                   struct ieee80211_chanctx *chanctx)
+ {
+-      struct ieee80211_sub_if_data *sdata;
+-      bool radar_enabled = false;
++      bool radar_enabled;
  
-               return;
-       }
+       lockdep_assert_held(&local->chanctx_mtx);
  
--      /*
--       * Generate beacon frames. we are sending frames
--       * staggered so calculate the slot for this frame based
--       * on the tsf to safeguard against missing an swba.
--       */
--
--
--      if (ah->opmode == NL80211_IFTYPE_AP) {
--              u16 intval;
--              u32 tsftu;
--              u64 tsf;
--
--              intval = cur_conf->beacon_interval ? : ATH_DEFAULT_BINTVAL;
--              tsf = ath9k_hw_gettsf64(ah);
--              tsf += TU_TO_USEC(ah->config.sw_beacon_response_time);
--              tsftu = TSF_TO_TU((tsf * ATH_BCBUF) >>32, tsf * ATH_BCBUF);
--              slot = (tsftu % (intval * ATH_BCBUF)) / intval;
--              vif = sc->beacon.bslot[slot];
--
--              ath_dbg(common, BEACON,
--                      "slot %d [tsf %llu tsftu %u intval %u] vif %p\n",
--                      slot, tsf, tsftu / ATH_BCBUF, intval, vif);
--      } else {
--              slot = 0;
--              vif = sc->beacon.bslot[slot];
+-      rcu_read_lock();
+-      list_for_each_entry_rcu(sdata, &local->interfaces, list) {
+-              if (sdata->radar_required) {
+-                      radar_enabled = true;
+-                      break;
+-              }
 -      }
-+      slot = ath9k_beacon_choose_slot(sc);
-+      vif = sc->beacon.bslot[slot];
+-      rcu_read_unlock();
++      radar_enabled = ieee80211_is_radar_required(local);
  
-+      if (!vif || !vif->bss_conf.enable_beacon)
-+              return;
+       if (radar_enabled == chanctx->conf.radar_enabled)
+               return;
+--- a/net/mac80211/debugfs_sta.c
++++ b/net/mac80211/debugfs_sta.c
+@@ -66,11 +66,11 @@ static ssize_t sta_flags_read(struct fil
+       test_sta_flag(sta, WLAN_STA_##flg) ? #flg "\n" : ""
  
--      bfaddr = 0;
--      if (vif) {
--              bf = ath_beacon_generate(sc->hw, vif);
--              if (bf != NULL) {
--                      bfaddr = bf->bf_daddr;
--                      bc = 1;
--              }
-+      bf = ath9k_beacon_generate(sc->hw, vif);
-+      WARN_ON(!bf);
--              if (sc->beacon.bmisscnt != 0) {
--                      ath_dbg(common, BSTUCK,
--                              "resume beacon xmit after %u misses\n",
--                              sc->beacon.bmisscnt);
--                      sc->beacon.bmisscnt = 0;
--              }
-+      if (sc->beacon.bmisscnt != 0) {
-+              ath_dbg(common, BSTUCK, "resume beacon xmit after %u misses\n",
-+                      sc->beacon.bmisscnt);
-+              sc->beacon.bmisscnt = 0;
-       }
+       int res = scnprintf(buf, sizeof(buf),
+-                          "%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s",
++                          "%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s",
+                           TEST(AUTH), TEST(ASSOC), TEST(PS_STA),
+                           TEST(PS_DRIVER), TEST(AUTHORIZED),
+                           TEST(SHORT_PREAMBLE),
+-                          TEST(WME), TEST(WDS), TEST(CLEAR_PS_FILT),
++                          TEST(WME), TEST(CLEAR_PS_FILT),
+                           TEST(MFP), TEST(BLOCK_BA), TEST(PSPOLL),
+                           TEST(UAPSD), TEST(SP), TEST(TDLS_PEER),
+                           TEST(TDLS_PEER_AUTH), TEST(4ADDR_EVENT),
+--- a/net/mac80211/ibss.c
++++ b/net/mac80211/ibss.c
+@@ -209,6 +209,8 @@ static void __ieee80211_sta_join_ibss(st
+       sdata->vif.bss_conf.enable_beacon = true;
+       sdata->vif.bss_conf.beacon_int = beacon_int;
+       sdata->vif.bss_conf.basic_rates = basic_rates;
++      sdata->vif.bss_conf.ssid_len = ifibss->ssid_len;
++      memcpy(sdata->vif.bss_conf.ssid, ifibss->ssid, ifibss->ssid_len);
+       bss_change = BSS_CHANGED_BEACON_INT;
+       bss_change |= ieee80211_reset_erp_info(sdata);
+       bss_change |= BSS_CHANGED_BSSID;
+@@ -217,6 +219,7 @@ static void __ieee80211_sta_join_ibss(st
+       bss_change |= BSS_CHANGED_BASIC_RATES;
+       bss_change |= BSS_CHANGED_HT;
+       bss_change |= BSS_CHANGED_IBSS;
++      bss_change |= BSS_CHANGED_SSID;
  
        /*
-@@ -458,39 +384,37 @@ void ath_beacon_tasklet(unsigned long da
-        *     set to ATH_BCBUF so this check is a noop.
-        */
-       if (sc->beacon.updateslot == UPDATE) {
--              sc->beacon.updateslot = COMMIT; /* commit next beacon */
-+              sc->beacon.updateslot = COMMIT;
-               sc->beacon.slotupdate = slot;
--      } else if (sc->beacon.updateslot == COMMIT && sc->beacon.slotupdate == slot) {
-+      } else if (sc->beacon.updateslot == COMMIT &&
-+                 sc->beacon.slotupdate == slot) {
-               ah->slottime = sc->beacon.slottime;
-               ath9k_hw_init_global_settings(ah);
-               sc->beacon.updateslot = OK;
-       }
--      if (bfaddr != 0) {
-+
-+      if (bf) {
-+              ath9k_reset_beacon_status(sc);
-+
-               /* NB: cabq traffic should already be queued and primed */
--              ath9k_hw_puttxbuf(ah, sc->beacon.beaconq, bfaddr);
-+              ath9k_hw_puttxbuf(ah, sc->beacon.beaconq, bf->bf_daddr);
-               if (!edma)
-                       ath9k_hw_txstart(ah, sc->beacon.beaconq);
--
--              sc->beacon.ast_be_xmit += bc;     /* XXX per-vif? */
-       }
- }
+        * In 5 GHz/802.11a, we can always use short slot time.
+@@ -911,7 +914,7 @@ void ieee80211_rx_mgmt_probe_beacon(stru
+               return;
  
--static void ath9k_beacon_init(struct ath_softc *sc,
--                            u32 next_beacon,
--                            u32 beacon_period)
-+static void ath9k_beacon_init(struct ath_softc *sc, u32 nexttbtt, u32 intval)
- {
--      if (test_bit(SC_OP_TSF_RESET, &sc->sc_flags)) {
--              ath9k_ps_wakeup(sc);
--              ath9k_hw_reset_tsf(sc->sc_ah);
--      }
--
--      ath9k_hw_beaconinit(sc->sc_ah, next_beacon, beacon_period);
-+      struct ath_hw *ah = sc->sc_ah;
+       ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen,
+-                              &elems);
++                             false, &elems);
  
--      if (test_bit(SC_OP_TSF_RESET, &sc->sc_flags)) {
--              ath9k_ps_restore(sc);
--              clear_bit(SC_OP_TSF_RESET, &sc->sc_flags);
--      }
-+      ath9k_hw_disable_interrupts(ah);
-+      ath9k_hw_reset_tsf(ah);
-+      ath9k_beaconq_config(sc);
-+      ath9k_hw_beaconinit(ah, nexttbtt, intval);
-+      sc->beacon.bmisscnt = 0;
-+      ath9k_hw_set_interrupts(ah);
-+      ath9k_hw_enable_interrupts(ah);
+       ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems);
  }
+@@ -1159,6 +1162,7 @@ int ieee80211_ibss_leave(struct ieee8021
+       sdata->vif.bss_conf.ibss_joined = false;
+       sdata->vif.bss_conf.ibss_creator = false;
+       sdata->vif.bss_conf.enable_beacon = false;
++      sdata->vif.bss_conf.ssid_len = 0;
+       clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state);
+       ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED |
+                                               BSS_CHANGED_IBSS);
+--- a/net/mac80211/ieee80211_i.h
++++ b/net/mac80211/ieee80211_i.h
+@@ -156,6 +156,7 @@ struct ieee80211_tx_data {
+       struct ieee80211_sub_if_data *sdata;
+       struct sta_info *sta;
+       struct ieee80211_key *key;
++      struct ieee80211_tx_rate rate;
  
- /*
-@@ -498,32 +422,27 @@ static void ath9k_beacon_init(struct ath
-  * burst together.  For the former arrange for the SWBA to be delivered for each
-  * slot. Slots that are not occupied will generate nothing.
-  */
--static void ath_beacon_config_ap(struct ath_softc *sc,
--                               struct ath_beacon_config *conf)
-+static void ath9k_beacon_config_ap(struct ath_softc *sc,
-+                                 struct ath_beacon_config *conf)
- {
-       struct ath_hw *ah = sc->sc_ah;
-+      struct ath_common *common = ath9k_hw_common(ah);
-       u32 nexttbtt, intval;
-       /* NB: the beacon interval is kept internally in TU's */
-       intval = TU_TO_USEC(conf->beacon_interval);
--      intval /= ATH_BCBUF;    /* for staggered beacons */
-+      intval /= ATH_BCBUF;
-       nexttbtt = intval;
+       unsigned int flags;
+ };
+@@ -740,6 +741,8 @@ struct ieee80211_sub_if_data {
  
--      /*
--       * In AP mode we enable the beacon timers and SWBA interrupts to
--       * prepare beacon frames.
--       */
--      ah->imask |= ATH9K_INT_SWBA;
--      ath_beaconq_config(sc);
-+      if (conf->enable_beacon)
-+              ah->imask |= ATH9K_INT_SWBA;
-+      else
-+              ah->imask &= ~ATH9K_INT_SWBA;
--      /* Set the computed AP beacon timers */
-+      ath_dbg(common, BEACON, "AP nexttbtt: %u intval: %u conf_intval: %u\n",
-+              nexttbtt, intval, conf->beacon_interval);
--      ath9k_hw_disable_interrupts(ah);
--      set_bit(SC_OP_TSF_RESET, &sc->sc_flags);
-       ath9k_beacon_init(sc, nexttbtt, intval);
--      sc->beacon.bmisscnt = 0;
--      ath9k_hw_set_interrupts(ah);
--      ath9k_hw_enable_interrupts(ah);
+       /* bitmap of allowed (non-MCS) rate indexes for rate control */
+       u32 rc_rateidx_mask[IEEE80211_NUM_BANDS];
++
++      bool rc_has_mcs_mask[IEEE80211_NUM_BANDS];
+       u8  rc_rateidx_mcs_mask[IEEE80211_NUM_BANDS][IEEE80211_HT_MCS_MASK_LEN];
+       union {
+@@ -1025,7 +1028,7 @@ struct ieee80211_local {
+       enum mac80211_scan_state next_scan_state;
+       struct delayed_work scan_work;
+       struct ieee80211_sub_if_data __rcu *scan_sdata;
+-      struct ieee80211_channel *csa_channel;
++      struct cfg80211_chan_def csa_chandef;
+       /* For backward compatibility only -- do not use */
+       struct cfg80211_chan_def _oper_chandef;
+@@ -1184,10 +1187,13 @@ struct ieee802_11_elems {
+       const u8 *perr;
+       const struct ieee80211_rann_ie *rann;
+       const struct ieee80211_channel_sw_ie *ch_switch_ie;
++      const struct ieee80211_ext_chansw_ie *ext_chansw_ie;
++      const struct ieee80211_wide_bw_chansw_ie *wide_bw_chansw_ie;
+       const u8 *country_elem;
+       const u8 *pwr_constr_elem;
+       const struct ieee80211_timeout_interval_ie *timeout_int;
+       const u8 *opmode_notif;
++      const struct ieee80211_sec_chan_offs_ie *sec_chan_offs;
+       /* length of them, respectively */
+       u8 ssid_len;
+@@ -1258,10 +1264,6 @@ void ieee80211_recalc_ps_vif(struct ieee
+ int ieee80211_max_network_latency(struct notifier_block *nb,
+                                 unsigned long data, void *dummy);
+ int ieee80211_set_arp_filter(struct ieee80211_sub_if_data *sdata);
+-void
+-ieee80211_sta_process_chanswitch(struct ieee80211_sub_if_data *sdata,
+-                               const struct ieee80211_channel_sw_ie *sw_elem,
+-                               struct ieee80211_bss *bss, u64 timestamp);
+ void ieee80211_sta_work(struct ieee80211_sub_if_data *sdata);
+ void ieee80211_sta_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
+                                 struct sk_buff *skb);
+@@ -1499,13 +1501,13 @@ static inline void ieee80211_tx_skb(stru
+       ieee80211_tx_skb_tid(sdata, skb, 7);
  }
  
- /*
-@@ -534,8 +453,8 @@ static void ath_beacon_config_ap(struct 
-  * we'll receive a BMISS interrupt when we stop seeing beacons from the AP
-  * we've associated with.
-  */
--static void ath_beacon_config_sta(struct ath_softc *sc,
--                                struct ath_beacon_config *conf)
-+static void ath9k_beacon_config_sta(struct ath_softc *sc,
-+                                  struct ath_beacon_config *conf)
+-u32 ieee802_11_parse_elems_crc(u8 *start, size_t len,
++u32 ieee802_11_parse_elems_crc(u8 *start, size_t len, bool action,
+                              struct ieee802_11_elems *elems,
+                              u64 filter, u32 crc);
+-static inline void ieee802_11_parse_elems(u8 *start, size_t len,
++static inline void ieee802_11_parse_elems(u8 *start, size_t len, bool action,
+                                         struct ieee802_11_elems *elems)
  {
-       struct ath_hw *ah = sc->sc_ah;
-       struct ath_common *common = ath9k_hw_common(ah);
-@@ -654,8 +573,8 @@ static void ath_beacon_config_sta(struct
-       ath9k_hw_enable_interrupts(ah);
+-      ieee802_11_parse_elems_crc(start, len, elems, 0, 0);
++      ieee802_11_parse_elems_crc(start, len, action, elems, 0, 0);
  }
  
--static void ath_beacon_config_adhoc(struct ath_softc *sc,
--                                  struct ath_beacon_config *conf)
-+static void ath9k_beacon_config_adhoc(struct ath_softc *sc,
-+                                    struct ath_beacon_config *conf)
- {
-       struct ath_hw *ah = sc->sc_ah;
-       struct ath_common *common = ath9k_hw_common(ah);
-@@ -669,82 +588,53 @@ static void ath_beacon_config_adhoc(stru
-       tsf = roundup(ath9k_hw_gettsf32(ah) + TU_TO_USEC(FUDGE), intval);
-       nexttbtt = tsf + intval;
--      ath_dbg(common, BEACON, "IBSS nexttbtt %u intval %u (%u)\n",
--              nexttbtt, intval, conf->beacon_interval);
--
--      /*
--       * In IBSS mode enable the beacon timers but only enable SWBA interrupts
--       * if we need to manually prepare beacon frames.  Otherwise we use a
--       * self-linked tx descriptor and let the hardware deal with things.
--       */
--      ah->imask |= ATH9K_INT_SWBA;
--
--      ath_beaconq_config(sc);
-+      if (conf->enable_beacon)
-+              ah->imask |= ATH9K_INT_SWBA;
-+      else
-+              ah->imask &= ~ATH9K_INT_SWBA;
--      /* Set the computed ADHOC beacon timers */
-+      ath_dbg(common, BEACON, "IBSS nexttbtt: %u intval: %u conf_intval: %u\n",
-+              nexttbtt, intval, conf->beacon_interval);
--      ath9k_hw_disable_interrupts(ah);
-       ath9k_beacon_init(sc, nexttbtt, intval);
--      sc->beacon.bmisscnt = 0;
--
--      ath9k_hw_set_interrupts(ah);
--      ath9k_hw_enable_interrupts(ah);
+ u32 ieee80211_mandatory_rates(struct ieee80211_local *local,
+--- a/net/mac80211/iface.c
++++ b/net/mac80211/iface.c
+@@ -159,7 +159,8 @@ static int ieee80211_change_mtu(struct n
+       return 0;
  }
  
--static bool ath9k_allow_beacon_config(struct ath_softc *sc,
--                                    struct ieee80211_vif *vif)
-+bool ath9k_allow_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif)
+-static int ieee80211_verify_mac(struct ieee80211_local *local, u8 *addr)
++static int ieee80211_verify_mac(struct ieee80211_local *local, u8 *addr,
++                              bool check_dup)
  {
--      struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
-       struct ath_common *common = ath9k_hw_common(sc->sc_ah);
--      struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
-       struct ath_vif *avp = (void *)vif->drv_priv;
--      /*
--       * Can not have different beacon interval on multiple
--       * AP interface case
--       */
--      if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) &&
--          (sc->nbcnvifs > 1) &&
--          (vif->type == NL80211_IFTYPE_AP) &&
--          (cur_conf->beacon_interval != bss_conf->beacon_int)) {
--              ath_dbg(common, CONFIG,
--                      "Changing beacon interval of multiple AP interfaces !\n");
--              return false;
--      }
--      /*
--       * Can not configure station vif's beacon config
--       * while on AP opmode
--       */
--      if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) &&
--          (vif->type != NL80211_IFTYPE_AP)) {
--              ath_dbg(common, CONFIG,
--                      "STA vif's beacon not allowed on AP mode\n");
--              return false;
-+      if (sc->sc_ah->opmode == NL80211_IFTYPE_AP) {
-+              if ((vif->type != NL80211_IFTYPE_AP) ||
-+                  (sc->nbcnvifs > 1)) {
-+                      ath_dbg(common, CONFIG,
-+                              "An AP interface is already present !\n");
-+                      return false;
-+              }
-       }
--      /*
--       * Do not allow beacon config if HW was already configured
--       * with another STA vif
--       */
--      if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
--          (vif->type == NL80211_IFTYPE_STATION) &&
--          test_bit(SC_OP_BEACONS, &sc->sc_flags) &&
--          !avp->primary_sta_vif) {
--              ath_dbg(common, CONFIG,
--                      "Beacon already configured for a station interface\n");
--              return false;
-+
-+      if (sc->sc_ah->opmode == NL80211_IFTYPE_STATION) {
-+              if ((vif->type == NL80211_IFTYPE_STATION) &&
-+                  test_bit(SC_OP_BEACONS, &sc->sc_flags) &&
-+                  !avp->primary_sta_vif) {
-+                      ath_dbg(common, CONFIG,
-+                              "Beacon already configured for a station interface\n");
-+                      return false;
-+              }
-       }
-+
-       return true;
- }
+       struct ieee80211_sub_if_data *sdata;
+       u64 new, mask, tmp;
+@@ -179,10 +180,13 @@ static int ieee80211_verify_mac(struct i
+               ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) |
+               ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8);
++      if (!check_dup)
++              return ret;
+       mutex_lock(&local->iflist_mtx);
+       list_for_each_entry(sdata, &local->interfaces, list) {
+-              if (sdata->vif.type == NL80211_IFTYPE_MONITOR)
++              if (sdata->vif.type == NL80211_IFTYPE_MONITOR &&
++                  !(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
+                       continue;
  
--void ath_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif)
-+static void ath9k_cache_beacon_config(struct ath_softc *sc,
-+                                    struct ieee80211_bss_conf *bss_conf)
+               m = sdata->vif.addr;
+@@ -204,12 +208,17 @@ static int ieee80211_change_mac(struct n
  {
-+      struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-       struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
--      struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
+       struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
+       struct sockaddr *sa = addr;
++      bool check_dup = true;
+       int ret;
  
--      if (!ath9k_allow_beacon_config(sc, vif))
--              return;
-+      ath_dbg(common, BEACON,
-+              "Caching beacon data for BSS: %pM\n", bss_conf->bssid);
--      /* Setup the beacon configuration parameters */
-       cur_conf->beacon_interval = bss_conf->beacon_int;
-       cur_conf->dtim_period = bss_conf->dtim_period;
-       cur_conf->listen_interval = 1;
-@@ -769,73 +659,59 @@ void ath_beacon_config(struct ath_softc 
-       if (cur_conf->dtim_period == 0)
-               cur_conf->dtim_period = 1;
--      ath_set_beacon(sc);
- }
+       if (ieee80211_sdata_running(sdata))
+               return -EBUSY;
  
--static bool ath_has_valid_bslot(struct ath_softc *sc)
-+void ath9k_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif,
-+                       u32 changed)
- {
--      struct ath_vif *avp;
--      int slot;
--      bool found = false;
-+      struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
-+      struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
--      for (slot = 0; slot < ATH_BCBUF; slot++) {
--              if (sc->beacon.bslot[slot]) {
--                      avp = (void *)sc->beacon.bslot[slot]->drv_priv;
--                      if (avp->is_bslot_active) {
--                              found = true;
--                              break;
--                      }
-+      ath9k_cache_beacon_config(sc, bss_conf);
+-      ret = ieee80211_verify_mac(sdata->local, sa->sa_data);
++      if (sdata->vif.type == NL80211_IFTYPE_MONITOR &&
++          !(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
++              check_dup = false;
 +
-+      if (sc->sc_ah->opmode == NL80211_IFTYPE_STATION) {
-+              ath9k_set_beacon(sc);
-+              set_bit(SC_OP_BEACONS, &sc->sc_flags);
-+      } else {
-+              /*
-+               * Take care of multiple interfaces when
-+               * enabling/disabling SWBA.
-+               */
-+              if (changed & BSS_CHANGED_BEACON_ENABLED) {
-+                      if (!bss_conf->enable_beacon &&
-+                          (sc->nbcnvifs <= 1))
-+                              cur_conf->enable_beacon = false;
-+                      else if (bss_conf->enable_beacon)
-+                              cur_conf->enable_beacon = true;
++      ret = ieee80211_verify_mac(sdata->local, sa->sa_data, check_dup);
+       if (ret)
+               return ret;
+@@ -450,7 +459,6 @@ int ieee80211_do_open(struct wireless_de
+       struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
+       struct net_device *dev = wdev->netdev;
+       struct ieee80211_local *local = sdata->local;
+-      struct sta_info *sta;
+       u32 changed = 0;
+       int res;
+       u32 hw_reconf_flags = 0;
+@@ -474,6 +482,9 @@ int ieee80211_do_open(struct wireless_de
+                       master->control_port_protocol;
+               sdata->control_port_no_encrypt =
+                       master->control_port_no_encrypt;
++              sdata->vif.cab_queue = master->vif.cab_queue;
++              memcpy(sdata->vif.hw_queue, master->vif.hw_queue,
++                     sizeof(sdata->vif.hw_queue));
+               break;
+               }
+       case NL80211_IFTYPE_AP:
+@@ -538,7 +549,11 @@ int ieee80211_do_open(struct wireless_de
+                       break;
                }
-+
-+              ath9k_set_beacon(sc);
-+
-+              if (cur_conf->enable_beacon)
-+                      set_bit(SC_OP_BEACONS, &sc->sc_flags);
-+              else
-+                      clear_bit(SC_OP_BEACONS, &sc->sc_flags);
-       }
--      return found;
- }
  
--
--void ath_set_beacon(struct ath_softc *sc)
-+void ath9k_set_beacon(struct ath_softc *sc)
- {
-       struct ath_common *common = ath9k_hw_common(sc->sc_ah);
-       struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
+-              if (local->monitors == 0 && local->open_count == 0) {
++              if (sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE) {
++                      res = drv_add_interface(local, sdata);
++                      if (res)
++                              goto err_stop;
++              } else if (local->monitors == 0 && local->open_count == 0) {
+                       res = ieee80211_add_virtual_monitor(local);
+                       if (res)
+                               goto err_stop;
+@@ -609,30 +624,8 @@ int ieee80211_do_open(struct wireless_de
  
-       switch (sc->sc_ah->opmode) {
-       case NL80211_IFTYPE_AP:
--              if (ath_has_valid_bslot(sc))
--                      ath_beacon_config_ap(sc, cur_conf);
-+              ath9k_beacon_config_ap(sc, cur_conf);
-               break;
-       case NL80211_IFTYPE_ADHOC:
-       case NL80211_IFTYPE_MESH_POINT:
--              ath_beacon_config_adhoc(sc, cur_conf);
-+              ath9k_beacon_config_adhoc(sc, cur_conf);
-               break;
-       case NL80211_IFTYPE_STATION:
--              ath_beacon_config_sta(sc, cur_conf);
-+              ath9k_beacon_config_sta(sc, cur_conf);
-               break;
-       default:
-               ath_dbg(common, CONFIG, "Unsupported beaconing mode\n");
-               return;
-       }
+       set_bit(SDATA_STATE_RUNNING, &sdata->state);
+-      if (sdata->vif.type == NL80211_IFTYPE_WDS) {
+-              /* Create STA entry for the WDS peer */
+-              sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr,
+-                                   GFP_KERNEL);
+-              if (!sta) {
+-                      res = -ENOMEM;
+-                      goto err_del_interface;
+-              }
 -
--      set_bit(SC_OP_BEACONS, &sc->sc_flags);
--}
+-              sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
+-              sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
+-              sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED);
 -
--void ath9k_set_beaconing_status(struct ath_softc *sc, bool status)
--{
--      struct ath_hw *ah = sc->sc_ah;
+-              res = sta_info_insert(sta);
+-              if (res) {
+-                      /* STA has been freed */
+-                      goto err_del_interface;
+-              }
 -
--      if (!ath_has_valid_bslot(sc)) {
--              clear_bit(SC_OP_BEACONS, &sc->sc_flags);
--              return;
+-              rate_control_rate_init(sta);
+-              netif_carrier_on(dev);
+-      } else if (sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE) {
++      if (sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE)
+               rcu_assign_pointer(local->p2p_sdata, sdata);
 -      }
--
--      ath9k_ps_wakeup(sc);
--      if (status) {
--              /* Re-enable beaconing */
--              ah->imask |= ATH9K_INT_SWBA;
--              ath9k_hw_set_interrupts(ah);
--      } else {
--              /* Disable SWBA interrupt */
--              ah->imask &= ~ATH9K_INT_SWBA;
--              ath9k_hw_set_interrupts(ah);
--              tasklet_kill(&sc->bcon_tasklet);
--              ath9k_hw_stop_dma_queue(ah, sc->beacon.beaconq);
--      }
--      ath9k_ps_restore(sc);
- }
---- a/drivers/net/wireless/ath/ath9k/calib.h
-+++ b/drivers/net/wireless/ath/ath9k/calib.h
-@@ -30,10 +30,10 @@ struct ar5416IniArray {
-       u32 ia_columns;
+       /*
+        * set_multicast_list will be invoked by the networking core
+@@ -653,7 +646,11 @@ int ieee80211_do_open(struct wireless_de
+       ieee80211_recalc_ps(local, -1);
+-      if (dev) {
++      if (sdata->vif.type == NL80211_IFTYPE_MONITOR ||
++          sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
++              /* XXX: for AP_VLAN, actually track AP queues */
++              netif_tx_start_all_queues(dev);
++      } else if (dev) {
+               unsigned long flags;
+               int n_acs = IEEE80211_NUM_ACS;
+               int ac;
+@@ -916,7 +913,11 @@ static void ieee80211_do_stop(struct iee
+               mutex_lock(&local->mtx);
+               ieee80211_recalc_idle(local);
+               mutex_unlock(&local->mtx);
+-              break;
++
++              if (!(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
++                      break;
++
++              /* fall through */
+       default:
+               if (going_down)
+                       drv_remove_interface(local, sdata);
+@@ -1075,7 +1076,7 @@ static const struct net_device_ops ieee8
+       .ndo_start_xmit         = ieee80211_monitor_start_xmit,
+       .ndo_set_rx_mode        = ieee80211_set_multicast_list,
+       .ndo_change_mtu         = ieee80211_change_mtu,
+-      .ndo_set_mac_address    = eth_mac_addr,
++      .ndo_set_mac_address    = ieee80211_change_mac,
+       .ndo_select_queue       = ieee80211_monitor_select_queue,
  };
  
--#define INIT_INI_ARRAY(iniarray, array, rows, columns) do {   \
-+#define INIT_INI_ARRAY(iniarray, array) do {  \
-               (iniarray)->ia_array = (u32 *)(array);          \
--              (iniarray)->ia_rows = (rows);                   \
--              (iniarray)->ia_columns = (columns);             \
-+              (iniarray)->ia_rows = ARRAY_SIZE(array);        \
-+              (iniarray)->ia_columns = ARRAY_SIZE(array[0]);  \
-       } while (0)
- #define INI_RA(iniarray, row, column) \
---- a/drivers/net/wireless/ath/ath9k/debug.c
-+++ b/drivers/net/wireless/ath/ath9k/debug.c
-@@ -206,10 +206,9 @@ static ssize_t write_file_disable_ani(st
-       if (disable_ani) {
-               clear_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--              del_timer_sync(&common->ani.timer);
-+              ath_stop_ani(sc);
-       } else {
--              set_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--              ath_start_ani(common);
-+              ath_check_ani(sc);
-       }
+@@ -1092,6 +1093,74 @@ static void ieee80211_if_setup(struct ne
+       dev->destructor = free_netdev;
+ }
  
-       return count;
-@@ -1556,6 +1555,14 @@ int ath9k_init_debug(struct ath_hw *ah)
-                           &fops_interrupt);
-       debugfs_create_file("xmit", S_IRUSR, sc->debug.debugfs_phy, sc,
-                           &fops_xmit);
-+      debugfs_create_u32("qlen_bk", S_IRUSR | S_IWUSR, sc->debug.debugfs_phy,
-+                         &sc->tx.txq_max_pending[WME_AC_BK]);
-+      debugfs_create_u32("qlen_be", S_IRUSR | S_IWUSR, sc->debug.debugfs_phy,
-+                         &sc->tx.txq_max_pending[WME_AC_BE]);
-+      debugfs_create_u32("qlen_vi", S_IRUSR | S_IWUSR, sc->debug.debugfs_phy,
-+                         &sc->tx.txq_max_pending[WME_AC_VI]);
-+      debugfs_create_u32("qlen_vo", S_IRUSR | S_IWUSR, sc->debug.debugfs_phy,
-+                         &sc->tx.txq_max_pending[WME_AC_VO]);
-       debugfs_create_file("stations", S_IRUSR, sc->debug.debugfs_phy, sc,
-                           &fops_stations);
-       debugfs_create_file("misc", S_IRUSR, sc->debug.debugfs_phy, sc,
---- a/drivers/net/wireless/ath/ath9k/debug.h
-+++ b/drivers/net/wireless/ath/ath9k/debug.h
-@@ -32,6 +32,19 @@ struct ath_buf;
- #define RESET_STAT_INC(sc, type) do { } while (0)
- #endif
++static void ieee80211_wds_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
++                                       struct sk_buff *skb)
++{
++      struct ieee80211_local *local = sdata->local;
++      struct ieee80211_rx_status *rx_status;
++      struct ieee802_11_elems elems;
++      struct ieee80211_mgmt *mgmt;
++      struct sta_info *sta;
++      size_t baselen;
++      u32 rates = 0;
++      u16 stype;
++      bool new = false;
++      enum ieee80211_band band;
++      struct ieee80211_supported_band *sband;
++
++      rx_status = IEEE80211_SKB_RXCB(skb);
++      band = rx_status->band;
++      sband = local->hw.wiphy->bands[band];
++      mgmt = (struct ieee80211_mgmt *) skb->data;
++      stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE;
++
++      if (stype != IEEE80211_STYPE_BEACON)
++              return;
++
++      baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
++      if (baselen > skb->len)
++              return;
++
++      ieee802_11_parse_elems(mgmt->u.probe_resp.variable,
++                             skb->len - baselen, false, &elems);
++
++      rates = ieee80211_sta_get_rates(local, &elems, band, NULL);
++
++      rcu_read_lock();
++
++      sta = sta_info_get(sdata, sdata->u.wds.remote_addr);
++
++      if (!sta) {
++              rcu_read_unlock();
++              sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr,
++                                   GFP_KERNEL);
++              if (!sta)
++                      return;
++
++              new = true;
++      }
++
++      sta->last_rx = jiffies;
++      sta->sta.supp_rates[band] = rates;
++
++      if (elems.ht_cap_elem)
++              ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
++                              elems.ht_cap_elem, sta);
++
++      if (elems.wmm_param)
++              set_sta_flag(sta, WLAN_STA_WME);
++
++      if (new) {
++              sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
++              sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
++              sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED);
++              rate_control_rate_init(sta);
++              sta_info_insert_rcu(sta);
++      }
++
++      rcu_read_unlock();
++}
++
+ static void ieee80211_iface_work(struct work_struct *work)
+ {
+       struct ieee80211_sub_if_data *sdata =
+@@ -1196,6 +1265,9 @@ static void ieee80211_iface_work(struct 
+                               break;
+                       ieee80211_mesh_rx_queued_mgmt(sdata, skb);
+                       break;
++              case NL80211_IFTYPE_WDS:
++                      ieee80211_wds_rx_queued_mgmt(sdata, skb);
++                      break;
+               default:
+                       WARN(1, "frame for unexpected interface type");
+                       break;
+@@ -1718,6 +1790,15 @@ void ieee80211_remove_interfaces(struct 
  
-+enum ath_reset_type {
-+      RESET_TYPE_BB_HANG,
-+      RESET_TYPE_BB_WATCHDOG,
-+      RESET_TYPE_FATAL_INT,
-+      RESET_TYPE_TX_ERROR,
-+      RESET_TYPE_TX_HANG,
-+      RESET_TYPE_PLL_HANG,
-+      RESET_TYPE_MAC_HANG,
-+      RESET_TYPE_BEACON_STUCK,
-+      RESET_TYPE_MCI,
-+      __RESET_TYPE_MAX
-+};
+       ASSERT_RTNL();
++      /*
++       * Close all AP_VLAN interfaces first, as otherwise they
++       * might be closed while the AP interface they belong to
++       * is closed, causing unregister_netdevice_many() to crash.
++       */
++      list_for_each_entry(sdata, &local->interfaces, list)
++              if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
++                      dev_close(sdata->dev);
++
+       mutex_lock(&local->iflist_mtx);
+       list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) {
+               list_del(&sdata->list);
+--- a/net/mac80211/main.c
++++ b/net/mac80211/main.c
+@@ -674,6 +674,7 @@ int ieee80211_register_hw(struct ieee802
+       int channels, max_bitrates;
+       bool supp_ht, supp_vht;
+       netdev_features_t feature_whitelist;
++      struct cfg80211_chan_def dflt_chandef = {};
+       static const u32 cipher_suites[] = {
+               /* keep WEP first, it may be removed below */
+               WLAN_CIPHER_SUITE_WEP40,
+@@ -751,19 +752,19 @@ int ieee80211_register_hw(struct ieee802
+               sband = local->hw.wiphy->bands[band];
+               if (!sband)
+                       continue;
+-              if (!local->use_chanctx && !local->_oper_chandef.chan) {
 +
- #ifdef CONFIG_ATH9K_DEBUGFS
++              if (!dflt_chandef.chan) {
++                      cfg80211_chandef_create(&dflt_chandef,
++                                              &sband->channels[0],
++                                              NL80211_CHAN_NO_HT);
+                       /* init channel we're on */
+-                      struct cfg80211_chan_def chandef = {
+-                              .chan = &sband->channels[0],
+-                              .width = NL80211_CHAN_NO_HT,
+-                              .center_freq1 = sband->channels[0].center_freq,
+-                              .center_freq2 = 0
+-                      };
+-                      local->hw.conf.chandef = local->_oper_chandef = chandef;
++                      if (!local->use_chanctx && !local->_oper_chandef.chan) {
++                              local->hw.conf.chandef = dflt_chandef;
++                              local->_oper_chandef = dflt_chandef;
++                      }
++                      local->monitor_chandef = dflt_chandef;
+               }
+-              cfg80211_chandef_create(&local->monitor_chandef,
+-                                      &sband->channels[0],
+-                                      NL80211_CHAN_NO_HT);
++
+               channels += sband->n_channels;
  
- /**
-@@ -209,17 +222,6 @@ struct ath_rx_stats {
-       u32 rx_frags;
- };
+               if (max_bitrates < sband->n_bitrates)
+--- a/net/mac80211/mesh.c
++++ b/net/mac80211/mesh.c
+@@ -838,7 +838,7 @@ ieee80211_mesh_rx_probe_req(struct ieee8
+       if (baselen > len)
+               return;
  
--enum ath_reset_type {
--      RESET_TYPE_BB_HANG,
--      RESET_TYPE_BB_WATCHDOG,
--      RESET_TYPE_FATAL_INT,
--      RESET_TYPE_TX_ERROR,
--      RESET_TYPE_TX_HANG,
--      RESET_TYPE_PLL_HANG,
--      RESET_TYPE_MAC_HANG,
--      __RESET_TYPE_MAX
--};
--
- struct ath_stats {
-       struct ath_interrupt_stats istats;
-       struct ath_tx_stats txstats[ATH9K_NUM_TX_QUEUES];
---- a/drivers/net/wireless/ath/ath9k/eeprom.h
-+++ b/drivers/net/wireless/ath/ath9k/eeprom.h
-@@ -241,16 +241,12 @@ enum eeprom_param {
-       EEP_TEMPSENSE_SLOPE,
-       EEP_TEMPSENSE_SLOPE_PAL_ON,
-       EEP_PWR_TABLE_OFFSET,
--      EEP_DRIVE_STRENGTH,
--      EEP_INTERNAL_REGULATOR,
--      EEP_SWREG,
-       EEP_PAPRD,
-       EEP_MODAL_VER,
-       EEP_ANT_DIV_CTL1,
-       EEP_CHAIN_MASK_REDUCE,
-       EEP_ANTENNA_GAIN_2G,
-       EEP_ANTENNA_GAIN_5G,
--      EEP_QUICK_DROP
- };
+-      ieee802_11_parse_elems(pos, len - baselen, &elems);
++      ieee802_11_parse_elems(pos, len - baselen, false, &elems);
  
- enum ar5416_rates {
---- a/drivers/net/wireless/ath/ath9k/htc_drv_main.c
-+++ b/drivers/net/wireless/ath/ath9k/htc_drv_main.c
-@@ -1111,7 +1111,7 @@ static int ath9k_htc_add_interface(struc
+       /* 802.11-2012 10.1.4.3.2 */
+       if ((!ether_addr_equal(mgmt->da, sdata->vif.addr) &&
+@@ -899,7 +899,7 @@ static void ieee80211_mesh_rx_bcn_presp(
+               return;
  
-       if ((priv->ah->opmode == NL80211_IFTYPE_AP) &&
-           !test_bit(OP_ANI_RUNNING, &priv->op_flags)) {
--              ath9k_hw_set_tsfadjust(priv->ah, 1);
-+              ath9k_hw_set_tsfadjust(priv->ah, true);
-               ath9k_htc_start_ani(priv);
+       ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen,
+-                             &elems);
++                             false, &elems);
+       /* ignore non-mesh or secure / unsecure mismatch */
+       if ((!elems.mesh_id || !elems.mesh_config) ||
+--- a/net/mac80211/mesh_hwmp.c
++++ b/net/mac80211/mesh_hwmp.c
+@@ -880,7 +880,7 @@ void mesh_rx_path_sel_frame(struct ieee8
+       baselen = (u8 *) mgmt->u.action.u.mesh_action.variable - (u8 *) mgmt;
+       ieee802_11_parse_elems(mgmt->u.action.u.mesh_action.variable,
+-                      len - baselen, &elems);
++                             len - baselen, false, &elems);
+       if (elems.preq) {
+               if (elems.preq_len != 37)
+--- a/net/mac80211/mesh_plink.c
++++ b/net/mac80211/mesh_plink.c
+@@ -544,8 +544,8 @@ static void mesh_plink_timer(unsigned lo
+               return;
+       }
+       mpl_dbg(sta->sdata,
+-              "Mesh plink timer for %pM fired on state %d\n",
+-              sta->sta.addr, sta->plink_state);
++              "Mesh plink timer for %pM fired on state %s\n",
++              sta->sta.addr, mplstates[sta->plink_state]);
+       reason = 0;
+       llid = sta->llid;
+       plid = sta->plid;
+@@ -687,7 +687,7 @@ void mesh_rx_plink_frame(struct ieee8021
+               baseaddr += 4;
+               baselen += 4;
+       }
+-      ieee802_11_parse_elems(baseaddr, len - baselen, &elems);
++      ieee802_11_parse_elems(baseaddr, len - baselen, true, &elems);
+       if (!elems.peering) {
+               mpl_dbg(sdata,
+--- a/net/mac80211/mlme.c
++++ b/net/mac80211/mlme.c
+@@ -289,6 +289,8 @@ ieee80211_determine_chantype(struct ieee
+       } else {
+               /* 40 MHz (and 80 MHz) must be supported for VHT */
+               ret = IEEE80211_STA_DISABLE_VHT;
++              /* also mark 40 MHz disabled */
++              ret |= IEEE80211_STA_DISABLE_40MHZ;
+               goto out;
        }
  
-@@ -1351,7 +1351,7 @@ static int ath9k_htc_conf_tx(struct ieee
-       qi.tqi_aifs = params->aifs;
-       qi.tqi_cwmin = params->cw_min;
-       qi.tqi_cwmax = params->cw_max;
--      qi.tqi_burstTime = params->txop;
-+      qi.tqi_burstTime = params->txop * 32;
+@@ -303,12 +305,6 @@ ieee80211_determine_chantype(struct ieee
+                                              channel->band);
+       vht_chandef.center_freq2 = 0;
+-      if (vht_oper->center_freq_seg2_idx)
+-              vht_chandef.center_freq2 =
+-                      ieee80211_channel_to_frequency(
+-                              vht_oper->center_freq_seg2_idx,
+-                              channel->band);
+-
+       switch (vht_oper->chan_width) {
+       case IEEE80211_VHT_CHANWIDTH_USE_HT:
+               vht_chandef.width = chandef->width;
+@@ -321,6 +317,10 @@ ieee80211_determine_chantype(struct ieee
+               break;
+       case IEEE80211_VHT_CHANWIDTH_80P80MHZ:
+               vht_chandef.width = NL80211_CHAN_WIDTH_80P80;
++              vht_chandef.center_freq2 =
++                      ieee80211_channel_to_frequency(
++                              vht_oper->center_freq_seg2_idx,
++                              channel->band);
+               break;
+       default:
+               if (verbose)
+@@ -604,7 +604,6 @@ static void ieee80211_add_vht_ie(struct 
+       u8 *pos;
+       u32 cap;
+       struct ieee80211_sta_vht_cap vht_cap;
+-      int i;
  
-       qnum = get_hw_qnum(queue, priv->hwq_map);
+       BUILD_BUG_ON(sizeof(vht_cap) != sizeof(sband->vht_cap));
  
---- a/drivers/net/wireless/ath/ath9k/hw.c
-+++ b/drivers/net/wireless/ath/ath9k/hw.c
-@@ -671,10 +671,6 @@ static int __ath9k_hw_init(struct ath_hw
-       if (!AR_SREV_9300_20_OR_LATER(ah))
-               ah->ani_function &= ~ATH9K_ANI_MRC_CCK;
+@@ -632,37 +631,6 @@ static void ieee80211_add_vht_ie(struct 
+                       cpu_to_le32(IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE)))
+               cap &= ~IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE;
  
--      /* disable ANI for 9340 */
--      if (AR_SREV_9340(ah))
--              ah->config.enable_ani = false;
+-      if (!(ap_vht_cap->vht_cap_info &
+-                      cpu_to_le32(IEEE80211_VHT_CAP_TXSTBC)))
+-              cap &= ~(IEEE80211_VHT_CAP_RXSTBC_1 |
+-                       IEEE80211_VHT_CAP_RXSTBC_3 |
+-                       IEEE80211_VHT_CAP_RXSTBC_4);
+-
+-      for (i = 0; i < 8; i++) {
+-              int shift = i * 2;
+-              u16 mask = IEEE80211_VHT_MCS_NOT_SUPPORTED << shift;
+-              u16 ap_mcs, our_mcs;
 -
-       ath9k_hw_init_mode_regs(ah);
+-              ap_mcs = (le16_to_cpu(ap_vht_cap->supp_mcs.tx_mcs_map) &
+-                                                              mask) >> shift;
+-              our_mcs = (le16_to_cpu(vht_cap.vht_mcs.rx_mcs_map) &
+-                                                              mask) >> shift;
+-
+-              if (our_mcs == IEEE80211_VHT_MCS_NOT_SUPPORTED)
+-                      continue;
+-
+-              switch (ap_mcs) {
+-              default:
+-                      if (our_mcs <= ap_mcs)
+-                              break;
+-                      /* fall through */
+-              case IEEE80211_VHT_MCS_NOT_SUPPORTED:
+-                      vht_cap.vht_mcs.rx_mcs_map &= cpu_to_le16(~mask);
+-                      vht_cap.vht_mcs.rx_mcs_map |=
+-                              cpu_to_le16(ap_mcs << shift);
+-              }
+-      }
+-
+       /* reserve and fill IE */
+       pos = skb_put(skb, sizeof(struct ieee80211_vht_cap) + 2);
+       ieee80211_ie_build_vht_cap(pos, &vht_cap, cap);
+@@ -998,16 +966,7 @@ static void ieee80211_chswitch_work(stru
+       if (!ifmgd->associated)
+               goto out;
  
-       if (!ah->is_pciexpress)
-@@ -2916,9 +2912,9 @@ void ath9k_hw_reset_tsf(struct ath_hw *a
+-      /*
+-       * FIXME: Here we are downgrading to NL80211_CHAN_WIDTH_20_NOHT
+-       * and don't adjust our ht/vht settings
+-       * This is wrong - we should behave according to the CSA params
+-       */
+-      local->_oper_chandef.chan = local->csa_channel;
+-      local->_oper_chandef.width = NL80211_CHAN_WIDTH_20_NOHT;
+-      local->_oper_chandef.center_freq1 =
+-              local->_oper_chandef.chan->center_freq;
+-      local->_oper_chandef.center_freq2 = 0;
++      local->_oper_chandef = local->csa_chandef;
+       if (!local->ops->channel_switch) {
+               /* call "hw_config" only if doing sw channel switch */
+@@ -1054,56 +1013,208 @@ static void ieee80211_chswitch_timer(uns
+       ieee80211_queue_work(&sdata->local->hw, &sdata->u.mgd.chswitch_work);
  }
- EXPORT_SYMBOL(ath9k_hw_reset_tsf);
  
--void ath9k_hw_set_tsfadjust(struct ath_hw *ah, u32 setting)
-+void ath9k_hw_set_tsfadjust(struct ath_hw *ah, bool set)
+-void
++static void
+ ieee80211_sta_process_chanswitch(struct ieee80211_sub_if_data *sdata,
+-                               const struct ieee80211_channel_sw_ie *sw_elem,
+-                               struct ieee80211_bss *bss, u64 timestamp)
++                               u64 timestamp, struct ieee802_11_elems *elems,
++                               bool beacon)
  {
--      if (setting)
-+      if (set)
-               ah->misc_mode |= AR_PCU_TX_ADD_TSF;
-       else
-               ah->misc_mode &= ~AR_PCU_TX_ADD_TSF;
---- a/drivers/net/wireless/ath/ath9k/hw.h
-+++ b/drivers/net/wireless/ath/ath9k/hw.h
-@@ -994,7 +994,7 @@ u32 ath9k_hw_gettsf32(struct ath_hw *ah)
- u64 ath9k_hw_gettsf64(struct ath_hw *ah);
- void ath9k_hw_settsf64(struct ath_hw *ah, u64 tsf64);
- void ath9k_hw_reset_tsf(struct ath_hw *ah);
--void ath9k_hw_set_tsfadjust(struct ath_hw *ah, u32 setting);
-+void ath9k_hw_set_tsfadjust(struct ath_hw *ah, bool set);
- void ath9k_hw_init_global_settings(struct ath_hw *ah);
- u32 ar9003_get_pll_sqsum_dvc(struct ath_hw *ah);
- void ath9k_hw_set11nmac2040(struct ath_hw *ah);
---- a/drivers/net/wireless/ath/ath9k/init.c
-+++ b/drivers/net/wireless/ath/ath9k/init.c
-@@ -436,6 +436,7 @@ static int ath9k_init_queues(struct ath_
-       for (i = 0; i < WME_NUM_AC; i++) {
-               sc->tx.txq_map[i] = ath_txq_setup(sc, ATH9K_TX_QUEUE_DATA, i);
-               sc->tx.txq_map[i]->mac80211_qnum = i;
-+              sc->tx.txq_max_pending[i] = ATH_MAX_QDEPTH;
+-      struct cfg80211_bss *cbss =
+-              container_of((void *)bss, struct cfg80211_bss, priv);
+-      struct ieee80211_channel *new_ch;
++      struct ieee80211_local *local = sdata->local;
+       struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
+-      int new_freq = ieee80211_channel_to_frequency(sw_elem->new_ch_num,
+-                                                    cbss->channel->band);
++      struct cfg80211_bss *cbss = ifmgd->associated;
++      struct ieee80211_bss *bss;
+       struct ieee80211_chanctx *chanctx;
++      enum ieee80211_band new_band;
++      int new_freq;
++      u8 new_chan_no;
++      u8 count;
++      u8 mode;
++      struct ieee80211_channel *new_chan;
++      struct cfg80211_chan_def new_chandef = {};
++      struct cfg80211_chan_def new_vht_chandef = {};
++      const struct ieee80211_sec_chan_offs_ie *sec_chan_offs;
++      const struct ieee80211_wide_bw_chansw_ie *wide_bw_chansw_ie;
++      const struct ieee80211_ht_operation *ht_oper;
++      int secondary_channel_offset = -1;
+       ASSERT_MGD_MTX(ifmgd);
+-      if (!ifmgd->associated)
++      if (!cbss)
++              return;
++
++      if (local->scanning)
+               return;
+-      if (sdata->local->scanning)
++      /* disregard subsequent announcements if we are already processing */
++      if (ifmgd->flags & IEEE80211_STA_CSA_RECEIVED)
+               return;
+-      /* Disregard subsequent beacons if we are already running a timer
+-         processing a CSA */
++      sec_chan_offs = elems->sec_chan_offs;
++      wide_bw_chansw_ie = elems->wide_bw_chansw_ie;
++      ht_oper = elems->ht_operation;
++
++      if (ifmgd->flags & (IEEE80211_STA_DISABLE_HT |
++                          IEEE80211_STA_DISABLE_40MHZ)) {
++              sec_chan_offs = NULL;
++              wide_bw_chansw_ie = NULL;
++              /* only used for bandwidth here */
++              ht_oper = NULL;
++      }
+-      if (ifmgd->flags & IEEE80211_STA_CSA_RECEIVED)
++      if (ifmgd->flags & IEEE80211_STA_DISABLE_VHT)
++              wide_bw_chansw_ie = NULL;
++
++      if (elems->ext_chansw_ie) {
++              if (!ieee80211_operating_class_to_band(
++                              elems->ext_chansw_ie->new_operating_class,
++                              &new_band)) {
++                      sdata_info(sdata,
++                                 "cannot understand ECSA IE operating class %d, disconnecting\n",
++                                 elems->ext_chansw_ie->new_operating_class);
++                      ieee80211_queue_work(&local->hw,
++                                           &ifmgd->csa_connection_drop_work);
++              }
++              new_chan_no = elems->ext_chansw_ie->new_ch_num;
++              count = elems->ext_chansw_ie->count;
++              mode = elems->ext_chansw_ie->mode;
++      } else if (elems->ch_switch_ie) {
++              new_band = cbss->channel->band;
++              new_chan_no = elems->ch_switch_ie->new_ch_num;
++              count = elems->ch_switch_ie->count;
++              mode = elems->ch_switch_ie->mode;
++      } else {
++              /* nothing here we understand */
+               return;
++      }
++
++      bss = (void *)cbss->priv;
+-      new_ch = ieee80211_get_channel(sdata->local->hw.wiphy, new_freq);
+-      if (!new_ch || new_ch->flags & IEEE80211_CHAN_DISABLED) {
++      new_freq = ieee80211_channel_to_frequency(new_chan_no, new_band);
++      new_chan = ieee80211_get_channel(sdata->local->hw.wiphy, new_freq);
++      if (!new_chan || new_chan->flags & IEEE80211_CHAN_DISABLED) {
+               sdata_info(sdata,
+                          "AP %pM switches to unsupported channel (%d MHz), disconnecting\n",
+                          ifmgd->associated->bssid, new_freq);
+-              ieee80211_queue_work(&sdata->local->hw,
++              ieee80211_queue_work(&local->hw,
++                                   &ifmgd->csa_connection_drop_work);
++              return;
++      }
++
++      if (!beacon && sec_chan_offs) {
++              secondary_channel_offset = sec_chan_offs->sec_chan_offs;
++      } else if (beacon && ht_oper) {
++              secondary_channel_offset =
++                      ht_oper->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET;
++      } else if (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT)) {
++              /*
++               * If it's not a beacon, HT is enabled and the IE not present,
++               * it's 20 MHz, 802.11-2012 8.5.2.6:
++               *      This element [the Secondary Channel Offset Element] is
++               *      present when switching to a 40 MHz channel. It may be
++               *      present when switching to a 20 MHz channel (in which
++               *      case the secondary channel offset is set to SCN).
++               */
++              secondary_channel_offset = IEEE80211_HT_PARAM_CHA_SEC_NONE;
++      }
++
++      switch (secondary_channel_offset) {
++      default:
++              /* secondary_channel_offset was present but is invalid */
++      case IEEE80211_HT_PARAM_CHA_SEC_NONE:
++              cfg80211_chandef_create(&new_chandef, new_chan,
++                                      NL80211_CHAN_HT20);
++              break;
++      case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
++              cfg80211_chandef_create(&new_chandef, new_chan,
++                                      NL80211_CHAN_HT40PLUS);
++              break;
++      case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
++              cfg80211_chandef_create(&new_chandef, new_chan,
++                                      NL80211_CHAN_HT40MINUS);
++              break;
++      case -1:
++              cfg80211_chandef_create(&new_chandef, new_chan,
++                                      NL80211_CHAN_NO_HT);
++              break;
++      }
++
++      if (wide_bw_chansw_ie) {
++              new_vht_chandef.chan = new_chan;
++              new_vht_chandef.center_freq1 =
++                      ieee80211_channel_to_frequency(
++                              wide_bw_chansw_ie->new_center_freq_seg0,
++                              new_band);
++
++              switch (wide_bw_chansw_ie->new_channel_width) {
++              default:
++                      /* hmmm, ignore VHT and use HT if present */
++              case IEEE80211_VHT_CHANWIDTH_USE_HT:
++                      new_vht_chandef.chan = NULL;
++                      break;
++              case IEEE80211_VHT_CHANWIDTH_80MHZ:
++                      new_vht_chandef.width = NL80211_CHAN_WIDTH_80;
++                      break;
++              case IEEE80211_VHT_CHANWIDTH_160MHZ:
++                      new_vht_chandef.width = NL80211_CHAN_WIDTH_160;
++                      break;
++              case IEEE80211_VHT_CHANWIDTH_80P80MHZ:
++                      /* field is otherwise reserved */
++                      new_vht_chandef.center_freq2 =
++                              ieee80211_channel_to_frequency(
++                                      wide_bw_chansw_ie->new_center_freq_seg1,
++                                      new_band);
++                      new_vht_chandef.width = NL80211_CHAN_WIDTH_80P80;
++                      break;
++              }
++              if (ifmgd->flags & IEEE80211_STA_DISABLE_80P80MHZ &&
++                  new_vht_chandef.width == NL80211_CHAN_WIDTH_80P80)
++                      chandef_downgrade(&new_vht_chandef);
++              if (ifmgd->flags & IEEE80211_STA_DISABLE_160MHZ &&
++                  new_vht_chandef.width == NL80211_CHAN_WIDTH_160)
++                      chandef_downgrade(&new_vht_chandef);
++              if (ifmgd->flags & IEEE80211_STA_DISABLE_40MHZ &&
++                  new_vht_chandef.width > NL80211_CHAN_WIDTH_20)
++                      chandef_downgrade(&new_vht_chandef);
++      }
++
++      /* if VHT data is there validate & use it */
++      if (new_vht_chandef.chan) {
++              if (!cfg80211_chandef_compatible(&new_vht_chandef,
++                                               &new_chandef)) {
++                      sdata_info(sdata,
++                                 "AP %pM CSA has inconsistent channel data, disconnecting\n",
++                                 ifmgd->associated->bssid);
++                      ieee80211_queue_work(&local->hw,
++                                           &ifmgd->csa_connection_drop_work);
++                      return;
++              }
++              new_chandef = new_vht_chandef;
++      }
++
++      if (!cfg80211_chandef_usable(local->hw.wiphy, &new_chandef,
++                                   IEEE80211_CHAN_DISABLED)) {
++              sdata_info(sdata,
++                         "AP %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n",
++                         ifmgd->associated->bssid, new_freq,
++                         new_chandef.width, new_chandef.center_freq1,
++                         new_chandef.center_freq2);
++              ieee80211_queue_work(&local->hw,
+                                    &ifmgd->csa_connection_drop_work);
+               return;
        }
-       return 0;
- }
-@@ -560,7 +561,7 @@ static int ath9k_init_softc(u16 devid, s
-       spin_lock_init(&sc->debug.samp_lock);
- #endif
-       tasklet_init(&sc->intr_tq, ath9k_tasklet, (unsigned long)sc);
--      tasklet_init(&sc->bcon_tasklet, ath_beacon_tasklet,
-+      tasklet_init(&sc->bcon_tasklet, ath9k_beacon_tasklet,
-                    (unsigned long)sc);
-       INIT_WORK(&sc->hw_reset_work, ath_reset_work);
---- a/drivers/net/wireless/ath/ath9k/link.c
-+++ b/drivers/net/wireless/ath/ath9k/link.c
-@@ -50,8 +50,7 @@ void ath_tx_complete_poll_work(struct wo
-       if (needreset) {
-               ath_dbg(ath9k_hw_common(sc->sc_ah), RESET,
-                       "tx hung, resetting the chip\n");
--              RESET_STAT_INC(sc, RESET_TYPE_TX_HANG);
--              ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
-+              ath9k_queue_reset(sc, RESET_TYPE_TX_HANG);
+       ifmgd->flags |= IEEE80211_STA_CSA_RECEIVED;
+-      if (sdata->local->use_chanctx) {
++      if (local->use_chanctx) {
+               sdata_info(sdata,
+                          "not handling channel switch with channel contexts\n");
+-              ieee80211_queue_work(&sdata->local->hw,
++              ieee80211_queue_work(&local->hw,
+                                    &ifmgd->csa_connection_drop_work);
                return;
        }
  
-@@ -69,6 +68,7 @@ void ath_hw_check(struct work_struct *wo
-       unsigned long flags;
-       int busy;
-       u8 is_alive, nbeacon = 1;
-+      enum ath_reset_type type;
-       ath9k_ps_wakeup(sc);
-       is_alive = ath9k_hw_check_alive(sc->sc_ah);
-@@ -78,7 +78,7 @@ void ath_hw_check(struct work_struct *wo
-       else if (!is_alive && AR_SREV_9300(sc->sc_ah)) {
-               ath_dbg(common, RESET,
-                       "DCU stuck is detected. Schedule chip reset\n");
--              RESET_STAT_INC(sc, RESET_TYPE_MAC_HANG);
-+              type = RESET_TYPE_MAC_HANG;
-               goto sched_reset;
+-      mutex_lock(&sdata->local->chanctx_mtx);
++      mutex_lock(&local->chanctx_mtx);
+       if (WARN_ON(!rcu_access_pointer(sdata->vif.chanctx_conf))) {
+-              mutex_unlock(&sdata->local->chanctx_mtx);
++              mutex_unlock(&local->chanctx_mtx);
+               return;
+       }
+       chanctx = container_of(rcu_access_pointer(sdata->vif.chanctx_conf),
+@@ -1111,40 +1222,39 @@ ieee80211_sta_process_chanswitch(struct 
+       if (chanctx->refcount > 1) {
+               sdata_info(sdata,
+                          "channel switch with multiple interfaces on the same channel, disconnecting\n");
+-              ieee80211_queue_work(&sdata->local->hw,
++              ieee80211_queue_work(&local->hw,
+                                    &ifmgd->csa_connection_drop_work);
+-              mutex_unlock(&sdata->local->chanctx_mtx);
++              mutex_unlock(&local->chanctx_mtx);
+               return;
+       }
+-      mutex_unlock(&sdata->local->chanctx_mtx);
++      mutex_unlock(&local->chanctx_mtx);
+-      sdata->local->csa_channel = new_ch;
++      local->csa_chandef = new_chandef;
+-      if (sw_elem->mode)
+-              ieee80211_stop_queues_by_reason(&sdata->local->hw,
++      if (mode)
++              ieee80211_stop_queues_by_reason(&local->hw,
+                               IEEE80211_MAX_QUEUE_MAP,
+                               IEEE80211_QUEUE_STOP_REASON_CSA);
+-      if (sdata->local->ops->channel_switch) {
++      if (local->ops->channel_switch) {
+               /* use driver's channel switch callback */
+               struct ieee80211_channel_switch ch_switch = {
+                       .timestamp = timestamp,
+-                      .block_tx = sw_elem->mode,
+-                      .channel = new_ch,
+-                      .count = sw_elem->count,
++                      .block_tx = mode,
++                      .chandef = new_chandef,
++                      .count = count,
+               };
+-              drv_channel_switch(sdata->local, &ch_switch);
++              drv_channel_switch(local, &ch_switch);
+               return;
        }
  
-@@ -90,7 +90,7 @@ void ath_hw_check(struct work_struct *wo
-               busy, sc->hw_busy_count + 1);
-       if (busy >= 99) {
-               if (++sc->hw_busy_count >= 3) {
--                      RESET_STAT_INC(sc, RESET_TYPE_BB_HANG);
-+                      type = RESET_TYPE_BB_HANG;
-                       goto sched_reset;
-               }
-       } else if (busy >= 0) {
-@@ -102,7 +102,7 @@ void ath_hw_check(struct work_struct *wo
-       goto out;
- sched_reset:
--      ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
-+      ath9k_queue_reset(sc, type);
- out:
-       ath9k_ps_restore(sc);
+       /* channel switch handled in software */
+-      if (sw_elem->count <= 1)
+-              ieee80211_queue_work(&sdata->local->hw, &ifmgd->chswitch_work);
++      if (count <= 1)
++              ieee80211_queue_work(&local->hw, &ifmgd->chswitch_work);
+       else
+               mod_timer(&ifmgd->chswitch_timer,
+-                        TU_TO_EXP_TIME(sw_elem->count *
+-                                       cbss->beacon_interval));
++                        TU_TO_EXP_TIME(count * cbss->beacon_interval));
  }
-@@ -119,8 +119,7 @@ static bool ath_hw_pll_rx_hang_check(str
-               count++;
-               if (count == 3) {
-                       ath_dbg(common, RESET, "PLL WAR, resetting the chip\n");
--                      RESET_STAT_INC(sc, RESET_TYPE_PLL_HANG);
--                      ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
-+                      ath9k_queue_reset(sc, RESET_TYPE_PLL_HANG);
-                       count = 0;
-                       return true;
-               }
-@@ -432,26 +431,69 @@ set_timer:
-       }
+ static u32 ieee80211_handle_pwr_constr(struct ieee80211_sub_if_data *sdata,
+@@ -2120,7 +2230,6 @@ void ieee80211_beacon_loss(struct ieee80
+       trace_api_beacon_loss(sdata);
+-      WARN_ON(hw->flags & IEEE80211_HW_CONNECTION_MONITOR);
+       sdata->u.mgd.connection_loss = false;
+       ieee80211_queue_work(hw, &sdata->u.mgd.beacon_connection_loss_work);
  }
+@@ -2170,7 +2279,7 @@ static void ieee80211_auth_challenge(str
+       u32 tx_flags = 0;
  
--void ath_start_ani(struct ath_common *common)
-+void ath_start_ani(struct ath_softc *sc)
- {
--      struct ath_hw *ah = common->ah;
-+      struct ath_hw *ah = sc->sc_ah;
-+      struct ath_common *common = ath9k_hw_common(ah);
-       unsigned long timestamp = jiffies_to_msecs(jiffies);
--      struct ath_softc *sc = (struct ath_softc *) common->priv;
+       pos = mgmt->u.auth.variable;
+-      ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), &elems);
++      ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems);
+       if (!elems.challenge)
+               return;
+       auth_data->expected_transaction = 4;
+@@ -2435,7 +2544,7 @@ static bool ieee80211_assoc_success(stru
+       }
  
--      if (!test_bit(SC_OP_ANI_RUN, &sc->sc_flags))
--              return;
--
--      if (sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL)
-+      if (common->disable_ani ||
-+          !test_bit(SC_OP_ANI_RUN, &sc->sc_flags) ||
-+          (sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL))
+       pos = mgmt->u.assoc_resp.variable;
+-      ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), &elems);
++      ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems);
+       if (!elems.supp_rates) {
+               sdata_info(sdata, "no SuppRates element in AssocResp\n");
+@@ -2604,7 +2713,7 @@ ieee80211_rx_mgmt_assoc_resp(struct ieee
+                  capab_info, status_code, (u16)(aid & ~(BIT(15) | BIT(14))));
+       pos = mgmt->u.assoc_resp.variable;
+-      ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), &elems);
++      ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems);
+       if (status_code == WLAN_STATUS_ASSOC_REJECTED_TEMPORARILY &&
+           elems.timeout_int &&
+@@ -2659,6 +2768,8 @@ static void ieee80211_rx_bss_info(struct
+       struct ieee80211_channel *channel;
+       bool need_ps = false;
++      lockdep_assert_held(&sdata->u.mgd.mtx);
++
+       if ((sdata->u.mgd.associated &&
+            ether_addr_equal(mgmt->bssid, sdata->u.mgd.associated->bssid)) ||
+           (sdata->u.mgd.assoc_data &&
+@@ -2689,7 +2800,8 @@ static void ieee80211_rx_bss_info(struct
+       if (bss)
+               ieee80211_rx_bss_put(local, bss);
+-      if (!sdata->u.mgd.associated)
++      if (!sdata->u.mgd.associated ||
++          !ether_addr_equal(mgmt->bssid, sdata->u.mgd.associated->bssid))
                return;
  
-       common->ani.longcal_timer = timestamp;
-       common->ani.shortcal_timer = timestamp;
-       common->ani.checkani_timer = timestamp;
+       if (need_ps) {
+@@ -2698,10 +2810,9 @@ static void ieee80211_rx_bss_info(struct
+               mutex_unlock(&local->iflist_mtx);
+       }
  
-+      ath_dbg(common, ANI, "Starting ANI\n");
-       mod_timer(&common->ani.timer,
-                 jiffies + msecs_to_jiffies((u32)ah->config.ani_poll_interval));
+-      if (elems->ch_switch_ie &&
+-          memcmp(mgmt->bssid, sdata->u.mgd.associated->bssid, ETH_ALEN) == 0)
+-              ieee80211_sta_process_chanswitch(sdata, elems->ch_switch_ie,
+-                                               bss, rx_status->mactime);
++      ieee80211_sta_process_chanswitch(sdata, rx_status->mactime,
++                                       elems, true);
++
  }
  
-+void ath_stop_ani(struct ath_softc *sc)
-+{
-+      struct ath_common *common = ath9k_hw_common(sc->sc_ah);
+@@ -2726,7 +2837,7 @@ static void ieee80211_rx_mgmt_probe_resp
+               return;
+       ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen,
+-                              &elems);
++                             false, &elems);
+       ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems);
+@@ -2809,7 +2920,7 @@ ieee80211_rx_mgmt_beacon(struct ieee8021
+       if (ifmgd->assoc_data && ifmgd->assoc_data->need_beacon &&
+           ether_addr_equal(mgmt->bssid, ifmgd->assoc_data->bss->bssid)) {
+               ieee802_11_parse_elems(mgmt->u.beacon.variable,
+-                                     len - baselen, &elems);
++                                     len - baselen, false, &elems);
+               ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems);
+               ifmgd->assoc_data->have_beacon = true;
+@@ -2919,7 +3030,7 @@ ieee80211_rx_mgmt_beacon(struct ieee8021
+       ncrc = crc32_be(0, (void *)&mgmt->u.beacon.beacon_int, 4);
+       ncrc = ieee802_11_parse_elems_crc(mgmt->u.beacon.variable,
+-                                        len - baselen, &elems,
++                                        len - baselen, false, &elems,
+                                         care_about_ies, ncrc);
+       if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) {
+@@ -3066,6 +3177,8 @@ void ieee80211_sta_rx_queued_mgmt(struct
+       enum rx_mgmt_action rma = RX_MGMT_NONE;
+       u8 deauth_buf[IEEE80211_DEAUTH_FRAME_LEN];
+       u16 fc;
++      struct ieee802_11_elems elems;
++      int ies_len;
+       rx_status = (struct ieee80211_rx_status *) skb->cb;
+       mgmt = (struct ieee80211_mgmt *) skb->data;
+@@ -3095,14 +3208,48 @@ void ieee80211_sta_rx_queued_mgmt(struct
+               rma = ieee80211_rx_mgmt_assoc_resp(sdata, mgmt, skb->len, &bss);
+               break;
+       case IEEE80211_STYPE_ACTION:
+-              switch (mgmt->u.action.category) {
+-              case WLAN_CATEGORY_SPECTRUM_MGMT:
++              if (mgmt->u.action.category == WLAN_CATEGORY_SPECTRUM_MGMT) {
++                      ies_len = skb->len -
++                                offsetof(struct ieee80211_mgmt,
++                                         u.action.u.chan_switch.variable);
 +
-+      ath_dbg(common, ANI, "Stopping ANI\n");
-+      del_timer_sync(&common->ani.timer);
-+}
++                      if (ies_len < 0)
++                              break;
 +
-+void ath_check_ani(struct ath_softc *sc)
-+{
-+      struct ath_hw *ah = sc->sc_ah;
-+      struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
++                      ieee802_11_parse_elems(
++                              mgmt->u.action.u.chan_switch.variable,
++                              ies_len, true, &elems);
 +
-+      /*
-+       * Check for the various conditions in which ANI has to
-+       * be stopped.
-+       */
-+      if (ah->opmode == NL80211_IFTYPE_ADHOC) {
-+              if (!cur_conf->enable_beacon)
-+                      goto stop_ani;
-+      } else if (ah->opmode == NL80211_IFTYPE_AP) {
-+              if (!cur_conf->enable_beacon) {
-+                      /*
-+                       * Disable ANI only when there are no
-+                       * associated stations.
-+                       */
-+                      if (!test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags))
-+                              goto stop_ani;
-+              }
-+      } else if (ah->opmode == NL80211_IFTYPE_STATION) {
-+              if (!test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags))
-+                      goto stop_ani;
-+      }
++                      if (elems.parse_error)
++                              break;
 +
-+      set_bit(SC_OP_ANI_RUN, &sc->sc_flags);
-+      ath_start_ani(sc);
-+      return;
+                       ieee80211_sta_process_chanswitch(sdata,
+-                                      &mgmt->u.action.u.chan_switch.sw_elem,
+-                                      (void *)ifmgd->associated->priv,
+-                                      rx_status->mactime);
+-                      break;
++                                                       rx_status->mactime,
++                                                       &elems, false);
++              } else if (mgmt->u.action.category == WLAN_CATEGORY_PUBLIC) {
++                      ies_len = skb->len -
++                                offsetof(struct ieee80211_mgmt,
++                                         u.action.u.ext_chan_switch.variable);
 +
-+stop_ani:
-+      clear_bit(SC_OP_ANI_RUN, &sc->sc_flags);
-+      ath_stop_ani(sc);
-+}
++                      if (ies_len < 0)
++                              break;
 +
- void ath_update_survey_nf(struct ath_softc *sc, int channel)
- {
-       struct ath_hw *ah = sc->sc_ah;
---- a/drivers/net/wireless/ath/ath9k/main.c
-+++ b/drivers/net/wireless/ath/ath9k/main.c
-@@ -167,8 +167,6 @@ static void ath_cancel_work(struct ath_s
- static void ath_restart_work(struct ath_softc *sc)
- {
--      struct ath_common *common = ath9k_hw_common(sc->sc_ah);
--
-       ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
++                      ieee802_11_parse_elems(
++                              mgmt->u.action.u.ext_chan_switch.variable,
++                              ies_len, true, &elems);
++
++                      if (elems.parse_error)
++                              break;
++
++                      /* for the handling code pretend this was also an IE */
++                      elems.ext_chansw_ie =
++                              &mgmt->u.action.u.ext_chan_switch.data;
++
++                      ieee80211_sta_process_chanswitch(sdata,
++                                                       rx_status->mactime,
++                                                       &elems, false);
+               }
++              break;
+       }
+       mutex_unlock(&ifmgd->mtx);
  
-       if (AR_SREV_9340(sc->sc_ah) || AR_SREV_9485(sc->sc_ah) ||
-@@ -177,21 +175,18 @@ static void ath_restart_work(struct ath_
-                                    msecs_to_jiffies(ATH_PLL_WORK_INTERVAL));
+@@ -4197,7 +4344,7 @@ int ieee80211_mgd_deauth(struct ieee8021
+       struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
+       u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN];
+       bool tx = !req->local_state_change;
+-      bool sent_frame = false;
++      bool report_frame = false;
  
-       ath_start_rx_poll(sc, 3);
--
--      if (!common->disable_ani)
--              ath_start_ani(common);
-+      ath_start_ani(sc);
- }
+       mutex_lock(&ifmgd->mtx);
  
- static bool ath_prepare_reset(struct ath_softc *sc, bool retry_tx, bool flush)
- {
-       struct ath_hw *ah = sc->sc_ah;
--      struct ath_common *common = ath9k_hw_common(ah);
-       bool ret = true;
-       ieee80211_stop_queues(sc->hw);
-       sc->hw_busy_count = 0;
--      del_timer_sync(&common->ani.timer);
-+      ath_stop_ani(sc);
-       del_timer_sync(&sc->rx_poll_timer);
-       ath9k_debug_samp_bb_mac(sc);
-@@ -236,7 +231,7 @@ static bool ath_complete_reset(struct at
-               if (!test_bit(SC_OP_BEACONS, &sc->sc_flags))
-                       goto work;
--              ath_set_beacon(sc);
-+              ath9k_set_beacon(sc);
-               if (ah->opmode == NL80211_IFTYPE_STATION &&
-                   test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) {
-@@ -365,6 +360,7 @@ void ath9k_tasklet(unsigned long data)
-       struct ath_softc *sc = (struct ath_softc *)data;
-       struct ath_hw *ah = sc->sc_ah;
-       struct ath_common *common = ath9k_hw_common(ah);
-+      enum ath_reset_type type;
-       unsigned long flags;
-       u32 status = sc->intrstatus;
-       u32 rxmask;
-@@ -374,18 +370,13 @@ void ath9k_tasklet(unsigned long data)
-       if ((status & ATH9K_INT_FATAL) ||
-           (status & ATH9K_INT_BB_WATCHDOG)) {
--#ifdef CONFIG_ATH9K_DEBUGFS
--              enum ath_reset_type type;
-               if (status & ATH9K_INT_FATAL)
-                       type = RESET_TYPE_FATAL_INT;
-               else
-                       type = RESET_TYPE_BB_WATCHDOG;
+@@ -4214,7 +4361,7 @@ int ieee80211_mgd_deauth(struct ieee8021
+               ieee80211_destroy_auth_data(sdata, false);
+               mutex_unlock(&ifmgd->mtx);
  
--              RESET_STAT_INC(sc, type);
--#endif
--              set_bit(SC_OP_HW_RESET, &sc->sc_flags);
--              ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
-+              ath9k_queue_reset(sc, type);
+-              sent_frame = tx;
++              report_frame = true;
                goto out;
        }
  
-@@ -586,6 +577,15 @@ static int ath_reset(struct ath_softc *s
-       return r;
+@@ -4222,12 +4369,12 @@ int ieee80211_mgd_deauth(struct ieee8021
+           ether_addr_equal(ifmgd->associated->bssid, req->bssid)) {
+               ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH,
+                                      req->reason_code, tx, frame_buf);
+-              sent_frame = tx;
++              report_frame = true;
+       }
+       mutex_unlock(&ifmgd->mtx);
+  out:
+-      if (sent_frame)
++      if (report_frame)
+               __cfg80211_send_deauth(sdata->dev, frame_buf,
+                                      IEEE80211_DEAUTH_FRAME_LEN);
+--- a/net/mac80211/pm.c
++++ b/net/mac80211/pm.c
+@@ -38,8 +38,8 @@ int __ieee80211_suspend(struct ieee80211
+                                       IEEE80211_MAX_QUEUE_MAP,
+                                       IEEE80211_QUEUE_STOP_REASON_SUSPEND);
+-      /* flush out all packets */
+-      synchronize_net();
++      /* flush out all packets and station cleanup call_rcu()s */
++      rcu_barrier();
+       ieee80211_flush_queues(local, NULL);
+--- a/net/mac80211/rate.c
++++ b/net/mac80211/rate.c
+@@ -252,6 +252,25 @@ rate_lowest_non_cck_index(struct ieee802
+       return 0;
  }
  
-+void ath9k_queue_reset(struct ath_softc *sc, enum ath_reset_type type)
++static void __rate_control_send_low(struct ieee80211_hw *hw,
++                                  struct ieee80211_supported_band *sband,
++                                  struct ieee80211_sta *sta,
++                                  struct ieee80211_tx_info *info)
 +{
-+#ifdef CONFIG_ATH9K_DEBUGFS
-+      RESET_STAT_INC(sc, type);
-+#endif
-+      set_bit(SC_OP_HW_RESET, &sc->sc_flags);
-+      ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
++      if ((sband->band != IEEE80211_BAND_2GHZ) ||
++          !(info->flags & IEEE80211_TX_CTL_NO_CCK_RATE))
++              info->control.rates[0].idx = rate_lowest_index(sband, sta);
++      else
++              info->control.rates[0].idx =
++                      rate_lowest_non_cck_index(sband, sta);
++
++      info->control.rates[0].count =
++              (info->flags & IEEE80211_TX_CTL_NO_ACK) ?
++              1 : hw->max_rate_tries;
++
++      info->control.skip_table = 1;
 +}
 +
- void ath_reset_work(struct work_struct *work)
- {
-       struct ath_softc *sc = container_of(work, struct ath_softc, hw_reset_work);
-@@ -852,16 +852,6 @@ bool ath9k_uses_beacons(int type)
-       }
- }
  
--static void ath9k_reclaim_beacon(struct ath_softc *sc,
--                               struct ieee80211_vif *vif)
--{
--      struct ath_vif *avp = (void *)vif->drv_priv;
+ bool rate_control_send_low(struct ieee80211_sta *sta,
+                          void *priv_sta,
+@@ -262,16 +281,8 @@ bool rate_control_send_low(struct ieee80
+       int mcast_rate;
+       if (!sta || !priv_sta || rc_no_data_or_no_ack_use_min(txrc)) {
+-              if ((sband->band != IEEE80211_BAND_2GHZ) ||
+-                  !(info->flags & IEEE80211_TX_CTL_NO_CCK_RATE))
+-                      info->control.rates[0].idx =
+-                              rate_lowest_index(txrc->sband, sta);
+-              else
+-                      info->control.rates[0].idx =
+-                              rate_lowest_non_cck_index(txrc->sband, sta);
+-              info->control.rates[0].count =
+-                      (info->flags & IEEE80211_TX_CTL_NO_ACK) ?
+-                      1 : txrc->hw->max_rate_tries;
++              __rate_control_send_low(txrc->hw, sband, sta, info);
++
+               if (!sta && txrc->bss) {
+                       mcast_rate = txrc->bss_conf->mcast_rate[sband->band];
+                       if (mcast_rate > 0) {
+@@ -355,7 +366,8 @@ static bool rate_idx_match_mcs_mask(stru
+ static void rate_idx_match_mask(struct ieee80211_tx_rate *rate,
+-                              struct ieee80211_tx_rate_control *txrc,
++                              struct ieee80211_supported_band *sband,
++                              enum nl80211_chan_width chan_width,
+                               u32 mask,
+                               u8 mcs_mask[IEEE80211_HT_MCS_MASK_LEN])
+ {
+@@ -375,27 +387,17 @@ static void rate_idx_match_mask(struct i
+                                 IEEE80211_TX_RC_USE_SHORT_PREAMBLE);
+               alt_rate.count = rate->count;
+               if (rate_idx_match_legacy_mask(&alt_rate,
+-                                             txrc->sband->n_bitrates,
+-                                             mask)) {
++                                             sband->n_bitrates, mask)) {
+                       *rate = alt_rate;
+                       return;
+               }
+       } else {
+-              struct sk_buff *skb = txrc->skb;
+-              struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
+-              __le16 fc;
 -
--      ath9k_set_beaconing_status(sc, false);
--      ath_beacon_return(sc, avp);
--      ath9k_set_beaconing_status(sc, true);
--}
+               /* handle legacy rates */
+-              if (rate_idx_match_legacy_mask(rate, txrc->sband->n_bitrates,
+-                                             mask))
++              if (rate_idx_match_legacy_mask(rate, sband->n_bitrates, mask))
+                       return;
+               /* if HT BSS, and we handle a data frame, also try HT rates */
+-              if (txrc->bss_conf->chandef.width == NL80211_CHAN_WIDTH_20_NOHT)
+-                      return;
 -
- static void ath9k_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
- {
-       struct ath9k_vif_iter_data *iter_data = data;
-@@ -929,18 +919,14 @@ static void ath9k_calculate_summary_stat
+-              fc = hdr->frame_control;
+-              if (!ieee80211_is_data(fc))
++              if (chan_width == NL80211_CHAN_WIDTH_20_NOHT)
+                       return;
  
-       ath9k_calculate_iter_data(hw, vif, &iter_data);
+               alt_rate.idx = 0;
+@@ -408,7 +410,7 @@ static void rate_idx_match_mask(struct i
  
--      /* Set BSSID mask. */
-       memcpy(common->bssidmask, iter_data.mask, ETH_ALEN);
-       ath_hw_setbssidmask(common);
+               alt_rate.flags |= IEEE80211_TX_RC_MCS;
  
--      /* Set op-mode & TSF */
-       if (iter_data.naps > 0) {
--              ath9k_hw_set_tsfadjust(ah, 1);
--              set_bit(SC_OP_TSF_RESET, &sc->sc_flags);
-+              ath9k_hw_set_tsfadjust(ah, true);
-               ah->opmode = NL80211_IFTYPE_AP;
-       } else {
--              ath9k_hw_set_tsfadjust(ah, 0);
--              clear_bit(SC_OP_TSF_RESET, &sc->sc_flags);
-+              ath9k_hw_set_tsfadjust(ah, false);
-               if (iter_data.nmeshes)
-                       ah->opmode = NL80211_IFTYPE_MESH_POINT;
-@@ -952,45 +938,14 @@ static void ath9k_calculate_summary_stat
-                       ah->opmode = NL80211_IFTYPE_STATION;
-       }
+-              if (txrc->bss_conf->chandef.width == NL80211_CHAN_WIDTH_40)
++              if (chan_width == NL80211_CHAN_WIDTH_40)
+                       alt_rate.flags |= IEEE80211_TX_RC_40_MHZ_WIDTH;
+               if (rate_idx_match_mcs_mask(&alt_rate, mcs_mask)) {
+@@ -426,6 +428,228 @@ static void rate_idx_match_mask(struct i
+        */
+ }
++static void rate_fixup_ratelist(struct ieee80211_vif *vif,
++                              struct ieee80211_supported_band *sband,
++                              struct ieee80211_tx_info *info,
++                              struct ieee80211_tx_rate *rates,
++                              int max_rates)
++{
++      struct ieee80211_rate *rate;
++      bool inval = false;
++      int i;
++
++      /*
++       * Set up the RTS/CTS rate as the fastest basic rate
++       * that is not faster than the data rate unless there
++       * is no basic rate slower than the data rate, in which
++       * case we pick the slowest basic rate
++       *
++       * XXX: Should this check all retry rates?
++       */
++      if (!(rates[0].flags & IEEE80211_TX_RC_MCS)) {
++              u32 basic_rates = vif->bss_conf.basic_rates;
++              s8 baserate = basic_rates ? ffs(basic_rates - 1) : 0;
++
++              rate = &sband->bitrates[rates[0].idx];
++
++              for (i = 0; i < sband->n_bitrates; i++) {
++                      /* must be a basic rate */
++                      if (!(basic_rates & BIT(i)))
++                              continue;
++                      /* must not be faster than the data rate */
++                      if (sband->bitrates[i].bitrate > rate->bitrate)
++                              continue;
++                      /* maximum */
++                      if (sband->bitrates[baserate].bitrate <
++                           sband->bitrates[i].bitrate)
++                              baserate = i;
++              }
++
++              info->control.rts_cts_rate_idx = baserate;
++      }
++
++      for (i = 0; i < max_rates; i++) {
++              /*
++               * make sure there's no valid rate following
++               * an invalid one, just in case drivers don't
++               * take the API seriously to stop at -1.
++               */
++              if (inval) {
++                      rates[i].idx = -1;
++                      continue;
++              }
++              if (rates[i].idx < 0) {
++                      inval = true;
++                      continue;
++              }
++
++              /*
++               * For now assume MCS is already set up correctly, this
++               * needs to be fixed.
++               */
++              if (rates[i].flags & IEEE80211_TX_RC_MCS) {
++                      WARN_ON(rates[i].idx > 76);
++
++                      if (!(rates[i].flags & IEEE80211_TX_RC_USE_RTS_CTS) &&
++                          info->control.use_cts_prot)
++                              rates[i].flags |=
++                                      IEEE80211_TX_RC_USE_CTS_PROTECT;
++                      continue;
++              }
++
++              if (rates[i].flags & IEEE80211_TX_RC_VHT_MCS) {
++                      WARN_ON(ieee80211_rate_get_vht_mcs(&rates[i]) > 9);
++                      continue;
++              }
++
++              /* set up RTS protection if desired */
++              if (info->control.use_rts) {
++                      rates[i].flags |= IEEE80211_TX_RC_USE_RTS_CTS;
++                      info->control.use_cts_prot = false;
++              }
++
++              /* RC is busted */
++              if (WARN_ON_ONCE(rates[i].idx >= sband->n_bitrates)) {
++                      rates[i].idx = -1;
++                      continue;
++              }
++
++              rate = &sband->bitrates[rates[i].idx];
++
++              /* set up short preamble */
++              if (info->control.short_preamble &&
++                  rate->flags & IEEE80211_RATE_SHORT_PREAMBLE)
++                      rates[i].flags |= IEEE80211_TX_RC_USE_SHORT_PREAMBLE;
++
++              /* set up G protection */
++              if (!(rates[i].flags & IEEE80211_TX_RC_USE_RTS_CTS) &&
++                  info->control.use_cts_prot &&
++                  rate->flags & IEEE80211_RATE_ERP_G)
++                      rates[i].flags |= IEEE80211_TX_RC_USE_CTS_PROTECT;
++      }
++}
++
++
++static void rate_control_fill_sta_table(struct ieee80211_sta *sta,
++                                      struct ieee80211_tx_info *info,
++                                      struct ieee80211_tx_rate *rates,
++                                      int max_rates)
++{
++      struct ieee80211_sta_rates *ratetbl = NULL;
++      int i;
++
++      if (sta && !info->control.skip_table)
++              ratetbl = rcu_dereference(sta->rates);
++
++      /* Fill remaining rate slots with data from the sta rate table. */
++      max_rates = min_t(int, max_rates, IEEE80211_TX_RATE_TABLE_SIZE);
++      for (i = 0; i < max_rates; i++) {
++              if (i < ARRAY_SIZE(info->control.rates) &&
++                  info->control.rates[i].idx >= 0 &&
++                  info->control.rates[i].count) {
++                      if (rates != info->control.rates)
++                              rates[i] = info->control.rates[i];
++              } else if (ratetbl) {
++                      rates[i].idx = ratetbl->rate[i].idx;
++                      rates[i].flags = ratetbl->rate[i].flags;
++                      if (info->control.use_rts)
++                              rates[i].count = ratetbl->rate[i].count_rts;
++                      else if (info->control.use_cts_prot)
++                              rates[i].count = ratetbl->rate[i].count_cts;
++                      else
++                              rates[i].count = ratetbl->rate[i].count;
++              } else {
++                      rates[i].idx = -1;
++                      rates[i].count = 0;
++              }
++
++              if (rates[i].idx < 0 || !rates[i].count)
++                      break;
++      }
++}
++
++static void rate_control_apply_mask(struct ieee80211_sub_if_data *sdata,
++                                  struct ieee80211_sta *sta,
++                                  struct ieee80211_supported_band *sband,
++                                  struct ieee80211_tx_info *info,
++                                  struct ieee80211_tx_rate *rates,
++                                  int max_rates)
++{
++      enum nl80211_chan_width chan_width;
++      u8 mcs_mask[IEEE80211_HT_MCS_MASK_LEN];
++      bool has_mcs_mask;
++      u32 mask;
++      int i;
++
++      /*
++       * Try to enforce the rateidx mask the user wanted. skip this if the
++       * default mask (allow all rates) is used to save some processing for
++       * the common case.
++       */
++      mask = sdata->rc_rateidx_mask[info->band];
++      has_mcs_mask = sdata->rc_has_mcs_mask[info->band];
++      if (mask == (1 << sband->n_bitrates) - 1 && !has_mcs_mask)
++              return;
++
++      if (has_mcs_mask)
++              memcpy(mcs_mask, sdata->rc_rateidx_mcs_mask[info->band],
++                     sizeof(mcs_mask));
++      else
++              memset(mcs_mask, 0xff, sizeof(mcs_mask));
++
++      if (sta) {
++              /* Filter out rates that the STA does not support */
++              mask &= sta->supp_rates[info->band];
++              for (i = 0; i < sizeof(mcs_mask); i++)
++                      mcs_mask[i] &= sta->ht_cap.mcs.rx_mask[i];
++      }
++
++      /*
++       * Make sure the rate index selected for each TX rate is
++       * included in the configured mask and change the rate indexes
++       * if needed.
++       */
++      chan_width = sdata->vif.bss_conf.chandef.width;
++      for (i = 0; i < max_rates; i++) {
++              /* Skip invalid rates */
++              if (rates[i].idx < 0)
++                      break;
++
++              rate_idx_match_mask(&rates[i], sband, chan_width, mask,
++                                  mcs_mask);
++      }
++}
++
++void ieee80211_get_tx_rates(struct ieee80211_vif *vif,
++                          struct ieee80211_sta *sta,
++                          struct sk_buff *skb,
++                          struct ieee80211_tx_rate *dest,
++                          int max_rates)
++{
++      struct ieee80211_sub_if_data *sdata;
++      struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
++      struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
++      struct ieee80211_supported_band *sband;
++
++      rate_control_fill_sta_table(sta, info, dest, max_rates);
++
++      if (!vif)
++              return;
++
++      sdata = vif_to_sdata(vif);
++      sband = sdata->local->hw.wiphy->bands[info->band];
++
++      if (ieee80211_is_data(hdr->frame_control))
++              rate_control_apply_mask(sdata, sta, sband, info, dest, max_rates);
++
++      if (dest[0].idx < 0)
++              __rate_control_send_low(&sdata->local->hw, sband, sta, info);
++
++      if (sta)
++              rate_fixup_ratelist(vif, sband, info, dest, max_rates);
++}
++EXPORT_SYMBOL(ieee80211_get_tx_rates);
++
+ void rate_control_get_rate(struct ieee80211_sub_if_data *sdata,
+                          struct sta_info *sta,
+                          struct ieee80211_tx_rate_control *txrc)
+@@ -435,8 +659,6 @@ void rate_control_get_rate(struct ieee80
+       struct ieee80211_sta *ista = NULL;
+       struct ieee80211_tx_info *info = IEEE80211_SKB_CB(txrc->skb);
+       int i;
+-      u32 mask;
+-      u8 mcs_mask[IEEE80211_HT_MCS_MASK_LEN];
+       if (sta && test_sta_flag(sta, WLAN_STA_RATE_CONTROL)) {
+               ista = &sta->sta;
+@@ -454,37 +676,27 @@ void rate_control_get_rate(struct ieee80
+       ref->ops->get_rate(ref->priv, ista, priv_sta, txrc);
  
 -      /*
--       * Enable MIB interrupts when there are hardware phy counters.
+-       * Try to enforce the rateidx mask the user wanted. skip this if the
+-       * default mask (allow all rates) is used to save some processing for
+-       * the common case.
 -       */
-+      ath9k_hw_setopmode(ah);
+-      mask = sdata->rc_rateidx_mask[info->band];
+-      memcpy(mcs_mask, sdata->rc_rateidx_mcs_mask[info->band],
+-             sizeof(mcs_mask));
+-      if (mask != (1 << txrc->sband->n_bitrates) - 1) {
+-              if (sta) {
+-                      /* Filter out rates that the STA does not support */
+-                      mask &= sta->sta.supp_rates[info->band];
+-                      for (i = 0; i < sizeof(mcs_mask); i++)
+-                              mcs_mask[i] &= sta->sta.ht_cap.mcs.rx_mask[i];
+-              }
+-              /*
+-               * Make sure the rate index selected for each TX rate is
+-               * included in the configured mask and change the rate indexes
+-               * if needed.
+-               */
+-              for (i = 0; i < IEEE80211_TX_MAX_RATES; i++) {
+-                      /* Skip invalid rates */
+-                      if (info->control.rates[i].idx < 0)
+-                              break;
+-                      rate_idx_match_mask(&info->control.rates[i], txrc,
+-                                          mask, mcs_mask);
+-              }
+-      }
++      if (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_RC_TABLE)
++              return;
+-      BUG_ON(info->control.rates[0].idx < 0);
++      ieee80211_get_tx_rates(&sdata->vif, ista, txrc->skb,
++                             info->control.rates,
++                             ARRAY_SIZE(info->control.rates));
++}
++
++int rate_control_set_rates(struct ieee80211_hw *hw,
++                         struct ieee80211_sta *pubsta,
++                         struct ieee80211_sta_rates *rates)
++{
++      struct ieee80211_sta_rates *old = rcu_dereference(pubsta->rates);
++
++      rcu_assign_pointer(pubsta->rates, rates);
++      if (old)
++              kfree_rcu(old, rcu_head);
 +
-       if ((iter_data.nstations + iter_data.nadhocs + iter_data.nmeshes) > 0)
-               ah->imask |= ATH9K_INT_TSFOOR;
++      return 0;
+ }
++EXPORT_SYMBOL(rate_control_set_rates);
+ int ieee80211_init_rate_ctrl_alg(struct ieee80211_local *local,
+                                const char *name)
+--- a/net/mac80211/rc80211_minstrel.c
++++ b/net/mac80211/rc80211_minstrel.c
+@@ -84,6 +84,50 @@ minstrel_sort_best_tp_rates(struct minst
+ }
+ static void
++minstrel_set_rate(struct minstrel_sta_info *mi, struct ieee80211_sta_rates *ratetbl,
++                int offset, int idx)
++{
++      struct minstrel_rate *r = &mi->r[idx];
++
++      ratetbl->rate[offset].idx = r->rix;
++      ratetbl->rate[offset].count = r->adjusted_retry_count;
++      ratetbl->rate[offset].count_cts = r->retry_count_cts;
++      ratetbl->rate[offset].count_rts = r->retry_count_rtscts;
++}
++
++static void
++minstrel_update_rates(struct minstrel_priv *mp, struct minstrel_sta_info *mi)
++{
++      struct ieee80211_sta_rates *ratetbl;
++      int i = 0;
++
++      ratetbl = kzalloc(sizeof(*ratetbl), GFP_ATOMIC);
++      if (!ratetbl)
++              return;
++
++      /* Start with max_tp_rate */
++      minstrel_set_rate(mi, ratetbl, i++, mi->max_tp_rate[0]);
++
++      if (mp->hw->max_rates >= 3) {
++              /* At least 3 tx rates supported, use max_tp_rate2 next */
++              minstrel_set_rate(mi, ratetbl, i++, mi->max_tp_rate[1]);
++      }
++
++      if (mp->hw->max_rates >= 2) {
++              /* At least 2 tx rates supported, use max_prob_rate next */
++              minstrel_set_rate(mi, ratetbl, i++, mi->max_prob_rate);
++      }
++
++      /* Use lowest rate last */
++      ratetbl->rate[i].idx = mi->lowest_rix;
++      ratetbl->rate[i].count = mp->max_retry;
++      ratetbl->rate[i].count_cts = mp->max_retry;
++      ratetbl->rate[i].count_rts = mp->max_retry;
++
++      rate_control_set_rates(mp->hw, mi->sta, ratetbl);
++}
++
++static void
+ minstrel_update_stats(struct minstrel_priv *mp, struct minstrel_sta_info *mi)
+ {
+       u8 tmp_tp_rate[MAX_THR_RATES];
+@@ -161,6 +205,8 @@ minstrel_update_stats(struct minstrel_pr
+       /* Reset update timer */
+       mi->stats_update = jiffies;
++
++      minstrel_update_rates(mp, mi);
+ }
+ static void
+@@ -209,9 +255,9 @@ minstrel_get_retry_count(struct minstrel
+ {
+       unsigned int retry = mr->adjusted_retry_count;
+-      if (info->control.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS)
++      if (info->control.use_rts)
+               retry = max(2U, min(mr->retry_count_rtscts, retry));
+-      else if (info->control.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT)
++      else if (info->control.use_cts_prot)
+               retry = max(2U, min(mr->retry_count_cts, retry));
+       return retry;
+ }
+@@ -240,13 +286,12 @@ minstrel_get_rate(void *priv, struct iee
+       struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
+       struct minstrel_sta_info *mi = priv_sta;
+       struct minstrel_priv *mp = priv;
+-      struct ieee80211_tx_rate *ar = info->control.rates;
+-      unsigned int ndx, sample_ndx = 0;
++      struct ieee80211_tx_rate *rate = &info->control.rates[0];
++      struct minstrel_rate *msr, *mr;
++      unsigned int ndx;
+       bool mrr_capable;
+-      bool indirect_rate_sampling = false;
+-      bool rate_sampling = false;
+-      int i, delta;
+-      int mrr_ndx[3];
++      bool prev_sample = mi->prev_sample;
++      int delta;
+       int sampling_ratio;
+       /* management/no-ack frames do not use rate control */
+@@ -262,107 +307,75 @@ minstrel_get_rate(void *priv, struct iee
        else
-               ah->imask &= ~ATH9K_INT_TSFOOR;
+               sampling_ratio = mp->lookaround_rate;
  
-       ath9k_hw_set_interrupts(ah);
--
--      /* Set up ANI */
--      if (iter_data.naps > 0) {
--              sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
+-      /* init rateindex [ndx] with max throughput rate */
+-      ndx = mi->max_tp_rate[0];
 -
--              if (!common->disable_ani) {
--                      set_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--                      ath_start_ani(common);
+       /* increase sum packet counter */
+       mi->packet_count++;
+       delta = (mi->packet_count * sampling_ratio / 100) -
+                       (mi->sample_count + mi->sample_deferred / 2);
+-      /* delta > 0: sampling required */
+-      if ((delta > 0) && (mrr_capable || !mi->prev_sample)) {
+-              struct minstrel_rate *msr;
+-              if (mi->packet_count >= 10000) {
+-                      mi->sample_deferred = 0;
+-                      mi->sample_count = 0;
+-                      mi->packet_count = 0;
+-              } else if (delta > mi->n_rates * 2) {
+-                      /* With multi-rate retry, not every planned sample
+-                       * attempt actually gets used, due to the way the retry
+-                       * chain is set up - [max_tp,sample,prob,lowest] for
+-                       * sample_rate < max_tp.
+-                       *
+-                       * If there's too much sampling backlog and the link
+-                       * starts getting worse, minstrel would start bursting
+-                       * out lots of sampling frames, which would result
+-                       * in a large throughput loss. */
+-                      mi->sample_count += (delta - mi->n_rates * 2);
 -              }
++      /* delta < 0: no sampling required */
++      mi->prev_sample = false;
++      if (delta < 0 || (!mrr_capable && prev_sample))
++              return;
+-              /* get next random rate sample */
+-              sample_ndx = minstrel_get_next_sample(mi);
+-              msr = &mi->r[sample_ndx];
+-              rate_sampling = true;
 -
--      } else {
--              clear_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--              del_timer_sync(&common->ani.timer);
--      }
--}
+-              /* Decide if direct ( 1st mrr stage) or indirect (2nd mrr stage)
+-               * rate sampling method should be used.
+-               * Respect such rates that are not sampled for 20 interations.
+-               */
+-              if (mrr_capable &&
+-                  msr->perfect_tx_time > mi->r[ndx].perfect_tx_time &&
+-                  msr->sample_skipped < 20)
+-                              indirect_rate_sampling = true;
 -
--/* Called with sc->mutex held, vif counts set up properly. */
--static void ath9k_do_vif_add_setup(struct ieee80211_hw *hw,
--                                 struct ieee80211_vif *vif)
--{
--      struct ath_softc *sc = hw->priv;
+-              if (!indirect_rate_sampling) {
+-                      if (msr->sample_limit != 0) {
+-                              ndx = sample_ndx;
+-                              mi->sample_count++;
+-                              if (msr->sample_limit > 0)
+-                                      msr->sample_limit--;
+-                      } else
+-                              rate_sampling = false;
+-              } else {
+-                      /* Only use IEEE80211_TX_CTL_RATE_CTRL_PROBE to mark
+-                       * packets that have the sampling rate deferred to the
+-                       * second MRR stage. Increase the sample counter only
+-                       * if the deferred sample rate was actually used.
+-                       * Use the sample_deferred counter to make sure that
+-                       * the sampling is not done in large bursts */
+-                      info->flags |= IEEE80211_TX_CTL_RATE_CTRL_PROBE;
+-                      mi->sample_deferred++;
+-              }
++      if (mi->packet_count >= 10000) {
++              mi->sample_deferred = 0;
++              mi->sample_count = 0;
++              mi->packet_count = 0;
++      } else if (delta > mi->n_rates * 2) {
++              /* With multi-rate retry, not every planned sample
++               * attempt actually gets used, due to the way the retry
++               * chain is set up - [max_tp,sample,prob,lowest] for
++               * sample_rate < max_tp.
++               *
++               * If there's too much sampling backlog and the link
++               * starts getting worse, minstrel would start bursting
++               * out lots of sampling frames, which would result
++               * in a large throughput loss. */
++              mi->sample_count += (delta - mi->n_rates * 2);
++      }
++
++      /* get next random rate sample */
++      ndx = minstrel_get_next_sample(mi);
++      msr = &mi->r[ndx];
++      mr = &mi->r[mi->max_tp_rate[0]];
++
++      /* Decide if direct ( 1st mrr stage) or indirect (2nd mrr stage)
++       * rate sampling method should be used.
++       * Respect such rates that are not sampled for 20 interations.
++       */
++      if (mrr_capable &&
++          msr->perfect_tx_time > mr->perfect_tx_time &&
++          msr->sample_skipped < 20) {
++              /* Only use IEEE80211_TX_CTL_RATE_CTRL_PROBE to mark
++               * packets that have the sampling rate deferred to the
++               * second MRR stage. Increase the sample counter only
++               * if the deferred sample rate was actually used.
++               * Use the sample_deferred counter to make sure that
++               * the sampling is not done in large bursts */
++              info->flags |= IEEE80211_TX_CTL_RATE_CTRL_PROBE;
++              rate++;
++              mi->sample_deferred++;
++      } else {
++              if (!msr->sample_limit != 0)
++                      return;
++
++              mi->sample_count++;
++              if (msr->sample_limit > 0)
++                      msr->sample_limit--;
+       }
+-      mi->prev_sample = rate_sampling;
+       /* If we're not using MRR and the sampling rate already
+        * has a probability of >95%, we shouldn't be attempting
+        * to use it, as this only wastes precious airtime */
+-      if (!mrr_capable && rate_sampling &&
++      if (!mrr_capable &&
+          (mi->r[ndx].probability > MINSTREL_FRAC(95, 100)))
+-              ndx = mi->max_tp_rate[0];
 -
--      ath9k_calculate_summary_state(hw, vif);
+-      /* mrr setup for 1st stage */
+-      ar[0].idx = mi->r[ndx].rix;
+-      ar[0].count = minstrel_get_retry_count(&mi->r[ndx], info);
 -
--      if (ath9k_uses_beacons(vif->type)) {
--              /* Reserve a beacon slot for the vif */
--              ath9k_set_beaconing_status(sc, false);
--              ath_beacon_alloc(sc, vif);
--              ath9k_set_beaconing_status(sc, true);
+-      /* non mrr setup for 2nd stage */
+-      if (!mrr_capable) {
+-              if (!rate_sampling)
+-                      ar[0].count = mp->max_retry;
+-              ar[1].idx = mi->lowest_rix;
+-              ar[1].count = mp->max_retry;
+               return;
+-      }
+-      /* mrr setup for 2nd stage */
+-      if (rate_sampling) {
+-              if (indirect_rate_sampling)
+-                      mrr_ndx[0] = sample_ndx;
+-              else
+-                      mrr_ndx[0] = mi->max_tp_rate[0];
+-      } else {
+-              mrr_ndx[0] = mi->max_tp_rate[1];
 -      }
++      mi->prev_sample = true;
+-      /* mrr setup for 3rd & 4th stage */
+-      mrr_ndx[1] = mi->max_prob_rate;
+-      mrr_ndx[2] = 0;
+-      for (i = 1; i < 4; i++) {
+-              ar[i].idx = mi->r[mrr_ndx[i - 1]].rix;
+-              ar[i].count = mi->r[mrr_ndx[i - 1]].adjusted_retry_count;
+-      }
++      rate->idx = mi->r[ndx].rix;
++      rate->count = minstrel_get_retry_count(&mi->r[ndx], info);
  }
  
- static int ath9k_add_interface(struct ieee80211_hw *hw,
-@@ -1032,7 +987,10 @@ static int ath9k_add_interface(struct ie
  
-       sc->nvifs++;
+@@ -412,12 +425,16 @@ minstrel_rate_init(void *priv, struct ie
+       unsigned int i, n = 0;
+       unsigned int t_slot = 9; /* FIXME: get real slot time */
  
--      ath9k_do_vif_add_setup(hw, vif);
-+      ath9k_calculate_summary_state(hw, vif);
-+      if (ath9k_uses_beacons(vif->type))
-+              ath9k_beacon_assign_slot(sc, vif);
-+
- out:
-       mutex_unlock(&sc->mutex);
-       ath9k_ps_restore(sc);
-@@ -1049,6 +1007,7 @@ static int ath9k_change_interface(struct
-       int ret = 0;
++      mi->sta = sta;
+       mi->lowest_rix = rate_lowest_index(sband, sta);
+       ctl_rate = &sband->bitrates[mi->lowest_rix];
+       mi->sp_ack_dur = ieee80211_frame_duration(sband->band, 10,
+                               ctl_rate->bitrate,
+                               !!(ctl_rate->flags & IEEE80211_RATE_ERP_G), 1);
  
-       ath_dbg(common, CONFIG, "Change Interface\n");
++      memset(mi->max_tp_rate, 0, sizeof(mi->max_tp_rate));
++      mi->max_prob_rate = 0;
 +
-       mutex_lock(&sc->mutex);
-       ath9k_ps_wakeup(sc);
-@@ -1061,15 +1020,16 @@ static int ath9k_change_interface(struct
-               }
+       for (i = 0; i < sband->n_bitrates; i++) {
+               struct minstrel_rate *mr = &mi->r[n];
+               unsigned int tx_time = 0, tx_time_cts = 0, tx_time_rtscts = 0;
+@@ -460,6 +477,8 @@ minstrel_rate_init(void *priv, struct ie
+               } while ((tx_time < mp->segment_size) &&
+                               (++mr->retry_count < mp->max_retry));
+               mr->adjusted_retry_count = mr->retry_count;
++              if (!(sband->bitrates[i].flags & IEEE80211_RATE_ERP_G))
++                      mr->retry_count_cts = mr->retry_count;
        }
  
--      /* Clean up old vif stuff */
-       if (ath9k_uses_beacons(vif->type))
--              ath9k_reclaim_beacon(sc, vif);
-+              ath9k_beacon_remove_slot(sc, vif);
--      /* Add new settings */
-       vif->type = new_type;
-       vif->p2p = p2p;
+       for (i = n; i < sband->n_bitrates; i++) {
+@@ -471,6 +490,7 @@ minstrel_rate_init(void *priv, struct ie
+       mi->stats_update = jiffies;
  
--      ath9k_do_vif_add_setup(hw, vif);
-+      ath9k_calculate_summary_state(hw, vif);
-+      if (ath9k_uses_beacons(vif->type))
-+              ath9k_beacon_assign_slot(sc, vif);
-+
- out:
-       ath9k_ps_restore(sc);
-       mutex_unlock(&sc->mutex);
-@@ -1089,9 +1049,8 @@ static void ath9k_remove_interface(struc
-       sc->nvifs--;
--      /* Reclaim beacon resources */
-       if (ath9k_uses_beacons(vif->type))
--              ath9k_reclaim_beacon(sc, vif);
-+              ath9k_beacon_remove_slot(sc, vif);
+       init_sample_table(mi);
++      minstrel_update_rates(mp, mi);
+ }
  
-       ath9k_calculate_summary_state(hw, NULL);
+ static void *
+--- a/net/mac80211/rc80211_minstrel.h
++++ b/net/mac80211/rc80211_minstrel.h
+@@ -9,7 +9,8 @@
+ #ifndef __RC_MINSTREL_H
+ #define __RC_MINSTREL_H
  
-@@ -1388,21 +1347,18 @@ static int ath9k_conf_tx(struct ieee8021
-       qi.tqi_aifs = params->aifs;
-       qi.tqi_cwmin = params->cw_min;
-       qi.tqi_cwmax = params->cw_max;
--      qi.tqi_burstTime = params->txop;
-+      qi.tqi_burstTime = params->txop * 32;
+-#define EWMA_LEVEL    75      /* ewma weighting factor [%] */
++#define EWMA_LEVEL    96      /* ewma weighting factor [/EWMA_DIV] */
++#define EWMA_DIV      128
+ #define SAMPLE_COLUMNS        10      /* number of columns in sample table */
  
-       ath_dbg(common, CONFIG,
-               "Configure tx [queue/halq] [%d/%d], aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
-               queue, txq->axq_qnum, params->aifs, params->cw_min,
-               params->cw_max, params->txop);
  
-+      ath_update_max_aggr_framelen(sc, queue, qi.tqi_burstTime);
-       ret = ath_txq_update(sc, txq->axq_qnum, &qi);
-       if (ret)
-               ath_err(common, "TXQ Update failed\n");
+@@ -27,7 +28,7 @@
+ static inline int
+ minstrel_ewma(int old, int new, int weight)
+ {
+-      return (new * (100 - weight) + old * weight) / 100;
++      return (new * (EWMA_DIV - weight) + old * weight) / EWMA_DIV;
+ }
  
--      if (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC)
--              if (queue == WME_AC_BE && !ret)
--                      ath_beaconq_config(sc);
--
-       mutex_unlock(&sc->mutex);
-       ath9k_ps_restore(sc);
  
-@@ -1471,85 +1427,36 @@ static int ath9k_set_key(struct ieee8021
+@@ -62,6 +63,8 @@ struct minstrel_rate {
+ };
  
-       return ret;
- }
--static void ath9k_bss_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
+ struct minstrel_sta_info {
++      struct ieee80211_sta *sta;
 +
-+static void ath9k_bss_assoc_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
- {
-       struct ath_softc *sc = data;
-       struct ath_common *common = ath9k_hw_common(sc->sc_ah);
--      struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
-       struct ath_vif *avp = (void *)vif->drv_priv;
-+      struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
-       unsigned long flags;
--      /*
--       * Skip iteration if primary station vif's bss info
--       * was not changed
--       */
+       unsigned long stats_update;
+       unsigned int sp_ack_dur;
+       unsigned int rate_avg;
+--- a/net/mac80211/rc80211_minstrel_debugfs.c
++++ b/net/mac80211/rc80211_minstrel_debugfs.c
+@@ -68,7 +68,7 @@ minstrel_stats_open(struct inode *inode,
+       file->private_data = ms;
+       p = ms->buf;
+-      p += sprintf(p, "rate     throughput  ewma prob   this prob  "
++      p += sprintf(p, "rate      throughput  ewma prob  this prob  "
+                       "this succ/attempt   success    attempts\n");
+       for (i = 0; i < mi->n_rates; i++) {
+               struct minstrel_rate *mr = &mi->r[i];
+@@ -86,7 +86,7 @@ minstrel_stats_open(struct inode *inode,
+               eprob = MINSTREL_TRUNC(mr->probability * 1000);
+               p += sprintf(p, "  %6u.%1u   %6u.%1u   %6u.%1u        "
+-                              "%3u(%3u)   %8llu    %8llu\n",
++                              "   %3u(%3u)  %8llu    %8llu\n",
+                               tp / 10, tp % 10,
+                               eprob / 10, eprob % 10,
+                               prob / 10, prob % 10,
+--- a/net/mac80211/rc80211_minstrel_ht.c
++++ b/net/mac80211/rc80211_minstrel_ht.c
+@@ -126,6 +126,9 @@ const struct mcs_group minstrel_mcs_grou
+ static u8 sample_table[SAMPLE_COLUMNS][MCS_GROUP_RATES];
++static void
++minstrel_ht_update_rates(struct minstrel_priv *mp, struct minstrel_ht_sta *mi);
 +
-       if (test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags))
-               return;
+ /*
+  * Look up an MCS group index based on mac80211 rate information
+  */
+@@ -244,6 +247,7 @@ minstrel_ht_update_stats(struct minstrel
+       struct minstrel_rate_stats *mr;
+       int cur_prob, cur_prob_tp, cur_tp, cur_tp2;
+       int group, i, index;
++      bool mi_rates_valid = false;
+       if (mi->ampdu_packets > 0) {
+               mi->avg_ampdu_len = minstrel_ewma(mi->avg_ampdu_len,
+@@ -254,11 +258,10 @@ minstrel_ht_update_stats(struct minstrel
+       mi->sample_slow = 0;
+       mi->sample_count = 0;
+-      mi->max_tp_rate = 0;
+-      mi->max_tp_rate2 = 0;
+-      mi->max_prob_rate = 0;
+       for (group = 0; group < ARRAY_SIZE(minstrel_mcs_groups); group++) {
++              bool mg_rates_valid = false;
++
+               cur_prob = 0;
+               cur_prob_tp = 0;
+               cur_tp = 0;
+@@ -268,15 +271,24 @@ minstrel_ht_update_stats(struct minstrel
+               if (!mg->supported)
+                       continue;
  
-       if (bss_conf->assoc) {
-               set_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags);
-               avp->primary_sta_vif = true;
+-              mg->max_tp_rate = 0;
+-              mg->max_tp_rate2 = 0;
+-              mg->max_prob_rate = 0;
+               mi->sample_count++;
+               for (i = 0; i < MCS_GROUP_RATES; i++) {
+                       if (!(mg->supported & BIT(i)))
+                               continue;
++                      /* initialize rates selections starting indexes */
++                      if (!mg_rates_valid) {
++                              mg->max_tp_rate = mg->max_tp_rate2 =
++                                      mg->max_prob_rate = i;
++                              if (!mi_rates_valid) {
++                                      mi->max_tp_rate = mi->max_tp_rate2 =
++                                              mi->max_prob_rate = i;
++                                      mi_rates_valid = true;
++                              }
++                              mg_rates_valid = true;
++                      }
 +
-               memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
-               common->curaid = bss_conf->aid;
-               ath9k_hw_write_associd(sc->sc_ah);
--              ath_dbg(common, CONFIG, "Bss Info ASSOC %d, bssid: %pM\n",
--                      bss_conf->aid, common->curbssid);
--              ath_beacon_config(sc, vif);
--              /*
--               * Request a re-configuration of Beacon related timers
--               * on the receipt of the first Beacon frame (i.e.,
--               * after time sync with the AP).
--               */
--              spin_lock_irqsave(&sc->sc_pm_lock, flags);
--              sc->ps_flags |= PS_BEACON_SYNC | PS_WAIT_FOR_BEACON;
--              spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
+                       mr = &mg->rates[i];
+                       mr->retry_updated = false;
+                       index = MCS_GROUP_RATES * group + i;
+@@ -456,7 +468,7 @@ minstrel_ht_tx_status(void *priv, struct
+       struct ieee80211_tx_rate *ar = info->status.rates;
+       struct minstrel_rate_stats *rate, *rate2;
+       struct minstrel_priv *mp = priv;
+-      bool last;
++      bool last, update = false;
+       int i;
  
--              /* Reset rssi stats */
-               sc->last_rssi = ATH_RSSI_DUMMY_MARKER;
-               sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
+       if (!msp->is_ht)
+@@ -505,21 +517,29 @@ minstrel_ht_tx_status(void *priv, struct
+       rate = minstrel_get_ratestats(mi, mi->max_tp_rate);
+       if (rate->attempts > 30 &&
+           MINSTREL_FRAC(rate->success, rate->attempts) <
+-          MINSTREL_FRAC(20, 100))
++          MINSTREL_FRAC(20, 100)) {
+               minstrel_downgrade_rate(mi, &mi->max_tp_rate, true);
++              update = true;
++      }
  
--              ath_start_rx_poll(sc, 3);
--
--              if (!common->disable_ani) {
--                      set_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--                      ath_start_ani(common);
--              }
--
--      }
--}
--
--static void ath9k_config_bss(struct ath_softc *sc, struct ieee80211_vif *vif)
--{
--      struct ath_common *common = ath9k_hw_common(sc->sc_ah);
--      struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
--      struct ath_vif *avp = (void *)vif->drv_priv;
--
--      if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
--              return;
--
--      /* Reconfigure bss info */
--      if (avp->primary_sta_vif && !bss_conf->assoc) {
--              ath_dbg(common, CONFIG, "Bss Info DISASSOC %d, bssid %pM\n",
--                      common->curaid, common->curbssid);
--              clear_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags);
--              clear_bit(SC_OP_BEACONS, &sc->sc_flags);
--              avp->primary_sta_vif = false;
--              memset(common->curbssid, 0, ETH_ALEN);
--              common->curaid = 0;
--      }
--
--      ieee80211_iterate_active_interfaces_atomic(
--                      sc->hw, ath9k_bss_iter, sc);
-+              spin_lock_irqsave(&sc->sc_pm_lock, flags);
-+              sc->ps_flags |= PS_BEACON_SYNC | PS_WAIT_FOR_BEACON;
-+              spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
+       rate2 = minstrel_get_ratestats(mi, mi->max_tp_rate2);
+       if (rate2->attempts > 30 &&
+           MINSTREL_FRAC(rate2->success, rate2->attempts) <
+-          MINSTREL_FRAC(20, 100))
++          MINSTREL_FRAC(20, 100)) {
+               minstrel_downgrade_rate(mi, &mi->max_tp_rate2, false);
++              update = true;
++      }
  
--      /*
--       * None of station vifs are associated.
--       * Clear bssid & aid
--       */
--      if (!test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) {
--              ath9k_hw_write_associd(sc->sc_ah);
--              clear_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--              del_timer_sync(&common->ani.timer);
--              del_timer_sync(&sc->rx_poll_timer);
--              memset(&sc->caldata, 0, sizeof(sc->caldata));
-+              ath_dbg(common, CONFIG,
-+                      "Primary Station interface: %pM, BSSID: %pM\n",
-+                      vif->addr, common->curbssid);
+       if (time_after(jiffies, mi->stats_update + (mp->update_interval / 2 * HZ) / 1000)) {
++              update = true;
+               minstrel_ht_update_stats(mp, mi);
+               if (!(info->flags & IEEE80211_TX_CTL_AMPDU) &&
+                   mi->max_prob_rate / MCS_GROUP_RATES != MINSTREL_CCK_GROUP)
+                       minstrel_aggr_check(sta, skb);
        }
++
++      if (update)
++              minstrel_ht_update_rates(mp, mi);
  }
  
-@@ -1558,6 +1465,11 @@ static void ath9k_bss_info_changed(struc
-                                  struct ieee80211_bss_conf *bss_conf,
-                                  u32 changed)
- {
-+#define CHECK_ANI                             \
-+      (BSS_CHANGED_ASSOC |                    \
-+       BSS_CHANGED_IBSS |                     \
-+       BSS_CHANGED_BEACON_ENABLED)
-+
-       struct ath_softc *sc = hw->priv;
-       struct ath_hw *ah = sc->sc_ah;
-       struct ath_common *common = ath9k_hw_common(ah);
-@@ -1568,53 +1480,43 @@ static void ath9k_bss_info_changed(struc
-       mutex_lock(&sc->mutex);
+ static void
+@@ -580,39 +600,73 @@ minstrel_calc_retransmit(struct minstrel
+                (++mr->retry_count < mp->max_retry));
+ }
  
-       if (changed & BSS_CHANGED_ASSOC) {
--              ath9k_config_bss(sc, vif);
-+              ath_dbg(common, CONFIG, "BSSID %pM Changed ASSOC %d\n",
-+                      bss_conf->bssid, bss_conf->assoc);
+-
+ static void
+ minstrel_ht_set_rate(struct minstrel_priv *mp, struct minstrel_ht_sta *mi,
+-                     struct ieee80211_tx_rate *rate, int index,
+-                     bool sample, bool rtscts)
++                     struct ieee80211_sta_rates *ratetbl, int offset, int index)
+ {
+       const struct mcs_group *group = &minstrel_mcs_groups[index / MCS_GROUP_RATES];
+       struct minstrel_rate_stats *mr;
++      u8 idx;
++      u16 flags;
+       mr = minstrel_get_ratestats(mi, index);
+       if (!mr->retry_updated)
+               minstrel_calc_retransmit(mp, mi, index);
+-      if (sample)
+-              rate->count = 1;
+-      else if (mr->probability < MINSTREL_FRAC(20, 100))
+-              rate->count = 2;
+-      else if (rtscts)
+-              rate->count = mr->retry_count_rtscts;
+-      else
+-              rate->count = mr->retry_count;
+-
+-      rate->flags = 0;
+-      if (rtscts)
+-              rate->flags |= IEEE80211_TX_RC_USE_RTS_CTS;
++      if (mr->probability < MINSTREL_FRAC(20, 100) || !mr->retry_count) {
++              ratetbl->rate[offset].count = 2;
++              ratetbl->rate[offset].count_rts = 2;
++              ratetbl->rate[offset].count_cts = 2;
++      } else {
++              ratetbl->rate[offset].count = mr->retry_count;
++              ratetbl->rate[offset].count_cts = mr->retry_count;
++              ratetbl->rate[offset].count_rts = mr->retry_count_rtscts;
++      }
  
--              ath_dbg(common, CONFIG, "BSSID: %pM aid: 0x%x\n",
--                      common->curbssid, common->curaid);
-+              /*
-+               * Do not do anything when the opmode is not STATION.
-+               */
-+              if (ah->opmode == NL80211_IFTYPE_STATION) {
-+                      if (avp->primary_sta_vif && !bss_conf->assoc) {
-+                              clear_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags);
-+                              clear_bit(SC_OP_BEACONS, &sc->sc_flags);
-+                              avp->primary_sta_vif = false;
-+                      }
+       if (index / MCS_GROUP_RATES == MINSTREL_CCK_GROUP) {
+-              rate->idx = mp->cck_rates[index % ARRAY_SIZE(mp->cck_rates)];
++              idx = mp->cck_rates[index % ARRAY_SIZE(mp->cck_rates)];
++              flags = 0;
++      } else {
++              idx = index % MCS_GROUP_RATES +
++                    (group->streams - 1) * MCS_GROUP_RATES;
++              flags = IEEE80211_TX_RC_MCS | group->flags;
++      }
 +
-+                      ieee80211_iterate_active_interfaces_atomic(sc->hw,
-+                                                 ath9k_bss_assoc_iter, sc);
++      if (offset > 0) {
++              ratetbl->rate[offset].count = ratetbl->rate[offset].count_rts;
++              flags |= IEEE80211_TX_RC_USE_RTS_CTS;
++      }
 +
-+                      if (!test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) {
-+                              memset(common->curbssid, 0, ETH_ALEN);
-+                              common->curaid = 0;
-+                              ath9k_hw_write_associd(sc->sc_ah);
-+                      }
-+              }
++      ratetbl->rate[offset].idx = idx;
++      ratetbl->rate[offset].flags = flags;
++}
++
++static void
++minstrel_ht_update_rates(struct minstrel_priv *mp, struct minstrel_ht_sta *mi)
++{
++      struct ieee80211_sta_rates *rates;
++      int i = 0;
++
++      rates = kzalloc(sizeof(*rates), GFP_ATOMIC);
++      if (!rates)
+               return;
++
++      /* Start with max_tp_rate */
++      minstrel_ht_set_rate(mp, mi, rates, i++, mi->max_tp_rate);
++
++      if (mp->hw->max_rates >= 3) {
++              /* At least 3 tx rates supported, use max_tp_rate2 next */
++              minstrel_ht_set_rate(mp, mi, rates, i++, mi->max_tp_rate2);
++      }
++
++      if (mp->hw->max_rates >= 2) {
++              /*
++               * At least 2 tx rates supported, use max_prob_rate next */
++              minstrel_ht_set_rate(mp, mi, rates, i++, mi->max_prob_rate);
        }
  
-       if (changed & BSS_CHANGED_IBSS) {
--              /* There can be only one vif available */
-               memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
-               common->curaid = bss_conf->aid;
-               ath9k_hw_write_associd(sc->sc_ah);
--
--              if (bss_conf->ibss_joined) {
--                      sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
--
--                      if (!common->disable_ani) {
--                              set_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--                              ath_start_ani(common);
--                      }
--
--              } else {
--                      clear_bit(SC_OP_ANI_RUN, &sc->sc_flags);
--                      del_timer_sync(&common->ani.timer);
--                      del_timer_sync(&sc->rx_poll_timer);
--              }
+-      rate->flags |= IEEE80211_TX_RC_MCS | group->flags;
+-      rate->idx = index % MCS_GROUP_RATES + (group->streams - 1) * MCS_GROUP_RATES;
++      rates->rate[i].idx = -1;
++      rate_control_set_rates(mp->hw, mi->sta, rates);
+ }
+ static inline int
+@@ -702,13 +756,13 @@ static void
+ minstrel_ht_get_rate(void *priv, struct ieee80211_sta *sta, void *priv_sta,
+                      struct ieee80211_tx_rate_control *txrc)
+ {
++      const struct mcs_group *sample_group;
+       struct ieee80211_tx_info *info = IEEE80211_SKB_CB(txrc->skb);
+-      struct ieee80211_tx_rate *ar = info->status.rates;
++      struct ieee80211_tx_rate *rate = &info->status.rates[0];
+       struct minstrel_ht_sta_priv *msp = priv_sta;
+       struct minstrel_ht_sta *mi = &msp->ht;
+       struct minstrel_priv *mp = priv;
+       int sample_idx;
+-      bool sample = false;
+       if (rate_control_send_low(sta, priv_sta, txrc))
+               return;
+@@ -736,51 +790,6 @@ minstrel_ht_get_rate(void *priv, struct 
        }
+ #endif
  
--      /*
--       * In case of AP mode, the HW TSF has to be reset
--       * when the beacon interval changes.
--       */
--      if ((changed & BSS_CHANGED_BEACON_INT) &&
--          (vif->type == NL80211_IFTYPE_AP))
--              set_bit(SC_OP_TSF_RESET, &sc->sc_flags);
+-      if (sample_idx >= 0) {
+-              sample = true;
+-              minstrel_ht_set_rate(mp, mi, &ar[0], sample_idx,
+-                      true, false);
+-              info->flags |= IEEE80211_TX_CTL_RATE_CTRL_PROBE;
+-      } else {
+-              minstrel_ht_set_rate(mp, mi, &ar[0], mi->max_tp_rate,
+-                      false, false);
+-      }
 -
--      /* Configure beaconing (AP, IBSS, MESH) */
--      if (ath9k_uses_beacons(vif->type) &&
--          ((changed & BSS_CHANGED_BEACON) ||
--           (changed & BSS_CHANGED_BEACON_ENABLED) ||
--           (changed & BSS_CHANGED_BEACON_INT))) {
--              ath9k_set_beaconing_status(sc, false);
--              if (bss_conf->enable_beacon)
--                      ath_beacon_alloc(sc, vif);
+-      if (mp->hw->max_rates >= 3) {
+-              /*
+-               * At least 3 tx rates supported, use
+-               * sample_rate -> max_tp_rate -> max_prob_rate for sampling and
+-               * max_tp_rate -> max_tp_rate2 -> max_prob_rate by default.
+-               */
+-              if (sample_idx >= 0)
+-                      minstrel_ht_set_rate(mp, mi, &ar[1], mi->max_tp_rate,
+-                              false, false);
 -              else
--                      avp->is_bslot_active = false;
--              ath_beacon_config(sc, vif);
--              ath9k_set_beaconing_status(sc, true);
-+      if ((changed & BSS_CHANGED_BEACON) ||
-+          (changed & BSS_CHANGED_BEACON_ENABLED) ||
-+          (changed & BSS_CHANGED_BEACON_INT)) {
-+              if (ah->opmode == NL80211_IFTYPE_AP)
-+                      ath9k_set_tsfadjust(sc, vif);
-+              if (ath9k_allow_beacon_config(sc, vif))
-+                      ath9k_beacon_config(sc, vif, changed);
-       }
+-                      minstrel_ht_set_rate(mp, mi, &ar[1], mi->max_tp_rate2,
+-                              false, true);
+-
+-              minstrel_ht_set_rate(mp, mi, &ar[2], mi->max_prob_rate,
+-                                   false, !sample);
+-
+-              ar[3].count = 0;
+-              ar[3].idx = -1;
+-      } else if (mp->hw->max_rates == 2) {
+-              /*
+-               * Only 2 tx rates supported, use
+-               * sample_rate -> max_prob_rate for sampling and
+-               * max_tp_rate -> max_prob_rate by default.
+-               */
+-              minstrel_ht_set_rate(mp, mi, &ar[1], mi->max_prob_rate,
+-                                   false, !sample);
+-
+-              ar[2].count = 0;
+-              ar[2].idx = -1;
+-      } else {
+-              /* Not using MRR, only use the first rate */
+-              ar[1].count = 0;
+-              ar[1].idx = -1;
+-      }
+-
+       mi->total_packets++;
  
-       if (changed & BSS_CHANGED_ERP_SLOT) {
-@@ -1636,8 +1538,13 @@ static void ath9k_bss_info_changed(struc
-               }
+       /* wraparound */
+@@ -788,6 +797,16 @@ minstrel_ht_get_rate(void *priv, struct 
+               mi->total_packets = 0;
+               mi->sample_packets = 0;
        }
-+      if (changed & CHECK_ANI)
-+              ath_check_ani(sc);
 +
-       mutex_unlock(&sc->mutex);
-       ath9k_ps_restore(sc);
++      if (sample_idx < 0)
++              return;
 +
-+#undef CHECK_ANI
++      sample_group = &minstrel_mcs_groups[sample_idx / MCS_GROUP_RATES];
++      info->flags |= IEEE80211_TX_CTL_RATE_CTRL_PROBE;
++      rate->idx = sample_idx % MCS_GROUP_RATES +
++                  (sample_group->streams - 1) * MCS_GROUP_RATES;
++      rate->flags = IEEE80211_TX_RC_MCS | sample_group->flags;
++      rate->count = 1;
  }
  
- static u64 ath9k_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
-@@ -1866,10 +1773,11 @@ static int ath9k_tx_last_beacon(struct i
-       if (!vif)
-               return 0;
+ static void
+@@ -837,6 +856,8 @@ minstrel_ht_update_caps(void *priv, stru
  
--      avp = (void *)vif->drv_priv;
--      if (!avp->is_bslot_active)
-+      if (!vif->bss_conf.enable_beacon)
-               return 0;
+       msp->is_ht = true;
+       memset(mi, 0, sizeof(*mi));
++
++      mi->sta = sta;
+       mi->stats_update = jiffies;
+       ack_dur = ieee80211_frame_duration(sband->band, 10, 60, 1, 1);
+@@ -898,6 +919,9 @@ minstrel_ht_update_caps(void *priv, stru
+       if (!n_supported)
+               goto use_legacy;
  
-+      avp = (void *)vif->drv_priv;
++      minstrel_ht_update_stats(mp, mi);
++      minstrel_ht_update_rates(mp, mi);
 +
-       if (!sc->beacon.tx_processed && !edma) {
-               tasklet_disable(&sc->bcon_tasklet);
+       return;
  
-@@ -1923,12 +1831,29 @@ static u32 fill_chainmask(u32 cap, u32 n
-       return filled;
- }
+ use_legacy:
+--- a/net/mac80211/rc80211_minstrel_ht.h
++++ b/net/mac80211/rc80211_minstrel_ht.h
+@@ -65,6 +65,8 @@ struct minstrel_mcs_group_data {
+ };
  
-+static bool validate_antenna_mask(struct ath_hw *ah, u32 val)
-+{
-+      switch (val & 0x7) {
-+      case 0x1:
-+      case 0x3:
-+      case 0x7:
-+              return true;
-+      case 0x2:
-+              return (ah->caps.rx_chainmask == 1);
-+      default:
-+              return false;
-+      }
-+}
+ struct minstrel_ht_sta {
++      struct ieee80211_sta *sta;
 +
- static int ath9k_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)
- {
-       struct ath_softc *sc = hw->priv;
-       struct ath_hw *ah = sc->sc_ah;
+       /* ampdu length (average, per sampling interval) */
+       unsigned int ampdu_len;
+       unsigned int ampdu_packets;
+--- a/net/mac80211/rx.c
++++ b/net/mac80211/rx.c
+@@ -1372,6 +1372,7 @@ ieee80211_rx_h_sta_process(struct ieee80
+       struct sk_buff *skb = rx->skb;
+       struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
+       struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
++      int i;
+       if (!sta)
+               return RX_CONTINUE;
+@@ -1422,6 +1423,19 @@ ieee80211_rx_h_sta_process(struct ieee80
+               ewma_add(&sta->avg_signal, -status->signal);
+       }
  
--      if (!rx_ant || !tx_ant)
-+      if (ah->caps.rx_chainmask != 1)
-+              rx_ant |= tx_ant;
++      if (status->chains) {
++              sta->chains = status->chains;
++              for (i = 0; i < ARRAY_SIZE(status->chain_signal); i++) {
++                      int signal = status->chain_signal[i];
 +
-+      if (!validate_antenna_mask(ah, rx_ant) || !tx_ant)
-               return -EINVAL;
-       sc->ant_rx = rx_ant;
---- a/drivers/net/wireless/ath/ath9k/mci.c
-+++ b/drivers/net/wireless/ath/ath9k/mci.c
-@@ -202,7 +202,7 @@ static void ath_mci_cal_msg(struct ath_s
-       case MCI_GPM_BT_CAL_REQ:
-               if (mci_hw->bt_state == MCI_BT_AWAKE) {
-                       ar9003_mci_state(ah, MCI_STATE_SET_BT_CAL_START);
--                      ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
-+                      ath9k_queue_reset(sc, RESET_TYPE_MCI);
-               }
-               ath_dbg(common, MCI, "MCI State : %d\n", mci_hw->bt_state);
-               break;
---- a/drivers/net/wireless/ath/ath9k/recv.c
-+++ b/drivers/net/wireless/ath/ath9k/recv.c
-@@ -553,7 +553,7 @@ static void ath_rx_ps_beacon(struct ath_
-               sc->ps_flags &= ~PS_BEACON_SYNC;
-               ath_dbg(common, PS,
-                       "Reconfigure Beacon timers based on timestamp from the AP\n");
--              ath_set_beacon(sc);
-+              ath9k_set_beacon(sc);
++                      if (!(status->chains & BIT(i)))
++                              continue;
++
++                      sta->chain_signal_last[i] = signal;
++                      ewma_add(&sta->chain_signal_avg[i], -signal);
++              }
++      }
++
+       /*
+        * Change STA power saving mode only at the end of a frame
+        * exchange sequence.
+@@ -2085,6 +2099,7 @@ ieee80211_rx_h_mesh_fwding(struct ieee80
        }
  
-       if (ath_beacon_dtim_pending_cab(skb)) {
---- a/drivers/net/wireless/ath/ath9k/xmit.c
-+++ b/drivers/net/wireless/ath/ath9k/xmit.c
-@@ -29,6 +29,8 @@
- #define HT_LTF(_ns)             (4 * (_ns))
- #define SYMBOL_TIME(_ns)        ((_ns) << 2) /* ns * 4 us */
- #define SYMBOL_TIME_HALFGI(_ns) (((_ns) * 18 + 4) / 5)  /* ns * 3.6 us */
-+#define TIME_SYMBOLS(t)         ((t) >> 2)
-+#define TIME_SYMBOLS_HALFGI(t)  (((t) * 5 - 4) / 18)
- #define NUM_SYMBOLS_PER_USEC(_usec) (_usec >> 2)
- #define NUM_SYMBOLS_PER_USEC_HALFGI(_usec) (((_usec*5)-4)/18)
-@@ -74,33 +76,6 @@ enum {
-       MCS_HT40_SGI,
- };
--static int ath_max_4ms_framelen[4][32] = {
--      [MCS_HT20] = {
--              3212,  6432,  9648,  12864,  19300,  25736,  28952,  32172,
--              6424,  12852, 19280, 25708,  38568,  51424,  57852,  64280,
--              9628,  19260, 28896, 38528,  57792,  65532,  65532,  65532,
--              12828, 25656, 38488, 51320,  65532,  65532,  65532,  65532,
--      },
--      [MCS_HT20_SGI] = {
--              3572,  7144,  10720,  14296,  21444,  28596,  32172,  35744,
--              7140,  14284, 21428,  28568,  42856,  57144,  64288,  65532,
--              10700, 21408, 32112,  42816,  64228,  65532,  65532,  65532,
--              14256, 28516, 42780,  57040,  65532,  65532,  65532,  65532,
--      },
--      [MCS_HT40] = {
--              6680,  13360,  20044,  26724,  40092,  53456,  60140,  65532,
--              13348, 26700,  40052,  53400,  65532,  65532,  65532,  65532,
--              20004, 40008,  60016,  65532,  65532,  65532,  65532,  65532,
--              26644, 53292,  65532,  65532,  65532,  65532,  65532,  65532,
--      },
--      [MCS_HT40_SGI] = {
--              7420,  14844,  22272,  29696,  44544,  59396,  65532,  65532,
--              14832, 29668,  44504,  59340,  65532,  65532,  65532,  65532,
--              22232, 44464,  65532,  65532,  65532,  65532,  65532,  65532,
--              29616, 59232,  65532,  65532,  65532,  65532,  65532,  65532,
--      }
--};
--
- /*********************/
- /* Aggregation logic */
- /*********************/
-@@ -614,10 +589,8 @@ static void ath_tx_complete_aggr(struct 
-       rcu_read_unlock();
--      if (needreset) {
--              RESET_STAT_INC(sc, RESET_TYPE_TX_ERROR);
--              ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
--      }
-+      if (needreset)
-+              ath9k_queue_reset(sc, RESET_TYPE_TX_ERROR);
- }
- static bool ath_lookup_legacy(struct ath_buf *bf)
-@@ -650,6 +623,7 @@ static u32 ath_lookup_rate(struct ath_so
-       struct ieee80211_tx_rate *rates;
-       u32 max_4ms_framelen, frmlen;
-       u16 aggr_limit, bt_aggr_limit, legacy = 0;
-+      int q = tid->ac->txq->mac80211_qnum;
-       int i;
-       skb = bf->bf_mpdu;
-@@ -658,8 +632,7 @@ static u32 ath_lookup_rate(struct ath_so
+       fwd_hdr =  (struct ieee80211_hdr *) fwd_skb->data;
++      fwd_hdr->frame_control &= ~cpu_to_le16(IEEE80211_FCTL_RETRY);
+       info = IEEE80211_SKB_CB(fwd_skb);
+       memset(info, 0, sizeof(*info));
+       info->flags |= IEEE80211_TX_INTFL_NEED_TXPROCESSING;
+@@ -2356,6 +2371,7 @@ ieee80211_rx_h_action(struct ieee80211_r
+                   sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
+                   sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
+                   sdata->vif.type != NL80211_IFTYPE_AP &&
++                  sdata->vif.type != NL80211_IFTYPE_WDS &&
+                   sdata->vif.type != NL80211_IFTYPE_ADHOC)
+                       break;
  
-       /*
-        * Find the lowest frame length among the rate series that will have a
--       * 4ms transmit duration.
--       * TODO - TXOP limit needs to be considered.
-+       * 4ms (or TXOP limited) transmit duration.
-        */
-       max_4ms_framelen = ATH_AMPDU_LIMIT_MAX;
+@@ -2423,6 +2439,22 @@ ieee80211_rx_h_action(struct ieee80211_r
+               }
  
-@@ -682,7 +655,7 @@ static u32 ath_lookup_rate(struct ath_so
-               if (rates[i].flags & IEEE80211_TX_RC_SHORT_GI)
-                       modeidx++;
+               break;
++      case WLAN_CATEGORY_PUBLIC:
++              if (len < IEEE80211_MIN_ACTION_SIZE + 1)
++                      goto invalid;
++              if (sdata->vif.type != NL80211_IFTYPE_STATION)
++                      break;
++              if (!rx->sta)
++                      break;
++              if (!ether_addr_equal(mgmt->bssid, sdata->u.mgd.bssid))
++                      break;
++              if (mgmt->u.action.u.ext_chan_switch.action_code !=
++                              WLAN_PUB_ACTION_EXT_CHANSW_ANN)
++                      break;
++              if (len < offsetof(struct ieee80211_mgmt,
++                                 u.action.u.ext_chan_switch.variable))
++                      goto invalid;
++              goto queue;
+       case WLAN_CATEGORY_VHT:
+               if (sdata->vif.type != NL80211_IFTYPE_STATION &&
+                   sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
+@@ -2506,10 +2538,6 @@ ieee80211_rx_h_action(struct ieee80211_r
+                       ieee80211_process_measurement_req(sdata, mgmt, len);
+                       goto handled;
+               case WLAN_ACTION_SPCT_CHL_SWITCH:
+-                      if (len < (IEEE80211_MIN_ACTION_SIZE +
+-                                 sizeof(mgmt->u.action.u.chan_switch)))
+-                              break;
+-
+                       if (sdata->vif.type != NL80211_IFTYPE_STATION)
+                               break;
  
--              frmlen = ath_max_4ms_framelen[modeidx][rates[i].idx];
-+              frmlen = sc->tx.max_aggr_framelen[q][modeidx][rates[i].idx];
-               max_4ms_framelen = min(max_4ms_framelen, frmlen);
-       }
+@@ -2695,14 +2723,15 @@ ieee80211_rx_h_mgmt(struct ieee80211_rx_
  
-@@ -929,6 +902,44 @@ static u32 ath_pkt_duration(struct ath_s
-       return duration;
- }
+       if (!ieee80211_vif_is_mesh(&sdata->vif) &&
+           sdata->vif.type != NL80211_IFTYPE_ADHOC &&
+-          sdata->vif.type != NL80211_IFTYPE_STATION)
++          sdata->vif.type != NL80211_IFTYPE_STATION &&
++          sdata->vif.type != NL80211_IFTYPE_WDS)
+               return RX_DROP_MONITOR;
  
-+static int ath_max_framelen(int usec, int mcs, bool ht40, bool sgi)
-+{
-+      int streams = HT_RC_2_STREAMS(mcs);
-+      int symbols, bits;
-+      int bytes = 0;
-+
-+      symbols = sgi ? TIME_SYMBOLS_HALFGI(usec) : TIME_SYMBOLS(usec);
-+      bits = symbols * bits_per_symbol[mcs % 8][ht40] * streams;
-+      bits -= OFDM_PLCP_BITS;
-+      bytes = bits / 8;
-+      bytes -= L_STF + L_LTF + L_SIG + HT_SIG + HT_STF + HT_LTF(streams);
-+      if (bytes > 65532)
-+              bytes = 65532;
-+
-+      return bytes;
-+}
+       switch (stype) {
+       case cpu_to_le16(IEEE80211_STYPE_AUTH):
+       case cpu_to_le16(IEEE80211_STYPE_BEACON):
+       case cpu_to_le16(IEEE80211_STYPE_PROBE_RESP):
+-              /* process for all: mesh, mlme, ibss */
++              /* process for all: mesh, mlme, ibss, wds */
+               break;
+       case cpu_to_le16(IEEE80211_STYPE_ASSOC_RESP):
+       case cpu_to_le16(IEEE80211_STYPE_REASSOC_RESP):
+@@ -3023,6 +3052,9 @@ static int prepare_for_handlers(struct i
+                        * and location updates. Note that mac80211
+                        * itself never looks at these frames.
+                        */
++                      if (!multicast &&
++                          !ether_addr_equal(sdata->vif.addr, hdr->addr1))
++                              return 0;
+                       if (ieee80211_is_public_action(hdr, skb->len))
+                               return 1;
+                       if (!ieee80211_is_beacon(hdr->frame_control))
+@@ -3031,10 +3063,16 @@ static int prepare_for_handlers(struct i
+               }
+               break;
+       case NL80211_IFTYPE_WDS:
+-              if (bssid || !ieee80211_is_data(hdr->frame_control))
+-                      return 0;
+               if (!ether_addr_equal(sdata->u.wds.remote_addr, hdr->addr2))
+                       return 0;
 +
-+void ath_update_max_aggr_framelen(struct ath_softc *sc, int queue, int txop)
-+{
-+      u16 *cur_ht20, *cur_ht20_sgi, *cur_ht40, *cur_ht40_sgi;
-+      int mcs;
-+
-+      /* 4ms is the default (and maximum) duration */
-+      if (!txop || txop > 4096)
-+              txop = 4096;
-+
-+      cur_ht20 = sc->tx.max_aggr_framelen[queue][MCS_HT20];
-+      cur_ht20_sgi = sc->tx.max_aggr_framelen[queue][MCS_HT20_SGI];
-+      cur_ht40 = sc->tx.max_aggr_framelen[queue][MCS_HT40];
-+      cur_ht40_sgi = sc->tx.max_aggr_framelen[queue][MCS_HT40_SGI];
-+      for (mcs = 0; mcs < 32; mcs++) {
-+              cur_ht20[mcs] = ath_max_framelen(txop, mcs, false, false);
-+              cur_ht20_sgi[mcs] = ath_max_framelen(txop, mcs, false, true);
-+              cur_ht40[mcs] = ath_max_framelen(txop, mcs, true, false);
-+              cur_ht40_sgi[mcs] = ath_max_framelen(txop, mcs, true, true);
-+      }
-+}
++              if (ieee80211_is_data(hdr->frame_control) ||
++                  ieee80211_is_action(hdr->frame_control)) {
++                      if (compare_ether_addr(sdata->vif.addr, hdr->addr1))
++                              return 0;
++              } else if (!ieee80211_is_beacon(hdr->frame_control))
++                      return 0;
 +
- static void ath_buf_set_rate(struct ath_softc *sc, struct ath_buf *bf,
-                            struct ath_tx_info *info, int len)
- {
-@@ -1586,7 +1597,8 @@ void ath_txq_schedule(struct ath_softc *
-       struct ath_atx_ac *ac, *ac_tmp, *last_ac;
-       struct ath_atx_tid *tid, *last_tid;
--      if (work_pending(&sc->hw_reset_work) || list_empty(&txq->axq_acq) ||
-+      if (test_bit(SC_OP_HW_RESET, &sc->sc_flags) ||
-+          list_empty(&txq->axq_acq) ||
-           txq->axq_ampdu_depth >= ATH_AGGR_MIN_QDEPTH)
+               break;
+       case NL80211_IFTYPE_P2P_DEVICE:
+               if (!ieee80211_is_public_action(hdr, skb->len) &&
+--- a/net/mac80211/scan.c
++++ b/net/mac80211/scan.c
+@@ -181,7 +181,7 @@ void ieee80211_scan_rx(struct ieee80211_
+       if (baselen > skb->len)
                return;
  
-@@ -1988,7 +2000,8 @@ int ath_tx_start(struct ieee80211_hw *hw
+-      ieee802_11_parse_elems(elements, skb->len - baselen, &elems);
++      ieee802_11_parse_elems(elements, skb->len - baselen, false, &elems);
  
-       ath_txq_lock(sc, txq);
-       if (txq == sc->tx.txq_map[q] &&
--          ++txq->pending_frames > ATH_MAX_QDEPTH && !txq->stopped) {
-+          ++txq->pending_frames > sc->tx.txq_max_pending[q] &&
-+          !txq->stopped) {
-               ieee80211_stop_queue(sc->hw, q);
-               txq->stopped = true;
-       }
-@@ -2047,7 +2060,8 @@ static void ath_tx_complete(struct ath_s
-               if (WARN_ON(--txq->pending_frames < 0))
-                       txq->pending_frames = 0;
--              if (txq->stopped && txq->pending_frames < ATH_MAX_QDEPTH) {
-+              if (txq->stopped &&
-+                  txq->pending_frames < sc->tx.txq_max_pending[q]) {
-                       ieee80211_wake_queue(sc->hw, q);
-                       txq->stopped = false;
-               }
-@@ -2191,7 +2205,7 @@ static void ath_tx_processq(struct ath_s
+       channel = ieee80211_get_channel(local->hw.wiphy, rx_status->freq);
  
-       ath_txq_lock(sc, txq);
-       for (;;) {
--              if (work_pending(&sc->hw_reset_work))
-+              if (test_bit(SC_OP_HW_RESET, &sc->sc_flags))
-                       break;
-               if (list_empty(&txq->axq_q)) {
-@@ -2274,7 +2288,7 @@ void ath_tx_edma_tasklet(struct ath_soft
-       int status;
-       for (;;) {
--              if (work_pending(&sc->hw_reset_work))
-+              if (test_bit(SC_OP_HW_RESET, &sc->sc_flags))
-                       break;
+--- a/net/mac80211/sta_info.h
++++ b/net/mac80211/sta_info.h
+@@ -32,7 +32,6 @@
+  * @WLAN_STA_SHORT_PREAMBLE: Station is capable of receiving short-preamble
+  *    frames.
+  * @WLAN_STA_WME: Station is a QoS-STA.
+- * @WLAN_STA_WDS: Station is one of our WDS peers.
+  * @WLAN_STA_CLEAR_PS_FILT: Clear PS filter in hardware (using the
+  *    IEEE80211_TX_CTL_CLEAR_PS_FILT control flag) when the next
+  *    frame to this station is transmitted.
+@@ -66,7 +65,6 @@ enum ieee80211_sta_info_flags {
+       WLAN_STA_AUTHORIZED,
+       WLAN_STA_SHORT_PREAMBLE,
+       WLAN_STA_WME,
+-      WLAN_STA_WDS,
+       WLAN_STA_CLEAR_PS_FILT,
+       WLAN_STA_MFP,
+       WLAN_STA_BLOCK_BA,
+@@ -344,6 +342,11 @@ struct sta_info {
+       int last_signal;
+       struct ewma avg_signal;
+       int last_ack_signal;
++
++      u8 chains;
++      s8 chain_signal_last[IEEE80211_MAX_CHAINS];
++      struct ewma chain_signal_avg[IEEE80211_MAX_CHAINS];
++
+       /* Plus 1 for non-QoS frames */
+       __le16 last_seq_ctrl[IEEE80211_NUM_TIDS + 1];
+--- a/net/mac80211/trace.h
++++ b/net/mac80211/trace.h
+@@ -990,23 +990,23 @@ TRACE_EVENT(drv_channel_switch,
+       TP_STRUCT__entry(
+               LOCAL_ENTRY
++              CHANDEF_ENTRY
+               __field(u64, timestamp)
+               __field(bool, block_tx)
+-              __field(u16, freq)
+               __field(u8, count)
+       ),
+       TP_fast_assign(
+               LOCAL_ASSIGN;
++              CHANDEF_ASSIGN(&ch_switch->chandef)
+               __entry->timestamp = ch_switch->timestamp;
+               __entry->block_tx = ch_switch->block_tx;
+-              __entry->freq = ch_switch->channel->center_freq;
+               __entry->count = ch_switch->count;
+       ),
+       TP_printk(
+-              LOCAL_PR_FMT " new freq:%u count:%d",
+-              LOCAL_PR_ARG, __entry->freq, __entry->count
++              LOCAL_PR_FMT " new " CHANDEF_PR_FMT " count:%d",
++              LOCAL_PR_ARG, CHANDEF_PR_ARG, __entry->count
+       )
+ );
+--- a/net/mac80211/tx.c
++++ b/net/mac80211/tx.c
+@@ -48,15 +48,15 @@ static __le16 ieee80211_duration(struct 
+       struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
+       /* assume HW handles this */
+-      if (info->control.rates[0].flags & IEEE80211_TX_RC_MCS)
++      if (tx->rate.flags & IEEE80211_TX_RC_MCS)
+               return 0;
  
-               status = ath9k_hw_txprocdesc(ah, NULL, (void *)&ts);
---- a/drivers/net/wireless/b43/xmit.c
-+++ b/drivers/net/wireless/b43/xmit.c
-@@ -663,7 +663,7 @@ void b43_rx(struct b43_wldev *dev, struc
-       u32 uninitialized_var(macstat);
-       u16 chanid;
-       u16 phytype;
--      int padding;
-+      int padding, rate_idx;
+       /* uh huh? */
+-      if (WARN_ON_ONCE(info->control.rates[0].idx < 0))
++      if (WARN_ON_ONCE(tx->rate.idx < 0))
+               return 0;
  
-       memset(&status, 0, sizeof(status));
+       sband = local->hw.wiphy->bands[info->band];
+-      txrate = &sband->bitrates[info->control.rates[0].idx];
++      txrate = &sband->bitrates[tx->rate.idx];
  
-@@ -766,16 +766,17 @@ void b43_rx(struct b43_wldev *dev, struc
-       }
+       erp = txrate->flags & IEEE80211_RATE_ERP_G;
  
-       if (phystat0 & B43_RX_PHYST0_OFDM)
--              status.rate_idx = b43_plcp_get_bitrate_idx_ofdm(plcp,
-+              rate_idx = b43_plcp_get_bitrate_idx_ofdm(plcp,
-                                               phytype == B43_PHYTYPE_A);
+@@ -617,11 +617,9 @@ ieee80211_tx_h_rate_ctrl(struct ieee8021
+       struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx->skb);
+       struct ieee80211_hdr *hdr = (void *)tx->skb->data;
+       struct ieee80211_supported_band *sband;
+-      struct ieee80211_rate *rate;
+-      int i;
+       u32 len;
+-      bool inval = false, rts = false, short_preamble = false;
+       struct ieee80211_tx_rate_control txrc;
++      struct ieee80211_sta_rates *ratetbl = NULL;
+       bool assoc = false;
+       memset(&txrc, 0, sizeof(txrc));
+@@ -642,18 +640,23 @@ ieee80211_tx_h_rate_ctrl(struct ieee8021
+               txrc.max_rate_idx = -1;
        else
--              status.rate_idx = b43_plcp_get_bitrate_idx_cck(plcp);
--      if (unlikely(status.rate_idx == -1)) {
-+              rate_idx = b43_plcp_get_bitrate_idx_cck(plcp);
-+      if (unlikely(rate_idx == -1)) {
-               /* PLCP seems to be corrupted.
-                * Drop the frame, if we are not interested in corrupted frames. */
-               if (!(dev->wl->filter_flags & FIF_PLCPFAIL))
-                       goto drop;
+               txrc.max_rate_idx = fls(txrc.rate_idx_mask) - 1;
+-      memcpy(txrc.rate_idx_mcs_mask,
+-             tx->sdata->rc_rateidx_mcs_mask[info->band],
+-             sizeof(txrc.rate_idx_mcs_mask));
++
++      if (tx->sdata->rc_has_mcs_mask[info->band])
++              txrc.rate_idx_mcs_mask =
++                      tx->sdata->rc_rateidx_mcs_mask[info->band];
++
+       txrc.bss = (tx->sdata->vif.type == NL80211_IFTYPE_AP ||
+                   tx->sdata->vif.type == NL80211_IFTYPE_MESH_POINT ||
+                   tx->sdata->vif.type == NL80211_IFTYPE_ADHOC);
+       /* set up RTS protection if desired */
+       if (len > tx->local->hw.wiphy->rts_threshold) {
+-              txrc.rts = rts = true;
++              txrc.rts = true;
        }
-+      status.rate_idx = rate_idx;
-       status.antenna = !!(phystat0 & B43_RX_PHYST0_ANT);
  
++      info->control.use_rts = txrc.rts;
++      info->control.use_cts_prot = tx->sdata->vif.bss_conf.use_cts_prot;
++
        /*
---- a/drivers/net/wireless/libertas/cfg.c
-+++ b/drivers/net/wireless/libertas/cfg.c
-@@ -2182,13 +2182,15 @@ int lbs_reg_notifier(struct wiphy *wiphy
-               struct regulatory_request *request)
- {
-       struct lbs_private *priv = wiphy_priv(wiphy);
--      int ret;
-+      int ret = 0;
-       lbs_deb_enter_args(LBS_DEB_CFG80211, "cfg80211 regulatory domain "
-                       "callback for domain %c%c\n", request->alpha2[0],
-                       request->alpha2[1]);
--      ret = lbs_set_11d_domain_info(priv, request, wiphy->bands);
-+      memcpy(priv->country_code, request->alpha2, sizeof(request->alpha2));
-+      if (lbs_iface_active(priv))
-+              ret = lbs_set_11d_domain_info(priv);
-       lbs_deb_leave(LBS_DEB_CFG80211);
-       return ret;
---- a/drivers/net/wireless/libertas/cmd.c
-+++ b/drivers/net/wireless/libertas/cmd.c
-@@ -733,15 +733,13 @@ int lbs_get_rssi(struct lbs_private *pri
-  *  to the firmware
-  *
-  *  @priv:    pointer to &struct lbs_private
-- *  @request: cfg80211 regulatory request structure
-- *  @bands:   the device's supported bands and channels
-  *
-  *  returns:  0 on success, error code on failure
- */
--int lbs_set_11d_domain_info(struct lbs_private *priv,
--                          struct regulatory_request *request,
--                          struct ieee80211_supported_band **bands)
-+int lbs_set_11d_domain_info(struct lbs_private *priv)
- {
-+      struct wiphy *wiphy = priv->wdev->wiphy;
-+      struct ieee80211_supported_band **bands = wiphy->bands;
-       struct cmd_ds_802_11d_domain_info cmd;
-       struct mrvl_ie_domain_param_set *domain = &cmd.domain;
-       struct ieee80211_country_ie_triplet *t;
-@@ -752,21 +750,23 @@ int lbs_set_11d_domain_info(struct lbs_p
-       u8 first_channel = 0, next_chan = 0, max_pwr = 0;
-       u8 i, flag = 0;
-       size_t triplet_size;
--      int ret;
-+      int ret = 0;
-       lbs_deb_enter(LBS_DEB_11D);
-+      if (!priv->country_code[0])
-+              goto out;
-       memset(&cmd, 0, sizeof(cmd));
-       cmd.action = cpu_to_le16(CMD_ACT_SET);
-       lbs_deb_11d("Setting country code '%c%c'\n",
--                  request->alpha2[0], request->alpha2[1]);
-+                  priv->country_code[0], priv->country_code[1]);
-       domain->header.type = cpu_to_le16(TLV_TYPE_DOMAIN);
-       /* Set country code */
--      domain->country_code[0] = request->alpha2[0];
--      domain->country_code[1] = request->alpha2[1];
-+      domain->country_code[0] = priv->country_code[0];
-+      domain->country_code[1] = priv->country_code[1];
-       domain->country_code[2] = ' ';
-       /* Now set up the channel triplets; firmware is somewhat picky here
-@@ -848,6 +848,7 @@ int lbs_set_11d_domain_info(struct lbs_p
-       ret = lbs_cmd_with_response(priv, CMD_802_11D_DOMAIN_INFO, &cmd);
-+out:
-       lbs_deb_leave_args(LBS_DEB_11D, "ret %d", ret);
-       return ret;
- }
-@@ -1019,9 +1020,9 @@ static void lbs_submit_command(struct lb
-       if (ret) {
-               netdev_info(priv->dev, "DNLD_CMD: hw_host_to_card failed: %d\n",
-                           ret);
--              /* Let the timer kick in and retry, and potentially reset
--                 the whole thing if the condition persists */
--              timeo = HZ/4;
-+              /* Reset dnld state machine, report failure */
-+              priv->dnld_sent = DNLD_RES_RECEIVED;
-+              lbs_complete_command(priv, cmdnode, ret);
-       }
-       if (command == CMD_802_11_DEEP_SLEEP) {
---- a/drivers/net/wireless/libertas/cmd.h
-+++ b/drivers/net/wireless/libertas/cmd.h
-@@ -128,9 +128,7 @@ int lbs_set_monitor_mode(struct lbs_priv
- int lbs_get_rssi(struct lbs_private *priv, s8 *snr, s8 *nf);
--int lbs_set_11d_domain_info(struct lbs_private *priv,
--                          struct regulatory_request *request,
--                          struct ieee80211_supported_band **bands);
-+int lbs_set_11d_domain_info(struct lbs_private *priv);
- int lbs_get_reg(struct lbs_private *priv, u16 reg, u16 offset, u32 *value);
---- a/drivers/net/wireless/libertas/dev.h
-+++ b/drivers/net/wireless/libertas/dev.h
-@@ -49,6 +49,7 @@ struct lbs_private {
-       bool wiphy_registered;
-       struct cfg80211_scan_request *scan_req;
-       u8 assoc_bss[ETH_ALEN];
-+      u8 country_code[IEEE80211_COUNTRY_STRING_LEN];
-       u8 disassoc_reason;
-       /* Mesh */
---- a/drivers/net/wireless/libertas/if_usb.c
-+++ b/drivers/net/wireless/libertas/if_usb.c
-@@ -311,7 +311,6 @@ static void if_usb_disconnect(struct usb
-       cardp->surprise_removed = 1;
-       if (priv) {
--              priv->surpriseremoved = 1;
-               lbs_stop_card(priv);
-               lbs_remove_card(priv);
-       }
---- a/drivers/net/wireless/libertas/main.c
-+++ b/drivers/net/wireless/libertas/main.c
-@@ -154,6 +154,12 @@ int lbs_start_iface(struct lbs_private *
-               goto err;
-       }
-+      ret = lbs_set_11d_domain_info(priv);
-+      if (ret) {
-+              lbs_deb_net("set 11d domain info failed\n");
-+              goto err;
-+      }
+        * Use short preamble if the BSS can handle it, but not for
+        * management frames unless we know the receiver can handle
+@@ -663,7 +666,9 @@ ieee80211_tx_h_rate_ctrl(struct ieee8021
+       if (tx->sdata->vif.bss_conf.use_short_preamble &&
+           (ieee80211_is_data(hdr->frame_control) ||
+            (tx->sta && test_sta_flag(tx->sta, WLAN_STA_SHORT_PREAMBLE))))
+-              txrc.short_preamble = short_preamble = true;
++              txrc.short_preamble = true;
 +
-       lbs_update_channel(priv);
-       priv->iface_running = true;
---- a/include/net/cfg80211.h
-+++ b/include/net/cfg80211.h
-@@ -1504,8 +1504,6 @@ struct cfg80211_gtk_rekey_data {
-  *    interfaces are active this callback should reject the configuration.
-  *    If no interfaces are active or the device is down, the channel should
-  *    be stored for when a monitor interface becomes active.
-- * @set_monitor_enabled: Notify driver that there are only monitor
-- *    interfaces running.
-  *
-  * @scan: Request to do a scan. If returning zero, the scan request is given
-  *    the driver, and will be valid until passed to cfg80211_scan_done().
-@@ -1612,6 +1610,10 @@ struct cfg80211_gtk_rekey_data {
-  * @get_et_strings:  Ethtool API to get a set of strings to describe stats
-  *    and perhaps other supported types of ethtool data-sets.
-  *    See @ethtool_ops.get_strings
-+ *
-+ * @get_channel: Get the current operating channel for the virtual interface.
-+ *    For monitor interfaces, it should return %NULL unless there's a single
-+ *    current monitoring channel.
-  */
- struct cfg80211_ops {
-       int     (*suspend)(struct wiphy *wiphy, struct cfg80211_wowlan *wow);
-@@ -1820,7 +1822,10 @@ struct cfg80211_ops {
-       void    (*get_et_strings)(struct wiphy *wiphy, struct net_device *dev,
-                                 u32 sset, u8 *data);
--      void (*set_monitor_enabled)(struct wiphy *wiphy, bool enabled);
-+      struct ieee80211_channel *
-+              (*get_channel)(struct wiphy *wiphy,
-+                             struct wireless_dev *wdev,
-+                             enum nl80211_channel_type *type);
- };
- /*
---- a/net/mac80211/agg-rx.c
-+++ b/net/mac80211/agg-rx.c
-@@ -203,6 +203,8 @@ static void ieee80211_send_addba_resp(st
-               memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
-       else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
-               memcpy(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN);
-+      else if (sdata->vif.type == NL80211_IFTYPE_WDS)
-+              memcpy(mgmt->bssid, da, ETH_ALEN);
-       mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
-                                         IEEE80211_STYPE_ACTION);
---- a/net/mac80211/agg-tx.c
-+++ b/net/mac80211/agg-tx.c
-@@ -81,7 +81,8 @@ static void ieee80211_send_addba_request
-       memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
-       if (sdata->vif.type == NL80211_IFTYPE_AP ||
-           sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
--          sdata->vif.type == NL80211_IFTYPE_MESH_POINT)
-+          sdata->vif.type == NL80211_IFTYPE_MESH_POINT ||
-+          sdata->vif.type == NL80211_IFTYPE_WDS)
-               memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
-       else if (sdata->vif.type == NL80211_IFTYPE_STATION)
-               memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
-@@ -460,6 +461,7 @@ int ieee80211_start_tx_ba_session(struct
-           sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
-           sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
-           sdata->vif.type != NL80211_IFTYPE_AP &&
-+          sdata->vif.type != NL80211_IFTYPE_WDS &&
-           sdata->vif.type != NL80211_IFTYPE_ADHOC)
-               return -EINVAL;
++      info->control.short_preamble = txrc.short_preamble;
  
---- a/net/mac80211/cfg.c
-+++ b/net/mac80211/cfg.c
-@@ -2982,14 +2982,14 @@ static int ieee80211_probe_client(struct
-       return 0;
- }
--static void ieee80211_set_monitor_enabled(struct wiphy *wiphy, bool enabled)
-+static struct ieee80211_channel *
-+ieee80211_cfg_get_channel(struct wiphy *wiphy, struct wireless_dev *wdev,
-+                        enum nl80211_channel_type *type)
- {
-       struct ieee80211_local *local = wiphy_priv(wiphy);
--      if (enabled)
--              WARN_ON(ieee80211_add_virtual_monitor(local));
--      else
--              ieee80211_del_virtual_monitor(local);
-+      *type = local->_oper_channel_type;
-+      return local->oper_channel;
- }
- #ifdef CONFIG_PM
-@@ -3066,11 +3066,11 @@ struct cfg80211_ops mac80211_config_ops 
-       .tdls_mgmt = ieee80211_tdls_mgmt,
-       .probe_client = ieee80211_probe_client,
-       .set_noack_map = ieee80211_set_noack_map,
--      .set_monitor_enabled = ieee80211_set_monitor_enabled,
- #ifdef CONFIG_PM
-       .set_wakeup = ieee80211_set_wakeup,
- #endif
-       .get_et_sset_count = ieee80211_get_et_sset_count,
-       .get_et_stats = ieee80211_get_et_stats,
-       .get_et_strings = ieee80211_get_et_strings,
-+      .get_channel = ieee80211_cfg_get_channel,
- };
---- a/net/mac80211/debugfs_sta.c
-+++ b/net/mac80211/debugfs_sta.c
-@@ -63,11 +63,11 @@ static ssize_t sta_flags_read(struct fil
-       test_sta_flag(sta, WLAN_STA_##flg) ? #flg "\n" : ""
-       int res = scnprintf(buf, sizeof(buf),
--                          "%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s",
-+                          "%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s",
-                           TEST(AUTH), TEST(ASSOC), TEST(PS_STA),
-                           TEST(PS_DRIVER), TEST(AUTHORIZED),
-                           TEST(SHORT_PREAMBLE),
--                          TEST(WME), TEST(WDS), TEST(CLEAR_PS_FILT),
-+                          TEST(WME), TEST(CLEAR_PS_FILT),
-                           TEST(MFP), TEST(BLOCK_BA), TEST(PSPOLL),
-                           TEST(UAPSD), TEST(SP), TEST(TDLS_PEER),
-                           TEST(TDLS_PEER_AUTH), TEST(4ADDR_EVENT),
---- a/net/mac80211/ieee80211_i.h
-+++ b/net/mac80211/ieee80211_i.h
-@@ -1496,10 +1496,6 @@ int ieee80211_add_srates_ie(struct ieee8
- int ieee80211_add_ext_srates_ie(struct ieee80211_sub_if_data *sdata,
-                               struct sk_buff *skb, bool need_basic);
--/* virtual monitor */
--int ieee80211_add_virtual_monitor(struct ieee80211_local *local);
--void ieee80211_del_virtual_monitor(struct ieee80211_local *local);
--
- /* channel management */
- enum ieee80211_chan_mode {
-       CHAN_MODE_UNDEFINED,
---- a/net/mac80211/iface.c
-+++ b/net/mac80211/iface.c
-@@ -331,7 +331,7 @@ static void ieee80211_set_default_queues
-       sdata->vif.cab_queue = IEEE80211_INVAL_HW_QUEUE;
- }
+       if (tx->sta)
+               assoc = test_sta_flag(tx->sta, WLAN_STA_ASSOC);
+@@ -687,16 +692,38 @@ ieee80211_tx_h_rate_ctrl(struct ieee8021
+        */
+       rate_control_get_rate(tx->sdata, tx->sta, &txrc);
  
--int ieee80211_add_virtual_monitor(struct ieee80211_local *local)
-+static int ieee80211_add_virtual_monitor(struct ieee80211_local *local)
- {
-       struct ieee80211_sub_if_data *sdata;
-       int ret = 0;
-@@ -377,7 +377,7 @@ int ieee80211_add_virtual_monitor(struct
-       return ret;
- }
+-      if (unlikely(info->control.rates[0].idx < 0))
+-              return TX_DROP;
++      if (tx->sta && !info->control.skip_table)
++              ratetbl = rcu_dereference(tx->sta->sta.rates);
++
++      if (unlikely(info->control.rates[0].idx < 0)) {
++              if (ratetbl) {
++                      struct ieee80211_tx_rate rate = {
++                              .idx = ratetbl->rate[0].idx,
++                              .flags = ratetbl->rate[0].flags,
++                              .count = ratetbl->rate[0].count
++                      };
++
++                      if (ratetbl->rate[0].idx < 0)
++                              return TX_DROP;
++
++                      tx->rate = rate;
++              } else {
++                      return TX_DROP;
++              }
++      } else {
++              tx->rate = info->control.rates[0];
++      }
  
--void ieee80211_del_virtual_monitor(struct ieee80211_local *local)
-+static void ieee80211_del_virtual_monitor(struct ieee80211_local *local)
- {
-       struct ieee80211_sub_if_data *sdata;
+       if (txrc.reported_rate.idx < 0) {
+-              txrc.reported_rate = info->control.rates[0];
++              txrc.reported_rate = tx->rate;
+               if (tx->sta && ieee80211_is_data(hdr->frame_control))
+                       tx->sta->last_tx_rate = txrc.reported_rate;
+       } else if (tx->sta)
+               tx->sta->last_tx_rate = txrc.reported_rate;
  
-@@ -410,7 +410,6 @@ static int ieee80211_do_open(struct net_
- {
-       struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
-       struct ieee80211_local *local = sdata->local;
--      struct sta_info *sta;
-       u32 changed = 0;
-       int res;
-       u32 hw_reconf_flags = 0;
-@@ -497,6 +496,12 @@ static int ieee80211_do_open(struct net_
-                       break;
-               }
-+              if (local->monitors == 0 && local->open_count == 0) {
-+                      res = ieee80211_add_virtual_monitor(local);
-+                      if (res)
-+                              goto err_stop;
-+              }
++      if (ratetbl)
++              return TX_CONTINUE;
 +
-               /* must be before the call to ieee80211_configure_filter */
-               local->monitors++;
-               if (local->monitors == 1) {
-@@ -511,6 +516,8 @@ static int ieee80211_do_open(struct net_
-               break;
-       default:
-               if (coming_up) {
-+                      ieee80211_del_virtual_monitor(local);
-+
-                       res = drv_add_interface(local, sdata);
-                       if (res)
-                               goto err_stop;
-@@ -548,28 +555,6 @@ static int ieee80211_do_open(struct net_
+       if (unlikely(!info->control.rates[0].count))
+               info->control.rates[0].count = 1;
  
-       set_bit(SDATA_STATE_RUNNING, &sdata->state);
+@@ -704,91 +731,6 @@ ieee80211_tx_h_rate_ctrl(struct ieee8021
+                        (info->flags & IEEE80211_TX_CTL_NO_ACK)))
+               info->control.rates[0].count = 1;
  
--      if (sdata->vif.type == NL80211_IFTYPE_WDS) {
--              /* Create STA entry for the WDS peer */
--              sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr,
--                                   GFP_KERNEL);
--              if (!sta) {
--                      res = -ENOMEM;
--                      goto err_del_interface;
+-      if (is_multicast_ether_addr(hdr->addr1)) {
+-              /*
+-               * XXX: verify the rate is in the basic rateset
+-               */
+-              return TX_CONTINUE;
+-      }
+-
+-      /*
+-       * set up the RTS/CTS rate as the fastest basic rate
+-       * that is not faster than the data rate
+-       *
+-       * XXX: Should this check all retry rates?
+-       */
+-      if (!(info->control.rates[0].flags & IEEE80211_TX_RC_MCS)) {
+-              s8 baserate = 0;
+-
+-              rate = &sband->bitrates[info->control.rates[0].idx];
+-
+-              for (i = 0; i < sband->n_bitrates; i++) {
+-                      /* must be a basic rate */
+-                      if (!(tx->sdata->vif.bss_conf.basic_rates & BIT(i)))
+-                              continue;
+-                      /* must not be faster than the data rate */
+-                      if (sband->bitrates[i].bitrate > rate->bitrate)
+-                              continue;
+-                      /* maximum */
+-                      if (sband->bitrates[baserate].bitrate <
+-                           sband->bitrates[i].bitrate)
+-                              baserate = i;
 -              }
 -
--              sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
--              sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
--              sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED);
+-              info->control.rts_cts_rate_idx = baserate;
+-      }
 -
--              res = sta_info_insert(sta);
--              if (res) {
--                      /* STA has been freed */
--                      goto err_del_interface;
+-      for (i = 0; i < IEEE80211_TX_MAX_RATES; i++) {
+-              /*
+-               * make sure there's no valid rate following
+-               * an invalid one, just in case drivers don't
+-               * take the API seriously to stop at -1.
+-               */
+-              if (inval) {
+-                      info->control.rates[i].idx = -1;
+-                      continue;
+-              }
+-              if (info->control.rates[i].idx < 0) {
+-                      inval = true;
+-                      continue;
 -              }
 -
--              rate_control_rate_init(sta);
+-              /*
+-               * For now assume MCS is already set up correctly, this
+-               * needs to be fixed.
+-               */
+-              if (info->control.rates[i].flags & IEEE80211_TX_RC_MCS) {
+-                      WARN_ON(info->control.rates[i].idx > 76);
+-                      continue;
+-              }
+-
+-              /* set up RTS protection if desired */
+-              if (rts)
+-                      info->control.rates[i].flags |=
+-                              IEEE80211_TX_RC_USE_RTS_CTS;
+-
+-              /* RC is busted */
+-              if (WARN_ON_ONCE(info->control.rates[i].idx >=
+-                               sband->n_bitrates)) {
+-                      info->control.rates[i].idx = -1;
+-                      continue;
+-              }
+-
+-              rate = &sband->bitrates[info->control.rates[i].idx];
+-
+-              /* set up short preamble */
+-              if (short_preamble &&
+-                  rate->flags & IEEE80211_RATE_SHORT_PREAMBLE)
+-                      info->control.rates[i].flags |=
+-                              IEEE80211_TX_RC_USE_SHORT_PREAMBLE;
+-
+-              /* set up G protection */
+-              if (!rts && tx->sdata->vif.bss_conf.use_cts_prot &&
+-                  rate->flags & IEEE80211_RATE_ERP_G)
+-                      info->control.rates[i].flags |=
+-                              IEEE80211_TX_RC_USE_CTS_PROTECT;
 -      }
 -
-       /*
-        * set_multicast_list will be invoked by the networking core
-        * which will check whether any increments here were done in
-@@ -750,6 +735,7 @@ static void ieee80211_do_stop(struct iee
-               if (local->monitors == 0) {
-                       local->hw.conf.flags &= ~IEEE80211_CONF_MONITOR;
-                       hw_reconf_flags |= IEEE80211_CONF_CHANGE_MONITOR;
-+                      ieee80211_del_virtual_monitor(local);
-               }
+       return TX_CONTINUE;
+ }
  
-               ieee80211_adjust_monitor_flags(sdata, -1);
-@@ -823,6 +809,9 @@ static void ieee80211_do_stop(struct iee
-               }
-       }
+@@ -2508,8 +2450,6 @@ struct sk_buff *ieee80211_beacon_get_tim
+               txrc.max_rate_idx = -1;
+       else
+               txrc.max_rate_idx = fls(txrc.rate_idx_mask) - 1;
+-      memcpy(txrc.rate_idx_mcs_mask, sdata->rc_rateidx_mcs_mask[band],
+-             sizeof(txrc.rate_idx_mcs_mask));
+       txrc.bss = true;
+       rate_control_get_rate(sdata, NULL, &txrc);
+--- a/net/mac80211/util.c
++++ b/net/mac80211/util.c
+@@ -485,7 +485,8 @@ int ieee80211_queue_stopped(struct ieee8
+               return true;
+       spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
+-      ret = !!local->queue_stop_reasons[queue];
++      ret = test_bit(IEEE80211_QUEUE_STOP_REASON_DRIVER,
++                     &local->queue_stop_reasons[queue]);
        spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
-+
-+      if (local->monitors == local->open_count && local->monitors > 0)
-+              ieee80211_add_virtual_monitor(local);
+       return ret;
  }
+@@ -559,6 +560,9 @@ void ieee80211_iterate_active_interfaces
+       list_for_each_entry(sdata, &local->interfaces, list) {
+               switch (sdata->vif.type) {
+               case NL80211_IFTYPE_MONITOR:
++                      if (!(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
++                              continue;
++                      break;
+               case NL80211_IFTYPE_AP_VLAN:
+                       continue;
+               default:
+@@ -597,6 +601,9 @@ void ieee80211_iterate_active_interfaces
+       list_for_each_entry_rcu(sdata, &local->interfaces, list) {
+               switch (sdata->vif.type) {
+               case NL80211_IFTYPE_MONITOR:
++                      if (!(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
++                              continue;
++                      break;
+               case NL80211_IFTYPE_AP_VLAN:
+                       continue;
+               default:
+@@ -660,7 +667,7 @@ void ieee80211_queue_delayed_work(struct
+ }
+ EXPORT_SYMBOL(ieee80211_queue_delayed_work);
  
- static int ieee80211_stop(struct net_device *dev)
-@@ -959,6 +948,72 @@ static void ieee80211_if_setup(struct ne
-       dev->destructor = free_netdev;
+-u32 ieee802_11_parse_elems_crc(u8 *start, size_t len,
++u32 ieee802_11_parse_elems_crc(u8 *start, size_t len, bool action,
+                              struct ieee802_11_elems *elems,
+                              u64 filter, u32 crc)
+ {
+@@ -668,6 +675,7 @@ u32 ieee802_11_parse_elems_crc(u8 *start
+       u8 *pos = start;
+       bool calc_crc = filter != 0;
+       DECLARE_BITMAP(seen_elems, 256);
++      const u8 *ie;
+       bitmap_zero(seen_elems, 256);
+       memset(elems, 0, sizeof(*elems));
+@@ -715,6 +723,12 @@ u32 ieee802_11_parse_elems_crc(u8 *start
+               case WLAN_EID_COUNTRY:
+               case WLAN_EID_PWR_CONSTRAINT:
+               case WLAN_EID_TIMEOUT_INTERVAL:
++              case WLAN_EID_SECONDARY_CHANNEL_OFFSET:
++              case WLAN_EID_WIDE_BW_CHANNEL_SWITCH:
++              /*
++               * not listing WLAN_EID_CHANNEL_SWITCH_WRAPPER -- it seems possible
++               * that if the content gets bigger it might be needed more than once
++               */
+                       if (test_bit(id, seen_elems)) {
+                               elems->parse_error = true;
+                               left -= elen;
+@@ -862,6 +876,48 @@ u32 ieee802_11_parse_elems_crc(u8 *start
+                       }
+                       elems->ch_switch_ie = (void *)pos;
+                       break;
++              case WLAN_EID_EXT_CHANSWITCH_ANN:
++                      if (elen != sizeof(struct ieee80211_ext_chansw_ie)) {
++                              elem_parse_failed = true;
++                              break;
++                      }
++                      elems->ext_chansw_ie = (void *)pos;
++                      break;
++              case WLAN_EID_SECONDARY_CHANNEL_OFFSET:
++                      if (elen != sizeof(struct ieee80211_sec_chan_offs_ie)) {
++                              elem_parse_failed = true;
++                              break;
++                      }
++                      elems->sec_chan_offs = (void *)pos;
++                      break;
++              case WLAN_EID_WIDE_BW_CHANNEL_SWITCH:
++                      if (!action ||
++                          elen != sizeof(*elems->wide_bw_chansw_ie)) {
++                              elem_parse_failed = true;
++                              break;
++                      }
++                      elems->wide_bw_chansw_ie = (void *)pos;
++                      break;
++              case WLAN_EID_CHANNEL_SWITCH_WRAPPER:
++                      if (action) {
++                              elem_parse_failed = true;
++                              break;
++                      }
++                      /*
++                       * This is a bit tricky, but as we only care about
++                       * the wide bandwidth channel switch element, so
++                       * just parse it out manually.
++                       */
++                      ie = cfg80211_find_ie(WLAN_EID_WIDE_BW_CHANNEL_SWITCH,
++                                            pos, elen);
++                      if (ie) {
++                              if (ie[1] == sizeof(*elems->wide_bw_chansw_ie))
++                                      elems->wide_bw_chansw_ie =
++                                              (void *)(ie + 2);
++                              else
++                                      elem_parse_failed = true;
++                      }
++                      break;
+               case WLAN_EID_COUNTRY:
+                       elems->country_elem = pos;
+                       elems->country_elem_len = elen;
+--- a/net/wireless/reg.c
++++ b/net/wireless/reg.c
+@@ -857,7 +857,7 @@ static void handle_channel(struct wiphy 
+                       return;
+               REG_DBG_PRINT("Disabling freq %d MHz\n", chan->center_freq);
+-              chan->flags = IEEE80211_CHAN_DISABLED;
++              chan->flags |= IEEE80211_CHAN_DISABLED;
+               return;
+       }
+--- a/net/wireless/util.c
++++ b/net/wireless/util.c
+@@ -1156,6 +1156,26 @@ int cfg80211_get_p2p_attr(const u8 *ies,
  }
+ EXPORT_SYMBOL(cfg80211_get_p2p_attr);
  
-+static void ieee80211_wds_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata,
-+                                       struct sk_buff *skb)
++bool ieee80211_operating_class_to_band(u8 operating_class,
++                                     enum ieee80211_band *band)
 +{
-+      struct ieee80211_local *local = sdata->local;
-+      struct ieee80211_rx_status *rx_status;
-+      struct ieee802_11_elems elems;
-+      struct ieee80211_mgmt *mgmt;
-+      struct sta_info *sta;
-+      size_t baselen;
-+      u32 rates = 0;
-+      u16 stype;
-+      bool new = false;
-+      enum ieee80211_band band = local->hw.conf.channel->band;
-+      struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band];
++      switch (operating_class) {
++      case 112:
++      case 115 ... 127:
++              *band = IEEE80211_BAND_5GHZ;
++              return true;
++      case 81:
++      case 82:
++      case 83:
++      case 84:
++              *band = IEEE80211_BAND_2GHZ;
++              return true;
++      }
 +
-+      rx_status = IEEE80211_SKB_RXCB(skb);
-+      mgmt = (struct ieee80211_mgmt *) skb->data;
-+      stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE;
++      return false;
++}
++EXPORT_SYMBOL(ieee80211_operating_class_to_band);
 +
-+      if (stype != IEEE80211_STYPE_BEACON)
-+              return;
+ int cfg80211_validate_beacon_int(struct cfg80211_registered_device *rdev,
+                                u32 beacon_int)
+ {
+--- a/include/uapi/linux/nl80211.h
++++ b/include/uapi/linux/nl80211.h
+@@ -1973,6 +1973,10 @@ enum nl80211_sta_bss_param {
+  * @NL80211_STA_INFO_PEER_PM: peer mesh STA link-specific power mode
+  * @NL80211_STA_INFO_NONPEER_PM: neighbor mesh STA power save mode towards
+  *    non-peer STA
++ * @NL80211_STA_INFO_CHAIN_SIGNAL: per-chain signal strength of last PPDU
++ *    Contains a nested array of signal strength attributes (u8, dBm)
++ * @NL80211_STA_INFO_CHAIN_SIGNAL_AVG: per-chain signal strength average
++ *    Same format as NL80211_STA_INFO_CHAIN_SIGNAL.
+  * @__NL80211_STA_INFO_AFTER_LAST: internal
+  * @NL80211_STA_INFO_MAX: highest possible station info attribute
+  */
+@@ -2002,6 +2006,8 @@ enum nl80211_sta_info {
+       NL80211_STA_INFO_NONPEER_PM,
+       NL80211_STA_INFO_RX_BYTES64,
+       NL80211_STA_INFO_TX_BYTES64,
++      NL80211_STA_INFO_CHAIN_SIGNAL,
++      NL80211_STA_INFO_CHAIN_SIGNAL_AVG,
+       /* keep last */
+       __NL80211_STA_INFO_AFTER_LAST,
+@@ -2395,6 +2401,8 @@ enum nl80211_survey_info {
+  * @NL80211_MNTR_FLAG_OTHER_BSS: disable BSSID filtering
+  * @NL80211_MNTR_FLAG_COOK_FRAMES: report frames after processing.
+  *    overrides all other flags.
++ * @NL80211_MNTR_FLAG_ACTIVE: use the configured MAC address
++ *    and ACK incoming unicast packets.
+  *
+  * @__NL80211_MNTR_FLAG_AFTER_LAST: internal use
+  * @NL80211_MNTR_FLAG_MAX: highest possible monitor flag
+@@ -2406,6 +2414,7 @@ enum nl80211_mntr_flags {
+       NL80211_MNTR_FLAG_CONTROL,
+       NL80211_MNTR_FLAG_OTHER_BSS,
+       NL80211_MNTR_FLAG_COOK_FRAMES,
++      NL80211_MNTR_FLAG_ACTIVE,
+       /* keep last */
+       __NL80211_MNTR_FLAG_AFTER_LAST,
+@@ -3557,6 +3566,7 @@ enum nl80211_feature_flags {
+       NL80211_FEATURE_ADVERTISE_CHAN_LIMITS           = 1 << 14,
+       NL80211_FEATURE_FULL_AP_CLIENT_STATE            = 1 << 15,
+       NL80211_FEATURE_USERSPACE_MPM                   = 1 << 16,
++      NL80211_FEATURE_ACTIVE_MONITOR                  = 1 << 17,
+ };
+ /**
+--- a/net/mac80211/sta_info.c
++++ b/net/mac80211/sta_info.c
+@@ -358,6 +358,8 @@ struct sta_info *sta_info_alloc(struct i
+       do_posix_clock_monotonic_gettime(&uptime);
+       sta->last_connected = uptime.tv_sec;
+       ewma_init(&sta->avg_signal, 1024, 8);
++      for (i = 0; i < ARRAY_SIZE(sta->chain_signal_avg); i++)
++              ewma_init(&sta->chain_signal_avg[i], 1024, 8);
+       if (sta_prepare_rate_control(local, sta, gfp)) {
+               kfree(sta);
+--- a/net/wireless/nl80211.c
++++ b/net/wireless/nl80211.c
+@@ -2270,6 +2270,7 @@ static const struct nla_policy mntr_flag
+       [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
+       [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
+       [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
++      [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
+ };
+ static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
+@@ -2381,6 +2382,10 @@ static int nl80211_set_interface(struct 
+               change = true;
+       }
++      if ((*flags & NL80211_MNTR_FLAG_ACTIVE) &&
++          !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
++              return -EOPNOTSUPP;
 +
-+      baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt;
-+      if (baselen > skb->len)
-+              return;
+       if (change)
+               err = cfg80211_change_iface(rdev, dev, ntype, flags, &params);
+       else
+@@ -2438,6 +2443,11 @@ static int nl80211_new_interface(struct 
+       err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
+                                 info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
+                                 &flags);
 +
-+      ieee802_11_parse_elems(mgmt->u.probe_resp.variable,
-+                             skb->len - baselen, &elems);
++      if (!err && (flags & NL80211_MNTR_FLAG_ACTIVE) &&
++          !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
++              return -EOPNOTSUPP;
 +
-+      rates = ieee80211_sta_get_rates(local, &elems, band, NULL);
+       wdev = rdev_add_virtual_intf(rdev,
+                               nla_data(info->attrs[NL80211_ATTR_IFNAME]),
+                               type, err ? NULL : &flags, &params);
+@@ -3367,6 +3377,32 @@ static bool nl80211_put_sta_rate(struct 
+       return true;
+ }
++static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
++                             int id)
++{
++      void *attr;
++      int i = 0;
 +
-+      rcu_read_lock();
++      if (!mask)
++              return true;
 +
-+      sta = sta_info_get(sdata, sdata->u.wds.remote_addr);
++      attr = nla_nest_start(msg, id);
++      if (!attr)
++              return false;
 +
-+      if (!sta) {
-+              rcu_read_unlock();
-+              sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr,
-+                                   GFP_KERNEL);
-+              if (!sta)
-+                      return;
++      for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
++              if (!(mask & BIT(i)))
++                      continue;
 +
-+              new = true;
++              if (nla_put_u8(msg, i, signal[i]))
++                      return false;
 +      }
 +
-+      sta->last_rx = jiffies;
-+      sta->sta.supp_rates[local->hw.conf.channel->band] = rates;
-+
-+      if (elems.ht_cap_elem)
-+              ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
-+                              elems.ht_cap_elem, &sta->sta.ht_cap);
++      nla_nest_end(msg, attr);
 +
-+      if (elems.wmm_param)
-+              set_sta_flag(sta, WLAN_STA_WME);
++      return true;
++}
 +
-+      if (new) {
-+              sta_info_pre_move_state(sta, IEEE80211_STA_AUTH);
-+              sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC);
-+              sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED);
-+              rate_control_rate_init(sta);
-+              sta_info_insert_rcu(sta);
+ static int nl80211_send_station(struct sk_buff *msg, u32 portid, u32 seq,
+                               int flags,
+                               struct cfg80211_registered_device *rdev,
+@@ -3402,7 +3438,7 @@ static int nl80211_send_station(struct s
+                       (u32)sinfo->rx_bytes))
+               goto nla_put_failure;
+       if ((sinfo->filled & (STATION_INFO_TX_BYTES |
+-                            NL80211_STA_INFO_TX_BYTES64)) &&
++                            STATION_INFO_TX_BYTES64)) &&
+           nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
+                       (u32)sinfo->tx_bytes))
+               goto nla_put_failure;
+@@ -3438,6 +3474,18 @@ static int nl80211_send_station(struct s
+       default:
+               break;
+       }
++      if (sinfo->filled & STATION_INFO_CHAIN_SIGNAL) {
++              if (!nl80211_put_signal(msg, sinfo->chains,
++                                      sinfo->chain_signal,
++                                      NL80211_STA_INFO_CHAIN_SIGNAL))
++                      goto nla_put_failure;
 +      }
++      if (sinfo->filled & STATION_INFO_CHAIN_SIGNAL_AVG) {
++              if (!nl80211_put_signal(msg, sinfo->chains,
++                                      sinfo->chain_signal_avg,
++                                      NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
++                      goto nla_put_failure;
++      }
+       if (sinfo->filled & STATION_INFO_TX_BITRATE) {
+               if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
+                                         NL80211_STA_INFO_TX_BITRATE))
+--- a/drivers/net/wireless/ath/ath9k/init.c
++++ b/drivers/net/wireless/ath/ath9k/init.c
+@@ -768,7 +768,8 @@ void ath9k_set_hw_capab(struct ath_softc
+               IEEE80211_HW_SUPPORTS_PS |
+               IEEE80211_HW_PS_NULLFUNC_STACK |
+               IEEE80211_HW_SPECTRUM_MGMT |
+-              IEEE80211_HW_REPORTS_TX_ACK_STATUS;
++              IEEE80211_HW_REPORTS_TX_ACK_STATUS |
++              IEEE80211_HW_SUPPORTS_RC_TABLE;
+       if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_HT)
+                hw->flags |= IEEE80211_HW_AMPDU_AGGREGATION;
+@@ -776,6 +777,8 @@ void ath9k_set_hw_capab(struct ath_softc
+       if (AR_SREV_9160_10_OR_LATER(sc->sc_ah) || ath9k_modparam_nohwcrypt)
+               hw->flags |= IEEE80211_HW_MFP_CAPABLE;
++      hw->wiphy->features |= NL80211_FEATURE_ACTIVE_MONITOR;
 +
-+      rcu_read_unlock();
+       hw->wiphy->interface_modes =
+               BIT(NL80211_IFTYPE_P2P_GO) |
+               BIT(NL80211_IFTYPE_P2P_CLIENT) |
+--- a/drivers/net/wireless/ath/ath9k/xmit.c
++++ b/drivers/net/wireless/ath/ath9k/xmit.c
+@@ -125,24 +125,6 @@ static void ath_tx_queue_tid(struct ath_
+       list_add_tail(&ac->list, &txq->axq_acq);
+ }
+-static void ath_tx_resume_tid(struct ath_softc *sc, struct ath_atx_tid *tid)
+-{
+-      struct ath_txq *txq = tid->ac->txq;
+-
+-      WARN_ON(!tid->paused);
+-
+-      ath_txq_lock(sc, txq);
+-      tid->paused = false;
+-
+-      if (skb_queue_empty(&tid->buf_q))
+-              goto unlock;
+-
+-      ath_tx_queue_tid(txq, tid);
+-      ath_txq_schedule(sc, txq);
+-unlock:
+-      ath_txq_unlock_complete(sc, txq);
+-}
+-
+ static struct ath_frame_info *get_frame_info(struct sk_buff *skb)
+ {
+       struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
+@@ -157,6 +139,13 @@ static void ath_send_bar(struct ath_atx_
+                          seqno << IEEE80211_SEQ_SEQ_SHIFT);
+ }
++static void ath_set_rates(struct ieee80211_vif *vif, struct ieee80211_sta *sta,
++                        struct ath_buf *bf)
++{
++      ieee80211_get_tx_rates(vif, sta, bf->bf_mpdu, bf->rates,
++                             ARRAY_SIZE(bf->rates));
 +}
 +
- static void ieee80211_iface_work(struct work_struct *work)
+ static void ath_tx_flush_tid(struct ath_softc *sc, struct ath_atx_tid *tid)
  {
-       struct ieee80211_sub_if_data *sdata =
-@@ -1063,6 +1118,9 @@ static void ieee80211_iface_work(struct 
-                               break;
-                       ieee80211_mesh_rx_queued_mgmt(sdata, skb);
-                       break;
-+              case NL80211_IFTYPE_WDS:
-+                      ieee80211_wds_rx_queued_mgmt(sdata, skb);
-+                      break;
-               default:
-                       WARN(1, "frame for unexpected interface type");
-                       break;
---- a/net/mac80211/offchannel.c
-+++ b/net/mac80211/offchannel.c
-@@ -324,6 +324,7 @@ void ieee80211_sw_roc_work(struct work_s
-               container_of(work, struct ieee80211_roc_work, work.work);
-       struct ieee80211_sub_if_data *sdata = roc->sdata;
-       struct ieee80211_local *local = sdata->local;
-+      bool started;
+       struct ath_txq *txq = tid->ac->txq;
+@@ -189,15 +178,11 @@ static void ath_tx_flush_tid(struct ath_
+                       ath_tx_complete_buf(sc, bf, txq, &bf_head, &ts, 0);
+                       sendbar = true;
+               } else {
++                      ath_set_rates(tid->an->vif, tid->an->sta, bf);
+                       ath_tx_send_normal(sc, txq, NULL, skb);
+               }
+       }
  
-       mutex_lock(&local->mtx);
+-      if (tid->baw_head == tid->baw_tail) {
+-              tid->state &= ~AGGR_ADDBA_COMPLETE;
+-              tid->state &= ~AGGR_CLEANUP;
+-      }
+-
+       if (sendbar) {
+               ath_txq_unlock(sc, txq);
+               ath_send_bar(tid, tid->seq_start);
+@@ -269,9 +254,7 @@ static void ath_tid_drain(struct ath_sof
  
-@@ -366,9 +367,10 @@ void ieee80211_sw_roc_work(struct work_s
-               /* finish this ROC */
-  finish:
-               list_del(&roc->list);
-+              started = roc->started;
-               ieee80211_roc_notify_destroy(roc);
+               list_add_tail(&bf->list, &bf_head);
  
--              if (roc->started) {
-+              if (started) {
-                       drv_flush(local, false);
+-              if (fi->retries)
+-                      ath_tx_update_baw(sc, tid, bf->bf_state.seqno);
+-
++              ath_tx_update_baw(sc, tid, bf->bf_state.seqno);
+               ath_tx_complete_buf(sc, bf, txq, &bf_head, &ts, 0);
+       }
  
-                       local->tmp_channel = NULL;
-@@ -379,7 +381,7 @@ void ieee80211_sw_roc_work(struct work_s
+@@ -407,7 +390,7 @@ static void ath_tx_complete_aggr(struct 
  
-               ieee80211_recalc_idle(local);
+       tx_info = IEEE80211_SKB_CB(skb);
  
--              if (roc->started)
-+              if (started)
-                       ieee80211_start_next_roc(local);
+-      memcpy(rates, tx_info->control.rates, sizeof(rates));
++      memcpy(rates, bf->rates, sizeof(rates));
+       retries = ts->ts_longretry + 1;
+       for (i = 0; i < ts->ts_rateindex; i++)
+@@ -483,19 +466,19 @@ static void ath_tx_complete_aggr(struct 
+               tx_info = IEEE80211_SKB_CB(skb);
+               fi = get_frame_info(skb);
+-              if (ATH_BA_ISSET(ba, ATH_BA_INDEX(seq_st, seqno))) {
++              if (!BAW_WITHIN(tid->seq_start, tid->baw_size, seqno)) {
++                      /*
++                       * Outside of the current BlockAck window,
++                       * maybe part of a previous session
++                       */
++                      txfail = 1;
++              } else if (ATH_BA_ISSET(ba, ATH_BA_INDEX(seq_st, seqno))) {
+                       /* transmit completion, subframe is
+                        * acked by block ack */
+                       acked_cnt++;
+               } else if (!isaggr && txok) {
+                       /* transmit completion */
+                       acked_cnt++;
+-              } else if (tid->state & AGGR_CLEANUP) {
+-                      /*
+-                       * cleanup in progress, just fail
+-                       * the un-acked sub-frames
+-                       */
+-                      txfail = 1;
+               } else if (flush) {
+                       txpending = 1;
+               } else if (fi->retries < ATH_MAX_SW_RETRIES) {
+@@ -519,7 +502,7 @@ static void ath_tx_complete_aggr(struct 
+               if (bf_next != NULL || !bf_last->bf_stale)
+                       list_move_tail(&bf->list, &bf_head);
+-              if (!txpending || (tid->state & AGGR_CLEANUP)) {
++              if (!txpending) {
+                       /*
+                        * complete the acked-ones/xretried ones; update
+                        * block-ack window
+@@ -593,9 +576,6 @@ static void ath_tx_complete_aggr(struct 
+               ath_txq_lock(sc, txq);
        }
  
---- a/net/mac80211/rx.c
-+++ b/net/mac80211/rx.c
-@@ -2239,6 +2239,7 @@ ieee80211_rx_h_action(struct ieee80211_r
-                   sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
-                   sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
-                   sdata->vif.type != NL80211_IFTYPE_AP &&
-+                  sdata->vif.type != NL80211_IFTYPE_WDS &&
-                   sdata->vif.type != NL80211_IFTYPE_ADHOC)
-                       break;
+-      if (tid->state & AGGR_CLEANUP)
+-              ath_tx_flush_tid(sc, tid);
+-
+       rcu_read_unlock();
  
-@@ -2456,14 +2457,15 @@ ieee80211_rx_h_mgmt(struct ieee80211_rx_
+       if (needreset)
+@@ -612,6 +592,7 @@ static void ath_tx_process_buffer(struct
+                                 struct ath_tx_status *ts, struct ath_buf *bf,
+                                 struct list_head *bf_head)
+ {
++      struct ieee80211_tx_info *info;
+       bool txok, flush;
+       txok = !(ts->ts_status & ATH9K_TXERR_MASK);
+@@ -623,8 +604,12 @@ static void ath_tx_process_buffer(struct
+               txq->axq_ampdu_depth--;
+       if (!bf_isampdu(bf)) {
+-              if (!flush)
++              if (!flush) {
++                      info = IEEE80211_SKB_CB(bf->bf_mpdu);
++                      memcpy(info->control.rates, bf->rates,
++                             sizeof(info->control.rates));
+                       ath_tx_rc_status(sc, bf, ts, 1, txok ? 0 : 1, txok);
++              }
+               ath_tx_complete_buf(sc, bf, txq, bf_head, ts, txok);
+       } else
+               ath_tx_complete_aggr(sc, txq, bf, bf_head, ts, txok);
+@@ -668,7 +653,7 @@ static u32 ath_lookup_rate(struct ath_so
  
-       if (!ieee80211_vif_is_mesh(&sdata->vif) &&
-           sdata->vif.type != NL80211_IFTYPE_ADHOC &&
--          sdata->vif.type != NL80211_IFTYPE_STATION)
-+          sdata->vif.type != NL80211_IFTYPE_STATION &&
-+          sdata->vif.type != NL80211_IFTYPE_WDS)
-               return RX_DROP_MONITOR;
+       skb = bf->bf_mpdu;
+       tx_info = IEEE80211_SKB_CB(skb);
+-      rates = tx_info->control.rates;
++      rates = bf->rates;
  
-       switch (stype) {
-       case cpu_to_le16(IEEE80211_STYPE_AUTH):
-       case cpu_to_le16(IEEE80211_STYPE_BEACON):
-       case cpu_to_le16(IEEE80211_STYPE_PROBE_RESP):
--              /* process for all: mesh, mlme, ibss */
-+              /* process for all: mesh, mlme, ibss, wds */
-               break;
-       case cpu_to_le16(IEEE80211_STYPE_ASSOC_RESP):
-       case cpu_to_le16(IEEE80211_STYPE_REASSOC_RESP):
-@@ -2788,10 +2790,16 @@ static int prepare_for_handlers(struct i
-               }
-               break;
-       case NL80211_IFTYPE_WDS:
--              if (bssid || !ieee80211_is_data(hdr->frame_control))
--                      return 0;
-               if (!ether_addr_equal(sdata->u.wds.remote_addr, hdr->addr2))
-                       return 0;
-+
-+              if (ieee80211_is_data(hdr->frame_control) ||
-+                  ieee80211_is_action(hdr->frame_control)) {
-+                      if (compare_ether_addr(sdata->vif.addr, hdr->addr1))
-+                              return 0;
-+              } else if (!ieee80211_is_beacon(hdr->frame_control))
-+                      return 0;
-+
-               break;
-       default:
-               /* should never get here */
---- a/net/mac80211/sta_info.h
-+++ b/net/mac80211/sta_info.h
-@@ -32,7 +32,6 @@
-  * @WLAN_STA_SHORT_PREAMBLE: Station is capable of receiving short-preamble
-  *    frames.
-  * @WLAN_STA_WME: Station is a QoS-STA.
-- * @WLAN_STA_WDS: Station is one of our WDS peers.
-  * @WLAN_STA_CLEAR_PS_FILT: Clear PS filter in hardware (using the
-  *    IEEE80211_TX_CTL_CLEAR_PS_FILT control flag) when the next
-  *    frame to this station is transmitted.
-@@ -64,7 +63,6 @@ enum ieee80211_sta_info_flags {
-       WLAN_STA_AUTHORIZED,
-       WLAN_STA_SHORT_PREAMBLE,
-       WLAN_STA_WME,
--      WLAN_STA_WDS,
-       WLAN_STA_CLEAR_PS_FILT,
-       WLAN_STA_MFP,
-       WLAN_STA_BLOCK_BA,
---- a/net/wireless/chan.c
-+++ b/net/wireless/chan.c
-@@ -82,7 +82,6 @@ int cfg80211_set_monitor_channel(struct 
-                                int freq, enum nl80211_channel_type chantype)
+       /*
+        * Find the lowest frame length among the rate series that will have a
+@@ -736,8 +721,6 @@ static int ath_compute_num_delims(struct
+                                 bool first_subfrm)
  {
-       struct ieee80211_channel *chan;
--      int err;
+ #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;
+       u16 minlen;
+       u8 flags, rix;
+@@ -778,8 +761,8 @@ static int ath_compute_num_delims(struct
+       if (tid->an->mpdudensity == 0)
+               return ndelim;
+-      rix = tx_info->control.rates[0].idx;
+-      flags = tx_info->control.rates[0].flags;
++      rix = bf->rates[0].idx;
++      flags = bf->rates[0].flags;
+       width = (flags & IEEE80211_TX_RC_40_MHZ_WIDTH) ? 1 : 0;
+       half_gi = (flags & IEEE80211_TX_RC_SHORT_GI) ? 1 : 0;
+@@ -858,6 +841,7 @@ static enum ATH_AGGR_STATUS ath_tx_form_
+                       bf_first = bf;
+               if (!rl) {
++                      ath_set_rates(tid->an->vif, tid->an->sta, bf);
+                       aggr_limit = ath_lookup_rate(sc, bf, tid);
+                       rl = 1;
+               }
+@@ -998,14 +982,14 @@ static void ath_buf_set_rate(struct ath_
  
-       if (!rdev->ops->set_monitor_channel)
-               return -EOPNOTSUPP;
-@@ -93,13 +92,7 @@ int cfg80211_set_monitor_channel(struct 
-       if (!chan)
-               return -EINVAL;
+       skb = bf->bf_mpdu;
+       tx_info = IEEE80211_SKB_CB(skb);
+-      rates = tx_info->control.rates;
++      rates = bf->rates;
+       hdr = (struct ieee80211_hdr *)skb->data;
+       /* set dur_update_en for l-sig computation except for PS-Poll frames */
+       info->dur_update = !ieee80211_is_pspoll(hdr->frame_control);
+       info->rtscts_rate = fi->rtscts_rate;
+-      for (i = 0; i < 4; i++) {
++      for (i = 0; i < ARRAY_SIZE(bf->rates); i++) {
+               bool is_40, is_sgi, is_sp;
+               int phy;
+@@ -1224,9 +1208,6 @@ int ath_tx_aggr_start(struct ath_softc *
+       an = (struct ath_node *)sta->drv_priv;
+       txtid = ATH_AN_2_TID(an, tid);
+-      if (txtid->state & (AGGR_CLEANUP | AGGR_ADDBA_COMPLETE))
+-              return -EAGAIN;
+-
+       /* update ampdu factor/density, they may have changed. This may happen
+        * in HT IBSS when a beacon with HT-info is received after the station
+        * has already been added.
+@@ -1238,7 +1219,7 @@ int ath_tx_aggr_start(struct ath_softc *
+               an->mpdudensity = density;
+       }
+-      txtid->state |= AGGR_ADDBA_PROGRESS;
++      txtid->active = true;
+       txtid->paused = true;
+       *ssn = txtid->seq_start = txtid->seq_next;
+       txtid->bar_index = -1;
+@@ -1255,28 +1236,9 @@ void ath_tx_aggr_stop(struct ath_softc *
+       struct ath_atx_tid *txtid = ATH_AN_2_TID(an, tid);
+       struct ath_txq *txq = txtid->ac->txq;
  
--      err = rdev->ops->set_monitor_channel(&rdev->wiphy, chan, chantype);
--      if (!err) {
--              rdev->monitor_channel = chan;
--              rdev->monitor_channel_type = chantype;
+-      if (txtid->state & AGGR_CLEANUP)
+-              return;
+-
+-      if (!(txtid->state & AGGR_ADDBA_COMPLETE)) {
+-              txtid->state &= ~AGGR_ADDBA_PROGRESS;
+-              return;
 -      }
 -
--      return err;
-+      return rdev->ops->set_monitor_channel(&rdev->wiphy, chan, chantype);
+       ath_txq_lock(sc, txq);
++      txtid->active = false;
+       txtid->paused = true;
+-
+-      /*
+-       * If frames are still being transmitted for this TID, they will be
+-       * cleaned up during tx completion. To prevent race conditions, this
+-       * TID can only be reused after all in-progress subframes have been
+-       * completed.
+-       */
+-      if (txtid->baw_head != txtid->baw_tail)
+-              txtid->state |= AGGR_CLEANUP;
+-      else
+-              txtid->state &= ~AGGR_ADDBA_COMPLETE;
+-
+       ath_tx_flush_tid(sc, txtid);
+       ath_txq_unlock_complete(sc, txq);
+ }
+@@ -1342,18 +1304,28 @@ void ath_tx_aggr_wakeup(struct ath_softc
+       }
  }
  
- void
-@@ -134,9 +127,16 @@ cfg80211_get_chan_state(struct wireless_
-               break;
-       case NL80211_IFTYPE_AP:
-       case NL80211_IFTYPE_P2P_GO:
-+              if (wdev->beacon_interval) {
-+                      *chan = wdev->channel;
-+                      *chanmode = CHAN_MODE_SHARED;
-+              }
-+              return;
-       case NL80211_IFTYPE_MESH_POINT:
--              *chan = wdev->channel;
--              *chanmode = CHAN_MODE_SHARED;
-+              if (wdev->mesh_id_len) {
-+                      *chan = wdev->channel;
-+                      *chanmode = CHAN_MODE_SHARED;
-+              }
+-void ath_tx_aggr_resume(struct ath_softc *sc, struct ieee80211_sta *sta, u16 tid)
++void ath_tx_aggr_resume(struct ath_softc *sc, struct ieee80211_sta *sta,
++                      u16 tidno)
+ {
+-      struct ath_atx_tid *txtid;
++      struct ath_atx_tid *tid;
+       struct ath_node *an;
++      struct ath_txq *txq;
+       an = (struct ath_node *)sta->drv_priv;
++      tid = ATH_AN_2_TID(an, tidno);
++      txq = tid->ac->txq;
+-      txtid = ATH_AN_2_TID(an, tid);
+-      txtid->baw_size = IEEE80211_MIN_AMPDU_BUF << sta->ht_cap.ampdu_factor;
+-      txtid->state |= AGGR_ADDBA_COMPLETE;
+-      txtid->state &= ~AGGR_ADDBA_PROGRESS;
+-      ath_tx_resume_tid(sc, txtid);
++      ath_txq_lock(sc, txq);
++
++      tid->baw_size = IEEE80211_MIN_AMPDU_BUF << sta->ht_cap.ampdu_factor;
++      tid->paused = false;
++
++      if (!skb_queue_empty(&tid->buf_q)) {
++              ath_tx_queue_tid(txq, tid);
++              ath_txq_schedule(sc, txq);
++      }
++
++      ath_txq_unlock_complete(sc, txq);
+ }
+ /********************/
+@@ -1743,6 +1715,7 @@ static void ath_tx_send_ampdu(struct ath
                return;
-       case NL80211_IFTYPE_MONITOR:
-       case NL80211_IFTYPE_AP_VLAN:
---- a/net/wireless/core.c
-+++ b/net/wireless/core.c
-@@ -747,60 +747,14 @@ static struct device_type wiphy_type = {
- };
- #endif
+       }
++      ath_set_rates(tid->an->vif, tid->an->sta, bf);
+       bf->bf_state.bf_type = BUF_AMPDU;
+       INIT_LIST_HEAD(&bf_head);
+       list_add(&bf->list, &bf_head);
+@@ -1892,49 +1865,6 @@ static struct ath_buf *ath_tx_setup_buff
+       return bf;
+ }
  
--static struct ieee80211_channel *
--cfg80211_get_any_chan(struct cfg80211_registered_device *rdev)
+-/* FIXME: tx power */
+-static void ath_tx_start_dma(struct ath_softc *sc, struct sk_buff *skb,
+-                           struct ath_tx_control *txctl)
 -{
--      struct ieee80211_supported_band *sband;
--      int i;
+-      struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
+-      struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
+-      struct ath_atx_tid *tid = NULL;
+-      struct ath_buf *bf;
+-      u8 tidno;
 -
--      for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
--              sband = rdev->wiphy.bands[i];
--              if (sband && sband->n_channels > 0)
--                      return &sband->channels[0];
+-      if (txctl->an && ieee80211_is_data_qos(hdr->frame_control)) {
+-              tidno = ieee80211_get_qos_ctl(hdr)[0] &
+-                      IEEE80211_QOS_CTL_TID_MASK;
+-              tid = ATH_AN_2_TID(txctl->an, tidno);
+-
+-              WARN_ON(tid->ac->txq != txctl->txq);
 -      }
 -
--      return NULL;
--}
+-      if ((tx_info->flags & IEEE80211_TX_CTL_AMPDU) && tid) {
+-              /*
+-               * Try aggregation if it's a unicast data frame
+-               * and the destination is HT capable.
+-               */
+-              ath_tx_send_ampdu(sc, tid, skb, txctl);
+-      } else {
+-              bf = ath_tx_setup_buffer(sc, txctl->txq, tid, skb);
+-              if (!bf) {
+-                      if (txctl->paprd)
+-                              dev_kfree_skb_any(skb);
+-                      else
+-                              ieee80211_free_txskb(sc->hw, skb);
+-                      return;
+-              }
 -
--static void cfg80211_init_mon_chan(struct cfg80211_registered_device *rdev)
--{
--      struct ieee80211_channel *chan;
+-              bf->bf_state.bfs_paprd = txctl->paprd;
 -
--      chan = cfg80211_get_any_chan(rdev);
--      if (WARN_ON(!chan))
--              return;
+-              if (txctl->paprd)
+-                      bf->bf_state.bfs_paprd_timestamp = jiffies;
 -
--      mutex_lock(&rdev->devlist_mtx);
--      WARN_ON(cfg80211_set_monitor_channel(rdev, chan->center_freq,
--                                           NL80211_CHAN_NO_HT));
--      mutex_unlock(&rdev->devlist_mtx);
+-              ath_tx_send_normal(sc, txctl->txq, tid, skb);
+-      }
 -}
 -
- void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
-                              enum nl80211_iftype iftype, int num)
- {
--      bool has_monitors_only_old = cfg80211_has_monitors_only(rdev);
--      bool has_monitors_only_new;
--
-       ASSERT_RTNL();
+ /* Upon failure caller should free skb */
+ int ath_tx_start(struct ieee80211_hw *hw, struct sk_buff *skb,
+                struct ath_tx_control *txctl)
+@@ -1945,8 +1875,11 @@ int ath_tx_start(struct ieee80211_hw *hw
+       struct ieee80211_vif *vif = info->control.vif;
+       struct ath_softc *sc = hw->priv;
+       struct ath_txq *txq = txctl->txq;
++      struct ath_atx_tid *tid = NULL;
++      struct ath_buf *bf;
+       int padpos, padsize;
+       int frmlen = skb->len + FCS_LEN;
++      u8 tidno;
+       int q;
+       /* NOTE:  sta can be NULL according to net/mac80211.h */
+@@ -2002,8 +1935,41 @@ int ath_tx_start(struct ieee80211_hw *hw
+               txq->stopped = true;
+       }
  
-       rdev->num_running_ifaces += num;
-       if (iftype == NL80211_IFTYPE_MONITOR)
-               rdev->num_running_monitor_ifaces += num;
--
--      has_monitors_only_new = cfg80211_has_monitors_only(rdev);
--      if (has_monitors_only_new != has_monitors_only_old) {
--              if (rdev->ops->set_monitor_enabled)
--                      rdev->ops->set_monitor_enabled(&rdev->wiphy,
--                                                     has_monitors_only_new);
--
--              if (!has_monitors_only_new) {
--                      rdev->monitor_channel = NULL;
--                      rdev->monitor_channel_type = NL80211_CHAN_NO_HT;
--              } else {
--                      cfg80211_init_mon_chan(rdev);
--              }
--      }
- }
+-      ath_tx_start_dma(sc, skb, txctl);
++      if (txctl->an && ieee80211_is_data_qos(hdr->frame_control)) {
++              tidno = ieee80211_get_qos_ctl(hdr)[0] &
++                      IEEE80211_QOS_CTL_TID_MASK;
++              tid = ATH_AN_2_TID(txctl->an, tidno);
  
- static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
-@@ -932,6 +886,7 @@ static int cfg80211_netdev_notifier_call
-                       mutex_unlock(&rdev->devlist_mtx);
-                       dev_put(dev);
-               }
-+              cfg80211_update_iface_num(rdev, wdev->iftype, 1);
-               cfg80211_lock_rdev(rdev);
-               mutex_lock(&rdev->devlist_mtx);
-               wdev_lock(wdev);
-@@ -1026,7 +981,6 @@ static int cfg80211_netdev_notifier_call
-               mutex_unlock(&rdev->devlist_mtx);
-               if (ret)
-                       return notifier_from_errno(ret);
--              cfg80211_update_iface_num(rdev, wdev->iftype, 1);
-               break;
++              WARN_ON(tid->ac->txq != txctl->txq);
++      }
++
++      if ((info->flags & IEEE80211_TX_CTL_AMPDU) && tid) {
++              /*
++               * Try aggregation if it's a unicast data frame
++               * and the destination is HT capable.
++               */
++              ath_tx_send_ampdu(sc, tid, skb, txctl);
++              goto out;
++      }
++
++      bf = ath_tx_setup_buffer(sc, txctl->txq, tid, skb);
++      if (!bf) {
++              if (txctl->paprd)
++                      dev_kfree_skb_any(skb);
++              else
++                      ieee80211_free_txskb(sc->hw, skb);
++              goto out;
++      }
++
++      bf->bf_state.bfs_paprd = txctl->paprd;
++
++      if (txctl->paprd)
++              bf->bf_state.bfs_paprd_timestamp = jiffies;
++
++      ath_set_rates(vif, sta, bf);
++      ath_tx_send_normal(sc, txctl->txq, tid, skb);
++
++out:
+       ath_txq_unlock(sc, txq);
+       return 0;
+@@ -2408,12 +2374,10 @@ void ath_tx_node_init(struct ath_softc *
+               tid->baw_head  = tid->baw_tail = 0;
+               tid->sched     = false;
+               tid->paused    = false;
+-              tid->state &= ~AGGR_CLEANUP;
++              tid->active        = false;
+               __skb_queue_head_init(&tid->buf_q);
+               acno = TID_TO_WME_AC(tidno);
+               tid->ac = &an->ac[acno];
+-              tid->state &= ~AGGR_ADDBA_COMPLETE;
+-              tid->state &= ~AGGR_ADDBA_PROGRESS;
        }
  
---- a/net/wireless/core.h
-+++ b/net/wireless/core.h
-@@ -61,9 +61,6 @@ struct cfg80211_registered_device {
-       int num_running_ifaces;
-       int num_running_monitor_ifaces;
+       for (acno = 0, ac = &an->ac[acno];
+@@ -2450,9 +2414,9 @@ void ath_tx_node_cleanup(struct ath_soft
+               }
  
--      struct ieee80211_channel *monitor_channel;
--      enum nl80211_channel_type monitor_channel_type;
--
-       /* BSSes/scanning */
-       spinlock_t bss_lock;
-       struct list_head bss_list;
---- a/net/wireless/nl80211.c
-+++ b/net/wireless/nl80211.c
-@@ -1759,11 +1759,17 @@ static int nl80211_send_iface(struct sk_
-                       (cfg80211_rdev_list_generation << 2)))
-               goto nla_put_failure;
+               ath_tid_drain(sc, txq, tid);
+-              tid->state &= ~AGGR_ADDBA_COMPLETE;
+-              tid->state &= ~AGGR_CLEANUP;
++              tid->active = false;
  
--      if (rdev->monitor_channel) {
--              if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
--                              rdev->monitor_channel->center_freq) ||
--                  nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
--                              rdev->monitor_channel_type))
-+      if (rdev->ops->get_channel) {
-+              struct ieee80211_channel *chan;
-+              enum nl80211_channel_type channel_type;
-+
-+              chan = rdev->ops->get_channel(&rdev->wiphy, wdev,
-+                                            &channel_type);
-+              if (chan &&
-+                  (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
-+                               chan->center_freq) ||
-+                   nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
-+                               channel_type)))
-                       goto nla_put_failure;
+               ath_txq_unlock(sc, txq);
        }
+ }
++
+--- a/drivers/net/wireless/ath/ath9k/recv.c
++++ b/drivers/net/wireless/ath/ath9k/recv.c
+@@ -124,7 +124,7 @@ static bool ath_rx_edma_buf_link(struct 
  
---- a/net/wireless/wext-compat.c
-+++ b/net/wireless/wext-compat.c
-@@ -827,6 +827,8 @@ static int cfg80211_wext_giwfreq(struct 
- {
-       struct wireless_dev *wdev = dev->ieee80211_ptr;
-       struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
-+      struct ieee80211_channel *chan;
-+      enum nl80211_channel_type channel_type;
-       switch (wdev->iftype) {
-       case NL80211_IFTYPE_STATION:
-@@ -834,10 +836,13 @@ static int cfg80211_wext_giwfreq(struct 
-       case NL80211_IFTYPE_ADHOC:
-               return cfg80211_ibss_wext_giwfreq(dev, info, freq, extra);
-       case NL80211_IFTYPE_MONITOR:
--              if (!rdev->monitor_channel)
-+              if (!rdev->ops->get_channel)
-                       return -EINVAL;
--              freq->m = rdev->monitor_channel->center_freq;
-+              chan = rdev->ops->get_channel(wdev->wiphy, wdev, &channel_type);
-+              if (!chan)
-+                      return -EINVAL;
-+              freq->m = chan->center_freq;
-               freq->e = 6;
-               return 0;
-       default:
---- a/drivers/net/wireless/ath/ath5k/ath5k.h
-+++ b/drivers/net/wireless/ath/ath5k/ath5k.h
-@@ -1331,7 +1331,6 @@ struct ath5k_hw {
-       unsigned int            nexttbtt;       /* next beacon time in TU */
-       struct ath5k_txq        *cabq;          /* content after beacon */
--      int                     power_level;    /* Requested tx power in dBm */
-       bool                    assoc;          /* associate state */
-       bool                    enable_beacon;  /* true if beacons are on */
-@@ -1425,6 +1424,7 @@ struct ath5k_hw {
-               /* Value in dB units */
-               s16             txp_cck_ofdm_pwr_delta;
-               bool            txp_setup;
-+              int             txp_requested;  /* Requested tx power in dBm */
-       } ah_txpower;
-       struct ath5k_nfcal_hist ah_nfcal_hist;
---- a/drivers/net/wireless/ath/ath5k/base.c
-+++ b/drivers/net/wireless/ath/ath5k/base.c
-@@ -325,6 +325,8 @@ ath5k_setup_channels(struct ath5k_hw *ah
-               if (!ath5k_is_standard_channel(ch, band))
-                       continue;
+       SKB_CB_ATHBUF(skb) = bf;
+       ath9k_hw_addrxbuf_edma(ah, bf->bf_buf_addr, qtype);
+-      skb_queue_tail(&rx_edma->rx_fifo, skb);
++      __skb_queue_tail(&rx_edma->rx_fifo, skb);
  
-+              channels[count].max_power = AR5K_TUNE_MAX_TXPOWER/2;
-+
-               count++;
-       }
+       return true;
+ }
+@@ -155,7 +155,7 @@ static void ath_rx_remove_buffer(struct 
  
-@@ -725,7 +727,7 @@ ath5k_txbuf_setup(struct ath5k_hw *ah, s
-       ret = ah->ah_setup_tx_desc(ah, ds, pktlen,
-               ieee80211_get_hdrlen_from_skb(skb), padsize,
-               get_hw_packet_type(skb),
--              (ah->power_level * 2),
-+              (ah->ah_txpower.txp_requested * 2),
-               hw_rate,
-               info->control.rates[0].count, keyidx, ah->ah_tx_ant, flags,
-               cts_rate, duration);
-@@ -1780,7 +1782,8 @@ ath5k_beacon_setup(struct ath5k_hw *ah, 
-       ds->ds_data = bf->skbaddr;
-       ret = ah->ah_setup_tx_desc(ah, ds, skb->len,
-                       ieee80211_get_hdrlen_from_skb(skb), padsize,
--                      AR5K_PKT_TYPE_BEACON, (ah->power_level * 2),
-+                      AR5K_PKT_TYPE_BEACON,
-+                      (ah->ah_txpower.txp_requested * 2),
-                       ieee80211_get_tx_rate(ah->hw, info)->hw_value,
-                       1, AR5K_TXKEYIX_INVALID,
-                       antenna, flags, 0, 0);
---- a/drivers/net/wireless/ath/ath5k/eeprom.c
-+++ b/drivers/net/wireless/ath/ath5k/eeprom.c
-@@ -524,7 +524,7 @@ ath5k_eeprom_read_freq_list(struct ath5k
-               freq1 = val & 0xff;
-               if (!freq1)
--                      break;
-+                      continue;
+       rx_edma = &sc->rx.rx_edma[qtype];
  
-               pc[i++].freq = ath5k_eeprom_bin2freq(ee,
-                               freq1, mode);
-@@ -532,7 +532,7 @@ ath5k_eeprom_read_freq_list(struct ath5k
+-      while ((skb = skb_dequeue(&rx_edma->rx_fifo)) != NULL) {
++      while ((skb = __skb_dequeue(&rx_edma->rx_fifo)) != NULL) {
+               bf = SKB_CB_ATHBUF(skb);
+               BUG_ON(!bf);
+               list_add_tail(&bf->list, &sc->rx.rxbuf);
+@@ -1287,13 +1287,13 @@ int ath_rx_tasklet(struct ath_softc *sc,
+                       goto requeue_drop_frag;
+               }
  
-               freq2 = (val >> 8) & 0xff;
-               if (!freq2)
--                      break;
-+                      continue;
+-              bf->bf_mpdu = requeue_skb;
+-              bf->bf_buf_addr = new_buf_addr;
+-
+               /* Unmap the frame */
+               dma_unmap_single(sc->dev, bf->bf_buf_addr,
+                                common->rx_bufsize, dma_type);
  
-               pc[i++].freq = ath5k_eeprom_bin2freq(ee,
-                               freq2, mode);
---- a/drivers/net/wireless/ath/ath5k/phy.c
-+++ b/drivers/net/wireless/ath/ath5k/phy.c
-@@ -3518,6 +3518,7 @@ ath5k_setup_rate_powertable(struct ath5k
- {
-       unsigned int i;
-       u16 *rates;
-+      s16 rate_idx_scaled = 0;
-       /* max_pwr is power level we got from driver/user in 0.5dB
-        * units, switch to 0.25dB units so we can compare */
-@@ -3564,20 +3565,32 @@ ath5k_setup_rate_powertable(struct ath5k
-               for (i = 8; i <= 15; i++)
-                       rates[i] -= ah->ah_txpower.txp_cck_ofdm_gainf_delta;
-+      /* Save min/max and current tx power for this channel
-+       * in 0.25dB units.
-+       *
-+       * Note: We use rates[0] for current tx power because
-+       * it covers most of the rates, in most cases. It's our
-+       * tx power limit and what the user expects to see. */
-+      ah->ah_txpower.txp_min_pwr = 2 * rates[7];
-+      ah->ah_txpower.txp_cur_pwr = 2 * rates[0];
-+
-+      /* Set max txpower for correct OFDM operation on all rates
-+       * -that is the txpower for 54Mbit-, it's used for the PAPD
-+       * gain probe and it's in 0.5dB units */
-+      ah->ah_txpower.txp_ofdm = rates[7];
-+
-       /* Now that we have all rates setup use table offset to
-        * match the power range set by user with the power indices
-        * on PCDAC/PDADC table */
-       for (i = 0; i < 16; i++) {
--              rates[i] += ah->ah_txpower.txp_offset;
-+              rate_idx_scaled = rates[i] + ah->ah_txpower.txp_offset;
-               /* Don't get out of bounds */
--              if (rates[i] > 63)
--                      rates[i] = 63;
-+              if (rate_idx_scaled > 63)
-+                      rate_idx_scaled = 63;
-+              if (rate_idx_scaled < 0)
-+                      rate_idx_scaled = 0;
-+              rates[i] = rate_idx_scaled;
++              bf->bf_mpdu = requeue_skb;
++              bf->bf_buf_addr = new_buf_addr;
++
+               skb_put(skb, rs.rs_datalen + ah->caps.rx_status_len);
+               if (ah->caps.rx_status_len)
+                       skb_pull(skb, ah->caps.rx_status_len);
+--- a/net/wireless/core.c
++++ b/net/wireless/core.c
+@@ -885,7 +885,6 @@ void cfg80211_leave(struct cfg80211_regi
+ #endif
+               __cfg80211_disconnect(rdev, dev,
+                                     WLAN_REASON_DEAUTH_LEAVING, true);
+-              cfg80211_mlme_down(rdev, dev);
+               wdev_unlock(wdev);
+               break;
+       case NL80211_IFTYPE_MESH_POINT:
+--- a/net/wireless/sme.c
++++ b/net/wireless/sme.c
+@@ -961,7 +961,7 @@ int __cfg80211_disconnect(struct cfg8021
+               /* was it connected by userspace SME? */
+               if (!wdev->conn) {
+                       cfg80211_mlme_down(rdev, dev);
+-                      return 0;
++                      goto disconnect;
+               }
+               if (wdev->sme_state == CFG80211_SME_CONNECTING &&
+@@ -987,6 +987,7 @@ int __cfg80211_disconnect(struct cfg8021
+                       return err;
        }
++ disconnect:
+       if (wdev->sme_state == CFG80211_SME_CONNECTED)
+               __cfg80211_disconnected(dev, NULL, 0, 0, false);
+       else if (wdev->sme_state == CFG80211_SME_CONNECTING)
+--- a/drivers/net/wireless/ath/ath9k/rc.c
++++ b/drivers/net/wireless/ath/ath9k/rc.c
+@@ -1227,10 +1227,7 @@ static bool ath_tx_aggr_check(struct ath
+               return false;
+       txtid = ATH_AN_2_TID(an, tidno);
 -
--      /* Min/max in 0.25dB units */
--      ah->ah_txpower.txp_min_pwr = 2 * rates[7];
--      ah->ah_txpower.txp_cur_pwr = 2 * rates[0];
--      ah->ah_txpower.txp_ofdm = rates[7];
+-      if (!(txtid->state & (AGGR_ADDBA_COMPLETE | AGGR_ADDBA_PROGRESS)))
+-                      return true;
+-      return false;
++      return !txtid->active;
  }
  
  
-@@ -3641,10 +3654,17 @@ ath5k_hw_txpower(struct ath5k_hw *ah, st
-       if (!ah->ah_txpower.txp_setup ||
-           (channel->hw_value != curr_channel->hw_value) ||
-           (channel->center_freq != curr_channel->center_freq)) {
--              /* Reset TX power values */
-+              /* Reset TX power values but preserve requested
-+               * tx power from above */
-+              int requested_txpower = ah->ah_txpower.txp_requested;
-+
-               memset(&ah->ah_txpower, 0, sizeof(ah->ah_txpower));
-+
-+              /* Restore TPC setting and requested tx power */
-               ah->ah_txpower.txp_tpc = AR5K_TUNE_TPC_TXPOWER;
+--- a/drivers/net/wireless/ath/ath9k/ar9003_phy.c
++++ b/drivers/net/wireless/ath/ath9k/ar9003_phy.c
+@@ -334,7 +334,8 @@ static void ar9003_hw_spur_ofdm(struct a
+       REG_RMW_FIELD(ah, AR_PHY_SPUR_REG,
+                     AR_PHY_SPUR_REG_EN_VIT_SPUR_RSSI, 1);
+-      if (REG_READ_FIELD(ah, AR_PHY_MODE,
++      if (!AR_SREV_9340(ah) &&
++          REG_READ_FIELD(ah, AR_PHY_MODE,
+                          AR_PHY_MODE_DYNAMIC) == 0x1)
+               REG_RMW_FIELD(ah, AR_PHY_SPUR_REG,
+                             AR_PHY_SPUR_REG_ENABLE_NF_RSSI_SPUR_MIT, 1);
+--- a/drivers/net/wireless/ath/ath9k/mac.c
++++ b/drivers/net/wireless/ath/ath9k/mac.c
+@@ -410,7 +410,7 @@ bool ath9k_hw_resettxqueue(struct ath_hw
+       REG_WRITE(ah, AR_QMISC(q), AR_Q_MISC_DCU_EARLY_TERM_REQ);
+-      if (AR_SREV_9340(ah))
++      if (AR_SREV_9340(ah) && !AR_SREV_9340_13_OR_LATER(ah))
+               REG_WRITE(ah, AR_DMISC(q),
+                         AR_D_MISC_CW_BKOFF_EN | AR_D_MISC_FRAG_WAIT_EN | 0x1);
+       else
+--- a/net/mac80211/driver-ops.h
++++ b/net/mac80211/driver-ops.h
+@@ -146,7 +146,8 @@ static inline int drv_add_interface(stru
+       if (WARN_ON(sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
+                   (sdata->vif.type == NL80211_IFTYPE_MONITOR &&
+-                   !(local->hw.flags & IEEE80211_HW_WANT_MONITOR_VIF))))
++                   !(local->hw.flags & IEEE80211_HW_WANT_MONITOR_VIF) &&
++                   !(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))))
+               return -EINVAL;
  
-+              ah->ah_txpower.txp_requested = requested_txpower;
+       trace_drv_add_interface(local, sdata);
+--- a/drivers/net/wireless/ath/ath9k/ar9003_paprd.c
++++ b/drivers/net/wireless/ath/ath9k/ar9003_paprd.c
+@@ -454,6 +454,8 @@ static bool create_pa_curve(u32 *data_L,
+               if (accum_cnt <= thresh_accum_cnt)
+                       continue;
++              max_index++;
 +
-               /* Calculate the powertable */
-               ret = ath5k_setup_channel_powertable(ah, channel,
-                                                       ee_mode, type);
-@@ -3791,8 +3811,9 @@ ath5k_hw_phy_init(struct ath5k_hw *ah, s
-        * RF buffer settings on 5211/5212+ so that we
-        * properly set curve indices.
-        */
--      ret = ath5k_hw_txpower(ah, channel, ah->ah_txpower.txp_cur_pwr ?
--                      ah->ah_txpower.txp_cur_pwr / 2 : AR5K_TUNE_MAX_TXPOWER);
-+      ret = ath5k_hw_txpower(ah, channel, ah->ah_txpower.txp_requested ?
-+                                      ah->ah_txpower.txp_requested * 2 :
-+                                      AR5K_TUNE_MAX_TXPOWER);
-       if (ret)
-               return ret;
+               /* sum(tx amplitude) */
+               accum_tx = ((data_L[i] >> 16) & 0xffff) |
+                   ((data_U[i] & 0x7ff) << 16);
+@@ -468,20 +470,21 @@ static bool create_pa_curve(u32 *data_L,
+               accum_tx <<= scale_factor;
+               accum_rx <<= scale_factor;
+-              x_est[i + 1] = (((accum_tx + accum_cnt) / accum_cnt) + 32) >>
+-                  scale_factor;
++              x_est[max_index] =
++                      (((accum_tx + accum_cnt) / accum_cnt) + 32) >>
++                      scale_factor;
+-              Y[i + 1] = ((((accum_rx + accum_cnt) / accum_cnt) + 32) >>
++              Y[max_index] =
++                      ((((accum_rx + accum_cnt) / accum_cnt) + 32) >>
+                           scale_factor) +
+-                          (1 << scale_factor) * max_index + 16;
++                      (1 << scale_factor) * i + 16;
+               if (accum_ang >= (1 << 26))
+                       accum_ang -= 1 << 27;
+-              theta[i + 1] = ((accum_ang * (1 << scale_factor)) + accum_cnt) /
+-                  accum_cnt;
+-
+-              max_index++;
++              theta[max_index] =
++                      ((accum_ang * (1 << scale_factor)) + accum_cnt) /
++                      accum_cnt;
+       }
  
+       /*