X-Git-Url: https://git.archive.openwrt.org/?p=openwrt.git;a=blobdiff_plain;f=package%2Fmac80211%2Fpatches%2F300-pending_work.patch;h=305cb8f8ecf5d21bd6aced7cfdfc552060e651bf;hp=3255b8da0ce7ec6dc5986895b186ae7361916306;hb=88e1957598057efcc8b274abad999dd9f88ec83a;hpb=30ea4fa0fbe4e3692114e8b742256751f6bc3fff diff --git a/package/mac80211/patches/300-pending_work.patch b/package/mac80211/patches/300-pending_work.patch index 3255b8da0c..305cb8f8ec 100644 --- a/package/mac80211/patches/300-pending_work.patch +++ b/package/mac80211/patches/300-pending_work.patch @@ -1,4434 +1,4325 @@ ---- 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 + #include + #include ++#include + #include + #include + #include +@@ -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; -+ -+ 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); -+} + 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; + - 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); - } + 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; ++ } - 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 */ + 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; ++ } ++ + 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 --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; + 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 + } - 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; + 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; - 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); +--- 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 } - } - -@@ -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); - } - 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); - } + 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; - 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); - } +- 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; - 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); -+} + /** ++ * 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; + -+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); - } ++/** ++ * 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_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; - } - } +--- 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, + }; -@@ -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); - } + /** +@@ -857,6 +861,8 @@ struct sta_bss_parameters { + u16 beacon_interval; + }; - static void ar9003_rx_gain_table_mode1(struct ath_hw *ah) ++#define IEEE80211_MAX_CHAINS 4 ++ + /** + * 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; +@@ -4027,6 +4041,17 @@ bool cfg80211_reg_can_beacon(struct wiph + void cfg80211_ch_switch_notify(struct net_device *dev, + struct cfg80211_chan_def *chandef); + ++/** ++ * 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 +@@ -444,7 +444,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; -- /* 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; -+ -+ mgmt_hdr = (struct ieee80211_mgmt *)skb->data; -+ mgmt_hdr->u.beacon.timestamp = avp->tsf_adjust; + sinfo->generation = sdata->local->sta_generation; - info = IEEE80211_SKB_CB(skb); - if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) { -@@ -212,61 +202,52 @@ static struct ath_buf *ath_beacon_genera - } +@@ -488,6 +488,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]); ++ } ++ } -- ath_beacon_setup(sc, vif, bf, info->control.rates[0].idx); -+ ath9k_beacon_setup(sc, vif, bf, info->control.rates[0].idx); - - while (skb) { -- ath_tx_cabq(hw, skb); -+ ath9k_tx_cabq(hw, skb); - skb = ieee80211_get_buffered_bc(hw, vif); - } + sta_set_rate_info_tx(sta, &sta->last_tx_rate, &sinfo->txrate); + sta_set_rate_info_rx(sta, &sinfo->rxrate); +@@ -1052,6 +1063,7 @@ static int ieee80211_stop_ap(struct wiph + ieee80211_free_keys(sdata); - return bf; - } + 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); --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; - } +@@ -2416,9 +2428,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; + u32 ieee80211_mandatory_rates(struct ieee80211_local *local, +--- a/net/mac80211/iface.c ++++ b/net/mac80211/iface.c +@@ -450,7 +450,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; +@@ -609,30 +608,8 @@ int ieee80211_do_open(struct wireless_de -- ath_dbg(common, BEACON, "IBSS nexttbtt %u intval %u (%u)\n", -- nexttbtt, intval, conf->beacon_interval); + 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; +- } - -- /* -- * 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; +- 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); - -- 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; +- res = sta_info_insert(sta); +- if (res) { +- /* STA has been freed */ +- goto err_del_interface; +- } - -- ath9k_hw_set_interrupts(ah); -- ath9k_hw_enable_interrupts(ah); - } - --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) - { -- 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; +- 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); - } -- /* -- * 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; - } --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) - { -+ 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; - -- 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); + /* + * set_multicast_list will be invoked by the networking core +@@ -1092,6 +1069,74 @@ static void ieee80211_if_setup(struct ne + dev->destructor = free_netdev; } --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); ++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; + -+ 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; - } ++ 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; + -+ ath9k_set_beacon(sc); ++ if (stype != IEEE80211_STYPE_BEACON) ++ return; + -+ 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; - - 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(SC_OP_BEACONS, &sc->sc_flags); --} -- --void ath9k_set_beaconing_status(struct ath_softc *sc, bool status) --{ -- struct ath_hw *ah = sc->sc_ah; -- -- if (!ath_has_valid_bslot(sc)) { -- clear_bit(SC_OP_BEACONS, &sc->sc_flags); -- return; -- } -- -- 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; - }; - --#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); - } - - 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 - -+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 -+}; ++ 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 +1241,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/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) { ++ ++ 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); + - #ifdef CONFIG_ATH9K_DEBUGFS + 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; - - qnum = get_hw_qnum(queue, priv->hwq_map); - ---- 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; +@@ -303,12 +305,6 @@ ieee80211_determine_chantype(struct ieee + channel->band); + vht_chandef.center_freq2 = 0; -- /* disable ANI for 9340 */ -- if (AR_SREV_9340(ah)) -- ah->config.enable_ani = false; +- if (vht_oper->center_freq_seg2_idx) +- vht_chandef.center_freq2 = +- ieee80211_channel_to_frequency( +- vht_oper->center_freq_seg2_idx, +- channel->band); - - ath9k_hw_init_mode_regs(ah); + 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; - if (!ah->is_pciexpress) -@@ -2916,9 +2912,9 @@ void ath9k_hw_reset_tsf(struct ath_hw *a - } - EXPORT_SYMBOL(ath9k_hw_reset_tsf); + BUILD_BUG_ON(sizeof(vht_cap) != sizeof(sband->vht_cap)); --void ath9k_hw_set_tsfadjust(struct ath_hw *ah, u32 setting) -+void ath9k_hw_set_tsfadjust(struct ath_hw *ah, bool set) - { -- 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; - } - 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); - return; - } +@@ -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; -@@ -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; - } +- 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; +- +- 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; -@@ -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); - } -@@ -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: - } +- /* +- * 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); } --void ath_start_ani(struct ath_common *common) -+void ath_start_ani(struct ath_softc *sc) +-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) { -- 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; - -- 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)) +- 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; - common->ani.longcal_timer = timestamp; - common->ani.shortcal_timer = timestamp; - common->ani.checkani_timer = timestamp; +- if (sdata->local->scanning) ++ /* disregard subsequent announcements if we are already processing */ ++ if (ifmgd->flags & IEEE80211_STA_CSA_RECEIVED) + return; -+ ath_dbg(common, ANI, "Starting ANI\n"); - mod_timer(&common->ani.timer, - jiffies + msecs_to_jiffies((u32)ah->config.ani_poll_interval)); - } +- /* 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; ++ } -+void ath_stop_ani(struct ath_softc *sc) -+{ -+ struct ath_common *common = ath9k_hw_common(sc->sc_ah); +- if (ifmgd->flags & IEEE80211_STA_CSA_RECEIVED) ++ if (ifmgd->flags & IEEE80211_STA_DISABLE_VHT) ++ wide_bw_chansw_ie = NULL; + -+ ath_dbg(common, ANI, "Stopping ANI\n"); -+ del_timer_sync(&common->ani.timer); -+} ++ 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; ++ } + -+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; ++ 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; ++ } + -+ /* -+ * 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 (!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; + } + -+ set_bit(SC_OP_ANI_RUN, &sc->sc_flags); -+ ath_start_ani(sc); -+ return; ++ 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; ++ } + -+stop_ani: -+ clear_bit(SC_OP_ANI_RUN, &sc->sc_flags); -+ ath_stop_ani(sc); -+} ++ 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); + - 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 ++ 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; + } - 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); + ifmgd->flags |= IEEE80211_STA_CSA_RECEIVED; - 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)); +- 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; + } - ath_start_rx_poll(sc, 3); -- -- if (!common->disable_ani) -- ath_start_ani(common); -+ ath_start_ani(sc); +- 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; + } + + /* 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)); } - 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; + static u32 ieee80211_handle_pwr_constr(struct ieee80211_sub_if_data *sdata, +@@ -2120,7 +2230,6 @@ void ieee80211_beacon_loss(struct ieee80 -- 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); - goto out; - } + trace_api_beacon_loss(sdata); -@@ -586,6 +577,15 @@ static int ath_reset(struct ath_softc *s - return r; +- 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 ath9k_queue_reset(struct ath_softc *sc, enum ath_reset_type type) -+{ -+#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); -+} -+ - 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) + 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 } - } --static void ath9k_reclaim_beacon(struct ath_softc *sc, -- struct ieee80211_vif *vif) --{ -- struct ath_vif *avp = (void *)vif->drv_priv; -- -- ath9k_set_beaconing_status(sc, false); -- ath_beacon_return(sc, avp); -- ath9k_set_beaconing_status(sc, true); --} -- - 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 + 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); - ath9k_calculate_iter_data(hw, vif, &iter_data); + 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)))); -- /* Set BSSID mask. */ - memcpy(common->bssidmask, iter_data.mask, ETH_ALEN); - ath_hw_setbssidmask(common); + 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); -- /* 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 (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; -- /* -- * Enable MIB interrupts when there are hardware phy counters. -- */ -+ ath9k_hw_setopmode(ah); ++ lockdep_assert_held(&sdata->u.mgd.mtx); + - if ((iter_data.nstations + iter_data.nadhocs + iter_data.nmeshes) > 0) - ah->imask |= ATH9K_INT_TSFOOR; - else - ah->imask &= ~ATH9K_INT_TSFOOR; + 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; - ath9k_hw_set_interrupts(ah); -- -- /* Set up ANI */ -- if (iter_data.naps > 0) { -- 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); -- } --} -- --/* 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; -- -- ath9k_calculate_summary_state(hw, vif); -- -- 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); -- } + if (need_ps) { +@@ -2698,10 +2810,9 @@ static void ieee80211_rx_bss_info(struct + mutex_unlock(&local->iflist_mtx); + } + +- 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); ++ } - static int ath9k_add_interface(struct ieee80211_hw *hw, -@@ -1032,7 +987,10 @@ static int ath9k_add_interface(struct ie - sc->nvifs++; +@@ -2726,7 +2837,7 @@ static void ieee80211_rx_mgmt_probe_resp + return; -- 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; + 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; - ath_dbg(common, CONFIG, "Change Interface\n"); + 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); + - mutex_lock(&sc->mutex); - ath9k_ps_wakeup(sc); - -@@ -1061,15 +1020,16 @@ static int ath9k_change_interface(struct ++ if (ies_len < 0) ++ break; ++ ++ ieee802_11_parse_elems( ++ mgmt->u.action.u.chan_switch.variable, ++ ies_len, true, &elems); ++ ++ if (elems.parse_error) ++ break; ++ + 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); ++ ++ if (ies_len < 0) ++ break; ++ ++ 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); -- /* 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; - -- 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); - - ath9k_calculate_summary_state(hw, NULL); - -@@ -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; - - 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"); - -- 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); +@@ -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; -@@ -1471,85 +1427,36 @@ static int ath9k_set_key(struct ieee8021 + mutex_lock(&ifmgd->mtx); - return ret; +@@ -4214,7 +4361,7 @@ int ieee80211_mgd_deauth(struct ieee8021 + ieee80211_destroy_auth_data(sdata, false); + mutex_unlock(&ifmgd->mtx); + +- sent_frame = tx; ++ report_frame = true; + goto out; + } + +@@ -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; } --static void ath9k_bss_iter(void *data, u8 *mac, struct ieee80211_vif *vif) + ++static void __rate_control_send_low(struct ieee80211_hw *hw, ++ struct ieee80211_supported_band *sband, ++ struct ieee80211_sta *sta, ++ struct ieee80211_tx_info *info) ++{ ++ 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); + -+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 -- */ ++ info->control.rates[0].count = ++ (info->flags & IEEE80211_TX_CTL_NO_ACK) ? ++ 1 : hw->max_rate_tries; + - if (test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) - return; - - if (bss_conf->assoc) { - set_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags); - avp->primary_sta_vif = true; ++ info->control.skip_table = 1; ++} + - 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); -- /* Reset rssi stats */ - sc->last_rssi = ATH_RSSI_DUMMY_MARKER; - sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER; + 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; -- 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; + 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; - -- /* 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; -- } + /* 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; - -- 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); +- fc = hdr->frame_control; +- if (!ieee80211_is_data(fc)) ++ if (chan_width == NL80211_CHAN_WIDTH_20_NOHT) + return; -- /* -- * 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); - } - } + alt_rate.idx = 0; +@@ -408,7 +410,7 @@ static void rate_idx_match_mask(struct i -@@ -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); + alt_rate.flags |= IEEE80211_TX_RC_MCS; + +- 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 (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); + if (rate_idx_match_mcs_mask(&alt_rate, mcs_mask)) { +@@ -426,6 +428,228 @@ static void rate_idx_match_mask(struct i + */ + } -- ath_dbg(common, CONFIG, "BSSID: %pM aid: 0x%x\n", -- common->curbssid, common->curaid); ++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++) { + /* -+ * Do not do anything when the opmode is not STATION. ++ * 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 (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 (inval) { ++ rates[i].idx = -1; ++ continue; ++ } ++ if (rates[i].idx < 0) { ++ inval = true; ++ continue; ++ } + -+ ieee80211_iterate_active_interfaces_atomic(sc->hw, -+ ath9k_bss_assoc_iter, sc); ++ /* ++ * 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 (!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); -+ } ++ 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 (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); -- } - } - -- /* -- * 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); -- -- /* 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); -- 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); - } - - if (changed & BSS_CHANGED_ERP_SLOT) { -@@ -1636,8 +1538,13 @@ static void ath9k_bss_info_changed(struc - } - } - -+ if (changed & CHECK_ANI) -+ ath_check_ani(sc); + - mutex_unlock(&sc->mutex); - ath9k_ps_restore(sc); ++ if (rates[i].flags & IEEE80211_TX_RC_VHT_MCS) { ++ WARN_ON(ieee80211_rate_get_vht_mcs(&rates[i]) > 9); ++ continue; ++ } + -+#undef CHECK_ANI - } - - 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; - -- avp = (void *)vif->drv_priv; -- if (!avp->is_bslot_active) -+ if (!vif->bss_conf.enable_beacon) - return 0; - -+ avp = (void *)vif->drv_priv; ++ /* 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; ++ } + - if (!sc->beacon.tx_processed && !edma) { - tasklet_disable(&sc->bcon_tasklet); - -@@ -1923,12 +1831,29 @@ static u32 fill_chainmask(u32 cap, u32 n - return filled; - } - -+static bool validate_antenna_mask(struct ath_hw *ah, u32 val) ++ /* 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) +{ -+ switch (val & 0x7) { -+ case 0x1: -+ case 0x3: -+ case 0x7: -+ return true; -+ case 0x2: -+ return (ah->caps.rx_chainmask == 1); -+ default: -+ return false; ++ 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 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; - -- if (!rx_ant || !tx_ant) -+ if (ah->caps.rx_chainmask != 1) -+ rx_ant |= tx_ant; ++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; + -+ if (!validate_antenna_mask(ah, rx_ant) || !tx_ant) - return -EINVAL; ++ /* ++ * 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]; - 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 (sta && test_sta_flag(sta, WLAN_STA_RATE_CONTROL)) { + ista = &sta->sta; +@@ -454,37 +676,27 @@ void rate_control_get_rate(struct ieee80 - if (ath_beacon_dtim_pending_cab(skb)) { -@@ -1044,7 +1044,6 @@ int ath_rx_tasklet(struct ath_softc *sc, - struct ieee80211_hw *hw = sc->hw; - struct ieee80211_hdr *hdr; - int retval; -- bool decrypt_error = false; - struct ath_rx_status rs; - enum ath9k_rx_qtype qtype; - bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA); -@@ -1066,6 +1065,7 @@ int ath_rx_tasklet(struct ath_softc *sc, - tsf_lower = tsf & 0xffffffff; - - do { -+ bool decrypt_error = false; - /* If handling rx interrupt and flush is in progress => exit */ - if (test_bit(SC_OP_RXFLUSH, &sc->sc_flags) && (flush == 0)) - break; ---- 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, - }; + ref->ops->get_rate(ref->priv, ista, priv_sta, txrc); --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, +- /* +- * 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]; +- 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); +- } - } --}; -- - /*********************/ - /* Aggregation logic */ - /*********************/ -@@ -614,10 +589,8 @@ static void ath_tx_complete_aggr(struct - - rcu_read_unlock(); ++ if (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_RC_TABLE) ++ return; -- 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); +- 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); ++ ++ return 0; } ++EXPORT_SYMBOL(rate_control_set_rates); - 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 - - /* - * 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; - -@@ -682,7 +655,7 @@ static u32 ath_lookup_rate(struct ath_so - if (rates[i].flags & IEEE80211_TX_RC_SHORT_GI) - modeidx++; - -- 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); - } - -@@ -929,6 +902,44 @@ static u32 ath_pkt_duration(struct ath_s - return duration; + 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 int ath_max_framelen(int usec, int mcs, bool ht40, bool sgi) + static void ++minstrel_set_rate(struct minstrel_sta_info *mi, struct ieee80211_sta_rates *ratetbl, ++ int offset, int idx) +{ -+ 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; ++ 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; +} + -+void ath_update_max_aggr_framelen(struct ath_softc *sc, int queue, int txop) ++static void ++minstrel_update_rates(struct minstrel_priv *mp, struct minstrel_sta_info *mi) +{ -+ 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); ++ 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 ath_buf_set_rate(struct ath_softc *sc, struct ath_buf *bf, - struct ath_tx_info *info, int len) ++static void + minstrel_update_stats(struct minstrel_priv *mp, struct minstrel_sta_info *mi) { -@@ -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) - return; + u8 tmp_tp_rate[MAX_THR_RATES]; +@@ -161,6 +205,8 @@ minstrel_update_stats(struct minstrel_pr -@@ -1988,7 +2000,8 @@ int ath_tx_start(struct ieee80211_hw *hw + /* Reset update timer */ + mi->stats_update = jiffies; ++ ++ minstrel_update_rates(mp, mi); + } - 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 + 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 + sampling_ratio = mp->lookaround_rate; - ath_txq_lock(sc, txq); - for (;;) { -- if (work_pending(&sc->hw_reset_work)) -+ if (test_bit(SC_OP_HW_RESET, &sc->sc_flags)) - break; +- /* init rateindex [ndx] with max throughput rate */ +- ndx = mi->max_tp_rate[0]; +- + /* 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; +- +- /* 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; +- +- 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]; +- +- /* mrr setup for 1st stage */ +- ar[0].idx = mi->r[ndx].rix; +- ar[0].count = minstrel_get_retry_count(&mi->r[ndx], info); +- +- /* 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; +- } - if (list_empty(&txq->axq_q)) { -@@ -2274,7 +2288,7 @@ void ath_tx_edma_tasklet(struct ath_soft - int status; +- /* 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); + } - for (;;) { -- if (work_pending(&sc->hw_reset_work)) -+ if (test_bit(SC_OP_HW_RESET, &sc->sc_flags)) - break; - 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; +@@ -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 */ - memset(&status, 0, sizeof(status)); ++ 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); -@@ -766,16 +766,17 @@ void b43_rx(struct b43_wldev *dev, struc ++ memset(mi->max_tp_rate, 0, sizeof(mi->max_tp_rate)); ++ mi->max_prob_rate = 0; ++ + 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; } - 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); - 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; - } -+ status.rate_idx = rate_idx; - status.antenna = !!(phystat0 & B43_RX_PHYST0_ANT); + for (i = n; i < sband->n_bitrates; i++) { +@@ -471,6 +490,7 @@ minstrel_rate_init(void *priv, struct ie + mi->stats_update = jiffies; - /* ---- 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; + init_sample_table(mi); ++ minstrel_update_rates(mp, mi); + } - lbs_deb_enter_args(LBS_DEB_CFG80211, "cfg80211 regulatory domain " - "callback for domain %c%c\n", request->alpha2[0], - request->alpha2[1]); + 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 -- 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); +-#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 */ - 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) + +@@ -27,7 +28,7 @@ + static inline int + minstrel_ewma(int old, int new, int weight) { -+ 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; +- return (new * (100 - weight) + old * weight) / 100; ++ return (new * (EWMA_DIV - weight) + old * weight) / EWMA_DIV; + } - 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]); +@@ -62,6 +63,8 @@ struct minstrel_rate { + }; - domain->header.type = cpu_to_le16(TLV_TYPE_DOMAIN); + struct minstrel_sta_info { ++ struct ieee80211_sta *sta; ++ + 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); ++ + /* + * 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; - /* 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] = ' '; +- 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; ++ } ++ + 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; - /* Now set up the channel triplets; firmware is somewhat picky here -@@ -848,6 +848,7 @@ int lbs_set_11d_domain_info(struct lbs_p + 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; ++ } - ret = lbs_cmd_with_response(priv, CMD_802_11D_DOMAIN_INFO, &cmd); + 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; ++ } -+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 (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); + } - 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; - } + static void +@@ -580,39 +600,73 @@ minstrel_calc_retransmit(struct minstrel + (++mr->retry_count < mp->max_retry)); + } -+ ret = lbs_set_11d_domain_info(priv); -+ if (ret) { -+ lbs_deb_net("set 11d domain info failed\n"); -+ goto err; +- + 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; + } -+ - 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; + 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; ++ } ++ ++ if (offset > 0) { ++ ratetbl->rate[offset].count = ratetbl->rate[offset].count_rts; ++ flags |= IEEE80211_TX_RC_USE_RTS_CTS; ++ } ++ ++ 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); + } ---- a/net/mac80211/cfg.c -+++ b/net/mac80211/cfg.c -@@ -2982,14 +2982,14 @@ static int ieee80211_probe_client(struct - return 0; +- 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 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) + 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) { - struct ieee80211_local *local = wiphy_priv(wiphy); ++ 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 -- if (enabled) -- WARN_ON(ieee80211_add_virtual_monitor(local)); -- else -- ieee80211_del_virtual_monitor(local); -+ *type = local->_oper_channel_type; -+ return local->oper_channel; +- 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); +- } +- +- 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 +- 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++; + + /* wraparound */ +@@ -788,6 +797,16 @@ minstrel_ht_get_rate(void *priv, struct + mi->total_packets = 0; + mi->sample_packets = 0; + } ++ ++ if (sample_idx < 0) ++ return; ++ ++ 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; } - #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" : "" + static void +@@ -837,6 +856,8 @@ minstrel_ht_update_caps(void *priv, stru - 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); + msp->is_ht = true; + memset(mi, 0, sizeof(*mi)); ++ ++ mi->sta = sta; + mi->stats_update = jiffies; --/* 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; - } + 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; --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; - } ++ minstrel_ht_update_stats(mp, mi); ++ minstrel_ht_update_rates(mp, mi); ++ + return; --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; + 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 { + }; -@@ -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_ + struct minstrel_ht_sta { ++ struct ieee80211_sta *sta; ++ + /* 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 (status->chains) { ++ sta->chains = status->chains; ++ for (i = 0; i < ARRAY_SIZE(status->chain_signal); i++) { ++ int signal = status->chain_signal[i]; ++ ++ 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 + } + + 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; + +@@ -2423,6 +2439,22 @@ ieee80211_rx_h_action(struct ieee80211_r } -+ if (local->monitors == 0 && local->open_count == 0) { -+ res = ieee80211_add_virtual_monitor(local); -+ if (res) -+ goto err_stop; -+ } + 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; + +@@ -2695,14 +2723,15 @@ ieee80211_rx_h_mgmt(struct ieee80211_rx_ + + 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; + + 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; ++ ++ 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; + - /* 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); + 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; + +- ieee802_11_parse_elems(elements, skb->len - baselen, &elems); ++ ieee802_11_parse_elems(elements, skb->len - baselen, false, &elems); + + channel = ieee80211_get_channel(local->hw.wiphy, rx_status->freq); + +--- 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]; + - res = drv_add_interface(local, sdata); - if (res) - goto err_stop; -@@ -548,28 +555,6 @@ static int ieee80211_do_open(struct net_ + /* 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; - set_bit(SDATA_STATE_RUNNING, &sdata->state); + /* uh huh? */ +- if (WARN_ON_ONCE(info->control.rates[0].idx < 0)) ++ if (WARN_ON_ONCE(tx->rate.idx < 0)) + return 0; -- 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; + sband = local->hw.wiphy->bands[info->band]; +- txrate = &sband->bitrates[info->control.rates[0].idx]; ++ txrate = &sband->bitrates[tx->rate.idx]; + + erp = txrate->flags & IEEE80211_RATE_ERP_G; + +@@ -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 + 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; + } + ++ info->control.use_rts = txrc.rts; ++ info->control.use_cts_prot = tx->sdata->vif.bss_conf.use_cts_prot; ++ + /* + * 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; ++ ++ info->control.short_preamble = txrc.short_preamble; + + 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); + +- 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]; ++ } + + 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; + ++ if (ratetbl) ++ return TX_CONTINUE; ++ + if (unlikely(!info->control.rates[0].count)) + info->control.rates[0].count = 1; + +@@ -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 (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; + } +@@ -660,7 +661,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 +669,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 +717,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 +870,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]; -+ -+ rx_status = IEEE80211_SKB_RXCB(skb); -+ 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, &elems); -+ -+ rates = ieee80211_sta_get_rates(local, &elems, band, NULL); -+ -+ rcu_read_lock(); -+ -+ sta = sta_info_get(sdata, sdata->u.wds.remote_addr); ++ 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; ++ } + -+ if (!sta) { -+ rcu_read_unlock(); -+ sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr, -+ GFP_KERNEL); -+ if (!sta) -+ return; ++ return false; ++} ++EXPORT_SYMBOL(ieee80211_operating_class_to_band); + -+ new = true; -+ } + 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, +--- 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 +@@ -3367,6 +3367,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; + -+ sta->last_rx = jiffies; -+ sta->sta.supp_rates[local->hw.conf.channel->band] = rates; ++ if (!mask) ++ return true; + -+ if (elems.ht_cap_elem) -+ ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband, -+ elems.ht_cap_elem, &sta->sta.ht_cap); ++ attr = nla_nest_start(msg, id); ++ if (!attr) ++ return false; + -+ if (elems.wmm_param) -+ set_sta_flag(sta, WLAN_STA_WME); ++ for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { ++ if (!(mask & BIT(i))) ++ continue; + -+ 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); ++ if (nla_put_u8(msg, i, signal[i])) ++ return false; + } + -+ rcu_read_unlock(); ++ nla_nest_end(msg, attr); ++ ++ return true; +} + - static void ieee80211_iface_work(struct work_struct *work) + static int nl80211_send_station(struct sk_buff *msg, u32 portid, u32 seq, + int flags, + struct cfg80211_registered_device *rdev, +@@ -3402,7 +3428,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 +3464,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; +--- 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_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 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); + } - mutex_lock(&local->mtx); ++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 ath_tx_flush_tid(struct ath_softc *sc, struct ath_atx_tid *tid) + { + 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); + } + } + +- 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 + + list_add_tail(&bf->list, &bf_head); + +- 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); + } -@@ -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); +@@ -407,7 +390,7 @@ static void ath_tx_complete_aggr(struct -- if (roc->started) { -+ if (started) { - drv_flush(local, false); + tx_info = IEEE80211_SKB_CB(skb); - local->tmp_channel = NULL; -@@ -379,7 +381,7 @@ void ieee80211_sw_roc_work(struct work_s +- memcpy(rates, tx_info->control.rates, sizeof(rates)); ++ memcpy(rates, bf->rates, sizeof(rates)); - ieee80211_recalc_idle(local); + 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 (roc->started) -+ if (started) - ieee80211_start_next_roc(local); +- 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; + } -- err = rdev->ops->set_monitor_channel(&rdev->wiphy, chan, chantype); -- if (!err) { -- rdev->monitor_channel = chan; -- rdev->monitor_channel_type = chantype; +- 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; + +- 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 + } --static struct ieee80211_channel * --cfg80211_get_any_chan(struct cfg80211_registered_device *rdev) ++ 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; + } + +-/* 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; +- +- 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); - -- for (i = 0; i < IEEE80211_NUM_BANDS; i++) { -- sband = rdev->wiphy.bands[i]; -- if (sband && sband->n_channels > 0) -- return &sband->channels[0]; +- 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); + + return true; + } +@@ -155,7 +155,7 @@ static void ath_rx_remove_buffer(struct + + rx_edma = &sc->rx.rx_edma[qtype]; + +- 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; + } -+ channels[count].max_power = AR5K_TUNE_MAX_TXPOWER/2; +- 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); + ++ bf->bf_mpdu = requeue_skb; ++ bf->bf_buf_addr = new_buf_addr; + - count++; - } + 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; + } -@@ -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/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; + 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); -+ ah->ah_txpower.txp_requested = requested_txpower; -+ - /* 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; - ---- a/drivers/net/wireless/ath/ath5k/eeprom.c -+++ b/drivers/net/wireless/ath/ath5k/eeprom.c -@@ -1484,7 +1484,7 @@ ath5k_eeprom_read_target_rate_pwr_info(s - case AR5K_EEPROM_MODE_11A: - offset += AR5K_EEPROM_TARGET_PWR_OFF_11A(ee->ee_version); - rate_pcal_info = ee->ee_rate_tpwr_a; -- ee->ee_rate_target_pwr_num[mode] = AR5K_EEPROM_N_5GHZ_CHAN; -+ ee->ee_rate_target_pwr_num[mode] = AR5K_EEPROM_N_5GHZ_RATE_CHAN; - break; - case AR5K_EEPROM_MODE_11B: - offset += AR5K_EEPROM_TARGET_PWR_OFF_11B(ee->ee_version); ---- a/drivers/net/wireless/ath/ath5k/eeprom.h -+++ b/drivers/net/wireless/ath/ath5k/eeprom.h -@@ -182,6 +182,7 @@ - #define AR5K_EEPROM_EEP_DELTA 10 - #define AR5K_EEPROM_N_MODES 3 - #define AR5K_EEPROM_N_5GHZ_CHAN 10 -+#define AR5K_EEPROM_N_5GHZ_RATE_CHAN 8 - #define AR5K_EEPROM_N_2GHZ_CHAN 3 - #define AR5K_EEPROM_N_2GHZ_CHAN_2413 4 - #define AR5K_EEPROM_N_2GHZ_CHAN_MAX 4 +- 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