On Wed, 2024-03-20 at 21:40 +0200, Bitterblue Smith wrote: > > These contain one RF configuration function and some functions related > to dual MAC operation. > > Signed-off-by: Bitterblue Smith <rtl8821cerfe2@xxxxxxxxx> > --- > v3: > - No change. > > v2: > - Patch is new in v2, split from patch 3/3 in v1. > --- > .../wireless/realtek/rtlwifi/rtl8192du/rf.c | 236 ++++++++++++++++++ > .../wireless/realtek/rtlwifi/rtl8192du/rf.h | 11 + > 2 files changed, 247 insertions(+) > create mode 100644 drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.c > create mode 100644 drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.h > > diff --git a/drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.c > b/drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.c > new file mode 100644 > index 000000000000..afdf03940015 > --- /dev/null > +++ b/drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.c > @@ -0,0 +1,236 @@ > +// 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 "../rtl8192d/rf_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 mac_on_bit = bmac0 ? MAC1_ON : MAC0_ON; > + u8 mac_reg = bmac0 ? REG_MAC1 : REG_MAC0; > + bool bresult = true; /* true: need to enable BB/RF power */ > + u32 maskforphyset = 0; > + u16 val16; > + u8 u1btmp; > + > + 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 */ > + > + maskforphyset = bmac0 ? MAC0_ACCESS_PHY1 : MAC1_ACCESS_PHY0; > + > + val16 = rtl_read_word(rtlpriv, REG_SYS_FUNC_EN | maskforphyset); > + val16 &= 0xfffc; > + rtl_write_word(rtlpriv, REG_SYS_FUNC_EN | maskforphyset, val16); > + > + val16 = rtl_read_word(rtlpriv, REG_SYS_FUNC_EN | maskforphyset); > + val16 |= BIT(13) | BIT(0) | BIT(1); > + rtl_write_word(rtlpriv, REG_SYS_FUNC_EN | maskforphyset, val16); > + } 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 mac_on_bit = bmac0 ? MAC1_ON : MAC0_ON; > + u8 mac_reg = bmac0 ? REG_MAC1 : REG_MAC0; > + u32 maskforphyset = 0; > + u8 u1btmp; > + > + 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. */ > + maskforphyset = bmac0 ? MAC0_ACCESS_PHY1 : MAC1_ACCESS_PHY0; > + rtl_write_dword(rtlpriv, RFPGA0_XA_LSSIPARAMETER | maskforphyset, > + 0x00000000); > + } > + rtl_dbg(rtlpriv, COMP_RF, DBG_LOUD, "<====\n"); > +} > + > +bool rtl92d_phy_rf6052_config(struct ieee80211_hw *hw) > +{ > + bool mac1_initradioa_first = false, mac0_initradiob_first = false; > + bool need_pwrdown_radioa = false, need_pwrdown_radiob = false; > + struct rtl_priv *rtlpriv = rtl_priv(hw); > + struct rtl_hal *rtlhal = &rtlpriv->rtlhal; > + struct rtl_phy *rtlphy = &rtlpriv->phy; > + struct bb_reg_def *pphyreg; > + bool true_bpath = false; > + bool rtstatus = true; > + u32 u4_regvalue = 0; > + u8 rfpath; > + > + 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 */ > + /* separately 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. */ /* Use this style of multiple lines comments * Second line * Third line */ > + if (rtlhal->macphymode == DUALMAC_DUALPHY) { > + if (rtlhal->current_bandtype == BAND_ON_2_4G && > + rtlhal->interfaceindex == 0) { > + /* MAC0 needs PHY1 load radio_b.txt. */ > + 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. */ > + 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; > + } > + } insert proper blank lines... > + 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 */ > + rtl_set_bbreg(hw, pphyreg->rfhssi_para2, > + B3WIREADDRESSLENGTH, 0x0); > + udelay(1); > + 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; No special deal, so should return directly. > +} > diff --git a/drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.h > b/drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.h > new file mode 100644 > index 000000000000..c097d90cc99c > --- /dev/null > +++ b/drivers/net/wireless/realtek/rtlwifi/rtl8192du/rf.h > @@ -0,0 +1,11 @@ > +/* SPDX-License-Identifier: GPL-2.0 */ > +/* Copyright(c) 2009-2012 Realtek Corporation.*/ > + > +#ifndef __RTL92D_RF_H__ > +#define __RTL92D_RF_H__ __RTL92DU_RF_H__ ?? > + > +bool rtl92d_phy_rf6052_config(struct ieee80211_hw *hw); > +bool rtl92d_phy_enable_anotherphy(struct ieee80211_hw *hw, bool bmac0); > +void rtl92d_phy_powerdown_anotherphy(struct ieee80211_hw *hw, bool bmac0); > + > +#endif > -- > 2.43.2