1f0a39ae738d660cb69e486abd20c0dec1cdcb898George/****************************************************************************** 2f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 3c1d6604d1e3357d734d209a04cc1f80af948364bLarry Finger * Copyright(c) 2009-2012 Realtek Corporation. 4f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 5f0a39ae738d660cb69e486abd20c0dec1cdcb898George * This program is free software; you can redistribute it and/or modify it 6f0a39ae738d660cb69e486abd20c0dec1cdcb898George * under the terms of version 2 of the GNU General Public License as 7f0a39ae738d660cb69e486abd20c0dec1cdcb898George * published by the Free Software Foundation. 8f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 9f0a39ae738d660cb69e486abd20c0dec1cdcb898George * This program is distributed in the hope that it will be useful, but WITHOUT 10f0a39ae738d660cb69e486abd20c0dec1cdcb898George * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 11f0a39ae738d660cb69e486abd20c0dec1cdcb898George * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 12f0a39ae738d660cb69e486abd20c0dec1cdcb898George * more details. 13f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 14f0a39ae738d660cb69e486abd20c0dec1cdcb898George * You should have received a copy of the GNU General Public License along with 15f0a39ae738d660cb69e486abd20c0dec1cdcb898George * this program; if not, write to the Free Software Foundation, Inc., 16f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA 17f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 18f0a39ae738d660cb69e486abd20c0dec1cdcb898George * The full GNU General Public License is included in this distribution in the 19f0a39ae738d660cb69e486abd20c0dec1cdcb898George * file called LICENSE. 20f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 21f0a39ae738d660cb69e486abd20c0dec1cdcb898George * Contact Information: 22f0a39ae738d660cb69e486abd20c0dec1cdcb898George * wlanfae <wlanfae@realtek.com> 23f0a39ae738d660cb69e486abd20c0dec1cdcb898George * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, 24f0a39ae738d660cb69e486abd20c0dec1cdcb898George * Hsinchu 300, Taiwan. 25f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 26f0a39ae738d660cb69e486abd20c0dec1cdcb898George * Larry Finger <Larry.Finger@lwfinger.net> 27f0a39ae738d660cb69e486abd20c0dec1cdcb898George * 28f0a39ae738d660cb69e486abd20c0dec1cdcb898George *****************************************************************************/ 29f0a39ae738d660cb69e486abd20c0dec1cdcb898George 30f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "../wifi.h" 31f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "../pci.h" 32f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "../ps.h" 3325b13dbc38a74b76da5746d75867e306b70035bdLarry Finger#include "../core.h" 34f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "reg.h" 35f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "def.h" 36f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "phy.h" 379f087a924427c01190b205f0051be00808c99828Larry Finger#include "../rtl8192c/phy_common.h" 38f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "rf.h" 39f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "dm.h" 409f087a924427c01190b205f0051be00808c99828Larry Finger#include "../rtl8192c/dm_common.h" 419f087a924427c01190b205f0051be00808c99828Larry Finger#include "../rtl8192c/fw_common.h" 42f0a39ae738d660cb69e486abd20c0dec1cdcb898George#include "table.h" 43f0a39ae738d660cb69e486abd20c0dec1cdcb898George 441472d3a87586eb7529d1d85f7c888055650b7208Larry Fingeru32 rtl92cu_phy_query_rf_reg(struct ieee80211_hw *hw, 45d3bb1429a2c1470d1f84646c00e34dc6784ee06eLarry Finger enum radio_path rfpath, u32 regaddr, u32 bitmask) 46f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 47f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 48f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 original_value, readback_value, bitshift; 49f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_phy *rtlphy = &(rtlpriv->phy); 50f0a39ae738d660cb69e486abd20c0dec1cdcb898George 51f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, 52f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "regaddr(%#x), rfpath(%#x), bitmask(%#x)\n", 53f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches regaddr, rfpath, bitmask); 54f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (rtlphy->rf_mode != RF_OP_BY_FW) { 55f0a39ae738d660cb69e486abd20c0dec1cdcb898George original_value = _rtl92c_phy_rf_serial_read(hw, 56f0a39ae738d660cb69e486abd20c0dec1cdcb898George rfpath, regaddr); 57f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 58f0a39ae738d660cb69e486abd20c0dec1cdcb898George original_value = _rtl92c_phy_fw_rf_serial_read(hw, 59f0a39ae738d660cb69e486abd20c0dec1cdcb898George rfpath, regaddr); 60f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 61f0a39ae738d660cb69e486abd20c0dec1cdcb898George bitshift = _rtl92c_phy_calculate_bit_shift(bitmask); 62f0a39ae738d660cb69e486abd20c0dec1cdcb898George readback_value = (original_value & bitmask) >> bitshift; 63f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, 64f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "regaddr(%#x), rfpath(%#x), bitmask(%#x), original_value(%#x)\n", 65f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches regaddr, rfpath, bitmask, original_value); 66f0a39ae738d660cb69e486abd20c0dec1cdcb898George return readback_value; 67f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 68f0a39ae738d660cb69e486abd20c0dec1cdcb898George 691472d3a87586eb7529d1d85f7c888055650b7208Larry Fingervoid rtl92cu_phy_set_rf_reg(struct ieee80211_hw *hw, 70d3bb1429a2c1470d1f84646c00e34dc6784ee06eLarry Finger enum radio_path rfpath, 71d3bb1429a2c1470d1f84646c00e34dc6784ee06eLarry Finger u32 regaddr, u32 bitmask, u32 data) 72f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 73f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 74f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_phy *rtlphy = &(rtlpriv->phy); 75f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 original_value, bitshift; 76f0a39ae738d660cb69e486abd20c0dec1cdcb898George 77f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, 78f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "regaddr(%#x), bitmask(%#x), data(%#x), rfpath(%#x)\n", 79f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches regaddr, bitmask, data, rfpath); 80f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (rtlphy->rf_mode != RF_OP_BY_FW) { 81f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (bitmask != RFREG_OFFSET_MASK) { 82f0a39ae738d660cb69e486abd20c0dec1cdcb898George original_value = _rtl92c_phy_rf_serial_read(hw, 83f0a39ae738d660cb69e486abd20c0dec1cdcb898George rfpath, 84f0a39ae738d660cb69e486abd20c0dec1cdcb898George regaddr); 85f0a39ae738d660cb69e486abd20c0dec1cdcb898George bitshift = _rtl92c_phy_calculate_bit_shift(bitmask); 86f0a39ae738d660cb69e486abd20c0dec1cdcb898George data = 87f0a39ae738d660cb69e486abd20c0dec1cdcb898George ((original_value & (~bitmask)) | 88f0a39ae738d660cb69e486abd20c0dec1cdcb898George (data << bitshift)); 89f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 90f0a39ae738d660cb69e486abd20c0dec1cdcb898George _rtl92c_phy_rf_serial_write(hw, rfpath, regaddr, data); 91f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 92f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (bitmask != RFREG_OFFSET_MASK) { 93f0a39ae738d660cb69e486abd20c0dec1cdcb898George original_value = _rtl92c_phy_fw_rf_serial_read(hw, 94f0a39ae738d660cb69e486abd20c0dec1cdcb898George rfpath, 95f0a39ae738d660cb69e486abd20c0dec1cdcb898George regaddr); 96f0a39ae738d660cb69e486abd20c0dec1cdcb898George bitshift = _rtl92c_phy_calculate_bit_shift(bitmask); 97f0a39ae738d660cb69e486abd20c0dec1cdcb898George data = 98f0a39ae738d660cb69e486abd20c0dec1cdcb898George ((original_value & (~bitmask)) | 99f0a39ae738d660cb69e486abd20c0dec1cdcb898George (data << bitshift)); 100f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 101f0a39ae738d660cb69e486abd20c0dec1cdcb898George _rtl92c_phy_fw_rf_serial_write(hw, rfpath, regaddr, data); 102f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 103f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE, 104f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "regaddr(%#x), bitmask(%#x), data(%#x), rfpath(%#x)\n", 105f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches regaddr, bitmask, data, rfpath); 106f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 107f0a39ae738d660cb69e486abd20c0dec1cdcb898George 1081472d3a87586eb7529d1d85f7c888055650b7208Larry Fingerbool rtl92cu_phy_mac_config(struct ieee80211_hw *hw) 109f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 110f0a39ae738d660cb69e486abd20c0dec1cdcb898George bool rtstatus; 111f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 112f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 113f0a39ae738d660cb69e486abd20c0dec1cdcb898George bool is92c = IS_92C_SERIAL(rtlhal->version); 114f0a39ae738d660cb69e486abd20c0dec1cdcb898George 1151472d3a87586eb7529d1d85f7c888055650b7208Larry Finger rtstatus = _rtl92cu_phy_config_mac_with_headerfile(hw); 116f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (is92c && IS_HARDWARE_TYPE_8192CE(rtlhal)) 117f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, 0x14, 0x71); 118f0a39ae738d660cb69e486abd20c0dec1cdcb898George return rtstatus; 119f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 120f0a39ae738d660cb69e486abd20c0dec1cdcb898George 1211472d3a87586eb7529d1d85f7c888055650b7208Larry Fingerbool rtl92cu_phy_bb_config(struct ieee80211_hw *hw) 122f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 123f0a39ae738d660cb69e486abd20c0dec1cdcb898George bool rtstatus = true; 124f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 125f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 126f0a39ae738d660cb69e486abd20c0dec1cdcb898George u16 regval; 1278a7192080f45f2e7858bc4448f45a9d05f7f4da3Mark Cave-Ayland u32 regval32; 128f0a39ae738d660cb69e486abd20c0dec1cdcb898George u8 b_reg_hwparafile = 1; 129f0a39ae738d660cb69e486abd20c0dec1cdcb898George 130f0a39ae738d660cb69e486abd20c0dec1cdcb898George _rtl92c_phy_init_bb_rf_register_definition(hw); 131f0a39ae738d660cb69e486abd20c0dec1cdcb898George regval = rtl_read_word(rtlpriv, REG_SYS_FUNC_EN); 132f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_word(rtlpriv, REG_SYS_FUNC_EN, regval | BIT(13) | 133f0a39ae738d660cb69e486abd20c0dec1cdcb898George BIT(0) | BIT(1)); 134f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_AFE_PLL_CTRL, 0x83); 135f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_AFE_PLL_CTRL + 1, 0xdb); 136f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_RF_CTRL, RF_EN | RF_RSTB | RF_SDMRSTB); 137f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (IS_HARDWARE_TYPE_8192CE(rtlhal)) { 138f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, FEN_PPLL | FEN_PCIEA | 139f0a39ae738d660cb69e486abd20c0dec1cdcb898George FEN_DIO_PCIE | FEN_BB_GLB_RSTn | FEN_BBRSTB); 140f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else if (IS_HARDWARE_TYPE_8192CU(rtlhal)) { 141f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, FEN_USBA | FEN_USBD | 142f0a39ae738d660cb69e486abd20c0dec1cdcb898George FEN_BB_GLB_RSTn | FEN_BBRSTB); 143f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 1448a7192080f45f2e7858bc4448f45a9d05f7f4da3Mark Cave-Ayland regval32 = rtl_read_dword(rtlpriv, 0x87c); 1458a7192080f45f2e7858bc4448f45a9d05f7f4da3Mark Cave-Ayland rtl_write_dword(rtlpriv, 0x87c, regval32 & (~BIT(31))); 1468a7192080f45f2e7858bc4448f45a9d05f7f4da3Mark Cave-Ayland if (IS_HARDWARE_TYPE_8192CU(rtlhal)) 1478a7192080f45f2e7858bc4448f45a9d05f7f4da3Mark Cave-Ayland rtl_write_byte(rtlpriv, REG_LDOHCI12_CTRL, 0x0f); 148f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_AFE_XTAL_CTRL + 1, 0x80); 149f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (b_reg_hwparafile == 1) 150f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtstatus = _rtl92c_phy_bb8192c_config_parafile(hw); 151f0a39ae738d660cb69e486abd20c0dec1cdcb898George return rtstatus; 152f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 153f0a39ae738d660cb69e486abd20c0dec1cdcb898George 1541472d3a87586eb7529d1d85f7c888055650b7208Larry Fingerbool _rtl92cu_phy_config_mac_with_headerfile(struct ieee80211_hw *hw) 155f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 156f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 157f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_phy *rtlphy = &(rtlpriv->phy); 158f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 i; 159f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 arraylength; 160f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 *ptrarray; 161f0a39ae738d660cb69e486abd20c0dec1cdcb898George 162f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, "Read Rtl819XMACPHY_Array\n"); 163f0a39ae738d660cb69e486abd20c0dec1cdcb898George arraylength = rtlphy->hwparam_tables[MAC_REG].length ; 164f0a39ae738d660cb69e486abd20c0dec1cdcb898George ptrarray = rtlphy->hwparam_tables[MAC_REG].pdata; 165f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, "Img:RTL8192CEMAC_2T_ARRAY\n"); 166f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (i = 0; i < arraylength; i = i + 2) 167f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, ptrarray[i], (u8) ptrarray[i + 1]); 168f0a39ae738d660cb69e486abd20c0dec1cdcb898George return true; 169f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 170f0a39ae738d660cb69e486abd20c0dec1cdcb898George 1711472d3a87586eb7529d1d85f7c888055650b7208Larry Fingerbool _rtl92cu_phy_config_bb_with_headerfile(struct ieee80211_hw *hw, 172d3bb1429a2c1470d1f84646c00e34dc6784ee06eLarry Finger u8 configtype) 173f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 174f0a39ae738d660cb69e486abd20c0dec1cdcb898George int i; 175f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 *phy_regarray_table; 176f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 *agctab_array_table; 177f0a39ae738d660cb69e486abd20c0dec1cdcb898George u16 phy_reg_arraylen, agctab_arraylen; 178f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 179f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 180f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_phy *rtlphy = &(rtlpriv->phy); 181f0a39ae738d660cb69e486abd20c0dec1cdcb898George 182f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (IS_92C_SERIAL(rtlhal->version)) { 183f0a39ae738d660cb69e486abd20c0dec1cdcb898George agctab_arraylen = rtlphy->hwparam_tables[AGCTAB_2T].length; 184f0a39ae738d660cb69e486abd20c0dec1cdcb898George agctab_array_table = rtlphy->hwparam_tables[AGCTAB_2T].pdata; 185f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_reg_arraylen = rtlphy->hwparam_tables[PHY_REG_2T].length; 186f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_table = rtlphy->hwparam_tables[PHY_REG_2T].pdata; 187f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 188f0a39ae738d660cb69e486abd20c0dec1cdcb898George agctab_arraylen = rtlphy->hwparam_tables[AGCTAB_1T].length; 189f0a39ae738d660cb69e486abd20c0dec1cdcb898George agctab_array_table = rtlphy->hwparam_tables[AGCTAB_1T].pdata; 190f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_reg_arraylen = rtlphy->hwparam_tables[PHY_REG_1T].length; 191f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_table = rtlphy->hwparam_tables[PHY_REG_1T].pdata; 192f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 193f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (configtype == BASEBAND_CONFIG_PHY_REG) { 194f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (i = 0; i < phy_reg_arraylen; i = i + 2) { 19525b13dbc38a74b76da5746d75867e306b70035bdLarry Finger rtl_addr_delay(phy_regarray_table[i]); 196f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, phy_regarray_table[i], MASKDWORD, 197f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_table[i + 1]); 198f0a39ae738d660cb69e486abd20c0dec1cdcb898George udelay(1); 199f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 200f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "The phy_regarray_table[0] is %x Rtl819XPHY_REGArray[1] is %x\n", 201f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches phy_regarray_table[i], 202f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches phy_regarray_table[i + 1]); 203f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 204f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else if (configtype == BASEBAND_CONFIG_AGC_TAB) { 205f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (i = 0; i < agctab_arraylen; i = i + 2) { 206f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, agctab_array_table[i], MASKDWORD, 207f0a39ae738d660cb69e486abd20c0dec1cdcb898George agctab_array_table[i + 1]); 208f0a39ae738d660cb69e486abd20c0dec1cdcb898George udelay(1); 209f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 210f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "The agctab_array_table[0] is %x Rtl819XPHY_REGArray[1] is %x\n", 211f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches agctab_array_table[i], 212f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches agctab_array_table[i + 1]); 213f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 214f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 215f0a39ae738d660cb69e486abd20c0dec1cdcb898George return true; 216f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 217f0a39ae738d660cb69e486abd20c0dec1cdcb898George 2181472d3a87586eb7529d1d85f7c888055650b7208Larry Fingerbool _rtl92cu_phy_config_bb_with_pgheaderfile(struct ieee80211_hw *hw, 219d3bb1429a2c1470d1f84646c00e34dc6784ee06eLarry Finger u8 configtype) 220f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 221f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 222f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_phy *rtlphy = &(rtlpriv->phy); 223f0a39ae738d660cb69e486abd20c0dec1cdcb898George int i; 224f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 *phy_regarray_table_pg; 225f0a39ae738d660cb69e486abd20c0dec1cdcb898George u16 phy_regarray_pg_len; 226f0a39ae738d660cb69e486abd20c0dec1cdcb898George 227f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtlphy->pwrgroup_cnt = 0; 228f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_pg_len = rtlphy->hwparam_tables[PHY_REG_PG].length; 229f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_table_pg = rtlphy->hwparam_tables[PHY_REG_PG].pdata; 230f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (configtype == BASEBAND_CONFIG_PHY_REG) { 231f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (i = 0; i < phy_regarray_pg_len; i = i + 3) { 23225b13dbc38a74b76da5746d75867e306b70035bdLarry Finger rtl_addr_delay(phy_regarray_table_pg[i]); 233f0a39ae738d660cb69e486abd20c0dec1cdcb898George _rtl92c_store_pwrIndex_diffrate_offset(hw, 234f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_table_pg[i], 235f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_table_pg[i + 1], 236f0a39ae738d660cb69e486abd20c0dec1cdcb898George phy_regarray_table_pg[i + 2]); 237f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 238f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 239f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE, 240f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "configtype != BaseBand_Config_PHY_REG\n"); 241f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 242f0a39ae738d660cb69e486abd20c0dec1cdcb898George return true; 243f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 244f0a39ae738d660cb69e486abd20c0dec1cdcb898George 2451472d3a87586eb7529d1d85f7c888055650b7208Larry Fingerbool rtl92cu_phy_config_rf_with_headerfile(struct ieee80211_hw *hw, 246f0a39ae738d660cb69e486abd20c0dec1cdcb898George enum radio_path rfpath) 247f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 248f0a39ae738d660cb69e486abd20c0dec1cdcb898George int i; 249f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 *radioa_array_table; 250f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 *radiob_array_table; 251f0a39ae738d660cb69e486abd20c0dec1cdcb898George u16 radioa_arraylen, radiob_arraylen; 252f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 253f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 254f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_phy *rtlphy = &(rtlpriv->phy); 255f0a39ae738d660cb69e486abd20c0dec1cdcb898George 256f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (IS_92C_SERIAL(rtlhal->version)) { 257f0a39ae738d660cb69e486abd20c0dec1cdcb898George radioa_arraylen = rtlphy->hwparam_tables[RADIOA_2T].length; 258f0a39ae738d660cb69e486abd20c0dec1cdcb898George radioa_array_table = rtlphy->hwparam_tables[RADIOA_2T].pdata; 259f0a39ae738d660cb69e486abd20c0dec1cdcb898George radiob_arraylen = rtlphy->hwparam_tables[RADIOB_2T].length; 260f0a39ae738d660cb69e486abd20c0dec1cdcb898George radiob_array_table = rtlphy->hwparam_tables[RADIOB_2T].pdata; 261f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 262f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "Radio_A:RTL8192CERADIOA_2TARRAY\n"); 263f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 264f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "Radio_B:RTL8192CE_RADIOB_2TARRAY\n"); 265f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 266f0a39ae738d660cb69e486abd20c0dec1cdcb898George radioa_arraylen = rtlphy->hwparam_tables[RADIOA_1T].length; 267f0a39ae738d660cb69e486abd20c0dec1cdcb898George radioa_array_table = rtlphy->hwparam_tables[RADIOA_1T].pdata; 268f0a39ae738d660cb69e486abd20c0dec1cdcb898George radiob_arraylen = rtlphy->hwparam_tables[RADIOB_1T].length; 269f0a39ae738d660cb69e486abd20c0dec1cdcb898George radiob_array_table = rtlphy->hwparam_tables[RADIOB_1T].pdata; 270f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 271f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "Radio_A:RTL8192CE_RADIOA_1TARRAY\n"); 272f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 273f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "Radio_B:RTL8192CE_RADIOB_1TARRAY\n"); 274f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 275f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, "Radio No %x\n", rfpath); 276f0a39ae738d660cb69e486abd20c0dec1cdcb898George switch (rfpath) { 277f0a39ae738d660cb69e486abd20c0dec1cdcb898George case RF90_PATH_A: 278f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (i = 0; i < radioa_arraylen; i = i + 2) { 27925b13dbc38a74b76da5746d75867e306b70035bdLarry Finger rtl_rfreg_delay(hw, rfpath, radioa_array_table[i], 28025b13dbc38a74b76da5746d75867e306b70035bdLarry Finger RFREG_OFFSET_MASK, 28125b13dbc38a74b76da5746d75867e306b70035bdLarry Finger radioa_array_table[i + 1]); 282f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 283f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 284f0a39ae738d660cb69e486abd20c0dec1cdcb898George case RF90_PATH_B: 285f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (i = 0; i < radiob_arraylen; i = i + 2) { 28625b13dbc38a74b76da5746d75867e306b70035bdLarry Finger rtl_rfreg_delay(hw, rfpath, radiob_array_table[i], 28725b13dbc38a74b76da5746d75867e306b70035bdLarry Finger RFREG_OFFSET_MASK, 28825b13dbc38a74b76da5746d75867e306b70035bdLarry Finger radiob_array_table[i + 1]); 289f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 290f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 291f0a39ae738d660cb69e486abd20c0dec1cdcb898George case RF90_PATH_C: 292f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 293f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "switch case not processed\n"); 294f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 295f0a39ae738d660cb69e486abd20c0dec1cdcb898George case RF90_PATH_D: 296f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 297f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "switch case not processed\n"); 298f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 29925b13dbc38a74b76da5746d75867e306b70035bdLarry Finger default: 30025b13dbc38a74b76da5746d75867e306b70035bdLarry Finger break; 301f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 302f0a39ae738d660cb69e486abd20c0dec1cdcb898George return true; 303f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 304f0a39ae738d660cb69e486abd20c0dec1cdcb898George 3051472d3a87586eb7529d1d85f7c888055650b7208Larry Fingervoid rtl92cu_phy_set_bw_mode_callback(struct ieee80211_hw *hw) 306f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 307f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 308f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 309f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_phy *rtlphy = &(rtlpriv->phy); 310f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 311f0a39ae738d660cb69e486abd20c0dec1cdcb898George u8 reg_bw_opmode; 312f0a39ae738d660cb69e486abd20c0dec1cdcb898George u8 reg_prsr_rsc; 313f0a39ae738d660cb69e486abd20c0dec1cdcb898George 314f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches RT_TRACE(rtlpriv, COMP_SCAN, DBG_TRACE, "Switch to %s bandwidth\n", 315f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20 ? 316f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "20MHz" : "40MHz"); 317f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (is_hal_stop(rtlhal)) { 318f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtlphy->set_bwmode_inprogress = false; 319f0a39ae738d660cb69e486abd20c0dec1cdcb898George return; 320f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 321f0a39ae738d660cb69e486abd20c0dec1cdcb898George reg_bw_opmode = rtl_read_byte(rtlpriv, REG_BWOPMODE); 322f0a39ae738d660cb69e486abd20c0dec1cdcb898George reg_prsr_rsc = rtl_read_byte(rtlpriv, REG_RRSR + 2); 323f0a39ae738d660cb69e486abd20c0dec1cdcb898George switch (rtlphy->current_chan_bw) { 324f0a39ae738d660cb69e486abd20c0dec1cdcb898George case HT_CHANNEL_WIDTH_20: 325f0a39ae738d660cb69e486abd20c0dec1cdcb898George reg_bw_opmode |= BW_OPMODE_20MHZ; 326f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_BWOPMODE, reg_bw_opmode); 327f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 328f0a39ae738d660cb69e486abd20c0dec1cdcb898George case HT_CHANNEL_WIDTH_20_40: 329f0a39ae738d660cb69e486abd20c0dec1cdcb898George reg_bw_opmode &= ~BW_OPMODE_20MHZ; 330f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_BWOPMODE, reg_bw_opmode); 331f0a39ae738d660cb69e486abd20c0dec1cdcb898George reg_prsr_rsc = 332f0a39ae738d660cb69e486abd20c0dec1cdcb898George (reg_prsr_rsc & 0x90) | (mac->cur_40_prime_sc << 5); 333f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_RRSR + 2, reg_prsr_rsc); 334f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 335f0a39ae738d660cb69e486abd20c0dec1cdcb898George default: 336f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 337f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "unknown bandwidth: %#X\n", rtlphy->current_chan_bw); 338f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 339f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 340f0a39ae738d660cb69e486abd20c0dec1cdcb898George switch (rtlphy->current_chan_bw) { 341f0a39ae738d660cb69e486abd20c0dec1cdcb898George case HT_CHANNEL_WIDTH_20: 342f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA0_RFMOD, BRFMOD, 0x0); 343f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA1_RFMOD, BRFMOD, 0x0); 344f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA0_ANALOGPARAMETER2, BIT(10), 1); 345f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 346f0a39ae738d660cb69e486abd20c0dec1cdcb898George case HT_CHANNEL_WIDTH_20_40: 347f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA0_RFMOD, BRFMOD, 0x1); 348f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA1_RFMOD, BRFMOD, 0x1); 349f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RCCK0_SYSTEM, BCCK_SIDEBAND, 350f0a39ae738d660cb69e486abd20c0dec1cdcb898George (mac->cur_40_prime_sc >> 1)); 351f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, ROFDM1_LSTF, 0xC00, mac->cur_40_prime_sc); 352f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA0_ANALOGPARAMETER2, BIT(10), 0); 353f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, 0x818, (BIT(26) | BIT(27)), 354f0a39ae738d660cb69e486abd20c0dec1cdcb898George (mac->cur_40_prime_sc == 355f0a39ae738d660cb69e486abd20c0dec1cdcb898George HAL_PRIME_CHNL_OFFSET_LOWER) ? 2 : 1); 356f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 357f0a39ae738d660cb69e486abd20c0dec1cdcb898George default: 358f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 359f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "unknown bandwidth: %#X\n", rtlphy->current_chan_bw); 360f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 361f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 3621472d3a87586eb7529d1d85f7c888055650b7208Larry Finger rtl92cu_phy_rf6052_set_bandwidth(hw, rtlphy->current_chan_bw); 363f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtlphy->set_bwmode_inprogress = false; 364f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches RT_TRACE(rtlpriv, COMP_SCAN, DBG_TRACE, "<==\n"); 365f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 366f0a39ae738d660cb69e486abd20c0dec1cdcb898George 3671472d3a87586eb7529d1d85f7c888055650b7208Larry Fingervoid rtl92cu_bb_block_on(struct ieee80211_hw *hw) 368f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 369f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 370f0a39ae738d660cb69e486abd20c0dec1cdcb898George 371f0a39ae738d660cb69e486abd20c0dec1cdcb898George mutex_lock(&rtlpriv->io.bb_mutex); 372f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA0_RFMOD, BCCKEN, 0x1); 373f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_bbreg(hw, RFPGA0_RFMOD, BOFDMEN, 0x1); 374f0a39ae738d660cb69e486abd20c0dec1cdcb898George mutex_unlock(&rtlpriv->io.bb_mutex); 375f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 376f0a39ae738d660cb69e486abd20c0dec1cdcb898George 3771472d3a87586eb7529d1d85f7c888055650b7208Larry Fingervoid _rtl92cu_phy_lc_calibrate(struct ieee80211_hw *hw, bool is2t) 378f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 379f0a39ae738d660cb69e486abd20c0dec1cdcb898George u8 tmpreg; 380f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 rf_a_mode = 0, rf_b_mode = 0, lc_cal; 381f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 382f0a39ae738d660cb69e486abd20c0dec1cdcb898George 383f0a39ae738d660cb69e486abd20c0dec1cdcb898George tmpreg = rtl_read_byte(rtlpriv, 0xd03); 384f0a39ae738d660cb69e486abd20c0dec1cdcb898George 385f0a39ae738d660cb69e486abd20c0dec1cdcb898George if ((tmpreg & 0x70) != 0) 386f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, 0xd03, tmpreg & 0x8F); 387f0a39ae738d660cb69e486abd20c0dec1cdcb898George else 388f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_TXPAUSE, 0xFF); 389f0a39ae738d660cb69e486abd20c0dec1cdcb898George 390f0a39ae738d660cb69e486abd20c0dec1cdcb898George if ((tmpreg & 0x70) != 0) { 391f0a39ae738d660cb69e486abd20c0dec1cdcb898George rf_a_mode = rtl_get_rfreg(hw, RF90_PATH_A, 0x00, MASK12BITS); 392f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (is2t) 393f0a39ae738d660cb69e486abd20c0dec1cdcb898George rf_b_mode = rtl_get_rfreg(hw, RF90_PATH_B, 0x00, 394f0a39ae738d660cb69e486abd20c0dec1cdcb898George MASK12BITS); 395f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_rfreg(hw, RF90_PATH_A, 0x00, MASK12BITS, 396f0a39ae738d660cb69e486abd20c0dec1cdcb898George (rf_a_mode & 0x8FFFF) | 0x10000); 397f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (is2t) 398f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_rfreg(hw, RF90_PATH_B, 0x00, MASK12BITS, 399f0a39ae738d660cb69e486abd20c0dec1cdcb898George (rf_b_mode & 0x8FFFF) | 0x10000); 400f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 401f0a39ae738d660cb69e486abd20c0dec1cdcb898George lc_cal = rtl_get_rfreg(hw, RF90_PATH_A, 0x18, MASK12BITS); 402f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_rfreg(hw, RF90_PATH_A, 0x18, MASK12BITS, lc_cal | 0x08000); 403f0a39ae738d660cb69e486abd20c0dec1cdcb898George mdelay(100); 404f0a39ae738d660cb69e486abd20c0dec1cdcb898George if ((tmpreg & 0x70) != 0) { 405f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, 0xd03, tmpreg); 406f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_rfreg(hw, RF90_PATH_A, 0x00, MASK12BITS, rf_a_mode); 407f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (is2t) 408f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_set_rfreg(hw, RF90_PATH_B, 0x00, MASK12BITS, 409f0a39ae738d660cb69e486abd20c0dec1cdcb898George rf_b_mode); 410f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 411f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_write_byte(rtlpriv, REG_TXPAUSE, 0x00); 412f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 413f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 414f0a39ae738d660cb69e486abd20c0dec1cdcb898George 415d3bb1429a2c1470d1f84646c00e34dc6784ee06eLarry Fingerstatic bool _rtl92cu_phy_set_rf_power_state(struct ieee80211_hw *hw, 416f0a39ae738d660cb69e486abd20c0dec1cdcb898George enum rf_pwrstate rfpwr_state) 417f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 418f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_priv *rtlpriv = rtl_priv(hw); 419f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_pci_priv *pcipriv = rtl_pcipriv(hw); 420f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 421f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 422f0a39ae738d660cb69e486abd20c0dec1cdcb898George bool bresult = true; 423f0a39ae738d660cb69e486abd20c0dec1cdcb898George u8 i, queue_id; 424f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl8192_tx_ring *ring = NULL; 425f0a39ae738d660cb69e486abd20c0dec1cdcb898George 426f0a39ae738d660cb69e486abd20c0dec1cdcb898George switch (rfpwr_state) { 427f0a39ae738d660cb69e486abd20c0dec1cdcb898George case ERFON: 428f0a39ae738d660cb69e486abd20c0dec1cdcb898George if ((ppsc->rfpwr_state == ERFOFF) && 429f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_IN_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC)) { 430f0a39ae738d660cb69e486abd20c0dec1cdcb898George bool rtstatus; 431f0a39ae738d660cb69e486abd20c0dec1cdcb898George u32 InitializeCount = 0; 432f0a39ae738d660cb69e486abd20c0dec1cdcb898George 433f0a39ae738d660cb69e486abd20c0dec1cdcb898George do { 434f0a39ae738d660cb69e486abd20c0dec1cdcb898George InitializeCount++; 435f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG, 436f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "IPS Set eRf nic enable\n"); 437f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtstatus = rtl_ps_enable_nic(hw); 43823677ce3172fcb93522a1df077d21019e73ee1e3Joe Perches } while (!rtstatus && (InitializeCount < 10)); 439f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_CLEAR_PS_LEVEL(ppsc, 440f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_RF_OFF_LEVL_HALT_NIC); 441f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 442f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG, 443f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "Set ERFON sleeped:%d ms\n", 444f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches jiffies_to_msecs(jiffies - 445f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches ppsc->last_sleep_jiffies)); 446f0a39ae738d660cb69e486abd20c0dec1cdcb898George ppsc->last_awake_jiffies = jiffies; 447f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl92ce_phy_set_rf_on(hw); 448f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 449f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (mac->link_state == MAC80211_LINKED) { 450f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtlpriv->cfg->ops->led_control(hw, 451f0a39ae738d660cb69e486abd20c0dec1cdcb898George LED_CTL_LINK); 452f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 453f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtlpriv->cfg->ops->led_control(hw, 454f0a39ae738d660cb69e486abd20c0dec1cdcb898George LED_CTL_NO_LINK); 455f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 456f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 457f0a39ae738d660cb69e486abd20c0dec1cdcb898George case ERFOFF: 458f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (queue_id = 0, i = 0; 459f0a39ae738d660cb69e486abd20c0dec1cdcb898George queue_id < RTL_PCI_MAX_TX_QUEUE_COUNT;) { 460f0a39ae738d660cb69e486abd20c0dec1cdcb898George ring = &pcipriv->dev.tx_ring[queue_id]; 461f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (skb_queue_len(&ring->queue) == 0 || 462f0a39ae738d660cb69e486abd20c0dec1cdcb898George queue_id == BEACON_QUEUE) { 463f0a39ae738d660cb69e486abd20c0dec1cdcb898George queue_id++; 464f0a39ae738d660cb69e486abd20c0dec1cdcb898George continue; 465f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 466f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, 467f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "eRf Off/Sleep: %d times TcbBusyQueue[%d] =%d before doze!\n", 468f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches i + 1, 469f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches queue_id, 470f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches skb_queue_len(&ring->queue)); 471f0a39ae738d660cb69e486abd20c0dec1cdcb898George udelay(10); 472f0a39ae738d660cb69e486abd20c0dec1cdcb898George i++; 473f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 474f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (i >= MAX_DOZE_WAITING_TIMES_9x) { 475f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, 476f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "ERFOFF: %d times TcbBusyQueue[%d] = %d !\n", 477f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches MAX_DOZE_WAITING_TIMES_9x, 478f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches queue_id, 479f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches skb_queue_len(&ring->queue)); 480f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 481f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 482f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 483f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_HALT_NIC) { 484f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG, 485f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "IPS Set eRf nic disable\n"); 486f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtl_ps_disable_nic(hw); 487f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC); 488f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 489f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (ppsc->rfoff_reason == RF_CHANGE_BY_IPS) { 490f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtlpriv->cfg->ops->led_control(hw, 491f0a39ae738d660cb69e486abd20c0dec1cdcb898George LED_CTL_NO_LINK); 492f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 493f0a39ae738d660cb69e486abd20c0dec1cdcb898George rtlpriv->cfg->ops->led_control(hw, 494f0a39ae738d660cb69e486abd20c0dec1cdcb898George LED_CTL_POWER_OFF); 495f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 496f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 497f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 498f0a39ae738d660cb69e486abd20c0dec1cdcb898George case ERFSLEEP: 499f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (ppsc->rfpwr_state == ERFOFF) 50091ddff8a3b9cc7ac2252aca138220939cf6cc2cfPhilipp Dreimann return false; 501f0a39ae738d660cb69e486abd20c0dec1cdcb898George for (queue_id = 0, i = 0; 502f0a39ae738d660cb69e486abd20c0dec1cdcb898George queue_id < RTL_PCI_MAX_TX_QUEUE_COUNT;) { 503f0a39ae738d660cb69e486abd20c0dec1cdcb898George ring = &pcipriv->dev.tx_ring[queue_id]; 504f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (skb_queue_len(&ring->queue) == 0) { 505f0a39ae738d660cb69e486abd20c0dec1cdcb898George queue_id++; 506f0a39ae738d660cb69e486abd20c0dec1cdcb898George continue; 507f0a39ae738d660cb69e486abd20c0dec1cdcb898George } else { 508f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, 509f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "eRf Off/Sleep: %d times TcbBusyQueue[%d] =%d before doze!\n", 510f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches i + 1, queue_id, 511f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches skb_queue_len(&ring->queue)); 512f0a39ae738d660cb69e486abd20c0dec1cdcb898George udelay(10); 513f0a39ae738d660cb69e486abd20c0dec1cdcb898George i++; 514f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 515f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (i >= MAX_DOZE_WAITING_TIMES_9x) { 516f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, 517f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "ERFSLEEP: %d times TcbBusyQueue[%d] = %d !\n", 518f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches MAX_DOZE_WAITING_TIMES_9x, 519f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches queue_id, 520f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches skb_queue_len(&ring->queue)); 521f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 522f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 523f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 524f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG, 525f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "Set ERFSLEEP awaked:%d ms\n", 526f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches jiffies_to_msecs(jiffies - ppsc->last_awake_jiffies)); 527f0a39ae738d660cb69e486abd20c0dec1cdcb898George ppsc->last_sleep_jiffies = jiffies; 5281472d3a87586eb7529d1d85f7c888055650b7208Larry Finger _rtl92c_phy_set_rf_sleep(hw); 529f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 530f0a39ae738d660cb69e486abd20c0dec1cdcb898George default: 531f0a39ae738d660cb69e486abd20c0dec1cdcb898George RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 532f30d7507a8116e2099a9135c873411db8c0a3dc6Joe Perches "switch case not processed\n"); 533f0a39ae738d660cb69e486abd20c0dec1cdcb898George bresult = false; 534f0a39ae738d660cb69e486abd20c0dec1cdcb898George break; 535f0a39ae738d660cb69e486abd20c0dec1cdcb898George } 536f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (bresult) 537f0a39ae738d660cb69e486abd20c0dec1cdcb898George ppsc->rfpwr_state = rfpwr_state; 538f0a39ae738d660cb69e486abd20c0dec1cdcb898George return bresult; 539f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 540f0a39ae738d660cb69e486abd20c0dec1cdcb898George 5411472d3a87586eb7529d1d85f7c888055650b7208Larry Fingerbool rtl92cu_phy_set_rf_power_state(struct ieee80211_hw *hw, 542d3bb1429a2c1470d1f84646c00e34dc6784ee06eLarry Finger enum rf_pwrstate rfpwr_state) 543f0a39ae738d660cb69e486abd20c0dec1cdcb898George{ 544f0a39ae738d660cb69e486abd20c0dec1cdcb898George struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 545f0a39ae738d660cb69e486abd20c0dec1cdcb898George bool bresult = false; 546f0a39ae738d660cb69e486abd20c0dec1cdcb898George 547f0a39ae738d660cb69e486abd20c0dec1cdcb898George if (rfpwr_state == ppsc->rfpwr_state) 548f0a39ae738d660cb69e486abd20c0dec1cdcb898George return bresult; 5491472d3a87586eb7529d1d85f7c888055650b7208Larry Finger bresult = _rtl92cu_phy_set_rf_power_state(hw, rfpwr_state); 550f0a39ae738d660cb69e486abd20c0dec1cdcb898George return bresult; 551f0a39ae738d660cb69e486abd20c0dec1cdcb898George} 552