227 lines
6.7 KiB
C
227 lines
6.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* Copyright(c) 2009-2012 Realtek Corporation.*/
|
|
|
|
#include "../wifi.h"
|
|
#include "../rtl8192d/reg.h"
|
|
#include "../rtl8192d/def.h"
|
|
#include "../rtl8192d/phy_common.h"
|
|
#include "phy.h"
|
|
#include "rf.h"
|
|
#include "dm.h"
|
|
#include "hw.h"
|
|
|
|
bool rtl92d_phy_enable_anotherphy(struct ieee80211_hw *hw, bool bmac0)
|
|
{
|
|
struct rtl_priv *rtlpriv = rtl_priv(hw);
|
|
struct rtl_hal *rtlhal = &(rtlpriv->rtlhal);
|
|
u8 u1btmp;
|
|
u8 direct = bmac0 ? BIT(3) | BIT(2) : BIT(3);
|
|
u8 mac_reg = bmac0 ? REG_MAC1 : REG_MAC0;
|
|
u8 mac_on_bit = bmac0 ? MAC1_ON : MAC0_ON;
|
|
bool bresult = true; /* true: need to enable BB/RF power */
|
|
|
|
rtlhal->during_mac0init_radiob = false;
|
|
rtlhal->during_mac1init_radioa = false;
|
|
rtl_dbg(rtlpriv, COMP_RF, DBG_LOUD, "===>\n");
|
|
/* MAC0 Need PHY1 load radio_b.txt . Driver use DBI to write. */
|
|
u1btmp = rtl_read_byte(rtlpriv, mac_reg);
|
|
if (!(u1btmp & mac_on_bit)) {
|
|
rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, "enable BB & RF\n");
|
|
/* Enable BB and RF power */
|
|
rtl92de_write_dword_dbi(hw, REG_SYS_ISO_CTRL,
|
|
rtl92de_read_dword_dbi(hw, REG_SYS_ISO_CTRL, direct) |
|
|
BIT(29) | BIT(16) | BIT(17), direct);
|
|
} else {
|
|
/* We think if MAC1 is ON,then radio_a.txt
|
|
* and radio_b.txt has been load. */
|
|
bresult = false;
|
|
}
|
|
rtl_dbg(rtlpriv, COMP_RF, DBG_LOUD, "<===\n");
|
|
return bresult;
|
|
|
|
}
|
|
|
|
void rtl92d_phy_powerdown_anotherphy(struct ieee80211_hw *hw, bool bmac0)
|
|
{
|
|
struct rtl_priv *rtlpriv = rtl_priv(hw);
|
|
struct rtl_hal *rtlhal = &(rtlpriv->rtlhal);
|
|
u8 u1btmp;
|
|
u8 direct = bmac0 ? BIT(3) | BIT(2) : BIT(3);
|
|
u8 mac_reg = bmac0 ? REG_MAC1 : REG_MAC0;
|
|
u8 mac_on_bit = bmac0 ? MAC1_ON : MAC0_ON;
|
|
|
|
rtlhal->during_mac0init_radiob = false;
|
|
rtlhal->during_mac1init_radioa = false;
|
|
rtl_dbg(rtlpriv, COMP_RF, DBG_LOUD, "====>\n");
|
|
/* check MAC0 enable or not again now, if
|
|
* enabled, not power down radio A. */
|
|
u1btmp = rtl_read_byte(rtlpriv, mac_reg);
|
|
if (!(u1btmp & mac_on_bit)) {
|
|
rtl_dbg(rtlpriv, COMP_INIT, DBG_LOUD, "power down\n");
|
|
/* power down RF radio A according to YuNan's advice. */
|
|
rtl92de_write_dword_dbi(hw, RFPGA0_XA_LSSIPARAMETER,
|
|
0x00000000, direct);
|
|
}
|
|
rtl_dbg(rtlpriv, COMP_RF, DBG_LOUD, "<====\n");
|
|
}
|
|
|
|
bool rtl92d_phy_rf6052_config(struct ieee80211_hw *hw)
|
|
{
|
|
struct rtl_priv *rtlpriv = rtl_priv(hw);
|
|
struct rtl_phy *rtlphy = &(rtlpriv->phy);
|
|
bool rtstatus = true;
|
|
struct rtl_hal *rtlhal = &(rtlpriv->rtlhal);
|
|
u32 u4_regvalue = 0;
|
|
u8 rfpath;
|
|
struct bb_reg_def *pphyreg;
|
|
bool mac1_initradioa_first = false, mac0_initradiob_first = false;
|
|
bool need_pwrdown_radioa = false, need_pwrdown_radiob = false;
|
|
bool true_bpath = false;
|
|
|
|
if (rtlphy->rf_type == RF_1T1R)
|
|
rtlphy->num_total_rfpath = 1;
|
|
else
|
|
rtlphy->num_total_rfpath = 2;
|
|
|
|
/* Single phy mode: use radio_a radio_b config path_A path_B */
|
|
/* seperately by MAC0, and MAC1 needn't configure RF; */
|
|
/* Dual PHY mode:MAC0 use radio_a config 1st phy path_A, */
|
|
/* MAC1 use radio_b config 2nd PHY path_A. */
|
|
/* DMDP,MAC0 on G band,MAC1 on A band. */
|
|
if (rtlhal->macphymode == DUALMAC_DUALPHY) {
|
|
if (rtlhal->current_bandtype == BAND_ON_2_4G &&
|
|
rtlhal->interfaceindex == 0) {
|
|
/* MAC0 needs PHY1 load radio_b.txt.
|
|
* Driver use DBI to write. */
|
|
if (rtl92d_phy_enable_anotherphy(hw, true)) {
|
|
rtlphy->num_total_rfpath = 2;
|
|
mac0_initradiob_first = true;
|
|
} else {
|
|
/* We think if MAC1 is ON,then radio_a.txt and
|
|
* radio_b.txt has been load. */
|
|
return rtstatus;
|
|
}
|
|
} else if (rtlhal->current_bandtype == BAND_ON_5G &&
|
|
rtlhal->interfaceindex == 1) {
|
|
/* MAC1 needs PHY0 load radio_a.txt.
|
|
* Driver use DBI to write. */
|
|
if (rtl92d_phy_enable_anotherphy(hw, false)) {
|
|
rtlphy->num_total_rfpath = 2;
|
|
mac1_initradioa_first = true;
|
|
} else {
|
|
/* We think if MAC0 is ON,then radio_a.txt and
|
|
* radio_b.txt has been load. */
|
|
return rtstatus;
|
|
}
|
|
} else if (rtlhal->interfaceindex == 1) {
|
|
/* MAC0 enabled, only init radia B. */
|
|
true_bpath = true;
|
|
}
|
|
}
|
|
|
|
for (rfpath = 0; rfpath < rtlphy->num_total_rfpath; rfpath++) {
|
|
/* Mac1 use PHY0 write */
|
|
if (mac1_initradioa_first) {
|
|
if (rfpath == RF90_PATH_A) {
|
|
rtlhal->during_mac1init_radioa = true;
|
|
need_pwrdown_radioa = true;
|
|
} else if (rfpath == RF90_PATH_B) {
|
|
rtlhal->during_mac1init_radioa = false;
|
|
mac1_initradioa_first = false;
|
|
rfpath = RF90_PATH_A;
|
|
true_bpath = true;
|
|
rtlphy->num_total_rfpath = 1;
|
|
}
|
|
} else if (mac0_initradiob_first) {
|
|
/* Mac0 use PHY1 write */
|
|
if (rfpath == RF90_PATH_A)
|
|
rtlhal->during_mac0init_radiob = false;
|
|
if (rfpath == RF90_PATH_B) {
|
|
rtlhal->during_mac0init_radiob = true;
|
|
mac0_initradiob_first = false;
|
|
need_pwrdown_radiob = true;
|
|
rfpath = RF90_PATH_A;
|
|
true_bpath = true;
|
|
rtlphy->num_total_rfpath = 1;
|
|
}
|
|
}
|
|
pphyreg = &rtlphy->phyreg_def[rfpath];
|
|
switch (rfpath) {
|
|
case RF90_PATH_A:
|
|
case RF90_PATH_C:
|
|
u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
|
|
BRFSI_RFENV);
|
|
break;
|
|
case RF90_PATH_B:
|
|
case RF90_PATH_D:
|
|
u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
|
|
BRFSI_RFENV << 16);
|
|
break;
|
|
}
|
|
rtl_set_bbreg(hw, pphyreg->rfintfe, BRFSI_RFENV << 16, 0x1);
|
|
udelay(1);
|
|
rtl_set_bbreg(hw, pphyreg->rfintfo, BRFSI_RFENV, 0x1);
|
|
udelay(1);
|
|
/* Set bit number of Address and Data for RF register */
|
|
/* Set 1 to 4 bits for 8255 */
|
|
rtl_set_bbreg(hw, pphyreg->rfhssi_para2,
|
|
B3WIREADDRESSLENGTH, 0x0);
|
|
udelay(1);
|
|
/* Set 0 to 12 bits for 8255 */
|
|
rtl_set_bbreg(hw, pphyreg->rfhssi_para2, B3WIREDATALENGTH, 0x0);
|
|
udelay(1);
|
|
switch (rfpath) {
|
|
case RF90_PATH_A:
|
|
if (true_bpath)
|
|
rtstatus = rtl92d_phy_config_rf_with_headerfile(
|
|
hw, radiob_txt,
|
|
(enum radio_path)rfpath);
|
|
else
|
|
rtstatus = rtl92d_phy_config_rf_with_headerfile(
|
|
hw, radioa_txt,
|
|
(enum radio_path)rfpath);
|
|
break;
|
|
case RF90_PATH_B:
|
|
rtstatus =
|
|
rtl92d_phy_config_rf_with_headerfile(hw, radiob_txt,
|
|
(enum radio_path) rfpath);
|
|
break;
|
|
case RF90_PATH_C:
|
|
break;
|
|
case RF90_PATH_D:
|
|
break;
|
|
}
|
|
switch (rfpath) {
|
|
case RF90_PATH_A:
|
|
case RF90_PATH_C:
|
|
rtl_set_bbreg(hw, pphyreg->rfintfs, BRFSI_RFENV,
|
|
u4_regvalue);
|
|
break;
|
|
case RF90_PATH_B:
|
|
case RF90_PATH_D:
|
|
rtl_set_bbreg(hw, pphyreg->rfintfs, BRFSI_RFENV << 16,
|
|
u4_regvalue);
|
|
break;
|
|
}
|
|
if (!rtstatus) {
|
|
rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE,
|
|
"Radio[%d] Fail!!\n", rfpath);
|
|
goto phy_rf_cfg_fail;
|
|
}
|
|
|
|
}
|
|
|
|
/* check MAC0 enable or not again, if enabled,
|
|
* not power down radio A. */
|
|
/* check MAC1 enable or not again, if enabled,
|
|
* not power down radio B. */
|
|
if (need_pwrdown_radioa)
|
|
rtl92d_phy_powerdown_anotherphy(hw, false);
|
|
else if (need_pwrdown_radiob)
|
|
rtl92d_phy_powerdown_anotherphy(hw, true);
|
|
rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, "<---\n");
|
|
return rtstatus;
|
|
|
|
phy_rf_cfg_fail:
|
|
return rtstatus;
|
|
}
|