162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* Copyright(c) 2009-2012 Realtek Corporation.*/ 362306a36Sopenharmony_ci 462306a36Sopenharmony_ci#include "../wifi.h" 562306a36Sopenharmony_ci#include "../efuse.h" 662306a36Sopenharmony_ci#include "../base.h" 762306a36Sopenharmony_ci#include "../regd.h" 862306a36Sopenharmony_ci#include "../cam.h" 962306a36Sopenharmony_ci#include "../ps.h" 1062306a36Sopenharmony_ci#include "../pci.h" 1162306a36Sopenharmony_ci#include "reg.h" 1262306a36Sopenharmony_ci#include "def.h" 1362306a36Sopenharmony_ci#include "phy.h" 1462306a36Sopenharmony_ci#include "../rtl8192c/dm_common.h" 1562306a36Sopenharmony_ci#include "../rtl8192c/fw_common.h" 1662306a36Sopenharmony_ci#include "../rtl8192c/phy_common.h" 1762306a36Sopenharmony_ci#include "dm.h" 1862306a36Sopenharmony_ci#include "led.h" 1962306a36Sopenharmony_ci#include "hw.h" 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci#define LLT_CONFIG 5 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_cistatic void _rtl92ce_set_bcn_ctrl_reg(struct ieee80211_hw *hw, 2462306a36Sopenharmony_ci u8 set_bits, u8 clear_bits) 2562306a36Sopenharmony_ci{ 2662306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 2762306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci rtlpci->reg_bcn_ctrl_val |= set_bits; 3062306a36Sopenharmony_ci rtlpci->reg_bcn_ctrl_val &= ~clear_bits; 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_BCN_CTRL, (u8)rtlpci->reg_bcn_ctrl_val); 3362306a36Sopenharmony_ci} 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_cistatic void _rtl92ce_stop_tx_beacon(struct ieee80211_hw *hw) 3662306a36Sopenharmony_ci{ 3762306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 3862306a36Sopenharmony_ci u8 tmp1byte; 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_ci tmp1byte = rtl_read_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2); 4162306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2, tmp1byte & (~BIT(6))); 4262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 1, 0x64); 4362306a36Sopenharmony_ci tmp1byte = rtl_read_byte(rtlpriv, REG_TBTT_PROHIBIT + 2); 4462306a36Sopenharmony_ci tmp1byte &= ~(BIT(0)); 4562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 2, tmp1byte); 4662306a36Sopenharmony_ci} 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_cistatic void _rtl92ce_resume_tx_beacon(struct ieee80211_hw *hw) 4962306a36Sopenharmony_ci{ 5062306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 5162306a36Sopenharmony_ci u8 tmp1byte; 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci tmp1byte = rtl_read_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2); 5462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2, tmp1byte | BIT(6)); 5562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 1, 0xff); 5662306a36Sopenharmony_ci tmp1byte = rtl_read_byte(rtlpriv, REG_TBTT_PROHIBIT + 2); 5762306a36Sopenharmony_ci tmp1byte |= BIT(0); 5862306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 2, tmp1byte); 5962306a36Sopenharmony_ci} 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_cistatic void _rtl92ce_enable_bcn_sub_func(struct ieee80211_hw *hw) 6262306a36Sopenharmony_ci{ 6362306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, 0, BIT(1)); 6462306a36Sopenharmony_ci} 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_cistatic void _rtl92ce_disable_bcn_sub_func(struct ieee80211_hw *hw) 6762306a36Sopenharmony_ci{ 6862306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, BIT(1), 0); 6962306a36Sopenharmony_ci} 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_civoid rtl92ce_get_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val) 7262306a36Sopenharmony_ci{ 7362306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 7462306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 7562306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 7662306a36Sopenharmony_ci 7762306a36Sopenharmony_ci switch (variable) { 7862306a36Sopenharmony_ci case HW_VAR_RCR: 7962306a36Sopenharmony_ci *((u32 *) (val)) = rtlpci->receive_config; 8062306a36Sopenharmony_ci break; 8162306a36Sopenharmony_ci case HW_VAR_RF_STATE: 8262306a36Sopenharmony_ci *((enum rf_pwrstate *)(val)) = ppsc->rfpwr_state; 8362306a36Sopenharmony_ci break; 8462306a36Sopenharmony_ci case HW_VAR_FWLPS_RF_ON:{ 8562306a36Sopenharmony_ci enum rf_pwrstate rfstate; 8662306a36Sopenharmony_ci u32 val_rcr; 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci rtlpriv->cfg->ops->get_hw_reg(hw, 8962306a36Sopenharmony_ci HW_VAR_RF_STATE, 9062306a36Sopenharmony_ci (u8 *)(&rfstate)); 9162306a36Sopenharmony_ci if (rfstate == ERFOFF) { 9262306a36Sopenharmony_ci *((bool *) (val)) = true; 9362306a36Sopenharmony_ci } else { 9462306a36Sopenharmony_ci val_rcr = rtl_read_dword(rtlpriv, REG_RCR); 9562306a36Sopenharmony_ci val_rcr &= 0x00070000; 9662306a36Sopenharmony_ci if (val_rcr) 9762306a36Sopenharmony_ci *((bool *) (val)) = false; 9862306a36Sopenharmony_ci else 9962306a36Sopenharmony_ci *((bool *) (val)) = true; 10062306a36Sopenharmony_ci } 10162306a36Sopenharmony_ci break; 10262306a36Sopenharmony_ci } 10362306a36Sopenharmony_ci case HW_VAR_FW_PSMODE_STATUS: 10462306a36Sopenharmony_ci *((bool *) (val)) = ppsc->fw_current_inpsmode; 10562306a36Sopenharmony_ci break; 10662306a36Sopenharmony_ci case HW_VAR_CORRECT_TSF:{ 10762306a36Sopenharmony_ci u64 tsf; 10862306a36Sopenharmony_ci u32 *ptsf_low = (u32 *)&tsf; 10962306a36Sopenharmony_ci u32 *ptsf_high = ((u32 *)&tsf) + 1; 11062306a36Sopenharmony_ci 11162306a36Sopenharmony_ci *ptsf_high = rtl_read_dword(rtlpriv, (REG_TSFTR + 4)); 11262306a36Sopenharmony_ci *ptsf_low = rtl_read_dword(rtlpriv, REG_TSFTR); 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_ci *((u64 *) (val)) = tsf; 11562306a36Sopenharmony_ci 11662306a36Sopenharmony_ci break; 11762306a36Sopenharmony_ci } 11862306a36Sopenharmony_ci case HAL_DEF_WOWLAN: 11962306a36Sopenharmony_ci break; 12062306a36Sopenharmony_ci default: 12162306a36Sopenharmony_ci pr_err("switch case %#x not processed\n", variable); 12262306a36Sopenharmony_ci break; 12362306a36Sopenharmony_ci } 12462306a36Sopenharmony_ci} 12562306a36Sopenharmony_ci 12662306a36Sopenharmony_civoid rtl92ce_set_hw_reg(struct ieee80211_hw *hw, u8 variable, u8 *val) 12762306a36Sopenharmony_ci{ 12862306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 12962306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 13062306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 13162306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 13262306a36Sopenharmony_ci struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw)); 13362306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 13462306a36Sopenharmony_ci u8 idx; 13562306a36Sopenharmony_ci 13662306a36Sopenharmony_ci switch (variable) { 13762306a36Sopenharmony_ci case HW_VAR_ETHER_ADDR:{ 13862306a36Sopenharmony_ci for (idx = 0; idx < ETH_ALEN; idx++) { 13962306a36Sopenharmony_ci rtl_write_byte(rtlpriv, (REG_MACID + idx), 14062306a36Sopenharmony_ci val[idx]); 14162306a36Sopenharmony_ci } 14262306a36Sopenharmony_ci break; 14362306a36Sopenharmony_ci } 14462306a36Sopenharmony_ci case HW_VAR_BASIC_RATE:{ 14562306a36Sopenharmony_ci u16 rate_cfg = ((u16 *) val)[0]; 14662306a36Sopenharmony_ci u8 rate_index = 0; 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_ci rate_cfg &= 0x15f; 14962306a36Sopenharmony_ci rate_cfg |= 0x01; 15062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RRSR, rate_cfg & 0xff); 15162306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RRSR + 1, 15262306a36Sopenharmony_ci (rate_cfg >> 8) & 0xff); 15362306a36Sopenharmony_ci while (rate_cfg > 0x1) { 15462306a36Sopenharmony_ci rate_cfg = (rate_cfg >> 1); 15562306a36Sopenharmony_ci rate_index++; 15662306a36Sopenharmony_ci } 15762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_INIRTS_RATE_SEL, 15862306a36Sopenharmony_ci rate_index); 15962306a36Sopenharmony_ci break; 16062306a36Sopenharmony_ci } 16162306a36Sopenharmony_ci case HW_VAR_BSSID:{ 16262306a36Sopenharmony_ci for (idx = 0; idx < ETH_ALEN; idx++) { 16362306a36Sopenharmony_ci rtl_write_byte(rtlpriv, (REG_BSSID + idx), 16462306a36Sopenharmony_ci val[idx]); 16562306a36Sopenharmony_ci } 16662306a36Sopenharmony_ci break; 16762306a36Sopenharmony_ci } 16862306a36Sopenharmony_ci case HW_VAR_SIFS:{ 16962306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SIFS_CTX + 1, val[0]); 17062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SIFS_TRX + 1, val[1]); 17162306a36Sopenharmony_ci 17262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SPEC_SIFS + 1, val[0]); 17362306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_MAC_SPEC_SIFS + 1, val[0]); 17462306a36Sopenharmony_ci 17562306a36Sopenharmony_ci if (!mac->ht_enable) 17662306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_RESP_SIFS_OFDM, 17762306a36Sopenharmony_ci 0x0e0e); 17862306a36Sopenharmony_ci else 17962306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_RESP_SIFS_OFDM, 18062306a36Sopenharmony_ci *((u16 *) val)); 18162306a36Sopenharmony_ci break; 18262306a36Sopenharmony_ci } 18362306a36Sopenharmony_ci case HW_VAR_SLOT_TIME:{ 18462306a36Sopenharmony_ci u8 e_aci; 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_MLME, DBG_LOUD, 18762306a36Sopenharmony_ci "HW_VAR_SLOT_TIME %x\n", val[0]); 18862306a36Sopenharmony_ci 18962306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SLOT, val[0]); 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci for (e_aci = 0; e_aci < AC_MAX; e_aci++) { 19262306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 19362306a36Sopenharmony_ci HW_VAR_AC_PARAM, 19462306a36Sopenharmony_ci &e_aci); 19562306a36Sopenharmony_ci } 19662306a36Sopenharmony_ci break; 19762306a36Sopenharmony_ci } 19862306a36Sopenharmony_ci case HW_VAR_ACK_PREAMBLE:{ 19962306a36Sopenharmony_ci u8 reg_tmp; 20062306a36Sopenharmony_ci u8 short_preamble = (bool)*val; 20162306a36Sopenharmony_ci 20262306a36Sopenharmony_ci reg_tmp = (mac->cur_40_prime_sc) << 5; 20362306a36Sopenharmony_ci if (short_preamble) 20462306a36Sopenharmony_ci reg_tmp |= 0x80; 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RRSR + 2, reg_tmp); 20762306a36Sopenharmony_ci break; 20862306a36Sopenharmony_ci } 20962306a36Sopenharmony_ci case HW_VAR_AMPDU_MIN_SPACE:{ 21062306a36Sopenharmony_ci u8 min_spacing_to_set; 21162306a36Sopenharmony_ci u8 sec_min_space; 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci min_spacing_to_set = *val; 21462306a36Sopenharmony_ci if (min_spacing_to_set <= 7) { 21562306a36Sopenharmony_ci sec_min_space = 0; 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_ci if (min_spacing_to_set < sec_min_space) 21862306a36Sopenharmony_ci min_spacing_to_set = sec_min_space; 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_ci mac->min_space_cfg = ((mac->min_space_cfg & 22162306a36Sopenharmony_ci 0xf8) | 22262306a36Sopenharmony_ci min_spacing_to_set); 22362306a36Sopenharmony_ci 22462306a36Sopenharmony_ci *val = min_spacing_to_set; 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_MLME, DBG_LOUD, 22762306a36Sopenharmony_ci "Set HW_VAR_AMPDU_MIN_SPACE: %#x\n", 22862306a36Sopenharmony_ci mac->min_space_cfg); 22962306a36Sopenharmony_ci 23062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_AMPDU_MIN_SPACE, 23162306a36Sopenharmony_ci mac->min_space_cfg); 23262306a36Sopenharmony_ci } 23362306a36Sopenharmony_ci break; 23462306a36Sopenharmony_ci } 23562306a36Sopenharmony_ci case HW_VAR_SHORTGI_DENSITY:{ 23662306a36Sopenharmony_ci u8 density_to_set; 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_ci density_to_set = *val; 23962306a36Sopenharmony_ci mac->min_space_cfg |= (density_to_set << 3); 24062306a36Sopenharmony_ci 24162306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_MLME, DBG_LOUD, 24262306a36Sopenharmony_ci "Set HW_VAR_SHORTGI_DENSITY: %#x\n", 24362306a36Sopenharmony_ci mac->min_space_cfg); 24462306a36Sopenharmony_ci 24562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_AMPDU_MIN_SPACE, 24662306a36Sopenharmony_ci mac->min_space_cfg); 24762306a36Sopenharmony_ci 24862306a36Sopenharmony_ci break; 24962306a36Sopenharmony_ci } 25062306a36Sopenharmony_ci case HW_VAR_AMPDU_FACTOR:{ 25162306a36Sopenharmony_ci u8 regtoset_normal[4] = {0x41, 0xa8, 0x72, 0xb9}; 25262306a36Sopenharmony_ci u8 regtoset_bt[4] = {0x31, 0x74, 0x42, 0x97}; 25362306a36Sopenharmony_ci 25462306a36Sopenharmony_ci u8 factor_toset; 25562306a36Sopenharmony_ci u8 *p_regtoset = NULL; 25662306a36Sopenharmony_ci u8 index = 0; 25762306a36Sopenharmony_ci 25862306a36Sopenharmony_ci if ((rtlpriv->btcoexist.bt_coexistence) && 25962306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_coexist_type == 26062306a36Sopenharmony_ci BT_CSR_BC4)) 26162306a36Sopenharmony_ci p_regtoset = regtoset_bt; 26262306a36Sopenharmony_ci else 26362306a36Sopenharmony_ci p_regtoset = regtoset_normal; 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_ci factor_toset = *(val); 26662306a36Sopenharmony_ci if (factor_toset <= 3) { 26762306a36Sopenharmony_ci factor_toset = (1 << (factor_toset + 2)); 26862306a36Sopenharmony_ci if (factor_toset > 0xf) 26962306a36Sopenharmony_ci factor_toset = 0xf; 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci for (index = 0; index < 4; index++) { 27262306a36Sopenharmony_ci if ((p_regtoset[index] & 0xf0) > 27362306a36Sopenharmony_ci (factor_toset << 4)) 27462306a36Sopenharmony_ci p_regtoset[index] = 27562306a36Sopenharmony_ci (p_regtoset[index] & 0x0f) | 27662306a36Sopenharmony_ci (factor_toset << 4); 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_ci if ((p_regtoset[index] & 0x0f) > 27962306a36Sopenharmony_ci factor_toset) 28062306a36Sopenharmony_ci p_regtoset[index] = 28162306a36Sopenharmony_ci (p_regtoset[index] & 0xf0) | 28262306a36Sopenharmony_ci (factor_toset); 28362306a36Sopenharmony_ci 28462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 28562306a36Sopenharmony_ci (REG_AGGLEN_LMT + index), 28662306a36Sopenharmony_ci p_regtoset[index]); 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci } 28962306a36Sopenharmony_ci 29062306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_MLME, DBG_LOUD, 29162306a36Sopenharmony_ci "Set HW_VAR_AMPDU_FACTOR: %#x\n", 29262306a36Sopenharmony_ci factor_toset); 29362306a36Sopenharmony_ci } 29462306a36Sopenharmony_ci break; 29562306a36Sopenharmony_ci } 29662306a36Sopenharmony_ci case HW_VAR_AC_PARAM:{ 29762306a36Sopenharmony_ci u8 e_aci = *(val); 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci rtl92c_dm_init_edca_turbo(hw); 30062306a36Sopenharmony_ci 30162306a36Sopenharmony_ci if (rtlpci->acm_method != EACMWAY2_SW) 30262306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 30362306a36Sopenharmony_ci HW_VAR_ACM_CTRL, 30462306a36Sopenharmony_ci (&e_aci)); 30562306a36Sopenharmony_ci break; 30662306a36Sopenharmony_ci } 30762306a36Sopenharmony_ci case HW_VAR_ACM_CTRL:{ 30862306a36Sopenharmony_ci u8 e_aci = *(val); 30962306a36Sopenharmony_ci union aci_aifsn *p_aci_aifsn = 31062306a36Sopenharmony_ci (union aci_aifsn *)(&(mac->ac[0].aifs)); 31162306a36Sopenharmony_ci u8 acm = p_aci_aifsn->f.acm; 31262306a36Sopenharmony_ci u8 acm_ctrl = rtl_read_byte(rtlpriv, REG_ACMHWCTRL); 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci acm_ctrl = 31562306a36Sopenharmony_ci acm_ctrl | ((rtlpci->acm_method == 2) ? 0x0 : 0x1); 31662306a36Sopenharmony_ci 31762306a36Sopenharmony_ci if (acm) { 31862306a36Sopenharmony_ci switch (e_aci) { 31962306a36Sopenharmony_ci case AC0_BE: 32062306a36Sopenharmony_ci acm_ctrl |= ACMHW_BEQEN; 32162306a36Sopenharmony_ci break; 32262306a36Sopenharmony_ci case AC2_VI: 32362306a36Sopenharmony_ci acm_ctrl |= ACMHW_VIQEN; 32462306a36Sopenharmony_ci break; 32562306a36Sopenharmony_ci case AC3_VO: 32662306a36Sopenharmony_ci acm_ctrl |= ACMHW_VOQEN; 32762306a36Sopenharmony_ci break; 32862306a36Sopenharmony_ci default: 32962306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_ERR, DBG_WARNING, 33062306a36Sopenharmony_ci "HW_VAR_ACM_CTRL acm set failed: eACI is %d\n", 33162306a36Sopenharmony_ci acm); 33262306a36Sopenharmony_ci break; 33362306a36Sopenharmony_ci } 33462306a36Sopenharmony_ci } else { 33562306a36Sopenharmony_ci switch (e_aci) { 33662306a36Sopenharmony_ci case AC0_BE: 33762306a36Sopenharmony_ci acm_ctrl &= (~ACMHW_BEQEN); 33862306a36Sopenharmony_ci break; 33962306a36Sopenharmony_ci case AC2_VI: 34062306a36Sopenharmony_ci acm_ctrl &= (~ACMHW_VIQEN); 34162306a36Sopenharmony_ci break; 34262306a36Sopenharmony_ci case AC3_VO: 34362306a36Sopenharmony_ci acm_ctrl &= (~ACMHW_VOQEN); 34462306a36Sopenharmony_ci break; 34562306a36Sopenharmony_ci default: 34662306a36Sopenharmony_ci pr_err("switch case %#x not processed\n", 34762306a36Sopenharmony_ci e_aci); 34862306a36Sopenharmony_ci break; 34962306a36Sopenharmony_ci } 35062306a36Sopenharmony_ci } 35162306a36Sopenharmony_ci 35262306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_QOS, DBG_TRACE, 35362306a36Sopenharmony_ci "SetHwReg8190pci(): [HW_VAR_ACM_CTRL] Write 0x%X\n", 35462306a36Sopenharmony_ci acm_ctrl); 35562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_ACMHWCTRL, acm_ctrl); 35662306a36Sopenharmony_ci break; 35762306a36Sopenharmony_ci } 35862306a36Sopenharmony_ci case HW_VAR_RCR:{ 35962306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RCR, ((u32 *) (val))[0]); 36062306a36Sopenharmony_ci rtlpci->receive_config = ((u32 *) (val))[0]; 36162306a36Sopenharmony_ci break; 36262306a36Sopenharmony_ci } 36362306a36Sopenharmony_ci case HW_VAR_RETRY_LIMIT:{ 36462306a36Sopenharmony_ci u8 retry_limit = val[0]; 36562306a36Sopenharmony_ci 36662306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_RL, 36762306a36Sopenharmony_ci retry_limit << RETRY_LIMIT_SHORT_SHIFT | 36862306a36Sopenharmony_ci retry_limit << RETRY_LIMIT_LONG_SHIFT); 36962306a36Sopenharmony_ci break; 37062306a36Sopenharmony_ci } 37162306a36Sopenharmony_ci case HW_VAR_DUAL_TSF_RST: 37262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_DUAL_TSF_RST, (BIT(0) | BIT(1))); 37362306a36Sopenharmony_ci break; 37462306a36Sopenharmony_ci case HW_VAR_EFUSE_BYTES: 37562306a36Sopenharmony_ci rtlefuse->efuse_usedbytes = *((u16 *) val); 37662306a36Sopenharmony_ci break; 37762306a36Sopenharmony_ci case HW_VAR_EFUSE_USAGE: 37862306a36Sopenharmony_ci rtlefuse->efuse_usedpercentage = *val; 37962306a36Sopenharmony_ci break; 38062306a36Sopenharmony_ci case HW_VAR_IO_CMD: 38162306a36Sopenharmony_ci rtl92c_phy_set_io_cmd(hw, (*(enum io_type *)val)); 38262306a36Sopenharmony_ci break; 38362306a36Sopenharmony_ci case HW_VAR_WPA_CONFIG: 38462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SECCFG, *val); 38562306a36Sopenharmony_ci break; 38662306a36Sopenharmony_ci case HW_VAR_SET_RPWM:{ 38762306a36Sopenharmony_ci u8 rpwm_val; 38862306a36Sopenharmony_ci 38962306a36Sopenharmony_ci rpwm_val = rtl_read_byte(rtlpriv, REG_PCIE_HRPWM); 39062306a36Sopenharmony_ci udelay(1); 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci if (rpwm_val & BIT(7)) { 39362306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_PCIE_HRPWM, *val); 39462306a36Sopenharmony_ci } else { 39562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_PCIE_HRPWM, 39662306a36Sopenharmony_ci *val | BIT(7)); 39762306a36Sopenharmony_ci } 39862306a36Sopenharmony_ci 39962306a36Sopenharmony_ci break; 40062306a36Sopenharmony_ci } 40162306a36Sopenharmony_ci case HW_VAR_H2C_FW_PWRMODE:{ 40262306a36Sopenharmony_ci u8 psmode = *val; 40362306a36Sopenharmony_ci 40462306a36Sopenharmony_ci if ((psmode != FW_PS_ACTIVE_MODE) && 40562306a36Sopenharmony_ci (!IS_92C_SERIAL(rtlhal->version))) { 40662306a36Sopenharmony_ci rtl92c_dm_rf_saving(hw, true); 40762306a36Sopenharmony_ci } 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci rtl92c_set_fw_pwrmode_cmd(hw, *val); 41062306a36Sopenharmony_ci break; 41162306a36Sopenharmony_ci } 41262306a36Sopenharmony_ci case HW_VAR_FW_PSMODE_STATUS: 41362306a36Sopenharmony_ci ppsc->fw_current_inpsmode = *((bool *) val); 41462306a36Sopenharmony_ci break; 41562306a36Sopenharmony_ci case HW_VAR_H2C_FW_JOINBSSRPT:{ 41662306a36Sopenharmony_ci u8 mstatus = *val; 41762306a36Sopenharmony_ci u8 tmp_regcr, tmp_reg422; 41862306a36Sopenharmony_ci bool recover = false; 41962306a36Sopenharmony_ci 42062306a36Sopenharmony_ci if (mstatus == RT_MEDIA_CONNECT) { 42162306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AID, 42262306a36Sopenharmony_ci NULL); 42362306a36Sopenharmony_ci 42462306a36Sopenharmony_ci tmp_regcr = rtl_read_byte(rtlpriv, REG_CR + 1); 42562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_CR + 1, 42662306a36Sopenharmony_ci (tmp_regcr | BIT(0))); 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, 0, BIT(3)); 42962306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, BIT(4), 0); 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_ci tmp_reg422 = 43262306a36Sopenharmony_ci rtl_read_byte(rtlpriv, 43362306a36Sopenharmony_ci REG_FWHW_TXQ_CTRL + 2); 43462306a36Sopenharmony_ci if (tmp_reg422 & BIT(6)) 43562306a36Sopenharmony_ci recover = true; 43662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 2, 43762306a36Sopenharmony_ci tmp_reg422 & (~BIT(6))); 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_ci rtl92c_set_fw_rsvdpagepkt(hw, NULL); 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, BIT(3), 0); 44262306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, 0, BIT(4)); 44362306a36Sopenharmony_ci 44462306a36Sopenharmony_ci if (recover) { 44562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 44662306a36Sopenharmony_ci REG_FWHW_TXQ_CTRL + 2, 44762306a36Sopenharmony_ci tmp_reg422); 44862306a36Sopenharmony_ci } 44962306a36Sopenharmony_ci 45062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_CR + 1, 45162306a36Sopenharmony_ci (tmp_regcr & ~(BIT(0)))); 45262306a36Sopenharmony_ci } 45362306a36Sopenharmony_ci rtl92c_set_fw_joinbss_report_cmd(hw, *val); 45462306a36Sopenharmony_ci 45562306a36Sopenharmony_ci break; 45662306a36Sopenharmony_ci } 45762306a36Sopenharmony_ci case HW_VAR_H2C_FW_P2P_PS_OFFLOAD: 45862306a36Sopenharmony_ci rtl92c_set_p2p_ps_offload_cmd(hw, *val); 45962306a36Sopenharmony_ci break; 46062306a36Sopenharmony_ci case HW_VAR_AID:{ 46162306a36Sopenharmony_ci u16 u2btmp; 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_ci u2btmp = rtl_read_word(rtlpriv, REG_BCN_PSR_RPT); 46462306a36Sopenharmony_ci u2btmp &= 0xC000; 46562306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_BCN_PSR_RPT, (u2btmp | 46662306a36Sopenharmony_ci mac->assoc_id)); 46762306a36Sopenharmony_ci 46862306a36Sopenharmony_ci break; 46962306a36Sopenharmony_ci } 47062306a36Sopenharmony_ci case HW_VAR_CORRECT_TSF:{ 47162306a36Sopenharmony_ci u8 btype_ibss = val[0]; 47262306a36Sopenharmony_ci 47362306a36Sopenharmony_ci if (btype_ibss) 47462306a36Sopenharmony_ci _rtl92ce_stop_tx_beacon(hw); 47562306a36Sopenharmony_ci 47662306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, 0, BIT(3)); 47762306a36Sopenharmony_ci 47862306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_TSFTR, 47962306a36Sopenharmony_ci (u32) (mac->tsf & 0xffffffff)); 48062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_TSFTR + 4, 48162306a36Sopenharmony_ci (u32) ((mac->tsf >> 32) & 0xffffffff)); 48262306a36Sopenharmony_ci 48362306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, BIT(3), 0); 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci if (btype_ibss) 48662306a36Sopenharmony_ci _rtl92ce_resume_tx_beacon(hw); 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci break; 48962306a36Sopenharmony_ci 49062306a36Sopenharmony_ci } 49162306a36Sopenharmony_ci case HW_VAR_FW_LPS_ACTION: { 49262306a36Sopenharmony_ci bool enter_fwlps = *((bool *)val); 49362306a36Sopenharmony_ci u8 rpwm_val, fw_pwrmode; 49462306a36Sopenharmony_ci bool fw_current_inps; 49562306a36Sopenharmony_ci 49662306a36Sopenharmony_ci if (enter_fwlps) { 49762306a36Sopenharmony_ci rpwm_val = 0x02; /* RF off */ 49862306a36Sopenharmony_ci fw_current_inps = true; 49962306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 50062306a36Sopenharmony_ci HW_VAR_FW_PSMODE_STATUS, 50162306a36Sopenharmony_ci (u8 *)(&fw_current_inps)); 50262306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 50362306a36Sopenharmony_ci HW_VAR_H2C_FW_PWRMODE, 50462306a36Sopenharmony_ci &ppsc->fwctrl_psmode); 50562306a36Sopenharmony_ci 50662306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 50762306a36Sopenharmony_ci HW_VAR_SET_RPWM, 50862306a36Sopenharmony_ci &rpwm_val); 50962306a36Sopenharmony_ci } else { 51062306a36Sopenharmony_ci rpwm_val = 0x0C; /* RF on */ 51162306a36Sopenharmony_ci fw_pwrmode = FW_PS_ACTIVE_MODE; 51262306a36Sopenharmony_ci fw_current_inps = false; 51362306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 51462306a36Sopenharmony_ci HW_VAR_SET_RPWM, 51562306a36Sopenharmony_ci &rpwm_val); 51662306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 51762306a36Sopenharmony_ci HW_VAR_H2C_FW_PWRMODE, 51862306a36Sopenharmony_ci &fw_pwrmode); 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 52162306a36Sopenharmony_ci HW_VAR_FW_PSMODE_STATUS, 52262306a36Sopenharmony_ci (u8 *)(&fw_current_inps)); 52362306a36Sopenharmony_ci } 52462306a36Sopenharmony_ci break; } 52562306a36Sopenharmony_ci case HW_VAR_KEEP_ALIVE: { 52662306a36Sopenharmony_ci u8 array[2]; 52762306a36Sopenharmony_ci 52862306a36Sopenharmony_ci array[0] = 0xff; 52962306a36Sopenharmony_ci array[1] = *((u8 *)val); 53062306a36Sopenharmony_ci rtl92c_fill_h2c_cmd(hw, H2C_92C_KEEP_ALIVE_CTRL, 2, array); 53162306a36Sopenharmony_ci break; } 53262306a36Sopenharmony_ci default: 53362306a36Sopenharmony_ci pr_err("switch case %d not processed\n", variable); 53462306a36Sopenharmony_ci break; 53562306a36Sopenharmony_ci } 53662306a36Sopenharmony_ci} 53762306a36Sopenharmony_ci 53862306a36Sopenharmony_cistatic bool _rtl92ce_llt_write(struct ieee80211_hw *hw, u32 address, u32 data) 53962306a36Sopenharmony_ci{ 54062306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 54162306a36Sopenharmony_ci bool status = true; 54262306a36Sopenharmony_ci long count = 0; 54362306a36Sopenharmony_ci u32 value = _LLT_INIT_ADDR(address) | 54462306a36Sopenharmony_ci _LLT_INIT_DATA(data) | _LLT_OP(_LLT_WRITE_ACCESS); 54562306a36Sopenharmony_ci 54662306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_LLT_INIT, value); 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci do { 54962306a36Sopenharmony_ci value = rtl_read_dword(rtlpriv, REG_LLT_INIT); 55062306a36Sopenharmony_ci if (_LLT_NO_ACTIVE == _LLT_OP_VALUE(value)) 55162306a36Sopenharmony_ci break; 55262306a36Sopenharmony_ci 55362306a36Sopenharmony_ci if (count > POLLING_LLT_THRESHOLD) { 55462306a36Sopenharmony_ci pr_err("Failed to polling write LLT done at address %d!\n", 55562306a36Sopenharmony_ci address); 55662306a36Sopenharmony_ci status = false; 55762306a36Sopenharmony_ci break; 55862306a36Sopenharmony_ci } 55962306a36Sopenharmony_ci } while (++count); 56062306a36Sopenharmony_ci 56162306a36Sopenharmony_ci return status; 56262306a36Sopenharmony_ci} 56362306a36Sopenharmony_ci 56462306a36Sopenharmony_cistatic bool _rtl92ce_llt_table_init(struct ieee80211_hw *hw) 56562306a36Sopenharmony_ci{ 56662306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 56762306a36Sopenharmony_ci unsigned short i; 56862306a36Sopenharmony_ci u8 txpktbuf_bndy; 56962306a36Sopenharmony_ci u8 maxpage; 57062306a36Sopenharmony_ci bool status; 57162306a36Sopenharmony_ci 57262306a36Sopenharmony_ci#if LLT_CONFIG == 1 57362306a36Sopenharmony_ci maxpage = 255; 57462306a36Sopenharmony_ci txpktbuf_bndy = 252; 57562306a36Sopenharmony_ci#elif LLT_CONFIG == 2 57662306a36Sopenharmony_ci maxpage = 127; 57762306a36Sopenharmony_ci txpktbuf_bndy = 124; 57862306a36Sopenharmony_ci#elif LLT_CONFIG == 3 57962306a36Sopenharmony_ci maxpage = 255; 58062306a36Sopenharmony_ci txpktbuf_bndy = 174; 58162306a36Sopenharmony_ci#elif LLT_CONFIG == 4 58262306a36Sopenharmony_ci maxpage = 255; 58362306a36Sopenharmony_ci txpktbuf_bndy = 246; 58462306a36Sopenharmony_ci#elif LLT_CONFIG == 5 58562306a36Sopenharmony_ci maxpage = 255; 58662306a36Sopenharmony_ci txpktbuf_bndy = 246; 58762306a36Sopenharmony_ci#endif 58862306a36Sopenharmony_ci 58962306a36Sopenharmony_ci#if LLT_CONFIG == 1 59062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RQPN_NPQ, 0x1c); 59162306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RQPN, 0x80a71c1c); 59262306a36Sopenharmony_ci#elif LLT_CONFIG == 2 59362306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RQPN, 0x845B1010); 59462306a36Sopenharmony_ci#elif LLT_CONFIG == 3 59562306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RQPN, 0x84838484); 59662306a36Sopenharmony_ci#elif LLT_CONFIG == 4 59762306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RQPN, 0x80bd1c1c); 59862306a36Sopenharmony_ci#elif LLT_CONFIG == 5 59962306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_RQPN_NPQ, 0x0000); 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RQPN, 0x80b01c29); 60262306a36Sopenharmony_ci#endif 60362306a36Sopenharmony_ci 60462306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_TRXFF_BNDY, (0x27FF0000 | txpktbuf_bndy)); 60562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TDECTRL + 1, txpktbuf_bndy); 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TXPKTBUF_BCNQ_BDNY, txpktbuf_bndy); 60862306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TXPKTBUF_MGQ_BDNY, txpktbuf_bndy); 60962306a36Sopenharmony_ci 61062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x45D, txpktbuf_bndy); 61162306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_PBP, 0x11); 61262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RX_DRVINFO_SZ, 0x4); 61362306a36Sopenharmony_ci 61462306a36Sopenharmony_ci for (i = 0; i < (txpktbuf_bndy - 1); i++) { 61562306a36Sopenharmony_ci status = _rtl92ce_llt_write(hw, i, i + 1); 61662306a36Sopenharmony_ci if (!status) 61762306a36Sopenharmony_ci return status; 61862306a36Sopenharmony_ci } 61962306a36Sopenharmony_ci 62062306a36Sopenharmony_ci status = _rtl92ce_llt_write(hw, (txpktbuf_bndy - 1), 0xFF); 62162306a36Sopenharmony_ci if (!status) 62262306a36Sopenharmony_ci return status; 62362306a36Sopenharmony_ci 62462306a36Sopenharmony_ci for (i = txpktbuf_bndy; i < maxpage; i++) { 62562306a36Sopenharmony_ci status = _rtl92ce_llt_write(hw, i, (i + 1)); 62662306a36Sopenharmony_ci if (!status) 62762306a36Sopenharmony_ci return status; 62862306a36Sopenharmony_ci } 62962306a36Sopenharmony_ci 63062306a36Sopenharmony_ci status = _rtl92ce_llt_write(hw, maxpage, txpktbuf_bndy); 63162306a36Sopenharmony_ci if (!status) 63262306a36Sopenharmony_ci return status; 63362306a36Sopenharmony_ci 63462306a36Sopenharmony_ci return true; 63562306a36Sopenharmony_ci} 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_cistatic void _rtl92ce_gen_refresh_led_state(struct ieee80211_hw *hw) 63862306a36Sopenharmony_ci{ 63962306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 64062306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 64162306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 64262306a36Sopenharmony_ci enum rtl_led_pin pin0 = rtlpriv->ledctl.sw_led0; 64362306a36Sopenharmony_ci 64462306a36Sopenharmony_ci if (rtlpci->up_first_time) 64562306a36Sopenharmony_ci return; 64662306a36Sopenharmony_ci 64762306a36Sopenharmony_ci if (ppsc->rfoff_reason == RF_CHANGE_BY_IPS) 64862306a36Sopenharmony_ci rtl92ce_sw_led_on(hw, pin0); 64962306a36Sopenharmony_ci else if (ppsc->rfoff_reason == RF_CHANGE_BY_INIT) 65062306a36Sopenharmony_ci rtl92ce_sw_led_on(hw, pin0); 65162306a36Sopenharmony_ci else 65262306a36Sopenharmony_ci rtl92ce_sw_led_off(hw, pin0); 65362306a36Sopenharmony_ci} 65462306a36Sopenharmony_ci 65562306a36Sopenharmony_cistatic bool _rtl92ce_init_mac(struct ieee80211_hw *hw) 65662306a36Sopenharmony_ci{ 65762306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 65862306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 65962306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 66062306a36Sopenharmony_ci 66162306a36Sopenharmony_ci unsigned char bytetmp; 66262306a36Sopenharmony_ci unsigned short wordtmp; 66362306a36Sopenharmony_ci u16 retry; 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RSV_CTRL, 0x00); 66662306a36Sopenharmony_ci if (rtlpriv->btcoexist.bt_coexistence) { 66762306a36Sopenharmony_ci u32 value32; 66862306a36Sopenharmony_ci 66962306a36Sopenharmony_ci value32 = rtl_read_dword(rtlpriv, REG_APS_FSMCO); 67062306a36Sopenharmony_ci value32 |= (SOP_ABG | SOP_AMB | XOP_BTCK); 67162306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_APS_FSMCO, value32); 67262306a36Sopenharmony_ci } 67362306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SPS0_CTRL, 0x2b); 67462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_AFE_XTAL_CTRL, 0x0F); 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_ci if (rtlpriv->btcoexist.bt_coexistence) { 67762306a36Sopenharmony_ci u32 u4b_tmp = rtl_read_dword(rtlpriv, REG_AFE_XTAL_CTRL); 67862306a36Sopenharmony_ci 67962306a36Sopenharmony_ci u4b_tmp &= (~0x00024800); 68062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_AFE_XTAL_CTRL, u4b_tmp); 68162306a36Sopenharmony_ci } 68262306a36Sopenharmony_ci 68362306a36Sopenharmony_ci bytetmp = rtl_read_byte(rtlpriv, REG_APS_FSMCO + 1) | BIT(0); 68462306a36Sopenharmony_ci udelay(2); 68562306a36Sopenharmony_ci 68662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_APS_FSMCO + 1, bytetmp); 68762306a36Sopenharmony_ci udelay(2); 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_ci bytetmp = rtl_read_byte(rtlpriv, REG_APS_FSMCO + 1); 69062306a36Sopenharmony_ci udelay(2); 69162306a36Sopenharmony_ci 69262306a36Sopenharmony_ci retry = 0; 69362306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, "reg0xec:%x:%x\n", 69462306a36Sopenharmony_ci rtl_read_dword(rtlpriv, 0xEC), bytetmp); 69562306a36Sopenharmony_ci 69662306a36Sopenharmony_ci while ((bytetmp & BIT(0)) && retry < 1000) { 69762306a36Sopenharmony_ci retry++; 69862306a36Sopenharmony_ci udelay(50); 69962306a36Sopenharmony_ci bytetmp = rtl_read_byte(rtlpriv, REG_APS_FSMCO + 1); 70062306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, "reg0xec:%x:%x\n", 70162306a36Sopenharmony_ci rtl_read_dword(rtlpriv, 0xEC), bytetmp); 70262306a36Sopenharmony_ci udelay(50); 70362306a36Sopenharmony_ci } 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_APS_FSMCO, 0x1012); 70662306a36Sopenharmony_ci 70762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SYS_ISO_CTRL + 1, 0x82); 70862306a36Sopenharmony_ci udelay(2); 70962306a36Sopenharmony_ci 71062306a36Sopenharmony_ci if (rtlpriv->btcoexist.bt_coexistence) { 71162306a36Sopenharmony_ci bytetmp = rtl_read_byte(rtlpriv, REG_AFE_XTAL_CTRL+2) & 0xfd; 71262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_AFE_XTAL_CTRL+2, bytetmp); 71362306a36Sopenharmony_ci } 71462306a36Sopenharmony_ci 71562306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_CR, 0x2ff); 71662306a36Sopenharmony_ci 71762306a36Sopenharmony_ci if (!_rtl92ce_llt_table_init(hw)) 71862306a36Sopenharmony_ci return false; 71962306a36Sopenharmony_ci 72062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_HISR, 0xffffffff); 72162306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_HISRE, 0xff); 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_TRXFF_BNDY + 2, 0x27ff); 72462306a36Sopenharmony_ci 72562306a36Sopenharmony_ci wordtmp = rtl_read_word(rtlpriv, REG_TRXDMA_CTRL); 72662306a36Sopenharmony_ci wordtmp &= 0xf; 72762306a36Sopenharmony_ci wordtmp |= 0xF771; 72862306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_TRXDMA_CTRL, wordtmp); 72962306a36Sopenharmony_ci 73062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_FWHW_TXQ_CTRL + 1, 0x1F); 73162306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RCR, rtlpci->receive_config); 73262306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_TCR, rtlpci->transmit_config); 73362306a36Sopenharmony_ci 73462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x4d0, 0x0); 73562306a36Sopenharmony_ci 73662306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_BCNQ_DESA, 73762306a36Sopenharmony_ci ((u64) rtlpci->tx_ring[BEACON_QUEUE].dma) & 73862306a36Sopenharmony_ci DMA_BIT_MASK(32)); 73962306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_MGQ_DESA, 74062306a36Sopenharmony_ci (u64) rtlpci->tx_ring[MGNT_QUEUE].dma & 74162306a36Sopenharmony_ci DMA_BIT_MASK(32)); 74262306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_VOQ_DESA, 74362306a36Sopenharmony_ci (u64) rtlpci->tx_ring[VO_QUEUE].dma & DMA_BIT_MASK(32)); 74462306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_VIQ_DESA, 74562306a36Sopenharmony_ci (u64) rtlpci->tx_ring[VI_QUEUE].dma & DMA_BIT_MASK(32)); 74662306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_BEQ_DESA, 74762306a36Sopenharmony_ci (u64) rtlpci->tx_ring[BE_QUEUE].dma & DMA_BIT_MASK(32)); 74862306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_BKQ_DESA, 74962306a36Sopenharmony_ci (u64) rtlpci->tx_ring[BK_QUEUE].dma & DMA_BIT_MASK(32)); 75062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_HQ_DESA, 75162306a36Sopenharmony_ci (u64) rtlpci->tx_ring[HIGH_QUEUE].dma & 75262306a36Sopenharmony_ci DMA_BIT_MASK(32)); 75362306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RX_DESA, 75462306a36Sopenharmony_ci (u64) rtlpci->rx_ring[RX_MPDU_QUEUE].dma & 75562306a36Sopenharmony_ci DMA_BIT_MASK(32)); 75662306a36Sopenharmony_ci 75762306a36Sopenharmony_ci if (IS_92C_SERIAL(rtlhal->version)) 75862306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 3, 0x77); 75962306a36Sopenharmony_ci else 76062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_PCIE_CTRL_REG + 3, 0x22); 76162306a36Sopenharmony_ci 76262306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_INT_MIG, 0); 76362306a36Sopenharmony_ci 76462306a36Sopenharmony_ci bytetmp = rtl_read_byte(rtlpriv, REG_APSD_CTRL); 76562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_APSD_CTRL, bytetmp & ~BIT(6)); 76662306a36Sopenharmony_ci do { 76762306a36Sopenharmony_ci retry++; 76862306a36Sopenharmony_ci bytetmp = rtl_read_byte(rtlpriv, REG_APSD_CTRL); 76962306a36Sopenharmony_ci } while ((retry < 200) && (bytetmp & BIT(7))); 77062306a36Sopenharmony_ci 77162306a36Sopenharmony_ci _rtl92ce_gen_refresh_led_state(hw); 77262306a36Sopenharmony_ci 77362306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_MCUTST_1, 0x0); 77462306a36Sopenharmony_ci 77562306a36Sopenharmony_ci return true; 77662306a36Sopenharmony_ci} 77762306a36Sopenharmony_ci 77862306a36Sopenharmony_cistatic void _rtl92ce_hw_configure(struct ieee80211_hw *hw) 77962306a36Sopenharmony_ci{ 78062306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 78162306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 78262306a36Sopenharmony_ci u8 reg_bw_opmode; 78362306a36Sopenharmony_ci u32 reg_prsr; 78462306a36Sopenharmony_ci 78562306a36Sopenharmony_ci reg_bw_opmode = BW_OPMODE_20MHZ; 78662306a36Sopenharmony_ci reg_prsr = RATE_ALL_CCK | RATE_ALL_OFDM_AG; 78762306a36Sopenharmony_ci 78862306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_INIRTS_RATE_SEL, 0x8); 78962306a36Sopenharmony_ci 79062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_BWOPMODE, reg_bw_opmode); 79162306a36Sopenharmony_ci 79262306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RRSR, reg_prsr); 79362306a36Sopenharmony_ci 79462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SLOT, 0x09); 79562306a36Sopenharmony_ci 79662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_AMPDU_MIN_SPACE, 0x0); 79762306a36Sopenharmony_ci 79862306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_FWHW_TXQ_CTRL, 0x1F80); 79962306a36Sopenharmony_ci 80062306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_RL, 0x0707); 80162306a36Sopenharmony_ci 80262306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_BAR_MODE_CTRL, 0x02012802); 80362306a36Sopenharmony_ci 80462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_HWSEQ_CTRL, 0xFF); 80562306a36Sopenharmony_ci 80662306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_DARFRC, 0x01000000); 80762306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_DARFRC + 4, 0x07060504); 80862306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RARFRC, 0x01000000); 80962306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RARFRC + 4, 0x07060504); 81062306a36Sopenharmony_ci 81162306a36Sopenharmony_ci if ((rtlpriv->btcoexist.bt_coexistence) && 81262306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC4)) 81362306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_AGGLEN_LMT, 0x97427431); 81462306a36Sopenharmony_ci else 81562306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_AGGLEN_LMT, 0xb972a841); 81662306a36Sopenharmony_ci 81762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_ATIMWND, 0x2); 81862306a36Sopenharmony_ci 81962306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_BCN_MAX_ERR, 0xff); 82062306a36Sopenharmony_ci 82162306a36Sopenharmony_ci rtlpci->reg_bcn_ctrl_val = 0x1f; 82262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_BCN_CTRL, rtlpci->reg_bcn_ctrl_val); 82362306a36Sopenharmony_ci 82462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 1, 0xff); 82562306a36Sopenharmony_ci 82662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TBTT_PROHIBIT + 1, 0xff); 82762306a36Sopenharmony_ci 82862306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_PIFS, 0x1C); 82962306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_AGGR_BREAK_TIME, 0x16); 83062306a36Sopenharmony_ci 83162306a36Sopenharmony_ci if ((rtlpriv->btcoexist.bt_coexistence) && 83262306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC4)) { 83362306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_NAV_PROT_LEN, 0x0020); 83462306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_PROT_MODE_CTRL, 0x0402); 83562306a36Sopenharmony_ci } else { 83662306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_NAV_PROT_LEN, 0x0020); 83762306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_NAV_PROT_LEN, 0x0020); 83862306a36Sopenharmony_ci } 83962306a36Sopenharmony_ci 84062306a36Sopenharmony_ci if ((rtlpriv->btcoexist.bt_coexistence) && 84162306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC4)) 84262306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_FAST_EDCA_CTRL, 0x03086666); 84362306a36Sopenharmony_ci else 84462306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_FAST_EDCA_CTRL, 0x086666); 84562306a36Sopenharmony_ci 84662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_ACKTO, 0x40); 84762306a36Sopenharmony_ci 84862306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_SPEC_SIFS, 0x1010); 84962306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_MAC_SPEC_SIFS, 0x1010); 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_SIFS_CTX, 0x1010); 85262306a36Sopenharmony_ci 85362306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_SIFS_TRX, 0x1010); 85462306a36Sopenharmony_ci 85562306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_MAR, 0xffffffff); 85662306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_MAR + 4, 0xffffffff); 85762306a36Sopenharmony_ci 85862306a36Sopenharmony_ci} 85962306a36Sopenharmony_ci 86062306a36Sopenharmony_cistatic void _rtl92ce_enable_aspm_back_door(struct ieee80211_hw *hw) 86162306a36Sopenharmony_ci{ 86262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 86362306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 86462306a36Sopenharmony_ci 86562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x34b, 0x93); 86662306a36Sopenharmony_ci rtl_write_word(rtlpriv, 0x350, 0x870c); 86762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x352, 0x1); 86862306a36Sopenharmony_ci 86962306a36Sopenharmony_ci if (ppsc->support_backdoor) 87062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x349, 0x1b); 87162306a36Sopenharmony_ci else 87262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x349, 0x03); 87362306a36Sopenharmony_ci 87462306a36Sopenharmony_ci rtl_write_word(rtlpriv, 0x350, 0x2718); 87562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x352, 0x1); 87662306a36Sopenharmony_ci} 87762306a36Sopenharmony_ci 87862306a36Sopenharmony_civoid rtl92ce_enable_hw_security_config(struct ieee80211_hw *hw) 87962306a36Sopenharmony_ci{ 88062306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 88162306a36Sopenharmony_ci u8 sec_reg_value; 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, 88462306a36Sopenharmony_ci "PairwiseEncAlgorithm = %d GroupEncAlgorithm = %d\n", 88562306a36Sopenharmony_ci rtlpriv->sec.pairwise_enc_algorithm, 88662306a36Sopenharmony_ci rtlpriv->sec.group_enc_algorithm); 88762306a36Sopenharmony_ci 88862306a36Sopenharmony_ci if (rtlpriv->cfg->mod_params->sw_crypto || rtlpriv->sec.use_sw_sec) { 88962306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_DMESG, 89062306a36Sopenharmony_ci "not open hw encryption\n"); 89162306a36Sopenharmony_ci return; 89262306a36Sopenharmony_ci } 89362306a36Sopenharmony_ci 89462306a36Sopenharmony_ci sec_reg_value = SCR_TXENCENABLE | SCR_RXDECENABLE; 89562306a36Sopenharmony_ci 89662306a36Sopenharmony_ci if (rtlpriv->sec.use_defaultkey) { 89762306a36Sopenharmony_ci sec_reg_value |= SCR_TXUSEDK; 89862306a36Sopenharmony_ci sec_reg_value |= SCR_RXUSEDK; 89962306a36Sopenharmony_ci } 90062306a36Sopenharmony_ci 90162306a36Sopenharmony_ci sec_reg_value |= (SCR_RXBCUSEDK | SCR_TXBCUSEDK); 90262306a36Sopenharmony_ci 90362306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_CR + 1, 0x02); 90462306a36Sopenharmony_ci 90562306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_LOUD, 90662306a36Sopenharmony_ci "The SECR-value %x\n", sec_reg_value); 90762306a36Sopenharmony_ci 90862306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_WPA_CONFIG, &sec_reg_value); 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci} 91162306a36Sopenharmony_ci 91262306a36Sopenharmony_ciint rtl92ce_hw_init(struct ieee80211_hw *hw) 91362306a36Sopenharmony_ci{ 91462306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 91562306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 91662306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 91762306a36Sopenharmony_ci struct rtl_phy *rtlphy = &(rtlpriv->phy); 91862306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 91962306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 92062306a36Sopenharmony_ci bool rtstatus = true; 92162306a36Sopenharmony_ci bool is92c; 92262306a36Sopenharmony_ci int err; 92362306a36Sopenharmony_ci u8 tmp_u1b; 92462306a36Sopenharmony_ci unsigned long flags; 92562306a36Sopenharmony_ci 92662306a36Sopenharmony_ci rtlpci->being_init_adapter = true; 92762306a36Sopenharmony_ci 92862306a36Sopenharmony_ci /* Since this function can take a very long time (up to 350 ms) 92962306a36Sopenharmony_ci * and can be called with irqs disabled, reenable the irqs 93062306a36Sopenharmony_ci * to let the other devices continue being serviced. 93162306a36Sopenharmony_ci * 93262306a36Sopenharmony_ci * It is safe doing so since our own interrupts will only be enabled 93362306a36Sopenharmony_ci * in a subsequent step. 93462306a36Sopenharmony_ci */ 93562306a36Sopenharmony_ci local_save_flags(flags); 93662306a36Sopenharmony_ci local_irq_enable(); 93762306a36Sopenharmony_ci 93862306a36Sopenharmony_ci rtlhal->fw_ready = false; 93962306a36Sopenharmony_ci rtlpriv->intf_ops->disable_aspm(hw); 94062306a36Sopenharmony_ci rtstatus = _rtl92ce_init_mac(hw); 94162306a36Sopenharmony_ci if (!rtstatus) { 94262306a36Sopenharmony_ci pr_err("Init MAC failed\n"); 94362306a36Sopenharmony_ci err = 1; 94462306a36Sopenharmony_ci goto exit; 94562306a36Sopenharmony_ci } 94662306a36Sopenharmony_ci 94762306a36Sopenharmony_ci err = rtl92c_download_fw(hw); 94862306a36Sopenharmony_ci if (err) { 94962306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_ERR, DBG_WARNING, 95062306a36Sopenharmony_ci "Failed to download FW. Init HW without FW now..\n"); 95162306a36Sopenharmony_ci err = 1; 95262306a36Sopenharmony_ci goto exit; 95362306a36Sopenharmony_ci } 95462306a36Sopenharmony_ci 95562306a36Sopenharmony_ci rtlhal->fw_ready = true; 95662306a36Sopenharmony_ci rtlhal->last_hmeboxnum = 0; 95762306a36Sopenharmony_ci rtl92c_phy_mac_config(hw); 95862306a36Sopenharmony_ci /* because last function modify RCR, so we update 95962306a36Sopenharmony_ci * rcr var here, or TP will unstable for receive_config 96062306a36Sopenharmony_ci * is wrong, RX RCR_ACRC32 will cause TP unstabel & Rx 96162306a36Sopenharmony_ci * RCR_APP_ICV will cause mac80211 unassoc for cisco 1252*/ 96262306a36Sopenharmony_ci rtlpci->receive_config = rtl_read_dword(rtlpriv, REG_RCR); 96362306a36Sopenharmony_ci rtlpci->receive_config &= ~(RCR_ACRC32 | RCR_AICV); 96462306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_RCR, rtlpci->receive_config); 96562306a36Sopenharmony_ci rtl92c_phy_bb_config(hw); 96662306a36Sopenharmony_ci rtlphy->rf_mode = RF_OP_BY_SW_3WIRE; 96762306a36Sopenharmony_ci rtl92c_phy_rf_config(hw); 96862306a36Sopenharmony_ci if (IS_VENDOR_UMC_A_CUT(rtlhal->version) && 96962306a36Sopenharmony_ci !IS_92C_SERIAL(rtlhal->version)) { 97062306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, RF_RX_G1, MASKDWORD, 0x30255); 97162306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, RF_RX_G2, MASKDWORD, 0x50a00); 97262306a36Sopenharmony_ci } else if (IS_81XXC_VENDOR_UMC_B_CUT(rtlhal->version)) { 97362306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, 0x0C, MASKDWORD, 0x894AE); 97462306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, 0x0A, MASKDWORD, 0x1AF31); 97562306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, RF_IPA, MASKDWORD, 0x8F425); 97662306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, RF_SYN_G2, MASKDWORD, 0x4F200); 97762306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, RF_RCK1, MASKDWORD, 0x44053); 97862306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, RF_RCK2, MASKDWORD, 0x80201); 97962306a36Sopenharmony_ci } 98062306a36Sopenharmony_ci rtlphy->rfreg_chnlval[0] = rtl_get_rfreg(hw, (enum radio_path)0, 98162306a36Sopenharmony_ci RF_CHNLBW, RFREG_OFFSET_MASK); 98262306a36Sopenharmony_ci rtlphy->rfreg_chnlval[1] = rtl_get_rfreg(hw, (enum radio_path)1, 98362306a36Sopenharmony_ci RF_CHNLBW, RFREG_OFFSET_MASK); 98462306a36Sopenharmony_ci rtl_set_bbreg(hw, RFPGA0_RFMOD, BCCKEN, 0x1); 98562306a36Sopenharmony_ci rtl_set_bbreg(hw, RFPGA0_RFMOD, BOFDMEN, 0x1); 98662306a36Sopenharmony_ci rtl_set_bbreg(hw, RFPGA0_ANALOGPARAMETER2, BIT(10), 1); 98762306a36Sopenharmony_ci _rtl92ce_hw_configure(hw); 98862306a36Sopenharmony_ci rtl_cam_reset_all_entry(hw); 98962306a36Sopenharmony_ci rtl92ce_enable_hw_security_config(hw); 99062306a36Sopenharmony_ci 99162306a36Sopenharmony_ci ppsc->rfpwr_state = ERFON; 99262306a36Sopenharmony_ci 99362306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_ETHER_ADDR, mac->mac_addr); 99462306a36Sopenharmony_ci _rtl92ce_enable_aspm_back_door(hw); 99562306a36Sopenharmony_ci rtlpriv->intf_ops->enable_aspm(hw); 99662306a36Sopenharmony_ci 99762306a36Sopenharmony_ci rtl8192ce_bt_hw_init(hw); 99862306a36Sopenharmony_ci 99962306a36Sopenharmony_ci if (ppsc->rfpwr_state == ERFON) { 100062306a36Sopenharmony_ci rtl92c_phy_set_rfpath_switch(hw, 1); 100162306a36Sopenharmony_ci if (rtlphy->iqk_initialized) { 100262306a36Sopenharmony_ci rtl92c_phy_iq_calibrate(hw, true); 100362306a36Sopenharmony_ci } else { 100462306a36Sopenharmony_ci rtl92c_phy_iq_calibrate(hw, false); 100562306a36Sopenharmony_ci rtlphy->iqk_initialized = true; 100662306a36Sopenharmony_ci } 100762306a36Sopenharmony_ci 100862306a36Sopenharmony_ci rtl92c_dm_check_txpower_tracking(hw); 100962306a36Sopenharmony_ci rtl92c_phy_lc_calibrate(hw); 101062306a36Sopenharmony_ci } 101162306a36Sopenharmony_ci 101262306a36Sopenharmony_ci is92c = IS_92C_SERIAL(rtlhal->version); 101362306a36Sopenharmony_ci tmp_u1b = efuse_read_1byte(hw, 0x1FA); 101462306a36Sopenharmony_ci if (!(tmp_u1b & BIT(0))) { 101562306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, 0x15, 0x0F, 0x05); 101662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, "PA BIAS path A\n"); 101762306a36Sopenharmony_ci } 101862306a36Sopenharmony_ci 101962306a36Sopenharmony_ci if (!(tmp_u1b & BIT(1)) && is92c) { 102062306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_B, 0x15, 0x0F, 0x05); 102162306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, "PA BIAS path B\n"); 102262306a36Sopenharmony_ci } 102362306a36Sopenharmony_ci 102462306a36Sopenharmony_ci if (!(tmp_u1b & BIT(4))) { 102562306a36Sopenharmony_ci tmp_u1b = rtl_read_byte(rtlpriv, 0x16); 102662306a36Sopenharmony_ci tmp_u1b &= 0x0F; 102762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x16, tmp_u1b | 0x80); 102862306a36Sopenharmony_ci udelay(10); 102962306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x16, tmp_u1b | 0x90); 103062306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, "under 1.5V\n"); 103162306a36Sopenharmony_ci } 103262306a36Sopenharmony_ci rtl92c_dm_init(hw); 103362306a36Sopenharmony_ciexit: 103462306a36Sopenharmony_ci local_irq_restore(flags); 103562306a36Sopenharmony_ci rtlpci->being_init_adapter = false; 103662306a36Sopenharmony_ci return err; 103762306a36Sopenharmony_ci} 103862306a36Sopenharmony_ci 103962306a36Sopenharmony_cistatic enum version_8192c _rtl92ce_read_chip_version(struct ieee80211_hw *hw) 104062306a36Sopenharmony_ci{ 104162306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 104262306a36Sopenharmony_ci struct rtl_phy *rtlphy = &(rtlpriv->phy); 104362306a36Sopenharmony_ci enum version_8192c version = VERSION_UNKNOWN; 104462306a36Sopenharmony_ci u32 value32; 104562306a36Sopenharmony_ci const char *versionid; 104662306a36Sopenharmony_ci 104762306a36Sopenharmony_ci value32 = rtl_read_dword(rtlpriv, REG_SYS_CFG); 104862306a36Sopenharmony_ci if (value32 & TRP_VAUX_EN) { 104962306a36Sopenharmony_ci version = (value32 & TYPE_ID) ? VERSION_A_CHIP_92C : 105062306a36Sopenharmony_ci VERSION_A_CHIP_88C; 105162306a36Sopenharmony_ci } else { 105262306a36Sopenharmony_ci version = (enum version_8192c) (CHIP_VER_B | 105362306a36Sopenharmony_ci ((value32 & TYPE_ID) ? CHIP_92C_BITMASK : 0) | 105462306a36Sopenharmony_ci ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : 0)); 105562306a36Sopenharmony_ci if ((!IS_CHIP_VENDOR_UMC(version)) && (value32 & 105662306a36Sopenharmony_ci CHIP_VER_RTL_MASK)) { 105762306a36Sopenharmony_ci version = (enum version_8192c)(version | 105862306a36Sopenharmony_ci ((((value32 & CHIP_VER_RTL_MASK) == BIT(12)) 105962306a36Sopenharmony_ci ? CHIP_VENDOR_UMC_B_CUT : CHIP_UNKNOWN) | 106062306a36Sopenharmony_ci CHIP_VENDOR_UMC)); 106162306a36Sopenharmony_ci } 106262306a36Sopenharmony_ci if (IS_92C_SERIAL(version)) { 106362306a36Sopenharmony_ci value32 = rtl_read_dword(rtlpriv, REG_HPON_FSM); 106462306a36Sopenharmony_ci version = (enum version_8192c)(version | 106562306a36Sopenharmony_ci ((CHIP_BONDING_IDENTIFIER(value32) 106662306a36Sopenharmony_ci == CHIP_BONDING_92C_1T2R) ? 106762306a36Sopenharmony_ci RF_TYPE_1T2R : 0)); 106862306a36Sopenharmony_ci } 106962306a36Sopenharmony_ci } 107062306a36Sopenharmony_ci 107162306a36Sopenharmony_ci switch (version) { 107262306a36Sopenharmony_ci case VERSION_B_CHIP_92C: 107362306a36Sopenharmony_ci versionid = "B_CHIP_92C"; 107462306a36Sopenharmony_ci break; 107562306a36Sopenharmony_ci case VERSION_B_CHIP_88C: 107662306a36Sopenharmony_ci versionid = "B_CHIP_88C"; 107762306a36Sopenharmony_ci break; 107862306a36Sopenharmony_ci case VERSION_A_CHIP_92C: 107962306a36Sopenharmony_ci versionid = "A_CHIP_92C"; 108062306a36Sopenharmony_ci break; 108162306a36Sopenharmony_ci case VERSION_A_CHIP_88C: 108262306a36Sopenharmony_ci versionid = "A_CHIP_88C"; 108362306a36Sopenharmony_ci break; 108462306a36Sopenharmony_ci case VERSION_NORMAL_UMC_CHIP_92C_1T2R_A_CUT: 108562306a36Sopenharmony_ci versionid = "A_CUT_92C_1T2R"; 108662306a36Sopenharmony_ci break; 108762306a36Sopenharmony_ci case VERSION_NORMAL_UMC_CHIP_92C_A_CUT: 108862306a36Sopenharmony_ci versionid = "A_CUT_92C"; 108962306a36Sopenharmony_ci break; 109062306a36Sopenharmony_ci case VERSION_NORMAL_UMC_CHIP_88C_A_CUT: 109162306a36Sopenharmony_ci versionid = "A_CUT_88C"; 109262306a36Sopenharmony_ci break; 109362306a36Sopenharmony_ci case VERSION_NORMAL_UMC_CHIP_92C_1T2R_B_CUT: 109462306a36Sopenharmony_ci versionid = "B_CUT_92C_1T2R"; 109562306a36Sopenharmony_ci break; 109662306a36Sopenharmony_ci case VERSION_NORMAL_UMC_CHIP_92C_B_CUT: 109762306a36Sopenharmony_ci versionid = "B_CUT_92C"; 109862306a36Sopenharmony_ci break; 109962306a36Sopenharmony_ci case VERSION_NORMAL_UMC_CHIP_88C_B_CUT: 110062306a36Sopenharmony_ci versionid = "B_CUT_88C"; 110162306a36Sopenharmony_ci break; 110262306a36Sopenharmony_ci default: 110362306a36Sopenharmony_ci versionid = "Unknown. Bug?"; 110462306a36Sopenharmony_ci break; 110562306a36Sopenharmony_ci } 110662306a36Sopenharmony_ci 110762306a36Sopenharmony_ci pr_info("Chip Version ID: %s\n", versionid); 110862306a36Sopenharmony_ci 110962306a36Sopenharmony_ci switch (version & 0x3) { 111062306a36Sopenharmony_ci case CHIP_88C: 111162306a36Sopenharmony_ci rtlphy->rf_type = RF_1T1R; 111262306a36Sopenharmony_ci break; 111362306a36Sopenharmony_ci case CHIP_92C: 111462306a36Sopenharmony_ci rtlphy->rf_type = RF_2T2R; 111562306a36Sopenharmony_ci break; 111662306a36Sopenharmony_ci case CHIP_92C_1T2R: 111762306a36Sopenharmony_ci rtlphy->rf_type = RF_1T2R; 111862306a36Sopenharmony_ci break; 111962306a36Sopenharmony_ci default: 112062306a36Sopenharmony_ci rtlphy->rf_type = RF_1T1R; 112162306a36Sopenharmony_ci pr_err("ERROR RF_Type is set!!\n"); 112262306a36Sopenharmony_ci break; 112362306a36Sopenharmony_ci } 112462306a36Sopenharmony_ci 112562306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, "Chip RF Type: %s\n", 112662306a36Sopenharmony_ci rtlphy->rf_type == RF_2T2R ? "RF_2T2R" : "RF_1T1R"); 112762306a36Sopenharmony_ci 112862306a36Sopenharmony_ci return version; 112962306a36Sopenharmony_ci} 113062306a36Sopenharmony_ci 113162306a36Sopenharmony_cistatic int _rtl92ce_set_media_status(struct ieee80211_hw *hw, 113262306a36Sopenharmony_ci enum nl80211_iftype type) 113362306a36Sopenharmony_ci{ 113462306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 113562306a36Sopenharmony_ci u8 bt_msr = rtl_read_byte(rtlpriv, MSR); 113662306a36Sopenharmony_ci enum led_ctl_mode ledaction = LED_CTL_NO_LINK; 113762306a36Sopenharmony_ci u8 mode = MSR_NOLINK; 113862306a36Sopenharmony_ci 113962306a36Sopenharmony_ci bt_msr &= 0xfc; 114062306a36Sopenharmony_ci 114162306a36Sopenharmony_ci switch (type) { 114262306a36Sopenharmony_ci case NL80211_IFTYPE_UNSPECIFIED: 114362306a36Sopenharmony_ci mode = MSR_NOLINK; 114462306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, 114562306a36Sopenharmony_ci "Set Network type to NO LINK!\n"); 114662306a36Sopenharmony_ci break; 114762306a36Sopenharmony_ci case NL80211_IFTYPE_ADHOC: 114862306a36Sopenharmony_ci mode = MSR_ADHOC; 114962306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, 115062306a36Sopenharmony_ci "Set Network type to Ad Hoc!\n"); 115162306a36Sopenharmony_ci break; 115262306a36Sopenharmony_ci case NL80211_IFTYPE_STATION: 115362306a36Sopenharmony_ci mode = MSR_INFRA; 115462306a36Sopenharmony_ci ledaction = LED_CTL_LINK; 115562306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, 115662306a36Sopenharmony_ci "Set Network type to STA!\n"); 115762306a36Sopenharmony_ci break; 115862306a36Sopenharmony_ci case NL80211_IFTYPE_AP: 115962306a36Sopenharmony_ci mode = MSR_AP; 116062306a36Sopenharmony_ci ledaction = LED_CTL_LINK; 116162306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, 116262306a36Sopenharmony_ci "Set Network type to AP!\n"); 116362306a36Sopenharmony_ci break; 116462306a36Sopenharmony_ci case NL80211_IFTYPE_MESH_POINT: 116562306a36Sopenharmony_ci mode = MSR_ADHOC; 116662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, 116762306a36Sopenharmony_ci "Set Network type to Mesh Point!\n"); 116862306a36Sopenharmony_ci break; 116962306a36Sopenharmony_ci default: 117062306a36Sopenharmony_ci pr_err("Network type %d not supported!\n", type); 117162306a36Sopenharmony_ci return 1; 117262306a36Sopenharmony_ci 117362306a36Sopenharmony_ci } 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_ci /* MSR_INFRA == Link in infrastructure network; 117662306a36Sopenharmony_ci * MSR_ADHOC == Link in ad hoc network; 117762306a36Sopenharmony_ci * Therefore, check link state is necessary. 117862306a36Sopenharmony_ci * 117962306a36Sopenharmony_ci * MSR_AP == AP mode; link state does not matter here. 118062306a36Sopenharmony_ci */ 118162306a36Sopenharmony_ci if (mode != MSR_AP && 118262306a36Sopenharmony_ci rtlpriv->mac80211.link_state < MAC80211_LINKED) { 118362306a36Sopenharmony_ci mode = MSR_NOLINK; 118462306a36Sopenharmony_ci ledaction = LED_CTL_NO_LINK; 118562306a36Sopenharmony_ci } 118662306a36Sopenharmony_ci if (mode == MSR_NOLINK || mode == MSR_INFRA) { 118762306a36Sopenharmony_ci _rtl92ce_stop_tx_beacon(hw); 118862306a36Sopenharmony_ci _rtl92ce_enable_bcn_sub_func(hw); 118962306a36Sopenharmony_ci } else if (mode == MSR_ADHOC || mode == MSR_AP) { 119062306a36Sopenharmony_ci _rtl92ce_resume_tx_beacon(hw); 119162306a36Sopenharmony_ci _rtl92ce_disable_bcn_sub_func(hw); 119262306a36Sopenharmony_ci } else { 119362306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_ERR, DBG_WARNING, 119462306a36Sopenharmony_ci "Set HW_VAR_MEDIA_STATUS: No such media status(%x).\n", 119562306a36Sopenharmony_ci mode); 119662306a36Sopenharmony_ci } 119762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, MSR, bt_msr | mode); 119862306a36Sopenharmony_ci 119962306a36Sopenharmony_ci rtlpriv->cfg->ops->led_control(hw, ledaction); 120062306a36Sopenharmony_ci if (mode == MSR_AP) 120162306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_BCNTCFG + 1, 0x00); 120262306a36Sopenharmony_ci else 120362306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_BCNTCFG + 1, 0x66); 120462306a36Sopenharmony_ci return 0; 120562306a36Sopenharmony_ci} 120662306a36Sopenharmony_ci 120762306a36Sopenharmony_civoid rtl92ce_set_check_bssid(struct ieee80211_hw *hw, bool check_bssid) 120862306a36Sopenharmony_ci{ 120962306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 121062306a36Sopenharmony_ci u32 reg_rcr; 121162306a36Sopenharmony_ci 121262306a36Sopenharmony_ci if (rtlpriv->psc.rfpwr_state != ERFON) 121362306a36Sopenharmony_ci return; 121462306a36Sopenharmony_ci 121562306a36Sopenharmony_ci rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_RCR, (u8 *)(®_rcr)); 121662306a36Sopenharmony_ci 121762306a36Sopenharmony_ci if (check_bssid) { 121862306a36Sopenharmony_ci reg_rcr |= (RCR_CBSSID_DATA | RCR_CBSSID_BCN); 121962306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RCR, 122062306a36Sopenharmony_ci (u8 *) (®_rcr)); 122162306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, 0, BIT(4)); 122262306a36Sopenharmony_ci } else if (!check_bssid) { 122362306a36Sopenharmony_ci reg_rcr &= (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN)); 122462306a36Sopenharmony_ci _rtl92ce_set_bcn_ctrl_reg(hw, BIT(4), 0); 122562306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, 122662306a36Sopenharmony_ci HW_VAR_RCR, (u8 *) (®_rcr)); 122762306a36Sopenharmony_ci } 122862306a36Sopenharmony_ci 122962306a36Sopenharmony_ci} 123062306a36Sopenharmony_ci 123162306a36Sopenharmony_ciint rtl92ce_set_network_type(struct ieee80211_hw *hw, enum nl80211_iftype type) 123262306a36Sopenharmony_ci{ 123362306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 123462306a36Sopenharmony_ci 123562306a36Sopenharmony_ci if (_rtl92ce_set_media_status(hw, type)) 123662306a36Sopenharmony_ci return -EOPNOTSUPP; 123762306a36Sopenharmony_ci 123862306a36Sopenharmony_ci if (rtlpriv->mac80211.link_state == MAC80211_LINKED) { 123962306a36Sopenharmony_ci if (type != NL80211_IFTYPE_AP && 124062306a36Sopenharmony_ci type != NL80211_IFTYPE_MESH_POINT) 124162306a36Sopenharmony_ci rtl92ce_set_check_bssid(hw, true); 124262306a36Sopenharmony_ci } else { 124362306a36Sopenharmony_ci rtl92ce_set_check_bssid(hw, false); 124462306a36Sopenharmony_ci } 124562306a36Sopenharmony_ci 124662306a36Sopenharmony_ci return 0; 124762306a36Sopenharmony_ci} 124862306a36Sopenharmony_ci 124962306a36Sopenharmony_ci/* don't set REG_EDCA_BE_PARAM here because mac80211 will send pkt when scan */ 125062306a36Sopenharmony_civoid rtl92ce_set_qos(struct ieee80211_hw *hw, int aci) 125162306a36Sopenharmony_ci{ 125262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 125362306a36Sopenharmony_ci 125462306a36Sopenharmony_ci rtl92c_dm_init_edca_turbo(hw); 125562306a36Sopenharmony_ci switch (aci) { 125662306a36Sopenharmony_ci case AC1_BK: 125762306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_EDCA_BK_PARAM, 0xa44f); 125862306a36Sopenharmony_ci break; 125962306a36Sopenharmony_ci case AC0_BE: 126062306a36Sopenharmony_ci /* rtl_write_dword(rtlpriv, REG_EDCA_BE_PARAM, u4b_ac_param); */ 126162306a36Sopenharmony_ci break; 126262306a36Sopenharmony_ci case AC2_VI: 126362306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_EDCA_VI_PARAM, 0x5e4322); 126462306a36Sopenharmony_ci break; 126562306a36Sopenharmony_ci case AC3_VO: 126662306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_EDCA_VO_PARAM, 0x2f3222); 126762306a36Sopenharmony_ci break; 126862306a36Sopenharmony_ci default: 126962306a36Sopenharmony_ci WARN_ONCE(true, "rtl8192ce: invalid aci: %d !\n", aci); 127062306a36Sopenharmony_ci break; 127162306a36Sopenharmony_ci } 127262306a36Sopenharmony_ci} 127362306a36Sopenharmony_ci 127462306a36Sopenharmony_civoid rtl92ce_enable_interrupt(struct ieee80211_hw *hw) 127562306a36Sopenharmony_ci{ 127662306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 127762306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 127862306a36Sopenharmony_ci 127962306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_HIMR, rtlpci->irq_mask[0] & 0xFFFFFFFF); 128062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_HIMRE, rtlpci->irq_mask[1] & 0xFFFFFFFF); 128162306a36Sopenharmony_ci rtlpci->irq_enabled = true; 128262306a36Sopenharmony_ci} 128362306a36Sopenharmony_ci 128462306a36Sopenharmony_civoid rtl92ce_disable_interrupt(struct ieee80211_hw *hw) 128562306a36Sopenharmony_ci{ 128662306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 128762306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 128862306a36Sopenharmony_ci 128962306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_HIMR, IMR8190_DISABLED); 129062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_HIMRE, IMR8190_DISABLED); 129162306a36Sopenharmony_ci rtlpci->irq_enabled = false; 129262306a36Sopenharmony_ci} 129362306a36Sopenharmony_ci 129462306a36Sopenharmony_cistatic void _rtl92ce_poweroff_adapter(struct ieee80211_hw *hw) 129562306a36Sopenharmony_ci{ 129662306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 129762306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtlpriv); 129862306a36Sopenharmony_ci u8 u1b_tmp; 129962306a36Sopenharmony_ci u32 u4b_tmp; 130062306a36Sopenharmony_ci 130162306a36Sopenharmony_ci rtlpriv->intf_ops->enable_aspm(hw); 130262306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_TXPAUSE, 0xFF); 130362306a36Sopenharmony_ci rtl_set_rfreg(hw, RF90_PATH_A, 0x00, RFREG_OFFSET_MASK, 0x00); 130462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RF_CTRL, 0x00); 130562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_APSD_CTRL, 0x40); 130662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE2); 130762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN, 0xE0); 130862306a36Sopenharmony_ci if (rtl_read_byte(rtlpriv, REG_MCUFWDL) & BIT(7)) 130962306a36Sopenharmony_ci rtl92c_firmware_selfreset(hw); 131062306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SYS_FUNC_EN + 1, 0x51); 131162306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_MCUFWDL, 0x00); 131262306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_GPIO_PIN_CTRL, 0x00000000); 131362306a36Sopenharmony_ci u1b_tmp = rtl_read_byte(rtlpriv, REG_GPIO_PIN_CTRL); 131462306a36Sopenharmony_ci if ((rtlpriv->btcoexist.bt_coexistence) && 131562306a36Sopenharmony_ci ((rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC4) || 131662306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC8))) { 131762306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_GPIO_PIN_CTRL, 0x00F30000 | 131862306a36Sopenharmony_ci (u1b_tmp << 8)); 131962306a36Sopenharmony_ci } else { 132062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_GPIO_PIN_CTRL, 0x00FF0000 | 132162306a36Sopenharmony_ci (u1b_tmp << 8)); 132262306a36Sopenharmony_ci } 132362306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_GPIO_IO_SEL, 0x0790); 132462306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_LEDCFG0, 0x8080); 132562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_AFE_PLL_CTRL, 0x80); 132662306a36Sopenharmony_ci if (!IS_81XXC_VENDOR_UMC_B_CUT(rtlhal->version)) 132762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_SPS0_CTRL, 0x23); 132862306a36Sopenharmony_ci if (rtlpriv->btcoexist.bt_coexistence) { 132962306a36Sopenharmony_ci u4b_tmp = rtl_read_dword(rtlpriv, REG_AFE_XTAL_CTRL); 133062306a36Sopenharmony_ci u4b_tmp |= 0x03824800; 133162306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_AFE_XTAL_CTRL, u4b_tmp); 133262306a36Sopenharmony_ci } else { 133362306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_AFE_XTAL_CTRL, 0x0e); 133462306a36Sopenharmony_ci } 133562306a36Sopenharmony_ci 133662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RSV_CTRL, 0x0e); 133762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_APS_FSMCO + 1, 0x10); 133862306a36Sopenharmony_ci} 133962306a36Sopenharmony_ci 134062306a36Sopenharmony_civoid rtl92ce_card_disable(struct ieee80211_hw *hw) 134162306a36Sopenharmony_ci{ 134262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 134362306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 134462306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 134562306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 134662306a36Sopenharmony_ci enum nl80211_iftype opmode; 134762306a36Sopenharmony_ci 134862306a36Sopenharmony_ci mac->link_state = MAC80211_NOLINK; 134962306a36Sopenharmony_ci opmode = NL80211_IFTYPE_UNSPECIFIED; 135062306a36Sopenharmony_ci _rtl92ce_set_media_status(hw, opmode); 135162306a36Sopenharmony_ci if (rtlpci->driver_is_goingto_unload || 135262306a36Sopenharmony_ci ppsc->rfoff_reason > RF_CHANGE_BY_PS) 135362306a36Sopenharmony_ci rtlpriv->cfg->ops->led_control(hw, LED_CTL_POWER_OFF); 135462306a36Sopenharmony_ci RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC); 135562306a36Sopenharmony_ci _rtl92ce_poweroff_adapter(hw); 135662306a36Sopenharmony_ci 135762306a36Sopenharmony_ci /* after power off we should do iqk again */ 135862306a36Sopenharmony_ci rtlpriv->phy.iqk_initialized = false; 135962306a36Sopenharmony_ci} 136062306a36Sopenharmony_ci 136162306a36Sopenharmony_civoid rtl92ce_interrupt_recognized(struct ieee80211_hw *hw, 136262306a36Sopenharmony_ci struct rtl_int *intvec) 136362306a36Sopenharmony_ci{ 136462306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 136562306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 136662306a36Sopenharmony_ci 136762306a36Sopenharmony_ci intvec->inta = rtl_read_dword(rtlpriv, ISR) & rtlpci->irq_mask[0]; 136862306a36Sopenharmony_ci rtl_write_dword(rtlpriv, ISR, intvec->inta); 136962306a36Sopenharmony_ci} 137062306a36Sopenharmony_ci 137162306a36Sopenharmony_civoid rtl92ce_set_beacon_related_registers(struct ieee80211_hw *hw) 137262306a36Sopenharmony_ci{ 137362306a36Sopenharmony_ci 137462306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 137562306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 137662306a36Sopenharmony_ci u16 bcn_interval, atim_window; 137762306a36Sopenharmony_ci 137862306a36Sopenharmony_ci bcn_interval = mac->beacon_interval; 137962306a36Sopenharmony_ci atim_window = 2; /*FIX MERGE */ 138062306a36Sopenharmony_ci rtl92ce_disable_interrupt(hw); 138162306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_ATIMWND, atim_window); 138262306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_BCN_INTERVAL, bcn_interval); 138362306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_BCNTCFG, 0x660f); 138462306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RXTSF_OFFSET_CCK, 0x18); 138562306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_RXTSF_OFFSET_OFDM, 0x18); 138662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x606, 0x30); 138762306a36Sopenharmony_ci rtl92ce_enable_interrupt(hw); 138862306a36Sopenharmony_ci} 138962306a36Sopenharmony_ci 139062306a36Sopenharmony_civoid rtl92ce_set_beacon_interval(struct ieee80211_hw *hw) 139162306a36Sopenharmony_ci{ 139262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 139362306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 139462306a36Sopenharmony_ci u16 bcn_interval = mac->beacon_interval; 139562306a36Sopenharmony_ci 139662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_BEACON, DBG_DMESG, 139762306a36Sopenharmony_ci "beacon_interval:%d\n", bcn_interval); 139862306a36Sopenharmony_ci rtl92ce_disable_interrupt(hw); 139962306a36Sopenharmony_ci rtl_write_word(rtlpriv, REG_BCN_INTERVAL, bcn_interval); 140062306a36Sopenharmony_ci rtl92ce_enable_interrupt(hw); 140162306a36Sopenharmony_ci} 140262306a36Sopenharmony_ci 140362306a36Sopenharmony_civoid rtl92ce_update_interrupt_mask(struct ieee80211_hw *hw, 140462306a36Sopenharmony_ci u32 add_msr, u32 rm_msr) 140562306a36Sopenharmony_ci{ 140662306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 140762306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 140862306a36Sopenharmony_ci 140962306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INTR, DBG_LOUD, "add_msr:%x, rm_msr:%x\n", 141062306a36Sopenharmony_ci add_msr, rm_msr); 141162306a36Sopenharmony_ci 141262306a36Sopenharmony_ci if (add_msr) 141362306a36Sopenharmony_ci rtlpci->irq_mask[0] |= add_msr; 141462306a36Sopenharmony_ci if (rm_msr) 141562306a36Sopenharmony_ci rtlpci->irq_mask[0] &= (~rm_msr); 141662306a36Sopenharmony_ci rtl92ce_disable_interrupt(hw); 141762306a36Sopenharmony_ci rtl92ce_enable_interrupt(hw); 141862306a36Sopenharmony_ci} 141962306a36Sopenharmony_ci 142062306a36Sopenharmony_cistatic void _rtl92ce_read_txpower_info_from_hwpg(struct ieee80211_hw *hw, 142162306a36Sopenharmony_ci bool autoload_fail, 142262306a36Sopenharmony_ci u8 *hwinfo) 142362306a36Sopenharmony_ci{ 142462306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 142562306a36Sopenharmony_ci struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw)); 142662306a36Sopenharmony_ci u8 rf_path, index, tempval; 142762306a36Sopenharmony_ci u16 i; 142862306a36Sopenharmony_ci 142962306a36Sopenharmony_ci for (rf_path = 0; rf_path < 2; rf_path++) { 143062306a36Sopenharmony_ci for (i = 0; i < 3; i++) { 143162306a36Sopenharmony_ci if (!autoload_fail && 143262306a36Sopenharmony_ci hwinfo[EEPROM_TXPOWERCCK + rf_path * 3 + i] != 0xff && 143362306a36Sopenharmony_ci hwinfo[EEPROM_TXPOWERHT40_1S + rf_path * 3 + i] != 0xff) { 143462306a36Sopenharmony_ci rtlefuse-> 143562306a36Sopenharmony_ci eeprom_chnlarea_txpwr_cck[rf_path][i] = 143662306a36Sopenharmony_ci hwinfo[EEPROM_TXPOWERCCK + rf_path * 3 + i]; 143762306a36Sopenharmony_ci rtlefuse-> 143862306a36Sopenharmony_ci eeprom_chnlarea_txpwr_ht40_1s[rf_path][i] = 143962306a36Sopenharmony_ci hwinfo[EEPROM_TXPOWERHT40_1S + rf_path * 3 + 144062306a36Sopenharmony_ci i]; 144162306a36Sopenharmony_ci } else { 144262306a36Sopenharmony_ci rtlefuse-> 144362306a36Sopenharmony_ci eeprom_chnlarea_txpwr_cck[rf_path][i] = 144462306a36Sopenharmony_ci EEPROM_DEFAULT_TXPOWERLEVEL; 144562306a36Sopenharmony_ci rtlefuse-> 144662306a36Sopenharmony_ci eeprom_chnlarea_txpwr_ht40_1s[rf_path][i] = 144762306a36Sopenharmony_ci EEPROM_DEFAULT_TXPOWERLEVEL; 144862306a36Sopenharmony_ci } 144962306a36Sopenharmony_ci } 145062306a36Sopenharmony_ci } 145162306a36Sopenharmony_ci 145262306a36Sopenharmony_ci for (i = 0; i < 3; i++) { 145362306a36Sopenharmony_ci if (!autoload_fail && 145462306a36Sopenharmony_ci hwinfo[EEPROM_TXPOWERHT40_2SDIFF + i] != 0xff) 145562306a36Sopenharmony_ci tempval = hwinfo[EEPROM_TXPOWERHT40_2SDIFF + i]; 145662306a36Sopenharmony_ci else 145762306a36Sopenharmony_ci tempval = EEPROM_DEFAULT_HT40_2SDIFF; 145862306a36Sopenharmony_ci rtlefuse->eprom_chnl_txpwr_ht40_2sdf[RF90_PATH_A][i] = 145962306a36Sopenharmony_ci (tempval & 0xf); 146062306a36Sopenharmony_ci rtlefuse->eprom_chnl_txpwr_ht40_2sdf[RF90_PATH_B][i] = 146162306a36Sopenharmony_ci ((tempval & 0xf0) >> 4); 146262306a36Sopenharmony_ci } 146362306a36Sopenharmony_ci 146462306a36Sopenharmony_ci for (rf_path = 0; rf_path < 2; rf_path++) 146562306a36Sopenharmony_ci for (i = 0; i < 3; i++) 146662306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_EEPROM, 146762306a36Sopenharmony_ci "RF(%d) EEPROM CCK Area(%d) = 0x%x\n", 146862306a36Sopenharmony_ci rf_path, i, 146962306a36Sopenharmony_ci rtlefuse-> 147062306a36Sopenharmony_ci eeprom_chnlarea_txpwr_cck[rf_path][i]); 147162306a36Sopenharmony_ci for (rf_path = 0; rf_path < 2; rf_path++) 147262306a36Sopenharmony_ci for (i = 0; i < 3; i++) 147362306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_EEPROM, 147462306a36Sopenharmony_ci "RF(%d) EEPROM HT40 1S Area(%d) = 0x%x\n", 147562306a36Sopenharmony_ci rf_path, i, 147662306a36Sopenharmony_ci rtlefuse-> 147762306a36Sopenharmony_ci eeprom_chnlarea_txpwr_ht40_1s[rf_path][i]); 147862306a36Sopenharmony_ci for (rf_path = 0; rf_path < 2; rf_path++) 147962306a36Sopenharmony_ci for (i = 0; i < 3; i++) 148062306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_EEPROM, 148162306a36Sopenharmony_ci "RF(%d) EEPROM HT40 2S Diff Area(%d) = 0x%x\n", 148262306a36Sopenharmony_ci rf_path, i, 148362306a36Sopenharmony_ci rtlefuse-> 148462306a36Sopenharmony_ci eprom_chnl_txpwr_ht40_2sdf[rf_path][i]); 148562306a36Sopenharmony_ci 148662306a36Sopenharmony_ci for (rf_path = 0; rf_path < 2; rf_path++) { 148762306a36Sopenharmony_ci for (i = 0; i < 14; i++) { 148862306a36Sopenharmony_ci index = rtl92c_get_chnl_group((u8)i); 148962306a36Sopenharmony_ci 149062306a36Sopenharmony_ci rtlefuse->txpwrlevel_cck[rf_path][i] = 149162306a36Sopenharmony_ci rtlefuse->eeprom_chnlarea_txpwr_cck[rf_path][index]; 149262306a36Sopenharmony_ci rtlefuse->txpwrlevel_ht40_1s[rf_path][i] = 149362306a36Sopenharmony_ci rtlefuse-> 149462306a36Sopenharmony_ci eeprom_chnlarea_txpwr_ht40_1s[rf_path][index]; 149562306a36Sopenharmony_ci 149662306a36Sopenharmony_ci if ((rtlefuse-> 149762306a36Sopenharmony_ci eeprom_chnlarea_txpwr_ht40_1s[rf_path][index] - 149862306a36Sopenharmony_ci rtlefuse-> 149962306a36Sopenharmony_ci eprom_chnl_txpwr_ht40_2sdf[rf_path][index]) 150062306a36Sopenharmony_ci > 0) { 150162306a36Sopenharmony_ci rtlefuse->txpwrlevel_ht40_2s[rf_path][i] = 150262306a36Sopenharmony_ci rtlefuse-> 150362306a36Sopenharmony_ci eeprom_chnlarea_txpwr_ht40_1s[rf_path] 150462306a36Sopenharmony_ci [index] - 150562306a36Sopenharmony_ci rtlefuse-> 150662306a36Sopenharmony_ci eprom_chnl_txpwr_ht40_2sdf[rf_path] 150762306a36Sopenharmony_ci [index]; 150862306a36Sopenharmony_ci } else { 150962306a36Sopenharmony_ci rtlefuse->txpwrlevel_ht40_2s[rf_path][i] = 0; 151062306a36Sopenharmony_ci } 151162306a36Sopenharmony_ci } 151262306a36Sopenharmony_ci 151362306a36Sopenharmony_ci for (i = 0; i < 14; i++) { 151462306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 151562306a36Sopenharmony_ci "RF(%d)-Ch(%d) [CCK / HT40_1S / HT40_2S] = [0x%x / 0x%x / 0x%x]\n", 151662306a36Sopenharmony_ci rf_path, i, 151762306a36Sopenharmony_ci rtlefuse->txpwrlevel_cck[rf_path][i], 151862306a36Sopenharmony_ci rtlefuse->txpwrlevel_ht40_1s[rf_path][i], 151962306a36Sopenharmony_ci rtlefuse->txpwrlevel_ht40_2s[rf_path][i]); 152062306a36Sopenharmony_ci } 152162306a36Sopenharmony_ci } 152262306a36Sopenharmony_ci 152362306a36Sopenharmony_ci for (i = 0; i < 3; i++) { 152462306a36Sopenharmony_ci if (!autoload_fail && 152562306a36Sopenharmony_ci hwinfo[EEPROM_TXPWR_GROUP + i] != 0xff && 152662306a36Sopenharmony_ci hwinfo[EEPROM_TXPWR_GROUP + 3 + i] != 0xff) { 152762306a36Sopenharmony_ci rtlefuse->eeprom_pwrlimit_ht40[i] = 152862306a36Sopenharmony_ci hwinfo[EEPROM_TXPWR_GROUP + i]; 152962306a36Sopenharmony_ci rtlefuse->eeprom_pwrlimit_ht20[i] = 153062306a36Sopenharmony_ci hwinfo[EEPROM_TXPWR_GROUP + 3 + i]; 153162306a36Sopenharmony_ci } else { 153262306a36Sopenharmony_ci rtlefuse->eeprom_pwrlimit_ht40[i] = 0; 153362306a36Sopenharmony_ci rtlefuse->eeprom_pwrlimit_ht20[i] = 0; 153462306a36Sopenharmony_ci } 153562306a36Sopenharmony_ci } 153662306a36Sopenharmony_ci 153762306a36Sopenharmony_ci for (rf_path = 0; rf_path < 2; rf_path++) { 153862306a36Sopenharmony_ci for (i = 0; i < 14; i++) { 153962306a36Sopenharmony_ci index = rtl92c_get_chnl_group((u8)i); 154062306a36Sopenharmony_ci 154162306a36Sopenharmony_ci if (rf_path == RF90_PATH_A) { 154262306a36Sopenharmony_ci rtlefuse->pwrgroup_ht20[rf_path][i] = 154362306a36Sopenharmony_ci (rtlefuse->eeprom_pwrlimit_ht20[index] 154462306a36Sopenharmony_ci & 0xf); 154562306a36Sopenharmony_ci rtlefuse->pwrgroup_ht40[rf_path][i] = 154662306a36Sopenharmony_ci (rtlefuse->eeprom_pwrlimit_ht40[index] 154762306a36Sopenharmony_ci & 0xf); 154862306a36Sopenharmony_ci } else if (rf_path == RF90_PATH_B) { 154962306a36Sopenharmony_ci rtlefuse->pwrgroup_ht20[rf_path][i] = 155062306a36Sopenharmony_ci ((rtlefuse->eeprom_pwrlimit_ht20[index] 155162306a36Sopenharmony_ci & 0xf0) >> 4); 155262306a36Sopenharmony_ci rtlefuse->pwrgroup_ht40[rf_path][i] = 155362306a36Sopenharmony_ci ((rtlefuse->eeprom_pwrlimit_ht40[index] 155462306a36Sopenharmony_ci & 0xf0) >> 4); 155562306a36Sopenharmony_ci } 155662306a36Sopenharmony_ci 155762306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 155862306a36Sopenharmony_ci "RF-%d pwrgroup_ht20[%d] = 0x%x\n", 155962306a36Sopenharmony_ci rf_path, i, 156062306a36Sopenharmony_ci rtlefuse->pwrgroup_ht20[rf_path][i]); 156162306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 156262306a36Sopenharmony_ci "RF-%d pwrgroup_ht40[%d] = 0x%x\n", 156362306a36Sopenharmony_ci rf_path, i, 156462306a36Sopenharmony_ci rtlefuse->pwrgroup_ht40[rf_path][i]); 156562306a36Sopenharmony_ci } 156662306a36Sopenharmony_ci } 156762306a36Sopenharmony_ci 156862306a36Sopenharmony_ci for (i = 0; i < 14; i++) { 156962306a36Sopenharmony_ci index = rtl92c_get_chnl_group((u8)i); 157062306a36Sopenharmony_ci 157162306a36Sopenharmony_ci if (!autoload_fail && 157262306a36Sopenharmony_ci hwinfo[EEPROM_TXPOWERHT20DIFF + index] != 0xff) 157362306a36Sopenharmony_ci tempval = hwinfo[EEPROM_TXPOWERHT20DIFF + index]; 157462306a36Sopenharmony_ci else 157562306a36Sopenharmony_ci tempval = EEPROM_DEFAULT_HT20_DIFF; 157662306a36Sopenharmony_ci 157762306a36Sopenharmony_ci rtlefuse->txpwr_ht20diff[RF90_PATH_A][i] = (tempval & 0xF); 157862306a36Sopenharmony_ci rtlefuse->txpwr_ht20diff[RF90_PATH_B][i] = 157962306a36Sopenharmony_ci ((tempval >> 4) & 0xF); 158062306a36Sopenharmony_ci 158162306a36Sopenharmony_ci if (rtlefuse->txpwr_ht20diff[RF90_PATH_A][i] & BIT(3)) 158262306a36Sopenharmony_ci rtlefuse->txpwr_ht20diff[RF90_PATH_A][i] |= 0xF0; 158362306a36Sopenharmony_ci 158462306a36Sopenharmony_ci if (rtlefuse->txpwr_ht20diff[RF90_PATH_B][i] & BIT(3)) 158562306a36Sopenharmony_ci rtlefuse->txpwr_ht20diff[RF90_PATH_B][i] |= 0xF0; 158662306a36Sopenharmony_ci 158762306a36Sopenharmony_ci index = rtl92c_get_chnl_group((u8)i); 158862306a36Sopenharmony_ci 158962306a36Sopenharmony_ci if (!autoload_fail && 159062306a36Sopenharmony_ci hwinfo[EEPROM_TXPOWER_OFDMDIFF + index] != 0xff) 159162306a36Sopenharmony_ci tempval = hwinfo[EEPROM_TXPOWER_OFDMDIFF + index]; 159262306a36Sopenharmony_ci else 159362306a36Sopenharmony_ci tempval = EEPROM_DEFAULT_LEGACYHTTXPOWERDIFF; 159462306a36Sopenharmony_ci 159562306a36Sopenharmony_ci rtlefuse->txpwr_legacyhtdiff[RF90_PATH_A][i] = (tempval & 0xF); 159662306a36Sopenharmony_ci rtlefuse->txpwr_legacyhtdiff[RF90_PATH_B][i] = 159762306a36Sopenharmony_ci ((tempval >> 4) & 0xF); 159862306a36Sopenharmony_ci } 159962306a36Sopenharmony_ci 160062306a36Sopenharmony_ci rtlefuse->legacy_ht_txpowerdiff = 160162306a36Sopenharmony_ci rtlefuse->txpwr_legacyhtdiff[RF90_PATH_A][7]; 160262306a36Sopenharmony_ci 160362306a36Sopenharmony_ci for (i = 0; i < 14; i++) 160462306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 160562306a36Sopenharmony_ci "RF-A Ht20 to HT40 Diff[%d] = 0x%x\n", 160662306a36Sopenharmony_ci i, rtlefuse->txpwr_ht20diff[RF90_PATH_A][i]); 160762306a36Sopenharmony_ci for (i = 0; i < 14; i++) 160862306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 160962306a36Sopenharmony_ci "RF-A Legacy to Ht40 Diff[%d] = 0x%x\n", 161062306a36Sopenharmony_ci i, rtlefuse->txpwr_legacyhtdiff[RF90_PATH_A][i]); 161162306a36Sopenharmony_ci for (i = 0; i < 14; i++) 161262306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 161362306a36Sopenharmony_ci "RF-B Ht20 to HT40 Diff[%d] = 0x%x\n", 161462306a36Sopenharmony_ci i, rtlefuse->txpwr_ht20diff[RF90_PATH_B][i]); 161562306a36Sopenharmony_ci for (i = 0; i < 14; i++) 161662306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 161762306a36Sopenharmony_ci "RF-B Legacy to HT40 Diff[%d] = 0x%x\n", 161862306a36Sopenharmony_ci i, rtlefuse->txpwr_legacyhtdiff[RF90_PATH_B][i]); 161962306a36Sopenharmony_ci 162062306a36Sopenharmony_ci if (!autoload_fail && hwinfo[RF_OPTION1] != 0xff) 162162306a36Sopenharmony_ci rtlefuse->eeprom_regulatory = (hwinfo[RF_OPTION1] & 0x7); 162262306a36Sopenharmony_ci else 162362306a36Sopenharmony_ci rtlefuse->eeprom_regulatory = 0; 162462306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 162562306a36Sopenharmony_ci "eeprom_regulatory = 0x%x\n", rtlefuse->eeprom_regulatory); 162662306a36Sopenharmony_ci 162762306a36Sopenharmony_ci if (!autoload_fail && 162862306a36Sopenharmony_ci hwinfo[EEPROM_TSSI_A] != 0xff && 162962306a36Sopenharmony_ci hwinfo[EEPROM_TSSI_B] != 0xff) { 163062306a36Sopenharmony_ci rtlefuse->eeprom_tssi[RF90_PATH_A] = hwinfo[EEPROM_TSSI_A]; 163162306a36Sopenharmony_ci rtlefuse->eeprom_tssi[RF90_PATH_B] = hwinfo[EEPROM_TSSI_B]; 163262306a36Sopenharmony_ci } else { 163362306a36Sopenharmony_ci rtlefuse->eeprom_tssi[RF90_PATH_A] = EEPROM_DEFAULT_TSSI; 163462306a36Sopenharmony_ci rtlefuse->eeprom_tssi[RF90_PATH_B] = EEPROM_DEFAULT_TSSI; 163562306a36Sopenharmony_ci } 163662306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, "TSSI_A = 0x%x, TSSI_B = 0x%x\n", 163762306a36Sopenharmony_ci rtlefuse->eeprom_tssi[RF90_PATH_A], 163862306a36Sopenharmony_ci rtlefuse->eeprom_tssi[RF90_PATH_B]); 163962306a36Sopenharmony_ci 164062306a36Sopenharmony_ci if (!autoload_fail && hwinfo[EEPROM_THERMAL_METER] != 0xff) 164162306a36Sopenharmony_ci tempval = hwinfo[EEPROM_THERMAL_METER]; 164262306a36Sopenharmony_ci else 164362306a36Sopenharmony_ci tempval = EEPROM_DEFAULT_THERMALMETER; 164462306a36Sopenharmony_ci rtlefuse->eeprom_thermalmeter = (tempval & 0x1f); 164562306a36Sopenharmony_ci 164662306a36Sopenharmony_ci if (rtlefuse->eeprom_thermalmeter == 0x1f || autoload_fail) 164762306a36Sopenharmony_ci rtlefuse->apk_thermalmeterignore = true; 164862306a36Sopenharmony_ci 164962306a36Sopenharmony_ci rtlefuse->thermalmeter[0] = rtlefuse->eeprom_thermalmeter; 165062306a36Sopenharmony_ci RTPRINT(rtlpriv, FINIT, INIT_TXPOWER, 165162306a36Sopenharmony_ci "thermalmeter = 0x%x\n", rtlefuse->eeprom_thermalmeter); 165262306a36Sopenharmony_ci} 165362306a36Sopenharmony_ci 165462306a36Sopenharmony_cistatic void _rtl92ce_read_adapter_info(struct ieee80211_hw *hw) 165562306a36Sopenharmony_ci{ 165662306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 165762306a36Sopenharmony_ci struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw)); 165862306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 165962306a36Sopenharmony_ci int params[] = {RTL8190_EEPROM_ID, EEPROM_VID, EEPROM_DID, 166062306a36Sopenharmony_ci EEPROM_SVID, EEPROM_SMID, EEPROM_MAC_ADDR, 166162306a36Sopenharmony_ci EEPROM_CHANNELPLAN, EEPROM_VERSION, EEPROM_CUSTOMER_ID, 166262306a36Sopenharmony_ci COUNTRY_CODE_WORLD_WIDE_13}; 166362306a36Sopenharmony_ci u8 *hwinfo; 166462306a36Sopenharmony_ci 166562306a36Sopenharmony_ci hwinfo = kzalloc(HWSET_MAX_SIZE, GFP_KERNEL); 166662306a36Sopenharmony_ci if (!hwinfo) 166762306a36Sopenharmony_ci return; 166862306a36Sopenharmony_ci 166962306a36Sopenharmony_ci if (rtl_get_hwinfo(hw, rtlpriv, HWSET_MAX_SIZE, hwinfo, params)) 167062306a36Sopenharmony_ci goto exit; 167162306a36Sopenharmony_ci 167262306a36Sopenharmony_ci _rtl92ce_read_txpower_info_from_hwpg(hw, 167362306a36Sopenharmony_ci rtlefuse->autoload_failflag, 167462306a36Sopenharmony_ci hwinfo); 167562306a36Sopenharmony_ci 167662306a36Sopenharmony_ci rtl8192ce_read_bt_coexist_info_from_hwpg(hw, 167762306a36Sopenharmony_ci rtlefuse->autoload_failflag, 167862306a36Sopenharmony_ci hwinfo); 167962306a36Sopenharmony_ci if (rtlhal->oem_id == RT_CID_DEFAULT) { 168062306a36Sopenharmony_ci switch (rtlefuse->eeprom_oemid) { 168162306a36Sopenharmony_ci case EEPROM_CID_DEFAULT: 168262306a36Sopenharmony_ci if (rtlefuse->eeprom_did == 0x8176) { 168362306a36Sopenharmony_ci if ((rtlefuse->eeprom_svid == 0x103C && 168462306a36Sopenharmony_ci rtlefuse->eeprom_smid == 0x1629)) 168562306a36Sopenharmony_ci rtlhal->oem_id = RT_CID_819X_HP; 168662306a36Sopenharmony_ci else 168762306a36Sopenharmony_ci rtlhal->oem_id = RT_CID_DEFAULT; 168862306a36Sopenharmony_ci } else { 168962306a36Sopenharmony_ci rtlhal->oem_id = RT_CID_DEFAULT; 169062306a36Sopenharmony_ci } 169162306a36Sopenharmony_ci break; 169262306a36Sopenharmony_ci case EEPROM_CID_TOSHIBA: 169362306a36Sopenharmony_ci rtlhal->oem_id = RT_CID_TOSHIBA; 169462306a36Sopenharmony_ci break; 169562306a36Sopenharmony_ci case EEPROM_CID_QMI: 169662306a36Sopenharmony_ci rtlhal->oem_id = RT_CID_819X_QMI; 169762306a36Sopenharmony_ci break; 169862306a36Sopenharmony_ci case EEPROM_CID_WHQL: 169962306a36Sopenharmony_ci default: 170062306a36Sopenharmony_ci rtlhal->oem_id = RT_CID_DEFAULT; 170162306a36Sopenharmony_ci break; 170262306a36Sopenharmony_ci } 170362306a36Sopenharmony_ci } 170462306a36Sopenharmony_ciexit: 170562306a36Sopenharmony_ci kfree(hwinfo); 170662306a36Sopenharmony_ci} 170762306a36Sopenharmony_ci 170862306a36Sopenharmony_cistatic void _rtl92ce_hal_customized_behavior(struct ieee80211_hw *hw) 170962306a36Sopenharmony_ci{ 171062306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 171162306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 171262306a36Sopenharmony_ci 171362306a36Sopenharmony_ci switch (rtlhal->oem_id) { 171462306a36Sopenharmony_ci case RT_CID_819X_HP: 171562306a36Sopenharmony_ci rtlpriv->ledctl.led_opendrain = true; 171662306a36Sopenharmony_ci break; 171762306a36Sopenharmony_ci case RT_CID_819X_LENOVO: 171862306a36Sopenharmony_ci case RT_CID_DEFAULT: 171962306a36Sopenharmony_ci case RT_CID_TOSHIBA: 172062306a36Sopenharmony_ci case RT_CID_CCX: 172162306a36Sopenharmony_ci case RT_CID_819X_ACER: 172262306a36Sopenharmony_ci case RT_CID_WHQL: 172362306a36Sopenharmony_ci default: 172462306a36Sopenharmony_ci break; 172562306a36Sopenharmony_ci } 172662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG, 172762306a36Sopenharmony_ci "RT Customized ID: 0x%02X\n", rtlhal->oem_id); 172862306a36Sopenharmony_ci} 172962306a36Sopenharmony_ci 173062306a36Sopenharmony_civoid rtl92ce_read_eeprom_info(struct ieee80211_hw *hw) 173162306a36Sopenharmony_ci{ 173262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 173362306a36Sopenharmony_ci struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw)); 173462306a36Sopenharmony_ci struct rtl_phy *rtlphy = &(rtlpriv->phy); 173562306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 173662306a36Sopenharmony_ci u8 tmp_u1b; 173762306a36Sopenharmony_ci 173862306a36Sopenharmony_ci rtlhal->version = _rtl92ce_read_chip_version(hw); 173962306a36Sopenharmony_ci if (get_rf_type(rtlphy) == RF_1T1R) 174062306a36Sopenharmony_ci rtlpriv->dm.rfpath_rxenable[0] = true; 174162306a36Sopenharmony_ci else 174262306a36Sopenharmony_ci rtlpriv->dm.rfpath_rxenable[0] = 174362306a36Sopenharmony_ci rtlpriv->dm.rfpath_rxenable[1] = true; 174462306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, "VersionID = 0x%4x\n", 174562306a36Sopenharmony_ci rtlhal->version); 174662306a36Sopenharmony_ci tmp_u1b = rtl_read_byte(rtlpriv, REG_9346CR); 174762306a36Sopenharmony_ci if (tmp_u1b & BIT(4)) { 174862306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG, "Boot from EEPROM\n"); 174962306a36Sopenharmony_ci rtlefuse->epromtype = EEPROM_93C46; 175062306a36Sopenharmony_ci } else { 175162306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG, "Boot from EFUSE\n"); 175262306a36Sopenharmony_ci rtlefuse->epromtype = EEPROM_BOOT_EFUSE; 175362306a36Sopenharmony_ci } 175462306a36Sopenharmony_ci if (tmp_u1b & BIT(5)) { 175562306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, "Autoload OK\n"); 175662306a36Sopenharmony_ci rtlefuse->autoload_failflag = false; 175762306a36Sopenharmony_ci _rtl92ce_read_adapter_info(hw); 175862306a36Sopenharmony_ci } else { 175962306a36Sopenharmony_ci pr_err("Autoload ERR!!\n"); 176062306a36Sopenharmony_ci } 176162306a36Sopenharmony_ci _rtl92ce_hal_customized_behavior(hw); 176262306a36Sopenharmony_ci} 176362306a36Sopenharmony_ci 176462306a36Sopenharmony_cistatic void rtl92ce_update_hal_rate_table(struct ieee80211_hw *hw, 176562306a36Sopenharmony_ci struct ieee80211_sta *sta) 176662306a36Sopenharmony_ci{ 176762306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 176862306a36Sopenharmony_ci struct rtl_phy *rtlphy = &(rtlpriv->phy); 176962306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 177062306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 177162306a36Sopenharmony_ci u32 ratr_value; 177262306a36Sopenharmony_ci u8 ratr_index = 0; 177362306a36Sopenharmony_ci u8 nmode = mac->ht_enable; 177462306a36Sopenharmony_ci u16 shortgi_rate; 177562306a36Sopenharmony_ci u32 tmp_ratr_value; 177662306a36Sopenharmony_ci u8 curtxbw_40mhz = mac->bw_40; 177762306a36Sopenharmony_ci u8 curshortgi_40mhz = (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_SGI_40) ? 177862306a36Sopenharmony_ci 1 : 0; 177962306a36Sopenharmony_ci u8 curshortgi_20mhz = (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_SGI_20) ? 178062306a36Sopenharmony_ci 1 : 0; 178162306a36Sopenharmony_ci enum wireless_mode wirelessmode = mac->mode; 178262306a36Sopenharmony_ci u32 ratr_mask; 178362306a36Sopenharmony_ci 178462306a36Sopenharmony_ci if (rtlhal->current_bandtype == BAND_ON_5G) 178562306a36Sopenharmony_ci ratr_value = sta->deflink.supp_rates[1] << 4; 178662306a36Sopenharmony_ci else 178762306a36Sopenharmony_ci ratr_value = sta->deflink.supp_rates[0]; 178862306a36Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_ADHOC) 178962306a36Sopenharmony_ci ratr_value = 0xfff; 179062306a36Sopenharmony_ci 179162306a36Sopenharmony_ci ratr_value |= (sta->deflink.ht_cap.mcs.rx_mask[1] << 20 | 179262306a36Sopenharmony_ci sta->deflink.ht_cap.mcs.rx_mask[0] << 12); 179362306a36Sopenharmony_ci switch (wirelessmode) { 179462306a36Sopenharmony_ci case WIRELESS_MODE_B: 179562306a36Sopenharmony_ci if (ratr_value & 0x0000000c) 179662306a36Sopenharmony_ci ratr_value &= 0x0000000d; 179762306a36Sopenharmony_ci else 179862306a36Sopenharmony_ci ratr_value &= 0x0000000f; 179962306a36Sopenharmony_ci break; 180062306a36Sopenharmony_ci case WIRELESS_MODE_G: 180162306a36Sopenharmony_ci ratr_value &= 0x00000FF5; 180262306a36Sopenharmony_ci break; 180362306a36Sopenharmony_ci case WIRELESS_MODE_N_24G: 180462306a36Sopenharmony_ci case WIRELESS_MODE_N_5G: 180562306a36Sopenharmony_ci nmode = 1; 180662306a36Sopenharmony_ci if (get_rf_type(rtlphy) == RF_1T2R || 180762306a36Sopenharmony_ci get_rf_type(rtlphy) == RF_1T1R) 180862306a36Sopenharmony_ci ratr_mask = 0x000ff005; 180962306a36Sopenharmony_ci else 181062306a36Sopenharmony_ci ratr_mask = 0x0f0ff005; 181162306a36Sopenharmony_ci 181262306a36Sopenharmony_ci ratr_value &= ratr_mask; 181362306a36Sopenharmony_ci break; 181462306a36Sopenharmony_ci default: 181562306a36Sopenharmony_ci if (rtlphy->rf_type == RF_1T2R) 181662306a36Sopenharmony_ci ratr_value &= 0x000ff0ff; 181762306a36Sopenharmony_ci else 181862306a36Sopenharmony_ci ratr_value &= 0x0f0ff0ff; 181962306a36Sopenharmony_ci 182062306a36Sopenharmony_ci break; 182162306a36Sopenharmony_ci } 182262306a36Sopenharmony_ci 182362306a36Sopenharmony_ci if ((rtlpriv->btcoexist.bt_coexistence) && 182462306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC4) && 182562306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_cur_state) && 182662306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_ant_isolation) && 182762306a36Sopenharmony_ci ((rtlpriv->btcoexist.bt_service == BT_SCO) || 182862306a36Sopenharmony_ci (rtlpriv->btcoexist.bt_service == BT_BUSY))) 182962306a36Sopenharmony_ci ratr_value &= 0x0fffcfc0; 183062306a36Sopenharmony_ci else 183162306a36Sopenharmony_ci ratr_value &= 0x0FFFFFFF; 183262306a36Sopenharmony_ci 183362306a36Sopenharmony_ci if (nmode && ((curtxbw_40mhz && 183462306a36Sopenharmony_ci curshortgi_40mhz) || (!curtxbw_40mhz && 183562306a36Sopenharmony_ci curshortgi_20mhz))) { 183662306a36Sopenharmony_ci 183762306a36Sopenharmony_ci ratr_value |= 0x10000000; 183862306a36Sopenharmony_ci tmp_ratr_value = (ratr_value >> 12); 183962306a36Sopenharmony_ci 184062306a36Sopenharmony_ci for (shortgi_rate = 15; shortgi_rate > 0; shortgi_rate--) { 184162306a36Sopenharmony_ci if ((1 << shortgi_rate) & tmp_ratr_value) 184262306a36Sopenharmony_ci break; 184362306a36Sopenharmony_ci } 184462306a36Sopenharmony_ci 184562306a36Sopenharmony_ci shortgi_rate = (shortgi_rate << 12) | (shortgi_rate << 8) | 184662306a36Sopenharmony_ci (shortgi_rate << 4) | (shortgi_rate); 184762306a36Sopenharmony_ci } 184862306a36Sopenharmony_ci 184962306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_ARFR0 + ratr_index * 4, ratr_value); 185062306a36Sopenharmony_ci 185162306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_RATR, DBG_DMESG, "%x\n", 185262306a36Sopenharmony_ci rtl_read_dword(rtlpriv, REG_ARFR0)); 185362306a36Sopenharmony_ci} 185462306a36Sopenharmony_ci 185562306a36Sopenharmony_cistatic void rtl92ce_update_hal_rate_mask(struct ieee80211_hw *hw, 185662306a36Sopenharmony_ci struct ieee80211_sta *sta, u8 rssi_level, bool update_bw) 185762306a36Sopenharmony_ci{ 185862306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 185962306a36Sopenharmony_ci struct rtl_phy *rtlphy = &(rtlpriv->phy); 186062306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 186162306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 186262306a36Sopenharmony_ci struct rtl_sta_info *sta_entry = NULL; 186362306a36Sopenharmony_ci u32 ratr_bitmap; 186462306a36Sopenharmony_ci u8 ratr_index; 186562306a36Sopenharmony_ci u8 curtxbw_40mhz = (sta->deflink.ht_cap.cap & 186662306a36Sopenharmony_ci IEEE80211_HT_CAP_SUP_WIDTH_20_40) ? 1 : 0; 186762306a36Sopenharmony_ci u8 curshortgi_40mhz = (sta->deflink.ht_cap.cap & 186862306a36Sopenharmony_ci IEEE80211_HT_CAP_SGI_40) ? 1 : 0; 186962306a36Sopenharmony_ci u8 curshortgi_20mhz = (sta->deflink.ht_cap.cap & IEEE80211_HT_CAP_SGI_20) ? 187062306a36Sopenharmony_ci 1 : 0; 187162306a36Sopenharmony_ci enum wireless_mode wirelessmode = 0; 187262306a36Sopenharmony_ci bool shortgi = false; 187362306a36Sopenharmony_ci u8 rate_mask[5]; 187462306a36Sopenharmony_ci u8 macid = 0; 187562306a36Sopenharmony_ci 187662306a36Sopenharmony_ci sta_entry = (struct rtl_sta_info *) sta->drv_priv; 187762306a36Sopenharmony_ci wirelessmode = sta_entry->wireless_mode; 187862306a36Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_STATION || 187962306a36Sopenharmony_ci mac->opmode == NL80211_IFTYPE_MESH_POINT) 188062306a36Sopenharmony_ci curtxbw_40mhz = mac->bw_40; 188162306a36Sopenharmony_ci else if (mac->opmode == NL80211_IFTYPE_AP || 188262306a36Sopenharmony_ci mac->opmode == NL80211_IFTYPE_ADHOC) 188362306a36Sopenharmony_ci macid = sta->aid + 1; 188462306a36Sopenharmony_ci 188562306a36Sopenharmony_ci if (rtlhal->current_bandtype == BAND_ON_5G) 188662306a36Sopenharmony_ci ratr_bitmap = sta->deflink.supp_rates[1] << 4; 188762306a36Sopenharmony_ci else 188862306a36Sopenharmony_ci ratr_bitmap = sta->deflink.supp_rates[0]; 188962306a36Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_ADHOC) 189062306a36Sopenharmony_ci ratr_bitmap = 0xfff; 189162306a36Sopenharmony_ci ratr_bitmap |= (sta->deflink.ht_cap.mcs.rx_mask[1] << 20 | 189262306a36Sopenharmony_ci sta->deflink.ht_cap.mcs.rx_mask[0] << 12); 189362306a36Sopenharmony_ci switch (wirelessmode) { 189462306a36Sopenharmony_ci case WIRELESS_MODE_B: 189562306a36Sopenharmony_ci ratr_index = RATR_INX_WIRELESS_B; 189662306a36Sopenharmony_ci if (ratr_bitmap & 0x0000000c) 189762306a36Sopenharmony_ci ratr_bitmap &= 0x0000000d; 189862306a36Sopenharmony_ci else 189962306a36Sopenharmony_ci ratr_bitmap &= 0x0000000f; 190062306a36Sopenharmony_ci break; 190162306a36Sopenharmony_ci case WIRELESS_MODE_G: 190262306a36Sopenharmony_ci ratr_index = RATR_INX_WIRELESS_GB; 190362306a36Sopenharmony_ci 190462306a36Sopenharmony_ci if (rssi_level == 1) 190562306a36Sopenharmony_ci ratr_bitmap &= 0x00000f00; 190662306a36Sopenharmony_ci else if (rssi_level == 2) 190762306a36Sopenharmony_ci ratr_bitmap &= 0x00000ff0; 190862306a36Sopenharmony_ci else 190962306a36Sopenharmony_ci ratr_bitmap &= 0x00000ff5; 191062306a36Sopenharmony_ci break; 191162306a36Sopenharmony_ci case WIRELESS_MODE_A: 191262306a36Sopenharmony_ci ratr_index = RATR_INX_WIRELESS_A; 191362306a36Sopenharmony_ci ratr_bitmap &= 0x00000ff0; 191462306a36Sopenharmony_ci break; 191562306a36Sopenharmony_ci case WIRELESS_MODE_N_24G: 191662306a36Sopenharmony_ci case WIRELESS_MODE_N_5G: 191762306a36Sopenharmony_ci ratr_index = RATR_INX_WIRELESS_NGB; 191862306a36Sopenharmony_ci 191962306a36Sopenharmony_ci if (rtlphy->rf_type == RF_1T2R || 192062306a36Sopenharmony_ci rtlphy->rf_type == RF_1T1R) { 192162306a36Sopenharmony_ci if (curtxbw_40mhz) { 192262306a36Sopenharmony_ci if (rssi_level == 1) 192362306a36Sopenharmony_ci ratr_bitmap &= 0x000f0000; 192462306a36Sopenharmony_ci else if (rssi_level == 2) 192562306a36Sopenharmony_ci ratr_bitmap &= 0x000ff000; 192662306a36Sopenharmony_ci else 192762306a36Sopenharmony_ci ratr_bitmap &= 0x000ff015; 192862306a36Sopenharmony_ci } else { 192962306a36Sopenharmony_ci if (rssi_level == 1) 193062306a36Sopenharmony_ci ratr_bitmap &= 0x000f0000; 193162306a36Sopenharmony_ci else if (rssi_level == 2) 193262306a36Sopenharmony_ci ratr_bitmap &= 0x000ff000; 193362306a36Sopenharmony_ci else 193462306a36Sopenharmony_ci ratr_bitmap &= 0x000ff005; 193562306a36Sopenharmony_ci } 193662306a36Sopenharmony_ci } else { 193762306a36Sopenharmony_ci if (curtxbw_40mhz) { 193862306a36Sopenharmony_ci if (rssi_level == 1) 193962306a36Sopenharmony_ci ratr_bitmap &= 0x0f0f0000; 194062306a36Sopenharmony_ci else if (rssi_level == 2) 194162306a36Sopenharmony_ci ratr_bitmap &= 0x0f0ff000; 194262306a36Sopenharmony_ci else 194362306a36Sopenharmony_ci ratr_bitmap &= 0x0f0ff015; 194462306a36Sopenharmony_ci } else { 194562306a36Sopenharmony_ci if (rssi_level == 1) 194662306a36Sopenharmony_ci ratr_bitmap &= 0x0f0f0000; 194762306a36Sopenharmony_ci else if (rssi_level == 2) 194862306a36Sopenharmony_ci ratr_bitmap &= 0x0f0ff000; 194962306a36Sopenharmony_ci else 195062306a36Sopenharmony_ci ratr_bitmap &= 0x0f0ff005; 195162306a36Sopenharmony_ci } 195262306a36Sopenharmony_ci } 195362306a36Sopenharmony_ci 195462306a36Sopenharmony_ci if ((curtxbw_40mhz && curshortgi_40mhz) || 195562306a36Sopenharmony_ci (!curtxbw_40mhz && curshortgi_20mhz)) { 195662306a36Sopenharmony_ci 195762306a36Sopenharmony_ci if (macid == 0) 195862306a36Sopenharmony_ci shortgi = true; 195962306a36Sopenharmony_ci else if (macid == 1) 196062306a36Sopenharmony_ci shortgi = false; 196162306a36Sopenharmony_ci } 196262306a36Sopenharmony_ci break; 196362306a36Sopenharmony_ci default: 196462306a36Sopenharmony_ci ratr_index = RATR_INX_WIRELESS_NGB; 196562306a36Sopenharmony_ci 196662306a36Sopenharmony_ci if (rtlphy->rf_type == RF_1T2R) 196762306a36Sopenharmony_ci ratr_bitmap &= 0x000ff0ff; 196862306a36Sopenharmony_ci else 196962306a36Sopenharmony_ci ratr_bitmap &= 0x0f0ff0ff; 197062306a36Sopenharmony_ci break; 197162306a36Sopenharmony_ci } 197262306a36Sopenharmony_ci sta_entry->ratr_index = ratr_index; 197362306a36Sopenharmony_ci 197462306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_RATR, DBG_DMESG, 197562306a36Sopenharmony_ci "ratr_bitmap :%x\n", ratr_bitmap); 197662306a36Sopenharmony_ci *(u32 *)&rate_mask = (ratr_bitmap & 0x0fffffff) | 197762306a36Sopenharmony_ci (ratr_index << 28); 197862306a36Sopenharmony_ci rate_mask[4] = macid | (shortgi ? 0x20 : 0x00) | 0x80; 197962306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_RATR, DBG_DMESG, 198062306a36Sopenharmony_ci "Rate_index:%x, ratr_val:%x, %5phC\n", 198162306a36Sopenharmony_ci ratr_index, ratr_bitmap, rate_mask); 198262306a36Sopenharmony_ci rtl92c_fill_h2c_cmd(hw, H2C_RA_MASK, 5, rate_mask); 198362306a36Sopenharmony_ci} 198462306a36Sopenharmony_ci 198562306a36Sopenharmony_civoid rtl92ce_update_hal_rate_tbl(struct ieee80211_hw *hw, 198662306a36Sopenharmony_ci struct ieee80211_sta *sta, u8 rssi_level, bool update_bw) 198762306a36Sopenharmony_ci{ 198862306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 198962306a36Sopenharmony_ci 199062306a36Sopenharmony_ci if (rtlpriv->dm.useramask) 199162306a36Sopenharmony_ci rtl92ce_update_hal_rate_mask(hw, sta, rssi_level, update_bw); 199262306a36Sopenharmony_ci else 199362306a36Sopenharmony_ci rtl92ce_update_hal_rate_table(hw, sta); 199462306a36Sopenharmony_ci} 199562306a36Sopenharmony_ci 199662306a36Sopenharmony_civoid rtl92ce_update_channel_access_setting(struct ieee80211_hw *hw) 199762306a36Sopenharmony_ci{ 199862306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 199962306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 200062306a36Sopenharmony_ci u16 sifs_timer; 200162306a36Sopenharmony_ci 200262306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SLOT_TIME, 200362306a36Sopenharmony_ci &mac->slot_time); 200462306a36Sopenharmony_ci if (!mac->ht_enable) 200562306a36Sopenharmony_ci sifs_timer = 0x0a0a; 200662306a36Sopenharmony_ci else 200762306a36Sopenharmony_ci sifs_timer = 0x1010; 200862306a36Sopenharmony_ci rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SIFS, (u8 *)&sifs_timer); 200962306a36Sopenharmony_ci} 201062306a36Sopenharmony_ci 201162306a36Sopenharmony_cibool rtl92ce_gpio_radio_on_off_checking(struct ieee80211_hw *hw, u8 *valid) 201262306a36Sopenharmony_ci{ 201362306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 201462306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 201562306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 201662306a36Sopenharmony_ci enum rf_pwrstate e_rfpowerstate_toset; 201762306a36Sopenharmony_ci u8 u1tmp; 201862306a36Sopenharmony_ci bool actuallyset = false; 201962306a36Sopenharmony_ci unsigned long flag; 202062306a36Sopenharmony_ci 202162306a36Sopenharmony_ci if (rtlpci->being_init_adapter) 202262306a36Sopenharmony_ci return false; 202362306a36Sopenharmony_ci 202462306a36Sopenharmony_ci if (ppsc->swrf_processing) 202562306a36Sopenharmony_ci return false; 202662306a36Sopenharmony_ci 202762306a36Sopenharmony_ci spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flag); 202862306a36Sopenharmony_ci if (ppsc->rfchange_inprogress) { 202962306a36Sopenharmony_ci spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flag); 203062306a36Sopenharmony_ci return false; 203162306a36Sopenharmony_ci } else { 203262306a36Sopenharmony_ci ppsc->rfchange_inprogress = true; 203362306a36Sopenharmony_ci spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flag); 203462306a36Sopenharmony_ci } 203562306a36Sopenharmony_ci 203662306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_MAC_PINMUX_CFG, rtl_read_byte(rtlpriv, 203762306a36Sopenharmony_ci REG_MAC_PINMUX_CFG)&~(BIT(3))); 203862306a36Sopenharmony_ci 203962306a36Sopenharmony_ci u1tmp = rtl_read_byte(rtlpriv, REG_GPIO_IO_SEL); 204062306a36Sopenharmony_ci e_rfpowerstate_toset = (u1tmp & BIT(3)) ? ERFON : ERFOFF; 204162306a36Sopenharmony_ci 204262306a36Sopenharmony_ci if ((ppsc->hwradiooff) && (e_rfpowerstate_toset == ERFON)) { 204362306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_RF, DBG_DMESG, 204462306a36Sopenharmony_ci "GPIOChangeRF - HW Radio ON, RF ON\n"); 204562306a36Sopenharmony_ci 204662306a36Sopenharmony_ci e_rfpowerstate_toset = ERFON; 204762306a36Sopenharmony_ci ppsc->hwradiooff = false; 204862306a36Sopenharmony_ci actuallyset = true; 204962306a36Sopenharmony_ci } else if (!ppsc->hwradiooff && (e_rfpowerstate_toset == ERFOFF)) { 205062306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_RF, DBG_DMESG, 205162306a36Sopenharmony_ci "GPIOChangeRF - HW Radio OFF, RF OFF\n"); 205262306a36Sopenharmony_ci 205362306a36Sopenharmony_ci e_rfpowerstate_toset = ERFOFF; 205462306a36Sopenharmony_ci ppsc->hwradiooff = true; 205562306a36Sopenharmony_ci actuallyset = true; 205662306a36Sopenharmony_ci } 205762306a36Sopenharmony_ci 205862306a36Sopenharmony_ci if (actuallyset) { 205962306a36Sopenharmony_ci spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flag); 206062306a36Sopenharmony_ci ppsc->rfchange_inprogress = false; 206162306a36Sopenharmony_ci spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flag); 206262306a36Sopenharmony_ci } else { 206362306a36Sopenharmony_ci if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_HALT_NIC) 206462306a36Sopenharmony_ci RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC); 206562306a36Sopenharmony_ci 206662306a36Sopenharmony_ci spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flag); 206762306a36Sopenharmony_ci ppsc->rfchange_inprogress = false; 206862306a36Sopenharmony_ci spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flag); 206962306a36Sopenharmony_ci } 207062306a36Sopenharmony_ci 207162306a36Sopenharmony_ci *valid = 1; 207262306a36Sopenharmony_ci return !ppsc->hwradiooff; 207362306a36Sopenharmony_ci 207462306a36Sopenharmony_ci} 207562306a36Sopenharmony_ci 207662306a36Sopenharmony_civoid rtl92ce_set_key(struct ieee80211_hw *hw, u32 key_index, 207762306a36Sopenharmony_ci u8 *p_macaddr, bool is_group, u8 enc_algo, 207862306a36Sopenharmony_ci bool is_wepkey, bool clear_all) 207962306a36Sopenharmony_ci{ 208062306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 208162306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 208262306a36Sopenharmony_ci struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw)); 208362306a36Sopenharmony_ci u8 *macaddr = p_macaddr; 208462306a36Sopenharmony_ci u32 entry_id = 0; 208562306a36Sopenharmony_ci bool is_pairwise = false; 208662306a36Sopenharmony_ci 208762306a36Sopenharmony_ci static u8 cam_const_addr[4][6] = { 208862306a36Sopenharmony_ci {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, 208962306a36Sopenharmony_ci {0x00, 0x00, 0x00, 0x00, 0x00, 0x01}, 209062306a36Sopenharmony_ci {0x00, 0x00, 0x00, 0x00, 0x00, 0x02}, 209162306a36Sopenharmony_ci {0x00, 0x00, 0x00, 0x00, 0x00, 0x03} 209262306a36Sopenharmony_ci }; 209362306a36Sopenharmony_ci static u8 cam_const_broad[] = { 209462306a36Sopenharmony_ci 0xff, 0xff, 0xff, 0xff, 0xff, 0xff 209562306a36Sopenharmony_ci }; 209662306a36Sopenharmony_ci 209762306a36Sopenharmony_ci if (clear_all) { 209862306a36Sopenharmony_ci u8 idx = 0; 209962306a36Sopenharmony_ci u8 cam_offset = 0; 210062306a36Sopenharmony_ci u8 clear_number = 5; 210162306a36Sopenharmony_ci 210262306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_DMESG, "clear_all\n"); 210362306a36Sopenharmony_ci 210462306a36Sopenharmony_ci for (idx = 0; idx < clear_number; idx++) { 210562306a36Sopenharmony_ci rtl_cam_mark_invalid(hw, cam_offset + idx); 210662306a36Sopenharmony_ci rtl_cam_empty_entry(hw, cam_offset + idx); 210762306a36Sopenharmony_ci 210862306a36Sopenharmony_ci if (idx < 5) { 210962306a36Sopenharmony_ci memset(rtlpriv->sec.key_buf[idx], 0, 211062306a36Sopenharmony_ci MAX_KEY_LEN); 211162306a36Sopenharmony_ci rtlpriv->sec.key_len[idx] = 0; 211262306a36Sopenharmony_ci } 211362306a36Sopenharmony_ci } 211462306a36Sopenharmony_ci 211562306a36Sopenharmony_ci } else { 211662306a36Sopenharmony_ci switch (enc_algo) { 211762306a36Sopenharmony_ci case WEP40_ENCRYPTION: 211862306a36Sopenharmony_ci enc_algo = CAM_WEP40; 211962306a36Sopenharmony_ci break; 212062306a36Sopenharmony_ci case WEP104_ENCRYPTION: 212162306a36Sopenharmony_ci enc_algo = CAM_WEP104; 212262306a36Sopenharmony_ci break; 212362306a36Sopenharmony_ci case TKIP_ENCRYPTION: 212462306a36Sopenharmony_ci enc_algo = CAM_TKIP; 212562306a36Sopenharmony_ci break; 212662306a36Sopenharmony_ci case AESCCMP_ENCRYPTION: 212762306a36Sopenharmony_ci enc_algo = CAM_AES; 212862306a36Sopenharmony_ci break; 212962306a36Sopenharmony_ci default: 213062306a36Sopenharmony_ci pr_err("switch case %#x not processed\n", 213162306a36Sopenharmony_ci enc_algo); 213262306a36Sopenharmony_ci enc_algo = CAM_TKIP; 213362306a36Sopenharmony_ci break; 213462306a36Sopenharmony_ci } 213562306a36Sopenharmony_ci 213662306a36Sopenharmony_ci if (is_wepkey || rtlpriv->sec.use_defaultkey) { 213762306a36Sopenharmony_ci macaddr = cam_const_addr[key_index]; 213862306a36Sopenharmony_ci entry_id = key_index; 213962306a36Sopenharmony_ci } else { 214062306a36Sopenharmony_ci if (is_group) { 214162306a36Sopenharmony_ci macaddr = cam_const_broad; 214262306a36Sopenharmony_ci entry_id = key_index; 214362306a36Sopenharmony_ci } else { 214462306a36Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_AP || 214562306a36Sopenharmony_ci mac->opmode == NL80211_IFTYPE_MESH_POINT) { 214662306a36Sopenharmony_ci entry_id = rtl_cam_get_free_entry(hw, 214762306a36Sopenharmony_ci p_macaddr); 214862306a36Sopenharmony_ci if (entry_id >= TOTAL_CAM_ENTRY) { 214962306a36Sopenharmony_ci pr_err("Can not find free hw security cam entry\n"); 215062306a36Sopenharmony_ci return; 215162306a36Sopenharmony_ci } 215262306a36Sopenharmony_ci } else { 215362306a36Sopenharmony_ci entry_id = CAM_PAIRWISE_KEY_POSITION; 215462306a36Sopenharmony_ci } 215562306a36Sopenharmony_ci 215662306a36Sopenharmony_ci key_index = PAIRWISE_KEYIDX; 215762306a36Sopenharmony_ci is_pairwise = true; 215862306a36Sopenharmony_ci } 215962306a36Sopenharmony_ci } 216062306a36Sopenharmony_ci 216162306a36Sopenharmony_ci if (rtlpriv->sec.key_len[key_index] == 0) { 216262306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_DMESG, 216362306a36Sopenharmony_ci "delete one entry, entry_id is %d\n", 216462306a36Sopenharmony_ci entry_id); 216562306a36Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_AP || 216662306a36Sopenharmony_ci mac->opmode == NL80211_IFTYPE_MESH_POINT) 216762306a36Sopenharmony_ci rtl_cam_del_entry(hw, p_macaddr); 216862306a36Sopenharmony_ci rtl_cam_delete_one_entry(hw, p_macaddr, entry_id); 216962306a36Sopenharmony_ci } else { 217062306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_LOUD, 217162306a36Sopenharmony_ci "The insert KEY length is %d\n", 217262306a36Sopenharmony_ci rtlpriv->sec.key_len[PAIRWISE_KEYIDX]); 217362306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_LOUD, 217462306a36Sopenharmony_ci "The insert KEY is %x %x\n", 217562306a36Sopenharmony_ci rtlpriv->sec.key_buf[0][0], 217662306a36Sopenharmony_ci rtlpriv->sec.key_buf[0][1]); 217762306a36Sopenharmony_ci 217862306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_DMESG, 217962306a36Sopenharmony_ci "add one entry\n"); 218062306a36Sopenharmony_ci if (is_pairwise) { 218162306a36Sopenharmony_ci RT_PRINT_DATA(rtlpriv, COMP_SEC, DBG_LOUD, 218262306a36Sopenharmony_ci "Pairwise Key content", 218362306a36Sopenharmony_ci rtlpriv->sec.pairwise_key, 218462306a36Sopenharmony_ci rtlpriv->sec. 218562306a36Sopenharmony_ci key_len[PAIRWISE_KEYIDX]); 218662306a36Sopenharmony_ci 218762306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_DMESG, 218862306a36Sopenharmony_ci "set Pairwise key\n"); 218962306a36Sopenharmony_ci 219062306a36Sopenharmony_ci rtl_cam_add_one_entry(hw, macaddr, key_index, 219162306a36Sopenharmony_ci entry_id, enc_algo, 219262306a36Sopenharmony_ci CAM_CONFIG_NO_USEDK, 219362306a36Sopenharmony_ci rtlpriv->sec. 219462306a36Sopenharmony_ci key_buf[key_index]); 219562306a36Sopenharmony_ci } else { 219662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEC, DBG_DMESG, 219762306a36Sopenharmony_ci "set group key\n"); 219862306a36Sopenharmony_ci 219962306a36Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_ADHOC) { 220062306a36Sopenharmony_ci rtl_cam_add_one_entry(hw, 220162306a36Sopenharmony_ci rtlefuse->dev_addr, 220262306a36Sopenharmony_ci PAIRWISE_KEYIDX, 220362306a36Sopenharmony_ci CAM_PAIRWISE_KEY_POSITION, 220462306a36Sopenharmony_ci enc_algo, 220562306a36Sopenharmony_ci CAM_CONFIG_NO_USEDK, 220662306a36Sopenharmony_ci rtlpriv->sec.key_buf 220762306a36Sopenharmony_ci [entry_id]); 220862306a36Sopenharmony_ci } 220962306a36Sopenharmony_ci 221062306a36Sopenharmony_ci rtl_cam_add_one_entry(hw, macaddr, key_index, 221162306a36Sopenharmony_ci entry_id, enc_algo, 221262306a36Sopenharmony_ci CAM_CONFIG_NO_USEDK, 221362306a36Sopenharmony_ci rtlpriv->sec.key_buf[entry_id]); 221462306a36Sopenharmony_ci } 221562306a36Sopenharmony_ci 221662306a36Sopenharmony_ci } 221762306a36Sopenharmony_ci } 221862306a36Sopenharmony_ci} 221962306a36Sopenharmony_ci 222062306a36Sopenharmony_cistatic void rtl8192ce_bt_var_init(struct ieee80211_hw *hw) 222162306a36Sopenharmony_ci{ 222262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 222362306a36Sopenharmony_ci 222462306a36Sopenharmony_ci rtlpriv->btcoexist.bt_coexistence = 222562306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_coexist; 222662306a36Sopenharmony_ci rtlpriv->btcoexist.bt_ant_num = 222762306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_ant_num; 222862306a36Sopenharmony_ci rtlpriv->btcoexist.bt_coexist_type = 222962306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_type; 223062306a36Sopenharmony_ci 223162306a36Sopenharmony_ci if (rtlpriv->btcoexist.reg_bt_iso == 2) 223262306a36Sopenharmony_ci rtlpriv->btcoexist.bt_ant_isolation = 223362306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_ant_isol; 223462306a36Sopenharmony_ci else 223562306a36Sopenharmony_ci rtlpriv->btcoexist.bt_ant_isolation = 223662306a36Sopenharmony_ci rtlpriv->btcoexist.reg_bt_iso; 223762306a36Sopenharmony_ci 223862306a36Sopenharmony_ci rtlpriv->btcoexist.bt_radio_shared_type = 223962306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_radio_shared; 224062306a36Sopenharmony_ci 224162306a36Sopenharmony_ci if (rtlpriv->btcoexist.bt_coexistence) { 224262306a36Sopenharmony_ci if (rtlpriv->btcoexist.reg_bt_sco == 1) 224362306a36Sopenharmony_ci rtlpriv->btcoexist.bt_service = BT_OTHER_ACTION; 224462306a36Sopenharmony_ci else if (rtlpriv->btcoexist.reg_bt_sco == 2) 224562306a36Sopenharmony_ci rtlpriv->btcoexist.bt_service = BT_SCO; 224662306a36Sopenharmony_ci else if (rtlpriv->btcoexist.reg_bt_sco == 4) 224762306a36Sopenharmony_ci rtlpriv->btcoexist.bt_service = BT_BUSY; 224862306a36Sopenharmony_ci else if (rtlpriv->btcoexist.reg_bt_sco == 5) 224962306a36Sopenharmony_ci rtlpriv->btcoexist.bt_service = BT_OTHERBUSY; 225062306a36Sopenharmony_ci else 225162306a36Sopenharmony_ci rtlpriv->btcoexist.bt_service = BT_IDLE; 225262306a36Sopenharmony_ci 225362306a36Sopenharmony_ci rtlpriv->btcoexist.bt_edca_ul = 0; 225462306a36Sopenharmony_ci rtlpriv->btcoexist.bt_edca_dl = 0; 225562306a36Sopenharmony_ci rtlpriv->btcoexist.bt_rssi_state = 0xff; 225662306a36Sopenharmony_ci } 225762306a36Sopenharmony_ci} 225862306a36Sopenharmony_ci 225962306a36Sopenharmony_civoid rtl8192ce_read_bt_coexist_info_from_hwpg(struct ieee80211_hw *hw, 226062306a36Sopenharmony_ci bool auto_load_fail, u8 *hwinfo) 226162306a36Sopenharmony_ci{ 226262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 226362306a36Sopenharmony_ci u8 val; 226462306a36Sopenharmony_ci 226562306a36Sopenharmony_ci if (!auto_load_fail) { 226662306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_coexist = 226762306a36Sopenharmony_ci ((hwinfo[RF_OPTION1] & 0xe0) >> 5); 226862306a36Sopenharmony_ci val = hwinfo[RF_OPTION4]; 226962306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_type = ((val & 0xe) >> 1); 227062306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_ant_num = (val & 0x1); 227162306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_ant_isol = ((val & 0x10) >> 4); 227262306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_radio_shared = 227362306a36Sopenharmony_ci ((val & 0x20) >> 5); 227462306a36Sopenharmony_ci } else { 227562306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_coexist = 0; 227662306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_type = BT_2WIRE; 227762306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_ant_num = ANT_X2; 227862306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_ant_isol = 0; 227962306a36Sopenharmony_ci rtlpriv->btcoexist.eeprom_bt_radio_shared = BT_RADIO_SHARED; 228062306a36Sopenharmony_ci } 228162306a36Sopenharmony_ci 228262306a36Sopenharmony_ci rtl8192ce_bt_var_init(hw); 228362306a36Sopenharmony_ci} 228462306a36Sopenharmony_ci 228562306a36Sopenharmony_civoid rtl8192ce_bt_reg_init(struct ieee80211_hw *hw) 228662306a36Sopenharmony_ci{ 228762306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 228862306a36Sopenharmony_ci 228962306a36Sopenharmony_ci /* 0:Low, 1:High, 2:From Efuse. */ 229062306a36Sopenharmony_ci rtlpriv->btcoexist.reg_bt_iso = 2; 229162306a36Sopenharmony_ci /* 0:Idle, 1:None-SCO, 2:SCO, 3:From Counter. */ 229262306a36Sopenharmony_ci rtlpriv->btcoexist.reg_bt_sco = 3; 229362306a36Sopenharmony_ci /* 0:Disable BT control A-MPDU, 1:Enable BT control A-MPDU. */ 229462306a36Sopenharmony_ci rtlpriv->btcoexist.reg_bt_sco = 0; 229562306a36Sopenharmony_ci} 229662306a36Sopenharmony_ci 229762306a36Sopenharmony_civoid rtl8192ce_bt_hw_init(struct ieee80211_hw *hw) 229862306a36Sopenharmony_ci{ 229962306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 230062306a36Sopenharmony_ci struct rtl_phy *rtlphy = &(rtlpriv->phy); 230162306a36Sopenharmony_ci 230262306a36Sopenharmony_ci u8 u1_tmp; 230362306a36Sopenharmony_ci 230462306a36Sopenharmony_ci if (rtlpriv->btcoexist.bt_coexistence && 230562306a36Sopenharmony_ci ((rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC4) || 230662306a36Sopenharmony_ci rtlpriv->btcoexist.bt_coexist_type == BT_CSR_BC8)) { 230762306a36Sopenharmony_ci 230862306a36Sopenharmony_ci if (rtlpriv->btcoexist.bt_ant_isolation) 230962306a36Sopenharmony_ci rtl_write_byte(rtlpriv, REG_GPIO_MUXCFG, 0xa0); 231062306a36Sopenharmony_ci 231162306a36Sopenharmony_ci u1_tmp = rtl_read_byte(rtlpriv, 0x4fd) & BIT(0); 231262306a36Sopenharmony_ci u1_tmp = u1_tmp | 231362306a36Sopenharmony_ci ((rtlpriv->btcoexist.bt_ant_isolation == 1) ? 231462306a36Sopenharmony_ci 0 : BIT(1)) | 231562306a36Sopenharmony_ci ((rtlpriv->btcoexist.bt_service == BT_SCO) ? 231662306a36Sopenharmony_ci 0 : BIT(2)); 231762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, 0x4fd, u1_tmp); 231862306a36Sopenharmony_ci 231962306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_BT_COEX_TABLE+4, 0xaaaa9aaa); 232062306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_BT_COEX_TABLE+8, 0xffbd0040); 232162306a36Sopenharmony_ci rtl_write_dword(rtlpriv, REG_BT_COEX_TABLE+0xc, 0x40000010); 232262306a36Sopenharmony_ci 232362306a36Sopenharmony_ci /* Config to 1T1R. */ 232462306a36Sopenharmony_ci if (rtlphy->rf_type == RF_1T1R) { 232562306a36Sopenharmony_ci u1_tmp = rtl_read_byte(rtlpriv, ROFDM0_TRXPATHENABLE); 232662306a36Sopenharmony_ci u1_tmp &= ~(BIT(1)); 232762306a36Sopenharmony_ci rtl_write_byte(rtlpriv, ROFDM0_TRXPATHENABLE, u1_tmp); 232862306a36Sopenharmony_ci 232962306a36Sopenharmony_ci u1_tmp = rtl_read_byte(rtlpriv, ROFDM1_TRXPATHENABLE); 233062306a36Sopenharmony_ci u1_tmp &= ~(BIT(1)); 233162306a36Sopenharmony_ci rtl_write_byte(rtlpriv, ROFDM1_TRXPATHENABLE, u1_tmp); 233262306a36Sopenharmony_ci } 233362306a36Sopenharmony_ci } 233462306a36Sopenharmony_ci} 233562306a36Sopenharmony_ci 233662306a36Sopenharmony_civoid rtl92ce_suspend(struct ieee80211_hw *hw) 233762306a36Sopenharmony_ci{ 233862306a36Sopenharmony_ci} 233962306a36Sopenharmony_ci 234062306a36Sopenharmony_civoid rtl92ce_resume(struct ieee80211_hw *hw) 234162306a36Sopenharmony_ci{ 234262306a36Sopenharmony_ci} 2343