X-Git-Url: http://git.openwrt.org/?p=openwrt%2Fsvn-archive%2Farchive.git;a=blobdiff_plain;f=package%2Fmac80211%2Fpatches%2F300-pending_work.patch;h=9a39b325e6ffc1853814be2cc2b5dab32438b8c4;hp=9addfa04028aac55a5db8863dbfdb692a28457f9;hb=4ed1374b0d1e2f26093073434e6a854744e5d72f;hpb=35e2be5ab842aa6db77492023e61c0139a3bf5ea diff --git a/package/mac80211/patches/300-pending_work.patch b/package/mac80211/patches/300-pending_work.patch index 9addfa0402..9a39b325e6 100644 --- a/package/mac80211/patches/300-pending_work.patch +++ b/package/mac80211/patches/300-pending_work.patch @@ -1,3728 +1,14 @@ ---- 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 - } - - 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; - } - - 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); - #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); - } - } - -@@ -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); - } - } - -@@ -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); - } 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); - } - } - -@@ -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); - } - - 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; - -- 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); -+ -+ /* check if eeprom contains valid data */ -+ eep = (struct ar9300_eeprom *) mptr; -+ txrx = eep->baseEepHeader.txrxMask; -+ if (txrx != 0 && txrx != 0xff) -+ return 0; -+ } - - word = kzalloc(2048, GFP_KERNEL); - if (!word) -@@ -3493,19 +3503,20 @@ static int ath9k_hw_ar9300_get_eeprom_re - return 0; - } - --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 (is2ghz) -- return eep->modalHeader2G.xpaBiasLvl; -+ return &eep->modalHeader2G; - else -- return eep->modalHeader5G.xpaBiasLvl; -+ return &eep->modalHeader5G; - } - - 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; - - 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 - } - } - --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); - } - - - 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); - } - - 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); - } - --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) - { -- 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); - } - -@@ -3681,11 +3661,12 @@ static void ar9003_hw_ant_ctrl_apply(str - - static void ar9003_hw_drive_strength_apply(struct ath_hw *ah) - { -+ 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; - -@@ -3815,11 +3796,11 @@ static bool is_pmu_set(struct ath_hw *ah - - 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) - { - 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; - - 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); - } - --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) - { -- struct ar9300_eeprom *eep = &ah->eeprom.ar9300_eep; - u32 value; - -- 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 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 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); - } - - 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 */ - } - --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; - } - - 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; - - 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); - } - } - -@@ -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); - } - - 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); - } - - 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); -+} -+ -+static void ar9003_tx_gain_table_mode4(struct ath_hw *ah) -+{ -+ if (AR_SREV_9340(ah)) -+ INIT_INI_ARRAY(&ah->iniModesTxGain, -+ ar9340Modes_mixed_ob_db_tx_gain_table_1p0); -+ else if (AR_SREV_9580(ah)) -+ INIT_INI_ARRAY(&ah->iniModesTxGain, -+ ar9580_1p0_mixed_ob_db_tx_gain_table); - } - - static void ar9003_tx_gain_table_apply(struct ath_hw *ah) -@@ -675,6 +477,9 @@ static void ar9003_tx_gain_table_apply(s - case 3: - ar9003_tx_gain_table_mode3(ah); - break; -+ case 4: -+ ar9003_tx_gain_table_mode4(ah); -+ break; - } - } - -@@ -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); - } - - static void ar9003_rx_gain_table_mode1(struct ath_hw *ah) - { - 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); - } - - static void ar9003_rx_gain_table_mode2(struct ath_hw *ah) - { - 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); - } - - 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 -+ - /* - * Channel 1 Register Map - */ ---- 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 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; - }; - - 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; - }; - --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); -+ - 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 - } - - 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; - } - } - -@@ -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; - -- 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); - } - --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; - -- /* 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; - } - -- /* 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; - - info = IEEE80211_SKB_CB(skb); - if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) { -@@ -212,61 +202,52 @@ static struct ath_buf *ath_beacon_genera - } - } - -- 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); - } - - return bf; - } - --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; - } - } - -- /* 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; -+ -+ ath_dbg(common, CONFIG, "Removing interface at beacon slot: %d\n", -+ avp->av_bslot); -+ -+ tasklet_disable(&sc->bcon_tasklet); -+ -+ 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; - } - -- /* 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); -+} - -- /* -- * 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) -+{ -+ 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_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) - { -- 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); - } - --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; - } -+ - /* - * 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); - } - - return; - } - -- /* -- * 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]; -- } -+ slot = ath9k_beacon_choose_slot(sc); -+ vif = sc->beacon.bslot[slot]; - -+ if (!vif || !vif->bss_conf.enable_beacon) -+ return; - -- 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; - } - - /* -@@ -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? */ - } - } - --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; - -- 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); - } - - /* -@@ -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; - -- /* -- * 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); - } - - /* -@@ -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) - { - 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); - } - --static void ath_beacon_config_adhoc(struct ath_softc *sc, -- struct ath_beacon_config *conf) -+static void ath9k_beacon_config_adhoc(struct ath_softc *sc, -+ struct ath_beacon_config *conf) - { - struct ath_hw *ah = sc->sc_ah; - struct ath_common *common = ath9k_hw_common(ah); -@@ -669,82 +588,53 @@ static void ath_beacon_config_adhoc(stru - tsf = roundup(ath9k_hw_gettsf32(ah) + TU_TO_USEC(FUDGE), intval); - nexttbtt = tsf + intval; - -- ath_dbg(common, BEACON, "IBSS nexttbtt %u intval %u (%u)\n", -- nexttbtt, intval, conf->beacon_interval); -- -- /* -- * In IBSS mode enable the beacon timers but only enable SWBA interrupts -- * if we need to manually prepare beacon frames. Otherwise we use a -- * self-linked tx descriptor and let the hardware deal with things. -- */ -- ah->imask |= ATH9K_INT_SWBA; -- -- ath_beaconq_config(sc); -+ if (conf->enable_beacon) -+ ah->imask |= ATH9K_INT_SWBA; -+ else -+ ah->imask &= ~ATH9K_INT_SWBA; - -- /* Set the computed ADHOC beacon timers */ -+ ath_dbg(common, BEACON, "IBSS nexttbtt: %u intval: %u conf_intval: %u\n", -+ nexttbtt, intval, conf->beacon_interval); - -- ath9k_hw_disable_interrupts(ah); - ath9k_beacon_init(sc, nexttbtt, intval); -- sc->beacon.bmisscnt = 0; -- -- ath9k_hw_set_interrupts(ah); -- ath9k_hw_enable_interrupts(ah); - } - --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; -- } -- /* -- * 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); - } - --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); -+ -+ 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; - } -+ -+ ath9k_set_beacon(sc); -+ -+ if (cur_conf->enable_beacon) -+ set_bit(SC_OP_BEACONS, &sc->sc_flags); -+ else -+ clear_bit(SC_OP_BEACONS, &sc->sc_flags); - } -- return found; - } - -- --void ath_set_beacon(struct ath_softc *sc) -+void ath9k_set_beacon(struct ath_softc *sc) - { - struct ath_common *common = ath9k_hw_common(sc->sc_ah); - struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf; - - 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 -+}; -+ - #ifdef CONFIG_ATH9K_DEBUGFS - - /** -@@ -209,17 +222,6 @@ struct ath_rx_stats { - u32 rx_frags; - }; - --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 - }; - - 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 - - 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); - } - -@@ -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; - -- /* disable ANI for 9340 */ -- if (AR_SREV_9340(ah)) -- ah->config.enable_ani = false; -- - ath9k_hw_init_mode_regs(ah); - - if (!ah->is_pciexpress) -@@ -2916,9 +2912,9 @@ void ath9k_hw_reset_tsf(struct ath_hw *a - } - EXPORT_SYMBOL(ath9k_hw_reset_tsf); - --void ath9k_hw_set_tsfadjust(struct ath_hw *ah, u32 setting) -+void ath9k_hw_set_tsfadjust(struct ath_hw *ah, bool set) - { -- 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; - } - -@@ -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; - } - -@@ -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: - } - } - --void ath_start_ani(struct ath_common *common) -+void ath_start_ani(struct ath_softc *sc) - { -- struct ath_hw *ah = common->ah; -+ struct ath_hw *ah = sc->sc_ah; -+ struct ath_common *common = ath9k_hw_common(ah); - unsigned long timestamp = jiffies_to_msecs(jiffies); -- struct ath_softc *sc = (struct ath_softc *) common->priv; - -- 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)) - return; - - common->ani.longcal_timer = timestamp; - common->ani.shortcal_timer = timestamp; - common->ani.checkani_timer = timestamp; - -+ ath_dbg(common, ANI, "Starting ANI\n"); - mod_timer(&common->ani.timer, - jiffies + msecs_to_jiffies((u32)ah->config.ani_poll_interval)); - } - -+void ath_stop_ani(struct ath_softc *sc) -+{ -+ struct ath_common *common = ath9k_hw_common(sc->sc_ah); -+ -+ ath_dbg(common, ANI, "Stopping ANI\n"); -+ del_timer_sync(&common->ani.timer); -+} -+ -+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; -+ -+ /* -+ * 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; -+ } -+ -+ set_bit(SC_OP_ANI_RUN, &sc->sc_flags); -+ ath_start_ani(sc); -+ return; -+ -+stop_ani: -+ clear_bit(SC_OP_ANI_RUN, &sc->sc_flags); -+ ath_stop_ani(sc); -+} -+ - void ath_update_survey_nf(struct ath_softc *sc, int channel) - { - struct ath_hw *ah = sc->sc_ah; ---- a/drivers/net/wireless/ath/ath9k/main.c -+++ b/drivers/net/wireless/ath/ath9k/main.c -@@ -167,8 +167,6 @@ static void ath_cancel_work(struct ath_s - - static void ath_restart_work(struct ath_softc *sc) - { -- struct ath_common *common = ath9k_hw_common(sc->sc_ah); -- - ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0); - - 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)); - - ath_start_rx_poll(sc, 3); -- -- if (!common->disable_ani) -- ath_start_ani(common); -+ ath_start_ani(sc); - } - - 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; - -- 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; - } - -@@ -586,6 +577,15 @@ static int ath_reset(struct ath_softc *s - return r; - } - -+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) - } - } - --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 - - ath9k_calculate_iter_data(hw, vif, &iter_data); - -- /* Set BSSID mask. */ - memcpy(common->bssidmask, iter_data.mask, ETH_ALEN); - ath_hw_setbssidmask(common); - -- /* 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; - } - -- /* -- * Enable MIB interrupts when there are hardware phy counters. -- */ -+ ath9k_hw_setopmode(ah); -+ - if ((iter_data.nstations + iter_data.nadhocs + iter_data.nmeshes) > 0) - ah->imask |= ATH9K_INT_TSFOOR; - else - ah->imask &= ~ATH9K_INT_TSFOOR; - - 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); -- } - } - - static int ath9k_add_interface(struct ieee80211_hw *hw, -@@ -1032,7 +987,10 @@ static int ath9k_add_interface(struct ie - - sc->nvifs++; - -- 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; - - ath_dbg(common, CONFIG, "Change Interface\n"); -+ - mutex_lock(&sc->mutex); - ath9k_ps_wakeup(sc); - -@@ -1061,15 +1020,16 @@ static int ath9k_change_interface(struct - } - } - -- /* 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); - -@@ -1471,85 +1427,36 @@ static int ath9k_set_key(struct ieee8021 - - return ret; - } --static void ath9k_bss_iter(void *data, u8 *mac, struct ieee80211_vif *vif) -+ -+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 -- */ -+ - 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; -+ - 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; - -- ath_start_rx_poll(sc, 3); -- -- if (!common->disable_ani) { -- set_bit(SC_OP_ANI_RUN, &sc->sc_flags); -- ath_start_ani(common); -- } -- -- } --} -- --static void ath9k_config_bss(struct ath_softc *sc, struct ieee80211_vif *vif) --{ -- struct ath_common *common = ath9k_hw_common(sc->sc_ah); -- struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; -- struct ath_vif *avp = (void *)vif->drv_priv; -- -- if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION) -- return; -- -- /* Reconfigure bss info */ -- if (avp->primary_sta_vif && !bss_conf->assoc) { -- ath_dbg(common, CONFIG, "Bss Info DISASSOC %d, bssid %pM\n", -- common->curaid, common->curbssid); -- clear_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags); -- clear_bit(SC_OP_BEACONS, &sc->sc_flags); -- avp->primary_sta_vif = false; -- memset(common->curbssid, 0, ETH_ALEN); -- common->curaid = 0; -- } -- -- ieee80211_iterate_active_interfaces_atomic( -- sc->hw, ath9k_bss_iter, sc); -+ spin_lock_irqsave(&sc->sc_pm_lock, flags); -+ sc->ps_flags |= PS_BEACON_SYNC | PS_WAIT_FOR_BEACON; -+ spin_unlock_irqrestore(&sc->sc_pm_lock, flags); - -- /* -- * 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); - } - } - -@@ -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); - - 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); - -- ath_dbg(common, CONFIG, "BSSID: %pM aid: 0x%x\n", -- common->curbssid, common->curaid); -+ /* -+ * Do not do anything when the opmode is not STATION. -+ */ -+ if (ah->opmode == NL80211_IFTYPE_STATION) { -+ if (avp->primary_sta_vif && !bss_conf->assoc) { -+ clear_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags); -+ clear_bit(SC_OP_BEACONS, &sc->sc_flags); -+ avp->primary_sta_vif = false; -+ } -+ -+ ieee80211_iterate_active_interfaces_atomic(sc->hw, -+ ath9k_bss_assoc_iter, sc); -+ -+ 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 (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); -+ -+#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; -+ - 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) -+{ -+ switch (val & 0x7) { -+ case 0x1: -+ case 0x3: -+ case 0x7: -+ return true; -+ case 0x2: -+ return (ah->caps.rx_chainmask == 1); -+ default: -+ return false; -+ } -+} -+ - 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; -+ -+ if (!validate_antenna_mask(ah, rx_ant) || !tx_ant) - return -EINVAL; - - sc->ant_rx = rx_ant; ---- a/drivers/net/wireless/ath/ath9k/mci.c -+++ b/drivers/net/wireless/ath/ath9k/mci.c -@@ -202,7 +202,7 @@ static void ath_mci_cal_msg(struct ath_s - case MCI_GPM_BT_CAL_REQ: - if (mci_hw->bt_state == MCI_BT_AWAKE) { - ar9003_mci_state(ah, MCI_STATE_SET_BT_CAL_START); -- ieee80211_queue_work(sc->hw, &sc->hw_reset_work); -+ ath9k_queue_reset(sc, RESET_TYPE_MCI); - } - ath_dbg(common, MCI, "MCI State : %d\n", mci_hw->bt_state); - break; ---- a/drivers/net/wireless/ath/ath9k/recv.c -+++ b/drivers/net/wireless/ath/ath9k/recv.c -@@ -553,7 +553,7 @@ static void ath_rx_ps_beacon(struct ath_ - sc->ps_flags &= ~PS_BEACON_SYNC; - ath_dbg(common, PS, - "Reconfigure Beacon timers based on timestamp from the AP\n"); -- ath_set_beacon(sc); -+ ath9k_set_beacon(sc); - } - - if (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, - }; - --static int ath_max_4ms_framelen[4][32] = { -- [MCS_HT20] = { -- 3212, 6432, 9648, 12864, 19300, 25736, 28952, 32172, -- 6424, 12852, 19280, 25708, 38568, 51424, 57852, 64280, -- 9628, 19260, 28896, 38528, 57792, 65532, 65532, 65532, -- 12828, 25656, 38488, 51320, 65532, 65532, 65532, 65532, -- }, -- [MCS_HT20_SGI] = { -- 3572, 7144, 10720, 14296, 21444, 28596, 32172, 35744, -- 7140, 14284, 21428, 28568, 42856, 57144, 64288, 65532, -- 10700, 21408, 32112, 42816, 64228, 65532, 65532, 65532, -- 14256, 28516, 42780, 57040, 65532, 65532, 65532, 65532, -- }, -- [MCS_HT40] = { -- 6680, 13360, 20044, 26724, 40092, 53456, 60140, 65532, -- 13348, 26700, 40052, 53400, 65532, 65532, 65532, 65532, -- 20004, 40008, 60016, 65532, 65532, 65532, 65532, 65532, -- 26644, 53292, 65532, 65532, 65532, 65532, 65532, 65532, -- }, -- [MCS_HT40_SGI] = { -- 7420, 14844, 22272, 29696, 44544, 59396, 65532, 65532, -- 14832, 29668, 44504, 59340, 65532, 65532, 65532, 65532, -- 22232, 44464, 65532, 65532, 65532, 65532, 65532, 65532, -- 29616, 59232, 65532, 65532, 65532, 65532, 65532, 65532, -- } --}; -- - /*********************/ - /* Aggregation logic */ - /*********************/ -@@ -614,10 +589,8 @@ static void ath_tx_complete_aggr(struct - - rcu_read_unlock(); - -- if (needreset) { -- RESET_STAT_INC(sc, RESET_TYPE_TX_ERROR); -- ieee80211_queue_work(sc->hw, &sc->hw_reset_work); -- } -+ if (needreset) -+ ath9k_queue_reset(sc, RESET_TYPE_TX_ERROR); - } - - static bool ath_lookup_legacy(struct ath_buf *bf) -@@ -650,6 +623,7 @@ static u32 ath_lookup_rate(struct ath_so - struct ieee80211_tx_rate *rates; - u32 max_4ms_framelen, frmlen; - u16 aggr_limit, bt_aggr_limit, legacy = 0; -+ int q = tid->ac->txq->mac80211_qnum; - int i; - - skb = bf->bf_mpdu; -@@ -658,8 +632,7 @@ static u32 ath_lookup_rate(struct ath_so - - /* - * 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; - } - -+static int ath_max_framelen(int usec, int mcs, bool ht40, bool sgi) -+{ -+ int streams = HT_RC_2_STREAMS(mcs); -+ int symbols, bits; -+ int bytes = 0; -+ -+ symbols = sgi ? TIME_SYMBOLS_HALFGI(usec) : TIME_SYMBOLS(usec); -+ bits = symbols * bits_per_symbol[mcs % 8][ht40] * streams; -+ bits -= OFDM_PLCP_BITS; -+ bytes = bits / 8; -+ bytes -= L_STF + L_LTF + L_SIG + HT_SIG + HT_STF + HT_LTF(streams); -+ if (bytes > 65532) -+ bytes = 65532; -+ -+ return bytes; -+} -+ -+void ath_update_max_aggr_framelen(struct ath_softc *sc, int queue, int txop) -+{ -+ u16 *cur_ht20, *cur_ht20_sgi, *cur_ht40, *cur_ht40_sgi; -+ int mcs; -+ -+ /* 4ms is the default (and maximum) duration */ -+ if (!txop || txop > 4096) -+ txop = 4096; -+ -+ cur_ht20 = sc->tx.max_aggr_framelen[queue][MCS_HT20]; -+ cur_ht20_sgi = sc->tx.max_aggr_framelen[queue][MCS_HT20_SGI]; -+ cur_ht40 = sc->tx.max_aggr_framelen[queue][MCS_HT40]; -+ cur_ht40_sgi = sc->tx.max_aggr_framelen[queue][MCS_HT40_SGI]; -+ for (mcs = 0; mcs < 32; mcs++) { -+ cur_ht20[mcs] = ath_max_framelen(txop, mcs, false, false); -+ cur_ht20_sgi[mcs] = ath_max_framelen(txop, mcs, false, true); -+ cur_ht40[mcs] = ath_max_framelen(txop, mcs, true, false); -+ cur_ht40_sgi[mcs] = ath_max_framelen(txop, mcs, true, true); -+ } -+} -+ - static void ath_buf_set_rate(struct ath_softc *sc, struct ath_buf *bf, - struct ath_tx_info *info, int len) - { -@@ -1586,7 +1597,8 @@ void ath_txq_schedule(struct ath_softc * - struct ath_atx_ac *ac, *ac_tmp, *last_ac; - struct ath_atx_tid *tid, *last_tid; - -- if (work_pending(&sc->hw_reset_work) || list_empty(&txq->axq_acq) || -+ if (test_bit(SC_OP_HW_RESET, &sc->sc_flags) || -+ list_empty(&txq->axq_acq) || - txq->axq_ampdu_depth >= ATH_AGGR_MIN_QDEPTH) - return; - -@@ -1988,7 +2000,8 @@ int ath_tx_start(struct ieee80211_hw *hw - - 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 - - ath_txq_lock(sc, txq); - for (;;) { -- if (work_pending(&sc->hw_reset_work)) -+ if (test_bit(SC_OP_HW_RESET, &sc->sc_flags)) - break; - - if (list_empty(&txq->axq_q)) { -@@ -2274,7 +2288,7 @@ void ath_tx_edma_tasklet(struct ath_soft - int status; - - for (;;) { -- if (work_pending(&sc->hw_reset_work)) -+ if (test_bit(SC_OP_HW_RESET, &sc->sc_flags)) - break; - - 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; - - memset(&status, 0, sizeof(status)); - -@@ -766,16 +766,17 @@ void b43_rx(struct b43_wldev *dev, struc - } - - 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); - - /* ---- a/drivers/net/wireless/libertas/cfg.c -+++ b/drivers/net/wireless/libertas/cfg.c -@@ -2182,13 +2182,15 @@ int lbs_reg_notifier(struct wiphy *wiphy - struct regulatory_request *request) - { - struct lbs_private *priv = wiphy_priv(wiphy); -- int ret; -+ int ret = 0; - - lbs_deb_enter_args(LBS_DEB_CFG80211, "cfg80211 regulatory domain " - "callback for domain %c%c\n", request->alpha2[0], - request->alpha2[1]); - -- ret = lbs_set_11d_domain_info(priv, request, wiphy->bands); -+ memcpy(priv->country_code, request->alpha2, sizeof(request->alpha2)); -+ if (lbs_iface_active(priv)) -+ ret = lbs_set_11d_domain_info(priv); - - lbs_deb_leave(LBS_DEB_CFG80211); - return ret; ---- a/drivers/net/wireless/libertas/cmd.c -+++ b/drivers/net/wireless/libertas/cmd.c -@@ -733,15 +733,13 @@ int lbs_get_rssi(struct lbs_private *pri - * to the firmware - * - * @priv: pointer to &struct lbs_private -- * @request: cfg80211 regulatory request structure -- * @bands: the device's supported bands and channels - * - * returns: 0 on success, error code on failure - */ --int lbs_set_11d_domain_info(struct lbs_private *priv, -- struct regulatory_request *request, -- struct ieee80211_supported_band **bands) -+int lbs_set_11d_domain_info(struct lbs_private *priv) - { -+ struct wiphy *wiphy = priv->wdev->wiphy; -+ struct ieee80211_supported_band **bands = wiphy->bands; - struct cmd_ds_802_11d_domain_info cmd; - struct mrvl_ie_domain_param_set *domain = &cmd.domain; - struct ieee80211_country_ie_triplet *t; -@@ -752,21 +750,23 @@ int lbs_set_11d_domain_info(struct lbs_p - u8 first_channel = 0, next_chan = 0, max_pwr = 0; - u8 i, flag = 0; - size_t triplet_size; -- int ret; -+ int ret = 0; - - lbs_deb_enter(LBS_DEB_11D); -+ if (!priv->country_code[0]) -+ goto out; - - memset(&cmd, 0, sizeof(cmd)); - cmd.action = cpu_to_le16(CMD_ACT_SET); - - lbs_deb_11d("Setting country code '%c%c'\n", -- request->alpha2[0], request->alpha2[1]); -+ priv->country_code[0], priv->country_code[1]); - - domain->header.type = cpu_to_le16(TLV_TYPE_DOMAIN); - - /* Set country code */ -- domain->country_code[0] = request->alpha2[0]; -- domain->country_code[1] = request->alpha2[1]; -+ domain->country_code[0] = priv->country_code[0]; -+ domain->country_code[1] = priv->country_code[1]; - domain->country_code[2] = ' '; - - /* Now set up the channel triplets; firmware is somewhat picky here -@@ -848,6 +848,7 @@ int lbs_set_11d_domain_info(struct lbs_p - - ret = lbs_cmd_with_response(priv, CMD_802_11D_DOMAIN_INFO, &cmd); - -+out: - lbs_deb_leave_args(LBS_DEB_11D, "ret %d", ret); - return ret; - } -@@ -1019,9 +1020,9 @@ static void lbs_submit_command(struct lb - if (ret) { - netdev_info(priv->dev, "DNLD_CMD: hw_host_to_card failed: %d\n", - ret); -- /* Let the timer kick in and retry, and potentially reset -- the whole thing if the condition persists */ -- timeo = HZ/4; -+ /* Reset dnld state machine, report failure */ -+ priv->dnld_sent = DNLD_RES_RECEIVED; -+ lbs_complete_command(priv, cmdnode, ret); - } - - if (command == CMD_802_11_DEEP_SLEEP) { ---- a/drivers/net/wireless/libertas/cmd.h -+++ b/drivers/net/wireless/libertas/cmd.h -@@ -128,9 +128,7 @@ int lbs_set_monitor_mode(struct lbs_priv - - int lbs_get_rssi(struct lbs_private *priv, s8 *snr, s8 *nf); - --int lbs_set_11d_domain_info(struct lbs_private *priv, -- struct regulatory_request *request, -- struct ieee80211_supported_band **bands); -+int lbs_set_11d_domain_info(struct lbs_private *priv); - - int lbs_get_reg(struct lbs_private *priv, u16 reg, u16 offset, u32 *value); - ---- a/drivers/net/wireless/libertas/dev.h -+++ b/drivers/net/wireless/libertas/dev.h -@@ -49,6 +49,7 @@ struct lbs_private { - bool wiphy_registered; - struct cfg80211_scan_request *scan_req; - u8 assoc_bss[ETH_ALEN]; -+ u8 country_code[IEEE80211_COUNTRY_STRING_LEN]; - u8 disassoc_reason; - - /* Mesh */ ---- a/drivers/net/wireless/libertas/if_usb.c -+++ b/drivers/net/wireless/libertas/if_usb.c -@@ -311,7 +311,6 @@ static void if_usb_disconnect(struct usb - cardp->surprise_removed = 1; - - if (priv) { -- priv->surpriseremoved = 1; - lbs_stop_card(priv); - lbs_remove_card(priv); - } ---- a/drivers/net/wireless/libertas/main.c -+++ b/drivers/net/wireless/libertas/main.c -@@ -154,6 +154,12 @@ int lbs_start_iface(struct lbs_private * - goto err; - } +--- 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; -+ ret = lbs_set_11d_domain_info(priv); -+ if (ret) { -+ lbs_deb_net("set 11d domain info failed\n"); -+ goto err; -+ } ++ channels[count].max_power = AR5K_TUNE_MAX_TXPOWER/2; + - 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); - }; + count++; + } - /* --- a/net/mac80211/agg-rx.c +++ b/net/mac80211/agg-rx.c @@ -203,6 +203,8 @@ static void ieee80211_send_addba_resp(st @@ -3754,41 +40,15 @@ sdata->vif.type != NL80211_IFTYPE_ADHOC) return -EINVAL; ---- a/net/mac80211/cfg.c -+++ b/net/mac80211/cfg.c -@@ -2982,14 +2982,14 @@ static int ieee80211_probe_client(struct - return 0; - } - --static void ieee80211_set_monitor_enabled(struct wiphy *wiphy, bool enabled) -+static struct ieee80211_channel * -+ieee80211_cfg_get_channel(struct wiphy *wiphy, struct wireless_dev *wdev, -+ enum nl80211_channel_type *type) - { - struct ieee80211_local *local = wiphy_priv(wiphy); +@@ -869,7 +871,7 @@ void ieee80211_process_addba_resp(struct -- if (enabled) -- WARN_ON(ieee80211_add_virtual_monitor(local)); -- else -- ieee80211_del_virtual_monitor(local); -+ *type = local->_oper_channel_type; -+ return local->oper_channel; - } + } else { + ___ieee80211_stop_tx_ba_session(sta, tid, WLAN_BACK_INITIATOR, +- true); ++ false); + } - #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, - }; + out: --- a/net/mac80211/debugfs_sta.c +++ b/net/mac80211/debugfs_sta.c @@ -63,11 +63,11 @@ static ssize_t sta_flags_read(struct fil @@ -3805,70 +65,17 @@ TEST(MFP), TEST(BLOCK_BA), TEST(PSPOLL), TEST(UAPSD), TEST(SP), TEST(TDLS_PEER), TEST(TDLS_PEER_AUTH), TEST(4ADDR_EVENT), ---- a/net/mac80211/ieee80211_i.h -+++ b/net/mac80211/ieee80211_i.h -@@ -1496,10 +1496,6 @@ int ieee80211_add_srates_ie(struct ieee8 - int ieee80211_add_ext_srates_ie(struct ieee80211_sub_if_data *sdata, - struct sk_buff *skb, bool need_basic); - --/* virtual monitor */ --int ieee80211_add_virtual_monitor(struct ieee80211_local *local); --void ieee80211_del_virtual_monitor(struct ieee80211_local *local); -- - /* channel management */ - enum ieee80211_chan_mode { - CHAN_MODE_UNDEFINED, --- a/net/mac80211/iface.c +++ b/net/mac80211/iface.c -@@ -331,7 +331,7 @@ static void ieee80211_set_default_queues - sdata->vif.cab_queue = IEEE80211_INVAL_HW_QUEUE; - } - --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; - } - --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; - -@@ -410,7 +410,6 @@ static int ieee80211_do_open(struct net_ - { - struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); +@@ -420,7 +420,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; -@@ -497,6 +496,12 @@ static int ieee80211_do_open(struct net_ - break; - } - -+ if (local->monitors == 0 && local->open_count == 0) { -+ res = ieee80211_add_virtual_monitor(local); -+ if (res) -+ goto err_stop; -+ } -+ - /* must be before the call to ieee80211_configure_filter */ - local->monitors++; - if (local->monitors == 1) { -@@ -511,6 +516,8 @@ static int ieee80211_do_open(struct net_ - break; - default: - if (coming_up) { -+ ieee80211_del_virtual_monitor(local); -+ - res = drv_add_interface(local, sdata); - if (res) - goto err_stop; -@@ -548,28 +555,6 @@ static int ieee80211_do_open(struct net_ +@@ -575,30 +574,8 @@ int ieee80211_do_open(struct wireless_de set_bit(SDATA_STATE_RUNNING, &sdata->state); @@ -3892,30 +99,24 @@ - } - - 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); - } -- + /* * 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); - } - - ieee80211_adjust_monitor_flags(sdata, -1); -@@ -823,6 +809,9 @@ static void ieee80211_do_stop(struct iee +@@ -849,7 +826,7 @@ static void ieee80211_do_stop(struct iee + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + if (info->control.vif == &sdata->vif) { + __skb_unlink(skb, &local->pending[i]); +- dev_kfree_skb_irq(skb); ++ ieee80211_free_txskb(&local->hw, skb); + } } } - spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); -+ -+ if (local->monitors == local->open_count && local->monitors > 0) -+ ieee80211_add_virtual_monitor(local); - } - - static int ieee80211_stop(struct net_device *dev) -@@ -959,6 +948,72 @@ static void ieee80211_if_setup(struct ne +@@ -997,6 +974,72 @@ static void ieee80211_if_setup(struct ne dev->destructor = free_netdev; } @@ -3988,7 +189,7 @@ static void ieee80211_iface_work(struct work_struct *work) { struct ieee80211_sub_if_data *sdata = -@@ -1063,6 +1118,9 @@ static void ieee80211_iface_work(struct +@@ -1101,6 +1144,9 @@ static void ieee80211_iface_work(struct break; ieee80211_mesh_rx_queued_mgmt(sdata, skb); break; @@ -3998,40 +199,9 @@ 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; - - mutex_lock(&local->mtx); - -@@ -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); - -- if (roc->started) { -+ if (started) { - drv_flush(local, false); - - local->tmp_channel = NULL; -@@ -379,7 +381,7 @@ void ieee80211_sw_roc_work(struct work_s - - ieee80211_recalc_idle(local); - -- if (roc->started) -+ if (started) - ieee80211_start_next_roc(local); - } - --- a/net/mac80211/rx.c +++ b/net/mac80211/rx.c -@@ -2239,6 +2239,7 @@ ieee80211_rx_h_action(struct ieee80211_r +@@ -2279,6 +2279,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 && @@ -4039,7 +209,7 @@ sdata->vif.type != NL80211_IFTYPE_ADHOC) break; -@@ -2456,14 +2457,15 @@ ieee80211_rx_h_mgmt(struct ieee80211_rx_ +@@ -2496,14 +2497,15 @@ ieee80211_rx_h_mgmt(struct ieee80211_rx_ if (!ieee80211_vif_is_mesh(&sdata->vif) && sdata->vif.type != NL80211_IFTYPE_ADHOC && @@ -4057,7 +227,7 @@ 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 +@@ -2827,10 +2829,16 @@ static int prepare_for_handlers(struct i } break; case NL80211_IFTYPE_WDS: @@ -4074,8 +244,8 @@ + return 0; + break; - default: - /* should never get here */ + case NL80211_IFTYPE_P2P_DEVICE: + if (!ieee80211_is_public_action(hdr, skb->len) && --- a/net/mac80211/sta_info.h +++ b/net/mac80211/sta_info.h @@ -32,7 +32,6 @@ @@ -4094,320 +264,732 @@ 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) - { - struct ieee80211_channel *chan; -- int err; +--- a/net/mac80211/status.c ++++ b/net/mac80211/status.c +@@ -34,7 +34,7 @@ void ieee80211_tx_status_irqsafe(struct + skb_queue_len(&local->skb_queue_unreliable); + while (tmp > IEEE80211_IRQSAFE_QUEUE_LIMIT && + (skb = skb_dequeue(&local->skb_queue_unreliable))) { +- dev_kfree_skb_irq(skb); ++ ieee80211_free_txskb(hw, skb); + tmp--; + I802_DEBUG_INC(local->tx_status_drop); + } +@@ -159,7 +159,7 @@ static void ieee80211_handle_filtered_fr + "dropped TX filtered frame, queue_len=%d PS=%d @%lu\n", + skb_queue_len(&sta->tx_filtered[ac]), + !!test_sta_flag(sta, WLAN_STA_PS_STA), jiffies); +- dev_kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + } - if (!rdev->ops->set_monitor_channel) - return -EOPNOTSUPP; -@@ -93,13 +92,7 @@ int cfg80211_set_monitor_channel(struct - if (!chan) - return -EINVAL; + static void ieee80211_check_pending_bar(struct sta_info *sta, u8 *addr, u8 tid) +@@ -324,6 +324,75 @@ static void ieee80211_add_tx_radiotap_he -- err = rdev->ops->set_monitor_channel(&rdev->wiphy, chan, chantype); -- if (!err) { -- rdev->monitor_channel = chan; -- rdev->monitor_channel_type = chantype; -- } -- -- return err; -+ return rdev->ops->set_monitor_channel(&rdev->wiphy, chan, chantype); } - 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; ++static void ieee80211_report_used_skb(struct ieee80211_local *local, ++ struct sk_buff *skb, bool dropped) ++{ ++ struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); ++ struct ieee80211_hdr *hdr = (void *)skb->data; ++ bool acked = info->flags & IEEE80211_TX_STAT_ACK; ++ ++ if (dropped) ++ acked = false; ++ ++ if (info->flags & IEEE80211_TX_INTFL_NL80211_FRAME_TX) { ++ struct ieee80211_sub_if_data *sdata = NULL; ++ struct ieee80211_sub_if_data *iter_sdata; ++ u64 cookie = (unsigned long)skb; ++ ++ rcu_read_lock(); ++ ++ if (skb->dev) { ++ list_for_each_entry_rcu(iter_sdata, &local->interfaces, ++ list) { ++ if (!iter_sdata->dev) ++ continue; ++ ++ if (skb->dev == iter_sdata->dev) { ++ sdata = iter_sdata; ++ break; ++ } ++ } ++ } else { ++ sdata = rcu_dereference(local->p2p_sdata); + } -+ 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; ++ ++ if (!sdata) ++ skb->dev = NULL; ++ else if (ieee80211_is_nullfunc(hdr->frame_control) || ++ ieee80211_is_qos_nullfunc(hdr->frame_control)) { ++ cfg80211_probe_status(sdata->dev, hdr->addr1, ++ cookie, acked, GFP_ATOMIC); ++ } else { ++ cfg80211_mgmt_tx_status(&sdata->wdev, cookie, skb->data, ++ skb->len, acked, GFP_ATOMIC); + } - 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) --{ -- struct ieee80211_supported_band *sband; -- int i; -- -- for (i = 0; i < IEEE80211_NUM_BANDS; i++) { -- sband = rdev->wiphy.bands[i]; -- if (sband && sband->n_channels > 0) -- return &sband->channels[0]; -- } -- -- return NULL; --} -- --static void cfg80211_init_mon_chan(struct cfg80211_registered_device *rdev) --{ -- struct ieee80211_channel *chan; -- -- chan = cfg80211_get_any_chan(rdev); -- if (WARN_ON(!chan)) -- return; -- -- mutex_lock(&rdev->devlist_mtx); -- WARN_ON(cfg80211_set_monitor_channel(rdev, chan->center_freq, -- NL80211_CHAN_NO_HT)); -- mutex_unlock(&rdev->devlist_mtx); --} -- - 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(); - - rdev->num_running_ifaces += num; - if (iftype == NL80211_IFTYPE_MONITOR) - rdev->num_running_monitor_ifaces += num; ++ ++ rcu_read_unlock(); ++ } ++ ++ if (unlikely(info->ack_frame_id)) { ++ struct sk_buff *ack_skb; ++ unsigned long flags; ++ ++ spin_lock_irqsave(&local->ack_status_lock, flags); ++ ack_skb = idr_find(&local->ack_status_frames, ++ info->ack_frame_id); ++ if (ack_skb) ++ idr_remove(&local->ack_status_frames, ++ info->ack_frame_id); ++ spin_unlock_irqrestore(&local->ack_status_lock, flags); ++ ++ if (ack_skb) { ++ if (!dropped) { ++ /* consumes ack_skb */ ++ skb_complete_wifi_ack(ack_skb, acked); ++ } else { ++ dev_kfree_skb_any(ack_skb); ++ } ++ } ++ } ++} ++ + /* + * Use a static threshold for now, best value to be determined + * by testing ... +@@ -515,50 +584,7 @@ void ieee80211_tx_status(struct ieee8021 + msecs_to_jiffies(10)); + } + +- if (info->flags & IEEE80211_TX_INTFL_NL80211_FRAME_TX) { +- u64 cookie = (unsigned long)skb; +- acked = info->flags & IEEE80211_TX_STAT_ACK; +- +- if (ieee80211_is_nullfunc(hdr->frame_control) || +- ieee80211_is_qos_nullfunc(hdr->frame_control)) { +- cfg80211_probe_status(skb->dev, hdr->addr1, +- cookie, acked, GFP_ATOMIC); +- } else if (skb->dev) { +- cfg80211_mgmt_tx_status( +- skb->dev->ieee80211_ptr, cookie, skb->data, +- skb->len, acked, GFP_ATOMIC); +- } else { +- struct ieee80211_sub_if_data *p2p_sdata; - -- 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); +- rcu_read_lock(); - -- if (!has_monitors_only_new) { -- rdev->monitor_channel = NULL; -- rdev->monitor_channel_type = NL80211_CHAN_NO_HT; -- } else { -- cfg80211_init_mon_chan(rdev); +- p2p_sdata = rcu_dereference(local->p2p_sdata); +- if (p2p_sdata) { +- cfg80211_mgmt_tx_status( +- &p2p_sdata->wdev, cookie, skb->data, +- skb->len, acked, GFP_ATOMIC); +- } +- rcu_read_unlock(); - } - } - } +- +- if (unlikely(info->ack_frame_id)) { +- struct sk_buff *ack_skb; +- unsigned long flags; +- +- spin_lock_irqsave(&local->ack_status_lock, flags); +- ack_skb = idr_find(&local->ack_status_frames, +- info->ack_frame_id); +- if (ack_skb) +- idr_remove(&local->ack_status_frames, +- info->ack_frame_id); +- spin_unlock_irqrestore(&local->ack_status_lock, flags); +- +- /* consumes ack_skb */ +- if (ack_skb) +- skb_complete_wifi_ack(ack_skb, +- info->flags & IEEE80211_TX_STAT_ACK); +- } ++ ieee80211_report_used_skb(local, skb, false); + + /* this was a transmitted frame, but now we want to reuse it */ + skb_orphan(skb); +@@ -634,25 +660,17 @@ EXPORT_SYMBOL(ieee80211_report_low_ack); + void ieee80211_free_txskb(struct ieee80211_hw *hw, struct sk_buff *skb) + { + struct ieee80211_local *local = hw_to_local(hw); +- struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); +- +- if (unlikely(info->ack_frame_id)) { +- struct sk_buff *ack_skb; +- unsigned long flags; +- +- spin_lock_irqsave(&local->ack_status_lock, flags); +- ack_skb = idr_find(&local->ack_status_frames, +- info->ack_frame_id); +- if (ack_skb) +- idr_remove(&local->ack_status_frames, +- info->ack_frame_id); +- spin_unlock_irqrestore(&local->ack_status_lock, flags); +- +- /* consumes ack_skb */ +- if (ack_skb) +- dev_kfree_skb_any(ack_skb); +- } - 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); ++ ieee80211_report_used_skb(local, skb, true); + dev_kfree_skb_any(skb); + } + EXPORT_SYMBOL(ieee80211_free_txskb); ++ ++void ieee80211_purge_tx_queue(struct ieee80211_hw *hw, ++ struct sk_buff_head *skbs) ++{ ++ struct sk_buff *skb; ++ ++ while ((skb = __skb_dequeue(skbs))) ++ ieee80211_free_txskb(hw, skb); ++} +--- a/drivers/net/wireless/p54/main.c ++++ b/drivers/net/wireless/p54/main.c +@@ -139,6 +139,7 @@ static int p54_beacon_format_ie_tim(stru + static int p54_beacon_update(struct p54_common *priv, + struct ieee80211_vif *vif) + { ++ struct ieee80211_tx_control control = { }; + struct sk_buff *beacon; + int ret; + +@@ -158,7 +159,7 @@ static int p54_beacon_update(struct p54_ + * to cancel the old beacon template by hand, instead the firmware + * will release the previous one through the feedback mechanism. + */ +- p54_tx_80211(priv->hw, NULL, beacon); ++ p54_tx_80211(priv->hw, &control, beacon); + priv->tsf_high32 = 0; + priv->tsf_low32 = 0; + +--- a/net/wireless/reg.c ++++ b/net/wireless/reg.c +@@ -352,6 +352,9 @@ static void reg_regdb_search(struct work + struct reg_regdb_search_request *request; + const struct ieee80211_regdomain *curdom, *regdom; + int i, r; ++ bool set_reg = false; ++ ++ mutex_lock(&cfg80211_mutex); + + mutex_lock(®_regdb_search_mutex); + while (!list_empty(®_regdb_search_list)) { +@@ -367,9 +370,7 @@ static void reg_regdb_search(struct work + r = reg_copy_regd(®dom, curdom); + if (r) + break; +- mutex_lock(&cfg80211_mutex); +- set_regdom(regdom); +- mutex_unlock(&cfg80211_mutex); ++ set_reg = true; + break; + } } -+ 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; +@@ -377,6 +378,11 @@ static void reg_regdb_search(struct work + kfree(request); } + mutex_unlock(®_regdb_search_mutex); ++ ++ if (set_reg) ++ set_regdom(regdom); ++ ++ mutex_unlock(&cfg80211_mutex); + } ---- 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; - -- 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; + static DECLARE_WORK(reg_regdb_work, reg_regdb_search); +--- a/drivers/net/wireless/ath/ath9k/recv.c ++++ b/drivers/net/wireless/ath/ath9k/recv.c +@@ -424,8 +424,8 @@ u32 ath_calcrxfilter(struct ath_softc *s + rfilt |= ATH9K_RX_FILTER_COMP_BAR; + + if (sc->nvifs > 1 || (sc->rx.rxfilter & FIF_OTHER_BSS)) { +- /* The following may also be needed for other older chips */ +- if (sc->sc_ah->hw_version.macVersion == AR_SREV_VERSION_9160) ++ /* This is needed for older chips */ ++ if (sc->sc_ah->hw_version.macVersion <= AR_SREV_VERSION_9160) + rfilt |= ATH9K_RX_FILTER_PROM; + rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL; + } +--- a/net/mac80211/mlme.c ++++ b/net/mac80211/mlme.c +@@ -818,23 +818,71 @@ void ieee80211_sta_process_chanswitch(st + } + + static void ieee80211_handle_pwr_constr(struct ieee80211_sub_if_data *sdata, +- u16 capab_info, u8 *pwr_constr_elem, +- u8 pwr_constr_elem_len) ++ struct ieee80211_channel *channel, ++ const u8 *country_ie, u8 country_ie_len, ++ const u8 *pwr_constr_elem) + { +- struct ieee80211_conf *conf = &sdata->local->hw.conf; ++ struct ieee80211_country_ie_triplet *triplet; ++ int chan = ieee80211_frequency_to_channel(channel->center_freq); ++ int i, chan_pwr, chan_increment, new_ap_level; ++ bool have_chan_pwr = false; + +- if (!(capab_info & WLAN_CAPABILITY_SPECTRUM_MGMT)) ++ /* Invalid IE */ ++ if (country_ie_len % 2 || country_ie_len < IEEE80211_COUNTRY_IE_MIN_LEN) + return; -- 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; +- /* Power constraint IE length should be 1 octet */ +- if (pwr_constr_elem_len != 1) +- return; ++ triplet = (void *)(country_ie + 3); ++ country_ie_len -= 3; + +- if ((*pwr_constr_elem <= conf->channel->max_reg_power) && +- (*pwr_constr_elem != sdata->local->power_constr_level)) { +- sdata->local->power_constr_level = *pwr_constr_elem; +- ieee80211_hw_config(sdata->local, 0); ++ switch (channel->band) { ++ default: ++ WARN_ON_ONCE(1); ++ /* fall through */ ++ case IEEE80211_BAND_2GHZ: ++ case IEEE80211_BAND_60GHZ: ++ chan_increment = 1; ++ break; ++ case IEEE80211_BAND_5GHZ: ++ chan_increment = 4; ++ break; + } ++ ++ /* find channel */ ++ while (country_ie_len >= 3) { ++ u8 first_channel = triplet->chans.first_channel; ++ ++ if (first_channel >= IEEE80211_COUNTRY_EXTENSION_ID) ++ goto next; ++ ++ for (i = 0; i < triplet->chans.num_channels; i++) { ++ if (first_channel + i * chan_increment == chan) { ++ have_chan_pwr = true; ++ chan_pwr = triplet->chans.max_power; ++ break; ++ } ++ } ++ if (have_chan_pwr) ++ break; + -+ 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; ++ next: ++ triplet++; ++ country_ie_len -= 3; ++ } ++ ++ if (!have_chan_pwr) ++ return; ++ ++ new_ap_level = max_t(int, 0, chan_pwr - *pwr_constr_elem); ++ ++ if (sdata->local->ap_power_level == new_ap_level) ++ return; ++ ++ sdata_info(sdata, ++ "Limiting TX power to %d (%d - %d) dBm as advertised by %pM\n", ++ new_ap_level, chan_pwr, *pwr_constr_elem, ++ sdata->u.mgd.bssid); ++ sdata->local->ap_power_level = new_ap_level; ++ ieee80211_hw_config(sdata->local, 0); + } + + void ieee80211_enable_dyn_ps(struct ieee80211_vif *vif) +@@ -1390,7 +1438,7 @@ static void ieee80211_set_disassoc(struc + sta = sta_info_get(sdata, ifmgd->bssid); + if (sta) { + set_sta_flag(sta, WLAN_STA_BLOCK_BA); +- ieee80211_sta_tear_down_BA_sessions(sta, tx); ++ ieee80211_sta_tear_down_BA_sessions(sta, false); + } + mutex_unlock(&local->sta_mtx); + +@@ -1438,7 +1486,7 @@ static void ieee80211_set_disassoc(struc + memset(&ifmgd->ht_capa, 0, sizeof(ifmgd->ht_capa)); + memset(&ifmgd->ht_capa_mask, 0, sizeof(ifmgd->ht_capa_mask)); + +- local->power_constr_level = 0; ++ local->ap_power_level = 0; + + del_timer_sync(&local->dynamic_ps_timer); + cancel_work_sync(&local->dynamic_ps_enable_work); +@@ -2530,15 +2578,13 @@ static void ieee80211_rx_mgmt_beacon(str + bssid, true); + } + +- /* Note: country IE parsing is done for us by cfg80211 */ +- if (elems.country_elem) { +- /* TODO: IBSS also needs this */ +- if (elems.pwr_constr_elem) +- ieee80211_handle_pwr_constr(sdata, +- le16_to_cpu(mgmt->u.probe_resp.capab_info), +- elems.pwr_constr_elem, +- elems.pwr_constr_elem_len); +- } ++ if (elems.country_elem && elems.pwr_constr_elem && ++ mgmt->u.probe_resp.capab_info & ++ cpu_to_le16(WLAN_CAPABILITY_SPECTRUM_MGMT)) ++ ieee80211_handle_pwr_constr(sdata, local->oper_channel, ++ elems.country_elem, ++ elems.country_elem_len, ++ elems.pwr_constr_elem); + + ieee80211_bss_info_change_notify(sdata, changed); + } +@@ -3526,6 +3572,7 @@ int ieee80211_mgd_deauth(struct ieee8021 + { + struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; + u8 frame_buf[DEAUTH_DISASSOC_LEN]; ++ bool tx = !req->local_state_change; + + mutex_lock(&ifmgd->mtx); + +@@ -3542,12 +3589,12 @@ int ieee80211_mgd_deauth(struct ieee8021 + if (ifmgd->associated && + ether_addr_equal(ifmgd->associated->bssid, req->bssid)) { + ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, +- req->reason_code, true, frame_buf); ++ req->reason_code, tx, frame_buf); + } else { + drv_mgd_prepare_tx(sdata->local, sdata); + ieee80211_send_deauth_disassoc(sdata, req->bssid, + IEEE80211_STYPE_DEAUTH, +- req->reason_code, true, ++ req->reason_code, tx, + frame_buf); + } + +--- a/net/mac80211/sta_info.c ++++ b/net/mac80211/sta_info.c +@@ -585,7 +585,7 @@ static bool sta_info_cleanup_expire_buff + */ + if (!skb) + break; +- dev_kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); } ---- 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; + /* +@@ -614,7 +614,7 @@ static bool sta_info_cleanup_expire_buff + local->total_ps_buffered--; + ps_dbg(sta->sdata, "Buffered frame expired (STA %pM)\n", + sta->sta.addr); +- dev_kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + } -- 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 */ + /* +@@ -674,7 +674,7 @@ int __must_check __sta_info_destroy(stru + * will be sufficient. + */ + set_sta_flag(sta, WLAN_STA_BLOCK_BA); +- ieee80211_sta_tear_down_BA_sessions(sta, true); ++ ieee80211_sta_tear_down_BA_sessions(sta, false); -- int power_level; /* Requested tx power in dBm */ - bool assoc; /* associate state */ - bool enable_beacon; /* true if beacons are on */ + ret = sta_info_hash_del(local, sta); + if (ret) +@@ -730,8 +730,8 @@ int __must_check __sta_info_destroy(stru -@@ -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; + for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { + local->total_ps_buffered -= skb_queue_len(&sta->ps_tx_buf[ac]); +- __skb_queue_purge(&sta->ps_tx_buf[ac]); +- __skb_queue_purge(&sta->tx_filtered[ac]); ++ ieee80211_purge_tx_queue(&local->hw, &sta->ps_tx_buf[ac]); ++ ieee80211_purge_tx_queue(&local->hw, &sta->tx_filtered[ac]); + } - 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)) + #ifdef CONFIG_MAC80211_MESH +@@ -765,7 +765,7 @@ int __must_check __sta_info_destroy(stru + tid_tx = rcu_dereference_raw(sta->ampdu_mlme.tid_tx[i]); + if (!tid_tx) continue; - -+ channels[count].max_power = AR5K_TUNE_MAX_TXPOWER/2; -+ - count++; +- __skb_queue_purge(&tid_tx->pending); ++ ieee80211_purge_tx_queue(&local->hw, &tid_tx->pending); + kfree(tid_tx); } -@@ -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; +@@ -1977,11 +1977,13 @@ ath5k_hw_set_spur_mitigation_filter(stru + spur_delta_phase = (spur_offset << 18) / 25; + spur_freq_sigma_delta = (spur_delta_phase >> 10); + symbol_width = AR5K_SPUR_SYMBOL_WIDTH_BASE_100Hz / 2; ++ break; + case AR5K_BWMODE_5MHZ: + /* Both sample_freq and chip_freq are 10MHz (?) */ + spur_delta_phase = (spur_offset << 19) / 25; + spur_freq_sigma_delta = (spur_delta_phase >> 10); + symbol_width = AR5K_SPUR_SYMBOL_WIDTH_BASE_100Hz / 4; ++ break; + default: + if (channel->band == IEEE80211_BAND_5GHZ) { + /* Both sample_freq and chip_freq are 40MHz */ +--- a/net/mac80211/ieee80211_i.h ++++ b/net/mac80211/ieee80211_i.h +@@ -1062,7 +1062,7 @@ struct ieee80211_local { + bool disable_dynamic_ps; + + int user_power_level; /* in dBm */ +- int power_constr_level; /* in dBm */ ++ int ap_power_level; /* in dBm */ + + enum ieee80211_smps_mode smps_mode; + +@@ -1170,7 +1170,6 @@ struct ieee802_11_elems { + u8 prep_len; + u8 perr_len; + u8 country_elem_len; +- u8 pwr_constr_elem_len; + u8 quiet_elem_len; + u8 num_of_quiet_elem; /* can be more the one */ + u8 timeout_int_len; +@@ -1318,6 +1317,8 @@ netdev_tx_t ieee80211_monitor_start_xmit + struct net_device *dev); + netdev_tx_t ieee80211_subif_start_xmit(struct sk_buff *skb, + struct net_device *dev); ++void ieee80211_purge_tx_queue(struct ieee80211_hw *hw, ++ struct sk_buff_head *skbs); + + /* HT */ + void ieee80211_apply_htcap_overrides(struct ieee80211_sub_if_data *sdata, +--- a/net/mac80211/util.c ++++ b/net/mac80211/util.c +@@ -406,7 +406,7 @@ void ieee80211_add_pending_skb(struct ie + int queue = info->hw_queue; + + if (WARN_ON(!info->control.vif)) { +- kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + return; + } - /* 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; +@@ -431,7 +431,7 @@ void ieee80211_add_pending_skbs_fn(struc + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); -+ /* 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 (WARN_ON(!info->control.vif)) { +- kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + continue; + } + +@@ -792,8 +792,11 @@ u32 ieee802_11_parse_elems_crc(u8 *start + elems->country_elem_len = elen; + break; + case WLAN_EID_PWR_CONSTRAINT: ++ if (elen != 1) { ++ elem_parse_failed = true; ++ break; ++ } + elems->pwr_constr_elem = pos; +- elems->pwr_constr_elem_len = elen; + break; + case WLAN_EID_TIMEOUT_INTERVAL: + elems->timeout_int = pos; +--- a/net/mac80211/main.c ++++ b/net/mac80211/main.c +@@ -154,13 +154,11 @@ int ieee80211_hw_config(struct ieee80211 + + if (test_bit(SCAN_SW_SCANNING, &local->scanning) || + test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning) || +- test_bit(SCAN_HW_SCANNING, &local->scanning)) ++ test_bit(SCAN_HW_SCANNING, &local->scanning) || ++ !local->ap_power_level) + power = chan->max_power; + else +- power = local->power_constr_level ? +- min(chan->max_power, +- (chan->max_reg_power - local->power_constr_level)) : +- chan->max_power; ++ power = min(chan->max_power, local->ap_power_level); + + if (local->user_power_level >= 0) + power = min(power, local->user_power_level); +--- a/include/net/cfg80211.h ++++ b/include/net/cfg80211.h +@@ -1218,6 +1218,7 @@ struct cfg80211_deauth_request { + const u8 *ie; + size_t ie_len; + u16 reason_code; ++ bool local_state_change; + }; + + /** +--- a/net/wireless/mlme.c ++++ b/net/wireless/mlme.c +@@ -457,20 +457,14 @@ int __cfg80211_mlme_deauth(struct cfg802 + .reason_code = reason, + .ie = ie, + .ie_len = ie_len, ++ .local_state_change = local_state_change, + }; + + ASSERT_WDEV_LOCK(wdev); + +- if (local_state_change) { +- if (wdev->current_bss && +- ether_addr_equal(wdev->current_bss->pub.bssid, bssid)) { +- cfg80211_unhold_bss(wdev->current_bss); +- cfg80211_put_bss(&wdev->current_bss->pub); +- wdev->current_bss = NULL; +- } - -- /* 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 (local_state_change && (!wdev->current_bss || ++ !ether_addr_equal(wdev->current_bss->pub.bssid, bssid))) + return 0; +- } + + return rdev->ops->deauth(&rdev->wiphy, dev, &req); } +--- a/drivers/net/wireless/ath/ath9k/xmit.c ++++ b/drivers/net/wireless/ath/ath9k/xmit.c +@@ -386,7 +386,7 @@ static void ath_tx_complete_aggr(struct + u16 seq_st = 0, acked_cnt = 0, txfail_cnt = 0, seq_first; + u32 ba[WME_BA_BMP_SIZE >> 5]; + int isaggr, txfail, txpending, sendbar = 0, needreset = 0, nbad = 0; +- bool rc_update = true; ++ bool rc_update = true, isba; + struct ieee80211_tx_rate rates[4]; + struct ath_frame_info *fi; + int nframes; +@@ -430,13 +430,17 @@ static void ath_tx_complete_aggr(struct + tidno = ieee80211_get_qos_ctl(hdr)[0] & IEEE80211_QOS_CTL_TID_MASK; + tid = ATH_AN_2_TID(an, tidno); + seq_first = tid->seq_start; ++ isba = ts->ts_flags & ATH9K_TX_BA; + /* + * The hardware occasionally sends a tx status for the wrong TID. + * In this case, the BA status cannot be considered valid and all + * subframes need to be retransmitted ++ * ++ * Only BlockAcks have a TID and therefore normal Acks cannot be ++ * checked + */ +- if (tidno != ts->tid) ++ if (isba && tidno != ts->tid) + txok = false; -@@ -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; + isaggr = bf_isaggr(bf); +--- a/net/mac80211/cfg.c ++++ b/net/mac80211/cfg.c +@@ -2563,6 +2563,9 @@ static void ieee80211_mgmt_frame_registe + else + local->probe_req_reg--; -+ ah->ah_txpower.txp_requested = requested_txpower; ++ if (!local->open_count) ++ break; + - /* 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; + ieee80211_queue_work(&local->hw, &local->reconfig_filter); + break; + default: +--- a/net/mac80211/tx.c ++++ b/net/mac80211/tx.c +@@ -354,7 +354,7 @@ static void purge_old_ps_buffers(struct + total += skb_queue_len(&sta->ps_tx_buf[ac]); + if (skb) { + purged++; +- dev_kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + break; + } + } +@@ -466,7 +466,7 @@ ieee80211_tx_h_unicast_ps_buf(struct iee + ps_dbg(tx->sdata, + "STA %pM TX buffer for AC %d full - dropping oldest frame\n", + sta->sta.addr, ac); +- dev_kfree_skb(old); ++ ieee80211_free_txskb(&local->hw, old); + } else + tx->local->total_ps_buffered++; + +@@ -1103,7 +1103,7 @@ static bool ieee80211_tx_prep_agg(struct + spin_unlock(&tx->sta->lock); + + if (purge_skb) +- dev_kfree_skb(purge_skb); ++ ieee80211_free_txskb(&tx->local->hw, purge_skb); + } + + /* reset session timer */ +@@ -1214,7 +1214,7 @@ static bool ieee80211_tx_frags(struct ie + #ifdef CONFIG_MAC80211_VERBOSE_DEBUG + if (WARN_ON_ONCE(q >= local->hw.queues)) { + __skb_unlink(skb, skbs); +- dev_kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + continue; + } + #endif +@@ -1356,9 +1356,9 @@ static int invoke_tx_handlers(struct iee + if (unlikely(res == TX_DROP)) { + I802_DEBUG_INC(tx->local->tx_handlers_drop); + if (tx->skb) +- dev_kfree_skb(tx->skb); ++ ieee80211_free_txskb(&tx->local->hw, tx->skb); + else +- __skb_queue_purge(&tx->skbs); ++ ieee80211_purge_tx_queue(&tx->local->hw, &tx->skbs); + return -1; + } else if (unlikely(res == TX_QUEUED)) { + I802_DEBUG_INC(tx->local->tx_handlers_queued); +@@ -1393,7 +1393,7 @@ static bool ieee80211_tx(struct ieee8021 + res_prepare = ieee80211_tx_prepare(sdata, &tx, skb); + + if (unlikely(res_prepare == TX_DROP)) { +- dev_kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + goto out; + } else if (unlikely(res_prepare == TX_QUEUED)) { + goto out; +@@ -1465,7 +1465,7 @@ void ieee80211_xmit(struct ieee80211_sub + headroom = max_t(int, 0, headroom); + + if (ieee80211_skb_resize(sdata, skb, headroom, may_encrypt)) { +- dev_kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + rcu_read_unlock(); + return; + } +@@ -2056,8 +2056,10 @@ netdev_tx_t ieee80211_subif_start_xmit(s + head_need += IEEE80211_ENCRYPT_HEADROOM; + head_need += local->tx_headroom; + head_need = max_t(int, 0, head_need); +- if (ieee80211_skb_resize(sdata, skb, head_need, true)) +- goto fail; ++ if (ieee80211_skb_resize(sdata, skb, head_need, true)) { ++ ieee80211_free_txskb(&local->hw, skb); ++ return NETDEV_TX_OK; ++ } + } + + if (encaps_data) { +@@ -2124,10 +2126,13 @@ netdev_tx_t ieee80211_subif_start_xmit(s + */ + void ieee80211_clear_tx_pending(struct ieee80211_local *local) + { ++ struct sk_buff *skb; + int i; + +- for (i = 0; i < local->hw.queues; i++) +- skb_queue_purge(&local->pending[i]); ++ for (i = 0; i < local->hw.queues; i++) { ++ while ((skb = skb_dequeue(&local->pending[i])) != NULL) ++ ieee80211_free_txskb(&local->hw, skb); ++ } + } + + /* +@@ -2190,7 +2195,7 @@ void ieee80211_tx_pending(unsigned long + struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); + + if (WARN_ON(!info->control.vif)) { +- kfree_skb(skb); ++ ieee80211_free_txskb(&local->hw, skb); + continue; + }