--- /dev/null
+/******************************************************************************
+ *
+ * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of version 2 of the GNU General Public License as
+ * published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License along with
+ * this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
+ *
+ *
+ ******************************************************************************/
+#define _RTL8822B_PHY_C_
+
+#include <hal_data.h> /* HAL_DATA_TYPE */
+#include "../hal_halmac.h" /* rtw_halmac_phy_power_switch() */
+#include "rtl8822b.h"
+
+
+/*
+ * Description:
+ * Initialize Register definition offset for Radio Path A/B/C/D
+ * The initialization value is constant and it should never be changes
+ */
+static void bb_rf_register_definition(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+
+
+ /* RF Interface Sowrtware Control */
+ hal->PHYRegDef[ODM_RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW;
+ hal->PHYRegDef[ODM_RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW;
+
+ /* RF Interface Output (and Enable) */
+ hal->PHYRegDef[ODM_RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE;
+ hal->PHYRegDef[ODM_RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE;
+
+ /* RF Interface (Output and) Enable */
+ hal->PHYRegDef[ODM_RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE;
+ hal->PHYRegDef[ODM_RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE;
+
+ hal->PHYRegDef[ODM_RF_PATH_A].rf3wireOffset = rA_LSSIWrite_Jaguar;
+ hal->PHYRegDef[ODM_RF_PATH_B].rf3wireOffset = rB_LSSIWrite_Jaguar;
+
+ hal->PHYRegDef[ODM_RF_PATH_A].rfHSSIPara2 = rHSSIRead_Jaguar;
+ hal->PHYRegDef[ODM_RF_PATH_B].rfHSSIPara2 = rHSSIRead_Jaguar;
+
+ /* Tranceiver Readback LSSI/HSPI mode */
+ hal->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBack = rA_SIRead_Jaguar;
+ hal->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBack = rB_SIRead_Jaguar;
+ hal->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBackPi = rA_PIRead_Jaguar;
+ hal->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBackPi = rB_PIRead_Jaguar;
+}
+
+/*
+ * Description:
+ * Initialize MAC registers
+ *
+ * Return:
+ * _TRUE Success
+ * _FALSE Fail
+ */
+u8 rtl8822b_phy_init_mac_register(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal;
+ u8 regfile[] = RTL8822B_PHY_MACREG;
+ u8 ret = _TRUE;
+ int res;
+ HAL_STATUS status;
+
+
+ hal = GET_HAL_DATA(adapter);
+
+ ret = _FALSE;
+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
+ res = phy_ConfigMACWithParaFile(adapter, regfile);
+ if (_SUCCESS == res)
+ ret = _TRUE;
+#endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */
+ if (_FALSE == ret) {
+ status = ODM_ConfigMACWithHeaderFile(&hal->odmpriv);
+ if (HAL_STATUS_SUCCESS == status)
+ ret = _TRUE;
+ }
+ if (_FALSE == ret)
+ RTW_INFO("%s: Write MAC Reg Fail!!", __FUNCTION__);
+
+ return ret;
+}
+
+static u8 _init_bb_reg(PADAPTER Adapter)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(Adapter);
+ u8 regfile[] = RTL8822B_PHY_REG;
+ u8 agcfile[] = RTL8822B_AGC_TAB;
+ u8 regfile_mp[] = RTL8822B_PHY_REG_MP;
+ u8 ret = _TRUE;
+ int res;
+ HAL_STATUS status;
+
+
+ /*
+ * 1. Read PHY_REG.TXT BB INIT!!
+ */
+ ret = _FALSE;
+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
+ res = phy_ConfigBBWithParaFile(Adapter, regfile, CONFIG_BB_PHY_REG);
+ if (_SUCCESS == res)
+ ret = _TRUE;
+#endif
+ if (_FALSE == ret) {
+ status = ODM_ConfigBBWithHeaderFile(&hal->odmpriv, CONFIG_BB_PHY_REG);
+ if (HAL_STATUS_SUCCESS == status)
+ ret = _TRUE;
+ }
+ if (_FALSE == ret) {
+ RTW_INFO("%s: Write BB Reg Fail!!", __FUNCTION__);
+ goto exit;
+ }
+
+#if 0 /* No parameter with MP using currently by BB@Stanley. */
+/*#ifdef CONFIG_MP_INCLUDED*/
+ if (Adapter->registrypriv.mp_mode == 1) {
+ /*
+ * 1.1 Read PHY_REG_MP.TXT BB INIT!!
+ */
+ ret = _FALSE;
+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
+ res = phy_ConfigBBWithMpParaFile(Adapter, regfile_mp);
+ if (_SUCCESS == res)
+ ret = _TRUE;
+#endif
+ if (_FALSE == ret) {
+ status = ODM_ConfigBBWithHeaderFile(&hal->odmpriv, CONFIG_BB_PHY_REG_MP);
+ if (HAL_STATUS_SUCCESS == status)
+ ret = _TRUE;
+ }
+ if (_FALSE == ret) {
+ RTW_INFO("%s: Write BB Reg MP Fail!!", __FUNCTION__);
+ goto exit;
+ }
+ }
+#endif /* CONFIG_MP_INCLUDED */
+
+ /*
+ * 2. Read BB AGC table Initialization
+ */
+ ret = _FALSE;
+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
+ res = phy_ConfigBBWithParaFile(Adapter, agcfile, CONFIG_BB_AGC_TAB);
+ if (_SUCCESS == res)
+ ret = _TRUE;
+#endif
+ if (_FALSE == ret) {
+ status = ODM_ConfigBBWithHeaderFile(&hal->odmpriv, CONFIG_BB_AGC_TAB);
+ if (HAL_STATUS_SUCCESS == status)
+ ret = _TRUE;
+ }
+ if (_FALSE == ret) {
+ RTW_INFO("%s: Write AGC Table Fail!\n", __FUNCTION__);
+ goto exit;
+ }
+
+exit:
+ return ret;
+}
+
+static u8 init_bb_reg(PADAPTER adapter)
+{
+ u8 ret = _TRUE;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+
+
+ /*
+ * Config BB and AGC
+ */
+ ret = _init_bb_reg(adapter);
+
+ hal_set_crystal_cap(adapter, hal->CrystalCap);
+
+ return ret;
+}
+
+static u8 _init_rf_reg(PADAPTER adapter)
+{
+ u8 path, phydm_path;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ u8 regfile_a[] = RTL8822B_PHY_RADIO_A;
+ u8 regfile_b[] = RTL8822B_PHY_RADIO_B;
+ u8 *regfile;
+ u8 txpwrtrackfile[] = RTL8822B_TXPWR_TRACK;
+ HAL_STATUS status;
+ int res;
+ u8 ret = _TRUE;
+
+
+ /*
+ * Initialize RF
+ */
+ for (path = 0; path < hal->NumTotalRFPath; path++) {
+ /* Initialize RF from configuration file */
+ switch (path) {
+ case RF_PATH_A:
+ phydm_path = ODM_RF_PATH_A;
+ regfile = regfile_a;
+ break;
+
+ case RF_PATH_B:
+ phydm_path = ODM_RF_PATH_B;
+ regfile = regfile_b;
+ break;
+
+ default:
+ RTW_INFO("%s: [WARN] Unknown path=%d, skip!\n", __FUNCTION__, path);
+ continue;
+ }
+
+ ret = _FALSE;
+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
+ res = PHY_ConfigRFWithParaFile(adapter, regfile, phydm_path);
+ if (_SUCCESS == res)
+ ret = _TRUE;
+#endif
+ if (_FALSE == ret) {
+ status = ODM_ConfigRFWithHeaderFile(&hal->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)phydm_path);
+ if (HAL_STATUS_SUCCESS != status)
+ goto exit;
+ ret = _TRUE;
+ }
+ }
+
+ /*
+ * Configuration of Tx Power Tracking
+ */
+ ret = _FALSE;
+#ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
+ res = PHY_ConfigRFWithTxPwrTrackParaFile(adapter, txpwrtrackfile);
+ if (_SUCCESS == res)
+ ret = _TRUE;
+#endif
+ if (_FALSE == ret) {
+ status = ODM_ConfigRFWithTxPwrTrackHeaderFile(&hal->odmpriv);
+ if (HAL_STATUS_SUCCESS != status) {
+ RTW_INFO("%s: Write PwrTrack Table Fail!\n", __FUNCTION__);
+ goto exit;
+ }
+ ret = _TRUE;
+ }
+
+exit:
+ return ret;
+}
+
+static u8 init_rf_reg(PADAPTER adapter)
+{
+ u8 ret = _TRUE;
+
+
+ ret = _init_rf_reg(adapter);
+
+ return ret;
+}
+
+/*
+ * Description:
+ * Initialize PHY(BB/RF) related functions
+ *
+ * Return:
+ * _TRUE Success
+ * _FALSE Fail
+ */
+u8 rtl8822b_phy_init(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal;
+ PDM_ODM_T phydm;
+ u8 rf_type;
+ ODM_RF_PATH_E txpath, rxpath;
+ BOOLEAN tx2path;
+ u8 ok = _TRUE;
+ BOOLEAN ret;
+
+
+ hal = GET_HAL_DATA(adapter);
+ phydm = &hal->odmpriv;
+
+ bb_rf_register_definition(adapter);
+
+ rtw_halmac_phy_power_switch(adapter_to_dvobj(adapter), _TRUE);
+
+ ret = config_phydm_parameter_init(phydm, ODM_PRE_SETTING);
+ if (FALSE == ret)
+ return _FALSE;
+
+ ok = init_bb_reg(adapter);
+ if (_FALSE == ok)
+ return _FALSE;
+ ok = init_rf_reg(adapter);
+ if (_FALSE == ok)
+ return _FALSE;
+
+ ret = config_phydm_parameter_init(phydm, ODM_POST_SETTING);
+ if (FALSE == ret)
+ return _FALSE;
+
+ rf_type = RF_2T2R;
+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)&rf_type);
+ switch (rf_type) {
+ case RF_1T1R:
+ txpath = ODM_RF_A;
+ rxpath = ODM_RF_A;
+ break;
+ case RF_1T2R:
+ txpath = ODM_RF_A;
+ rxpath = ODM_RF_A | ODM_RF_B;
+ break;
+ default:
+ case RF_2T2R:
+ txpath = ODM_RF_A | ODM_RF_B;
+ rxpath = ODM_RF_A | ODM_RF_B;
+ break;
+ }
+ tx2path = FALSE;
+ ret = config_phydm_trx_mode_8822b(phydm, txpath, rxpath, tx2path);
+ if (FALSE == ret)
+ return _FALSE;
+
+ return _TRUE;
+}
+
+static void dm_CheckProtection(PADAPTER adapter)
+{
+}
+
+static void dm_CheckStatistics(PADAPTER adapter)
+{
+}
+
+#ifdef CONFIG_SUPPORT_HW_WPS_PBC
+static void dm_CheckPbcGPIO(PADAPTER adapter)
+{
+ u8 tmp1byte;
+ u8 bPbcPressed = _FALSE;
+
+ if (!adapter->registrypriv.hw_wps_pbc)
+ return;
+
+#ifdef CONFIG_USB_HCI
+ tmp1byte = rtw_read8(adapter, GPIO_IO_SEL);
+ tmp1byte |= (HAL_8192C_HW_GPIO_WPS_BIT);
+ rtw_write8(adapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as output mode */
+
+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT);
+ rtw_write8(adapter, GPIO_IN, tmp1byte); /* reset the floating voltage level */
+
+ tmp1byte = rtw_read8(adapter, GPIO_IO_SEL);
+ tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT);
+ rtw_write8(adapter, GPIO_IO_SEL, tmp1byte); /* enable GPIO[2] as input mode */
+
+ tmp1byte = rtw_read8(adapter, GPIO_IN);
+ if (tmp1byte == 0xff)
+ return;
+
+ if (tmp1byte & HAL_8192C_HW_GPIO_WPS_BIT)
+ bPbcPressed = _TRUE;
+#else
+ tmp1byte = rtw_read8(adapter, GPIO_IN);
+
+ if ((tmp1byte == 0xff) || adapter->init_adpt_in_progress)
+ return;
+
+ if ((tmp1byte & HAL_8192C_HW_GPIO_WPS_BIT) == 0)
+ bPbcPressed = _TRUE;
+#endif
+
+ if (_TRUE == bPbcPressed) {
+ /*
+ * Here we only set bPbcPressed to true
+ * After trigger PBC, the variable will be set to false
+ */
+ RTW_INFO("CheckPbcGPIO - PBC is pressed\n");
+ rtw_request_wps_pbc_event(adapter);
+ }
+}
+#endif /* CONFIG_SUPPORT_HW_WPS_PBC */
+
+
+#ifdef CONFIG_PCI_HCI
+/*
+ * Description:
+ * Perform interrupt migration dynamically to reduce CPU utilization.
+ *
+ * Assumption:
+ * 1. Do not enable migration under WIFI test.
+ */
+void dm_InterruptMigration(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
+ BOOLEAN bCurrentIntMt, bCurrentACIntDisable;
+ BOOLEAN IntMtToSet = _FALSE;
+ BOOLEAN ACIntToSet = _FALSE;
+
+
+ /* Retrieve current interrupt migration and Tx four ACs IMR settings first. */
+ bCurrentIntMt = hal->bInterruptMigration;
+ bCurrentACIntDisable = hal->bDisableTxInt;
+
+ /*
+ * <Roger_Notes> Currently we use busy traffic for reference instead of RxIntOK counts to prevent non-linear Rx statistics
+ * when interrupt migration is set before. 2010.03.05.
+ */
+ if (!adapter->registrypriv.wifi_spec
+ && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)
+ && pmlmepriv->LinkDetectInfo.bHigherBusyTraffic) {
+ IntMtToSet = _TRUE;
+
+ /* To check whether we should disable Tx interrupt or not. */
+ if (pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic)
+ ACIntToSet = _TRUE;
+ }
+
+ /* Update current settings. */
+ if (bCurrentIntMt != IntMtToSet) {
+ RTW_INFO("%s: Update interrupt migration(%d)\n", __FUNCTION__, IntMtToSet);
+ if (IntMtToSet) {
+ /*
+ * <Roger_Notes> Set interrupt migration timer and corresponging Tx/Rx counter.
+ * timer 25ns*0xfa0=100us for 0xf packets.
+ * 2010.03.05.
+ */
+ rtw_write32(adapter, REG_INT_MIG, 0xff000fa0); /* 0x306:Rx, 0x307:Tx */
+ hal->bInterruptMigration = IntMtToSet;
+ } else {
+ /* Reset all interrupt migration settings. */
+ rtw_write32(adapter, REG_INT_MIG, 0);
+ hal->bInterruptMigration = IntMtToSet;
+ }
+ }
+}
+#endif /* CONFIG_PCI_HCI */
+
+/*
+ * ============================================================
+ * functions
+ * ============================================================
+ */
+static void init_phydm_cominfo(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal;
+ PDM_ODM_T pDM_Odm;
+ u32 SupportAbility = 0;
+ u8 cut_ver = ODM_CUT_A, fab_ver = ODM_TSMC;
+
+
+ hal = GET_HAL_DATA(adapter);
+ pDM_Odm = &hal->odmpriv;
+
+ Init_ODM_ComInfo(adapter);
+
+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PACKAGE_TYPE, hal->PackageType);
+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8822B);
+
+ if (IS_CHIP_VENDOR_TSMC(hal->VersionID))
+ fab_ver = ODM_TSMC;
+ else if (IS_CHIP_VENDOR_UMC(hal->VersionID))
+ fab_ver = ODM_UMC;
+ else if (IS_CHIP_VENDOR_SMIC(hal->VersionID))
+ fab_ver = ODM_UMC + 1;
+ else
+ RTW_INFO("%s: unknown fab_ver=%d !!\n",
+ __FUNCTION__, GET_CVID_MANUFACTUER(hal->VersionID));
+
+ if (IS_A_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_A;
+ else if (IS_B_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_B;
+ else if (IS_C_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_C;
+ else if (IS_D_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_D;
+ else if (IS_E_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_E;
+ else if (IS_F_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_F;
+ else if (IS_I_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_I;
+ else if (IS_J_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_J;
+ else if (IS_K_CUT(hal->VersionID))
+ cut_ver = ODM_CUT_K;
+ else
+ RTW_INFO("%s: unknown cut_ver=%d !!\n",
+ __FUNCTION__, GET_CVID_CUT_VERSION(hal->VersionID));
+
+ RTW_INFO("%s: fab_ver=%d cut_ver=%d\n", __FUNCTION__, fab_ver, cut_ver);
+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver);
+ ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver);
+
+#ifdef CONFIG_DISABLE_ODM
+ SupportAbility = 0;
+#else /* !CONFIG_DISABLE_ODM */
+ SupportAbility = ODM_RF_CALIBRATION | ODM_RF_TX_PWR_TRACK;
+#endif /* !CONFIG_DISABLE_ODM */
+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility);
+}
+
+static void update_phydm_cominfo(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal;
+ PDM_ODM_T pDM_Odm;
+ u32 SupportAbility = 0;
+
+
+ hal = GET_HAL_DATA(adapter);
+ pDM_Odm = &hal->odmpriv;
+
+ SupportAbility = 0
+ | ODM_BB_DIG
+ | ODM_BB_RA_MASK
+ | ODM_BB_DYNAMIC_TXPWR
+ | ODM_BB_FA_CNT
+ | ODM_BB_RSSI_MONITOR
+ | ODM_BB_CCK_PD
+/* | ODM_BB_PWR_SAVE*/
+ | ODM_BB_CFO_TRACKING
+ | ODM_MAC_EDCA_TURBO
+ | ODM_RF_TX_PWR_TRACK
+ | ODM_RF_CALIBRATION
+ | ODM_BB_NHM_CNT
+/* | ODM_BB_PWR_TRAIN*/
+ ;
+
+ if (rtw_odm_adaptivity_needed(adapter) == _TRUE)
+ SupportAbility |= ODM_BB_ADAPTIVITY;
+
+#ifdef CONFIG_ANTENNA_DIVERSITY
+ if (hal->AntDivCfg)
+ SupportAbility |= ODM_BB_ANT_DIV;
+#endif /* CONFIG_ANTENNA_DIVERSITY */
+
+#ifdef CONFIG_MP_INCLUDED
+ if (adapter->registrypriv.mp_mode == 1) {
+ SupportAbility = 0
+ | ODM_RF_CALIBRATION
+ | ODM_RF_TX_PWR_TRACK
+ ;
+ }
+#endif /* CONFIG_MP_INCLUDED */
+
+#ifdef CONFIG_DISABLE_ODM
+ SupportAbility = 0;
+#endif /* CONFIG_DISABLE_ODM */
+
+ ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility);
+}
+
+static void _pa_bias_paser(u8 shift, u8 *minus, u8 *val)
+{
+ shift &= 0xF;
+#if 0
+ /* Skip 0x8(-4) */
+ if ((shift == 0x8) || (shift > 0x9))
+ shift = 0;
+#endif
+
+ /*
+ * BIT 0 is sign bit,
+ * 1 for positive, 0 for negative
+ */
+ *minus = (shift & BIT(0)) ? 0 : 1;
+ /* BIT 1~3 are value */
+ *val = (shift & 0xE) >> 1;
+}
+
+/*
+ * Description:
+ * Access TX PA Bias according to 0x3D8[3:0] or 0x3D7[3:0]
+ *
+ * Return:
+ * Value between 0~7.
+ */
+static u8 _pa_bias_adjust(u8 bias, u8 minus, u8 val)
+{
+ s8 tmp = bias;
+
+
+ if (minus)
+ tmp -= val;
+ else
+ tmp += val;
+
+ if (tmp < 0)
+ return 0;
+ if (tmp > 7)
+ return 7;
+ return (u8)tmp;
+}
+
+static void _pa_bias_calibration(PADAPTER adapter, enum _ODM_RF_RADIO_PATH path, u8 shift)
+{
+ u32 rf_reg18_offset[12] = {
+ 0X10124,
+ 0X10524,
+ 0X10924,
+ 0X10D24,
+ 0X30164,
+ 0X30564,
+ 0X30964,
+ 0X30D64,
+ 0X50195,
+ 0X50595,
+ 0X50995,
+ 0X50D95
+ };
+ u8 offset;
+ u32 bias_org, bias_new;
+ u8 val8;
+ u8 minus = 0;
+ u8 val = 0;
+
+
+ _pa_bias_paser(shift, &minus, &val);
+ RTW_INFO("%s: RF-%u bias shift %s%u\n", __FUNCTION__, path, minus?"-":"+", val);
+ if (!val)
+ return;
+
+ rtw_hal_write_rfreg(adapter, path, 0xEF, 0xFFFFF, 0x200);
+
+ /* Set 12 sets of TxA value */
+ for (offset = 0; offset < 12; offset++) {
+ /* Read TX PA Bias Table default value */
+ rtw_hal_write_rfreg(adapter, path, 0x18, 0xFFFFF, rf_reg18_offset[offset]);
+ bias_org = rtw_hal_read_rfreg(adapter, path, 0x61, 0xFFFFF);
+ val8 = bias_org & 0xF;
+ val8 = _pa_bias_adjust(val8, minus, val);
+ bias_new = (bias_org & 0xFF0) | val8;
+ bias_new |= (offset << 12);
+ rtw_hal_write_rfreg(adapter, path, 0x30, 0xFFFFF, bias_new);
+ }
+
+ rtw_hal_write_rfreg(adapter, path, 0xEF, 0xFFFFF, 0x0);
+}
+
+static void pa_bias_calibration(PADAPTER adapter)
+{
+ struct hal_com_data *hal;
+ u32 rf_reg18_a, rf_reg18_b;
+ u32 time;
+
+
+ hal = GET_HAL_DATA(adapter);
+ if (0xFF == hal->tx_pa_bias_a)
+ return;
+
+ time = rtw_get_current_time();
+
+ /* Save RF register 0x18 */
+ rf_reg18_a = rtw_hal_read_rfreg(adapter, ODM_RF_PATH_A, 0x18, 0xFFFFF);
+ rf_reg18_b = rtw_hal_read_rfreg(adapter, ODM_RF_PATH_B, 0x18, 0xFFFFF);
+
+ _pa_bias_calibration(adapter, ODM_RF_PATH_A, hal->tx_pa_bias_a);
+ _pa_bias_calibration(adapter, ODM_RF_PATH_B, hal->tx_pa_bias_b);
+
+ /* Restore RF register 0x18 */
+ rtw_hal_write_rfreg(adapter, ODM_RF_PATH_A, 0x18, 0xFFFFF, rf_reg18_a);
+ rtw_hal_write_rfreg(adapter, ODM_RF_PATH_B, 0x18, 0xFFFFF, rf_reg18_b);
+
+ RTW_INFO("%s: done! cost %u ms\n", __FUNCTION__, rtw_get_passing_time_ms(time));
+}
+
+void rtl8822b_phy_init_dm_priv(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ PDM_ODM_T podmpriv = &hal->odmpriv;
+
+
+ /*
+ * Call this before other phydm functions
+ * to guarantee debug messages of phydm would be printed.
+ */
+
+ init_phydm_cominfo(adapter);
+ ODM_InitAllTimers(podmpriv);
+ PHYDM_InitDebugSetting(podmpriv);
+}
+
+void rtl8822b_phy_deinit_dm_priv(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ PDM_ODM_T podmpriv = &hal->odmpriv;
+
+
+ ODM_CancelAllTimers(podmpriv);
+}
+
+void rtl8822b_phy_init_haldm(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal;
+ PDM_ODM_T pDM_Odm;
+
+
+ hal = GET_HAL_DATA(adapter);
+ pDM_Odm = &hal->odmpriv;
+
+ hal->DM_Type = DM_Type_ByDriver;
+
+ update_phydm_cominfo(adapter);
+
+ ODM_DMInit(pDM_Odm);
+
+ pa_bias_calibration(adapter);
+}
+
+static void check_rxfifo_full(PADAPTER adapter)
+{
+ struct dvobj_priv *psdpriv = adapter->dvobj;
+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
+ HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter);
+ struct registry_priv *regsty = &adapter->registrypriv;
+ u8 val8 = 0;
+
+ if (regsty->check_hw_status == 1) {
+ /* switch counter to RX fifo */
+ val8 = rtw_read8(adapter, REG_RXERR_RPT_8822B + 3);
+ rtw_write8(adapter, REG_RXERR_RPT_8822B + 3, (val8 | 0xa0));
+
+ pdbgpriv->dbg_rx_fifo_last_overflow = pdbgpriv->dbg_rx_fifo_curr_overflow;
+ pdbgpriv->dbg_rx_fifo_curr_overflow = rtw_read16(adapter, REG_RXERR_RPT_8822B);
+ pdbgpriv->dbg_rx_fifo_diff_overflow =
+ pdbgpriv->dbg_rx_fifo_curr_overflow - pdbgpriv->dbg_rx_fifo_last_overflow;
+ }
+}
+
+void rtl8822b_phy_haldm_watchdog(PADAPTER adapter)
+{
+ BOOLEAN bFwCurrentInPSMode = _FALSE;
+ BOOLEAN bFwPSAwake = _TRUE;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+
+
+#ifdef CONFIG_MP_INCLUDED
+ /* for MP power tracking */
+ if ((adapter->registrypriv.mp_mode == 1)
+ && (adapter->mppriv.mp_dm == 0))
+ return;
+#endif /* CONFIG_MP_INCLUDED */
+
+ if (!rtw_is_hw_init_completed(adapter))
+ goto skip_dm;
+
+#ifdef CONFIG_LPS
+ bFwCurrentInPSMode = adapter_to_pwrctl(adapter)->bFwCurrentInPSMode;
+ rtw_hal_get_hwreg(adapter, HW_VAR_FWLPS_RF_ON, (u8 *)&bFwPSAwake);
+#endif /* CONFIG_LPS */
+
+#ifdef CONFIG_P2P_PS
+ /*
+ * Fw is under p2p powersaving mode, driver should stop dynamic mechanism.
+ */
+ if (adapter->wdinfo.p2p_ps_mode)
+ bFwPSAwake = _FALSE;
+#endif /* CONFIG_P2P */
+
+ if ((rtw_is_hw_init_completed(adapter))
+ && ((!bFwCurrentInPSMode) && bFwPSAwake)) {
+
+ /* check rx fifo */
+ check_rxfifo_full(adapter);
+ /*
+ * Dynamically switch RTS/CTS protection.
+ */
+ dm_CheckProtection(adapter);
+ }
+
+ /* PHYDM */
+ if (rtw_is_hw_init_completed(adapter)) {
+ u8 bLinked = _FALSE;
+ u8 bsta_state = _FALSE;
+ u8 bBtDisabled = _TRUE;
+
+ if (rtw_mi_check_status(adapter, MI_ASSOC)) {
+ bLinked = _TRUE;
+ if (rtw_mi_check_status(adapter, MI_STA_LINKED))
+ bsta_state = _TRUE;
+ }
+
+ ODM_CmnInfoUpdate(&hal->odmpriv, ODM_CMNINFO_LINK, bLinked);
+ ODM_CmnInfoUpdate(&hal->odmpriv, ODM_CMNINFO_STATION_STATE, bsta_state);
+
+#ifdef CONFIG_BT_COEXIST
+ bBtDisabled = rtw_btcoex_IsBtDisabled(adapter);
+#endif /* CONFIG_BT_COEXIST */
+ ODM_CmnInfoUpdate(&hal->odmpriv, ODM_CMNINFO_BT_ENABLED, ((bBtDisabled == _TRUE) ? _FALSE : _TRUE));
+
+ ODM_DMWatchdog(&hal->odmpriv);
+ }
+
+skip_dm:
+ /*
+ * Check GPIO to determine current RF on/off and Pbc status.
+ * Check Hardware Radio ON/OFF or not
+ */
+#ifdef CONFIG_SUPPORT_HW_WPS_PBC
+ dm_CheckPbcGPIO(adapter);
+#else /* !CONFIG_SUPPORT_HW_WPS_PBC */
+ return;
+#endif /* !CONFIG_SUPPORT_HW_WPS_PBC */
+}
+
+void rtl8822b_phy_haldm_in_lps(PADAPTER adapter)
+{
+ u32 PWDB_rssi = 0;
+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ PDM_ODM_T pDM_Odm = &hal->odmpriv;
+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable;
+ struct sta_priv *pstapriv = &adapter->stapriv;
+ struct sta_info *psta = NULL;
+
+
+ RTW_INFO("%s: RSSI_Min=%d\n", __FUNCTION__, pDM_Odm->RSSI_Min);
+
+ /* update IGI */
+ ODM_Write_DIG(pDM_Odm, pDM_Odm->RSSI_Min);
+
+ /* set rssi to fw */
+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv));
+ if (psta && (psta->rssi_stat.UndecoratedSmoothedPWDB > 0)) {
+ PWDB_rssi = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB << 16));
+ rtl8822b_set_FwRssiSetting_cmd(adapter, (u8 *)&PWDB_rssi);
+ }
+}
+
+void rtl8822b_phy_haldm_watchdog_in_lps(PADAPTER adapter)
+{
+ u8 bLinked = _FALSE;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
+ PDM_ODM_T pDM_Odm = &hal->odmpriv;
+ pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable;
+ struct sta_priv *pstapriv = &adapter->stapriv;
+ struct sta_info *psta = NULL;
+
+ if (!rtw_is_hw_init_completed(adapter))
+ goto skip_lps_dm;
+
+ if (rtw_mi_check_status(adapter, MI_ASSOC))
+ bLinked = _TRUE;
+
+ ODM_CmnInfoUpdate(&hal->odmpriv, ODM_CMNINFO_LINK, bLinked);
+
+ if (bLinked == _FALSE)
+ goto skip_lps_dm;
+
+ if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR))
+ goto skip_lps_dm;
+
+ /* Do DIG by RSSI In LPS-32K */
+
+ /* 1. Find MIN-RSSI */
+ psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv));
+ if (psta == NULL)
+ goto skip_lps_dm;
+
+ hal->EntryMinUndecoratedSmoothedPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB;
+
+ RTW_INFO("CurIGValue=%d, EntryMinUndecoratedSmoothedPWDB=%d\n",
+ pDM_DigTable->CurIGValue, hal->EntryMinUndecoratedSmoothedPWDB);
+
+ if (hal->EntryMinUndecoratedSmoothedPWDB <= 0)
+ goto skip_lps_dm;
+
+ hal->MinUndecoratedPWDBForDM = hal->EntryMinUndecoratedSmoothedPWDB;
+
+ pDM_Odm->RSSI_Min = hal->MinUndecoratedPWDBForDM;
+
+#ifdef CONFIG_LPS
+ if ((pDM_DigTable->CurIGValue > pDM_Odm->RSSI_Min + 5)
+ || (pDM_DigTable->CurIGValue < pDM_Odm->RSSI_Min - 5))
+ rtw_dm_in_lps_wk_cmd(adapter);
+#endif
+
+skip_lps_dm:
+ return;
+}
+
+static u32 phy_calculatebitshift(u32 mask)
+{
+ u32 i;
+
+
+ for (i = 0; i <= 31; i++)
+ if (mask & BIT(i))
+ break;
+
+ return i;
+}
+
+u32 rtl8822b_read_bb_reg(PADAPTER adapter, u32 addr, u32 mask)
+{
+ u32 val = 0, val_org, shift;
+
+
+#if (DISABLE_BB_RF == 1)
+ return 0;
+#endif
+
+ val_org = rtw_read32(adapter, addr);
+ shift = phy_calculatebitshift(mask);
+ val = (val_org & mask) >> shift;
+
+ return val;
+}
+
+void rtl8822b_write_bb_reg(PADAPTER adapter, u32 addr, u32 mask, u32 val)
+{
+ u32 val_org, shift;
+
+
+#if (DISABLE_BB_RF == 1)
+ return;
+#endif
+
+ if (mask != 0xFFFFFFFF) {
+ /* not "double word" write */
+ val_org = rtw_read32(adapter, addr);
+ shift = phy_calculatebitshift(mask);
+ val = ((val_org & (~mask)) | ((val << shift) & mask));
+ }
+
+ rtw_write32(adapter, addr, val);
+}
+
+u32 rtl8822b_read_rf_reg(PADAPTER adapter, u8 path, u32 addr, u32 mask)
+{
+ PHAL_DATA_TYPE hal;
+ PDM_ODM_T phydm;
+ u32 val;
+
+
+ hal = GET_HAL_DATA(adapter);
+ phydm = &hal->odmpriv;
+
+ val = config_phydm_read_rf_reg_8822b(phydm, path, addr, mask);
+ if (!config_phydm_read_rf_check_8822b(val))
+ RTW_INFO(FUNC_ADPT_FMT ": read RF reg path=%d addr=0x%x mask=0x%x FAIL!\n",
+ FUNC_ADPT_ARG(adapter), path, addr, mask);
+
+ return val;
+}
+
+void rtl8822b_write_rf_reg(PADAPTER adapter, u8 path, u32 addr, u32 mask, u32 val)
+{
+ PHAL_DATA_TYPE hal;
+ PDM_ODM_T phydm;
+ u8 ret;
+
+
+ hal = GET_HAL_DATA(adapter);
+ phydm = &hal->odmpriv;
+
+ ret = config_phydm_write_rf_reg_8822b(phydm, path, addr, mask, val);
+ if (_FALSE == ret)
+ RTW_INFO(FUNC_ADPT_FMT ": write RF reg path=%d addr=0x%x mask=0x%x val=0x%x FAIL!\n",
+ FUNC_ADPT_ARG(adapter), path, addr, mask, val);
+}
+
+static void set_tx_power_level_by_path(PADAPTER adapter, u8 channel, u8 path)
+{
+ PHY_SetTxPowerIndexByRateSection(adapter, path, channel, CCK);
+ PHY_SetTxPowerIndexByRateSection(adapter, path, channel, OFDM);
+ PHY_SetTxPowerIndexByRateSection(adapter, path, channel, HT_MCS0_MCS7);
+ PHY_SetTxPowerIndexByRateSection(adapter, path, channel, HT_MCS8_MCS15);
+ PHY_SetTxPowerIndexByRateSection(adapter, path, channel, VHT_1SSMCS0_1SSMCS9);
+ PHY_SetTxPowerIndexByRateSection(adapter, path, channel, VHT_2SSMCS0_2SSMCS9);
+}
+
+void rtl8822b_set_tx_power_level(PADAPTER adapter, u8 channel)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ PDM_ODM_T phydm;
+ pFAT_T pDM_FatTable;
+ u8 path = ODM_RF_PATH_A;
+
+
+ hal = GET_HAL_DATA(adapter);
+ phydm = &hal->odmpriv;
+ pDM_FatTable = &phydm->DM_FatTable;
+
+ if (hal->AntDivCfg) {
+ /* antenna diversity Enable */
+ path = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ODM_RF_PATH_A : ODM_RF_PATH_B;
+ set_tx_power_level_by_path(adapter, channel, path);
+ } else {
+ /* antenna diversity disable */
+ for (path = ODM_RF_PATH_A; path < hal->NumTotalRFPath; ++path)
+ set_tx_power_level_by_path(adapter, channel, path);
+ }
+}
+
+void rtl8822b_get_tx_power_level(PADAPTER adapter, s32 *power)
+{
+}
+
+/*
+ * Parameters:
+ * padatper
+ * powerindex power index for rate
+ * rfpath Antenna(RF) path, type "enum _ODM_RF_RADIO_PATH"
+ * rate data rate, type "enum MGN_RATE"
+ */
+void rtl8822b_set_tx_power_index(PADAPTER adapter, u32 powerindex, u8 rfpath, u8 rate)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ PDM_ODM_T phydm = &hal->odmpriv;
+ u8 shift = 0;
+ static u32 index = 0;
+
+
+ rate = PHY_GetRateIndexOfTxPowerByRate(rate);
+
+ /*
+ * For 8822B, phydm api use 4 bytes txagc value
+ * driver must combine every four 1 byte to one 4 byte and send to phydm api
+ */
+ shift = rate % 4;
+ index |= ((powerindex & 0xff) << (shift * 8));
+
+ if (shift == 3) {
+ rate = rate - 3;
+
+ if (!config_phydm_write_txagc_8822b(phydm, index, rfpath, rate)) {
+ RTW_INFO("%s(index:%d, rfpath:%d, rate:0x%02x, disable api:%d) fail\n",
+ __FUNCTION__, index, rfpath, rate, phydm->bDisablePhyApi);
+
+ rtw_warn_on(1);
+ }
+ index = 0;
+ }
+}
+
+static u8 rtl8822b_phy_get_current_tx_num(PADAPTER adapter, u8 rate)
+{
+ u8 tx_num = 0;
+
+ if ((rate >= MGN_MCS8 && rate <= MGN_MCS15) ||
+ (rate >= MGN_VHT2SS_MCS0 && rate <= MGN_VHT2SS_MCS9))
+ tx_num = RF_2TX;
+ else
+ tx_num = RF_1TX;
+
+ return tx_num;
+}
+
+/*
+ * Parameters:
+ * padatper
+ * rfpath Antenna(RF) path, type "enum _ODM_RF_RADIO_PATH"
+ * rate data rate, type "enum MGN_RATE"
+ * bandwidth Bandwidth, type "enum _CHANNEL_WIDTH"
+ * channel Channel number
+ *
+ * Rteurn:
+ * tx_power power index for rate
+ */
+u8 rtl8822b_get_tx_power_index(PADAPTER adapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ s8 power_diff_by_rate = 0;
+ s8 tx_power = 0, limit = 0;
+ u8 tx_num = rtl8822b_phy_get_current_tx_num(adapter, rate);
+ u8 bIn24G = _FALSE;
+
+
+ tx_power = (s8) PHY_GetTxPowerIndexBase(adapter, rfpath, rate, bandwidth, channel, &bIn24G);
+
+ power_diff_by_rate = PHY_GetTxPowerByRate(adapter, (u8)(!bIn24G), rfpath, tx_num, rate);
+
+ limit = PHY_GetTxPowerLimit(adapter, adapter->registrypriv.RegPwrTblSel, (BAND_TYPE)(!bIn24G),
+ hal->CurrentChannelBW, rfpath, rate, hal->CurrentChannel);
+
+ power_diff_by_rate = power_diff_by_rate > limit ? limit : power_diff_by_rate;
+
+ tx_power += power_diff_by_rate;
+
+#if 0
+#if CCX_SUPPORT
+ CCX_CellPowerLimit(pAdapter, Channel, Rate, (u8 *)&txPower);
+#endif
+#endif
+
+ if (tx_power > MAX_POWER_INDEX)
+ tx_power = MAX_POWER_INDEX;
+
+ return tx_power;
+}
+
+/*
+ * Description:
+ * Check need to switch band or not
+ * Parameters:
+ * channelToSW channel wiii be switch to
+ * Return:
+ * _TRUE need to switch band
+ * _FALSE not need to switch band
+ */
+static u8 need_switch_band(PADAPTER adapter, u8 channelToSW)
+{
+ u8 u1tmp = 0;
+ u8 ret_value = _TRUE;
+ u8 Band = BAND_ON_5G, BandToSW = BAND_ON_5G;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+
+ Band = hal->CurrentBandType;
+
+ /* Use current swich channel to judge Band Type and switch Band if need */
+ if (channelToSW > 14)
+ BandToSW = BAND_ON_5G;
+ else
+ BandToSW = BAND_ON_2_4G;
+
+ if (BandToSW != Band) {
+ /* record current band type for other hal use */
+ hal->CurrentBandType = (BAND_TYPE)BandToSW;
+ ret_value = _TRUE;
+ } else
+ ret_value = _FALSE;
+
+ return ret_value;
+}
+
+static u8 get_pri_ch_id(PADAPTER adapter)
+{
+ u8 pri_ch_idx = 0;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+
+ if (hal->CurrentChannelBW == CHANNEL_WIDTH_80) {
+ /* primary channel is at lower subband of 80MHz & 40MHz */
+ if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER))
+ pri_ch_idx = VHT_DATA_SC_20_LOWEST_OF_80MHZ;
+ /* primary channel is at lower subband of 80MHz & upper subband of 40MHz */
+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER))
+ pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ;
+ /* primary channel is at upper subband of 80MHz & lower subband of 40MHz */
+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER))
+ pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ;
+ /* primary channel is at upper subband of 80MHz & upper subband of 40MHz */
+ else if ((hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER))
+ pri_ch_idx = VHT_DATA_SC_20_UPPERST_OF_80MHZ;
+ else {
+ if (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)
+ pri_ch_idx = VHT_DATA_SC_40_LOWER_OF_80MHZ;
+ else if (hal->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)
+ pri_ch_idx = VHT_DATA_SC_40_UPPER_OF_80MHZ;
+ else
+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n");
+ }
+ } else if (hal->CurrentChannelBW == CHANNEL_WIDTH_40) {
+ /* primary channel is at upper subband of 40MHz */
+ if (hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)
+ pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ;
+ /* primary channel is at lower subband of 40MHz */
+ else if (hal->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)
+ pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ;
+ else
+ RTW_INFO("SCMapping: DONOT CARE Mode Setting\n");
+ }
+
+ return pri_ch_idx;
+}
+
+static void mac_switch_bandwidth(PADAPTER adapter, u8 pri_ch_idx)
+{
+ u8 channel = 0, bw = 0;
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ int err;
+
+ channel = hal->CurrentChannel;
+ bw = hal->CurrentChannelBW;
+ err = rtw_halmac_set_bandwidth(adapter_to_dvobj(adapter), channel, pri_ch_idx, bw);
+ if (err) {
+ RTW_INFO(FUNC_ADPT_FMT ": (channel=%d, pri_ch_idx=%d, bw=%d) fail\n",
+ FUNC_ADPT_ARG(adapter), channel, pri_ch_idx, bw);
+ }
+}
+
+/*
+ * Description:
+ * Set channel & bandwidth & offset
+ */
+void rtl8822b_switch_chnl_and_set_bw(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+ PDM_ODM_T pDM_Odm = &hal->odmpriv;
+ u8 center_ch = 0, ret = 0;
+
+ if (adapter->bNotifyChannelChange) {
+ RTW_INFO("[%s] bSwChnl=%d, ch=%d, bSetChnlBW=%d, bw=%d\n",
+ __FUNCTION__,
+ hal->bSwChnl,
+ hal->CurrentChannel,
+ hal->bSetChnlBW,
+ hal->CurrentChannelBW);
+ }
+
+ if (RTW_CANNOT_RUN(adapter)) {
+ hal->bSwChnlAndSetBWInProgress = _FALSE;
+ return;
+ }
+
+ /* set channel & Bandwidth register */
+ /* 1. set switch band register if need to switch band */
+ if (need_switch_band(adapter, hal->CurrentChannel) == _TRUE) {
+#ifdef CONFIG_BT_COEXIST
+ if (hal->EEPROMBluetoothCoexist) {
+ struct mlme_ext_priv *mlmeext;
+
+ /* switch band under site survey or not, must notify to BT COEX */
+ mlmeext = &adapter->mlmeextpriv;
+ if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE)
+ rtw_btcoex_switchband_notify(_TRUE, hal->CurrentBandType);
+ else
+ rtw_btcoex_switchband_notify(_FALSE, hal->CurrentBandType);
+ }
+#endif /* CONFIG_BT_COEXIST */
+
+ /* hal->CurrentChannel is center channel of pmlmeext->cur_channel(primary channel) */
+ ret = config_phydm_switch_band_8822b(pDM_Odm, hal->CurrentChannel);
+
+ if (!ret) {
+ RTW_INFO("%s: config_phydm_switch_band_8822b fail\n", __FUNCTION__);
+ rtw_warn_on(1);
+ return;
+ }
+
+ /* <2016/03/09> ** This Setting is for MP Driver Only*/
+#ifdef CONFIG_MP_INCLUDED
+ if (adapter->registrypriv.mp_mode == _TRUE) {
+ /* <2016/02/25, VincentL> Add for 8822B Antenna Binding between "2.4G-WiFi"
+ And between "5G-BT", Suggested by RF SzuyiTsai*/
+ if (hal->CurrentChannel <= 14) /* 2.4G*/
+ PHY_SetRFPathSwitch_8822B(adapter, 1); /*To WiFi-2.4G*/
+ else /* 5G */
+ PHY_SetRFPathSwitch_8822B(adapter, 0); /*To BT-5G*/
+ }
+#endif
+
+ }
+
+ /* 2. set channel register */
+ if (hal->bSwChnl) {
+ ret = config_phydm_switch_channel_8822b(pDM_Odm, hal->CurrentChannel);
+ hal->bSwChnl = _FALSE;
+
+ if (!ret) {
+ RTW_INFO("%s: config_phydm_switch_channel_8822b fail\n", __FUNCTION__);
+ rtw_warn_on(1);
+ return;
+ }
+ }
+
+ /* 3. set Bandwidth register */
+ if (hal->bSetChnlBW) {
+ /* get primary channel index */
+ u8 pri_ch_idx = get_pri_ch_id(adapter);
+
+ /* 3.1 set MAC register */
+ mac_switch_bandwidth(adapter, pri_ch_idx);
+
+ /* 3.2 set BB/RF registet */
+ ret = config_phydm_switch_bandwidth_8822b(pDM_Odm, pri_ch_idx, hal->CurrentChannelBW);
+ hal->bSetChnlBW = _FALSE;
+
+ if (!ret) {
+ RTW_INFO("%s: config_phydm_switch_bandwidth_8822b fail\n", __FUNCTION__);
+ rtw_warn_on(1);
+ return;
+ }
+ }
+
+ /* TX Power Setting */
+ ODM_ClearTxPowerTrackingState(pDM_Odm);
+ rtw_hal_set_tx_power_level(adapter, hal->CurrentChannel);
+
+ /* IQK */
+ if ((hal->bNeedIQK == _TRUE)
+ || (adapter->registrypriv.mp_mode == 1)) {
+ PHY_IQCalibrate_8822B(pDM_Odm, _FALSE);
+ hal->bNeedIQK = _FALSE;
+ }
+}
+
+/*
+ * Description:
+ * Store channel setting to hal date
+ * Parameters:
+ * bSwitchChannel swith channel or not
+ * bSetBandWidth set band or not
+ * ChannelNum center channel
+ * ChnlWidth bandwidth
+ * ChnlOffsetOf40MHz channel offset for 40MHz Bandwidth
+ * ChnlOffsetOf80MHz channel offset for 80MHz Bandwidth
+ * CenterFrequencyIndex1 center channel index
+ */
+
+void rtl8822b_handle_sw_chnl_and_set_bw(
+ PADAPTER Adapter, u8 bSwitchChannel, u8 bSetBandWidth,
+ u8 ChannelNum, CHANNEL_WIDTH ChnlWidth, u8 ChnlOffsetOf40MHz,
+ u8 ChnlOffsetOf80MHz, u8 CenterFrequencyIndex1)
+{
+ PADAPTER pDefAdapter = GetDefaultAdapter(Adapter);
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(pDefAdapter);
+ u8 tmpChannel = hal->CurrentChannel;
+ CHANNEL_WIDTH tmpBW = hal->CurrentChannelBW;
+ u8 tmpnCur40MhzPrimeSC = hal->nCur40MhzPrimeSC;
+ u8 tmpnCur80MhzPrimeSC = hal->nCur80MhzPrimeSC;
+ u8 tmpCenterFrequencyIndex1 = hal->CurrentCenterFrequencyIndex1;
+ struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv;
+
+
+ /* check swchnl or setbw */
+ if (!bSwitchChannel && !bSetBandWidth) {
+ RTW_INFO("%s: not switch channel and not set bandwidth\n", __FUNCTION__);
+ return;
+ }
+
+ /* skip switch channel operation for current channel & ChannelNum(will be switch) are the same */
+ if (bSwitchChannel) {
+ if (hal->CurrentChannel != ChannelNum) {
+ if (HAL_IsLegalChannel(Adapter, ChannelNum))
+ hal->bSwChnl = _TRUE;
+ else
+ return;
+ }
+ }
+
+ /* check set BandWidth */
+ if (bSetBandWidth) {
+ /* initial channel bw setting */
+ if (hal->bChnlBWInitialized == _FALSE) {
+ hal->bChnlBWInitialized = _TRUE;
+ hal->bSetChnlBW = _TRUE;
+ } else if ((hal->CurrentChannelBW != ChnlWidth) || /* check whether need set band or not */
+ (hal->nCur40MhzPrimeSC != ChnlOffsetOf40MHz) ||
+ (hal->nCur80MhzPrimeSC != ChnlOffsetOf80MHz) ||
+ (hal->CurrentCenterFrequencyIndex1 != CenterFrequencyIndex1))
+ hal->bSetChnlBW = _TRUE;
+ }
+
+ /* return if not need set bandwidth nor channel after check*/
+ if (!hal->bSetChnlBW && !hal->bSwChnl)
+ return;
+
+ /* set channel number to hal data */
+ if (hal->bSwChnl) {
+ hal->CurrentChannel = ChannelNum;
+ hal->CurrentCenterFrequencyIndex1 = ChannelNum;
+ }
+
+ /* set bandwidth info to hal data */
+ if (hal->bSetChnlBW) {
+ hal->CurrentChannelBW = ChnlWidth;
+ hal->nCur40MhzPrimeSC = ChnlOffsetOf40MHz;
+ hal->nCur80MhzPrimeSC = ChnlOffsetOf80MHz;
+ hal->CurrentCenterFrequencyIndex1 = CenterFrequencyIndex1;
+ }
+
+ /* switch channel & bandwidth */
+ if (!RTW_CANNOT_RUN(Adapter))
+ rtl8822b_switch_chnl_and_set_bw(Adapter);
+ else {
+ if (hal->bSwChnl) {
+ hal->CurrentChannel = tmpChannel;
+ hal->CurrentCenterFrequencyIndex1 = tmpChannel;
+ }
+
+ if (hal->bSetChnlBW) {
+ hal->CurrentChannelBW = tmpBW;
+ hal->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC;
+ hal->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC;
+ hal->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1;
+ }
+ }
+}
+
+/*
+ * Description:
+ * Change bandwidth, current channel is the same
+ * Parameters:
+ * bw bandwidth
+ * offset channel offset for 40MHz or 80MHz Bandwidth according to bw
+ */
+void rtl8822b_set_bw_mode(PADAPTER adapter, CHANNEL_WIDTH bw, u8 offset)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+
+ rtl8822b_handle_sw_chnl_and_set_bw(adapter, _FALSE, _TRUE, hal->CurrentChannel, bw, offset, offset, hal->CurrentChannel);
+}
+
+/*
+ * Description:
+ * Change channel, and bandwidth & offset are not changed
+ * Parameters:
+ * center_ch center channel
+ */
+void rtl8822b_set_channel(PADAPTER adapter, u8 center_ch)
+{
+ PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
+
+ rtl8822b_handle_sw_chnl_and_set_bw(adapter, _TRUE, _FALSE, center_ch, 0, 0, 0, center_ch);
+}
+
+/*
+ * Description:
+ * Change channel, bandwidth & offset
+ * Parameters:
+ * center_ch center channel
+ * bw bandwidth
+ * offset40 channel offset for 40MHz Bandwidth
+ * offset80 channel offset for 80MHz Bandwidth
+ */
+void rtl8822b_set_channel_bw(PADAPTER adapter, u8 center_ch, CHANNEL_WIDTH bw, u8 offset40, u8 offset80)
+{
+ rtl8822b_handle_sw_chnl_and_set_bw(adapter, _TRUE, _TRUE, center_ch, bw, offset40, offset80, center_ch);
+}
+
+void rtl8822b_notch_filter_switch(PADAPTER adapter, bool enable)
+{
+ if (enable)
+ RTW_INFO("%s: Enable notch filter\n", __FUNCTION__);
+ else
+ RTW_INFO("%s: Disable notch filter\n", __FUNCTION__);
+}
+
+#ifdef CONFIG_MP_INCLUDED
+/*
+ * Description:
+ * Config RF path
+ *
+ * Parameters:
+ * adapter pointer of struct _ADAPTER
+ */
+void rtl8822b_mp_config_rfpath(PADAPTER adapter)
+{
+ PHAL_DATA_TYPE hal;
+ PMPT_CONTEXT mpt;
+ ANTENNA_PATH anttx, antrx;
+ ODM_RF_PATH_E rxant;
+
+
+ hal = GET_HAL_DATA(adapter);
+ mpt = &adapter->mppriv.MptCtx;
+ anttx = hal->AntennaTxPath;
+ antrx = hal->AntennaRxPath;
+ hal->antenna_test = _TRUE;
+ RTW_INFO("+Config RF Path, tx=0x%x rx=0x%x\n", anttx, antrx);
+
+ switch (anttx) {
+ case ANTENNA_A:
+ mpt->MptRfPath = ODM_RF_A;
+ break;
+ case ANTENNA_B:
+ mpt->MptRfPath = ODM_RF_B;
+ break;
+ case ANTENNA_AB:
+ default:
+ mpt->MptRfPath = ODM_RF_A | ODM_RF_B;
+ break;
+ }
+
+ switch (antrx) {
+ case ANTENNA_A:
+ rxant = ODM_RF_A;
+ break;
+ case ANTENNA_B:
+ rxant = ODM_RF_B;
+ break;
+ case ANTENNA_AB:
+ default:
+ rxant = ODM_RF_A | ODM_RF_B;
+ break;
+ }
+
+ config_phydm_trx_mode_8822b(GET_PDM_ODM(adapter), mpt->MptRfPath, rxant, FALSE);
+
+ RTW_INFO("-Config RF Path Finish\n");
+}
+#endif /* CONFIG_MP_INCLUDED */
+
+#ifdef CONFIG_BEAMFORMING
+void rtl8822b_phy_init_beamforming(PADAPTER adapter)
+{
+ u8 v8;
+ u32 v32;
+
+ v32 = rtw_read32(adapter, 0x14c0);
+ /* Enable P1 aggr new packet according to P0 transfer time */
+ v32 |= BIT(16);
+ /* MU Retry Limit */
+ v32 = (v32 & 0xFFFF0FFF) | 0xA000;
+ /*Disable Tx MU-MIMO until sounding done*/
+ v32 &= ~BIT(7);
+ /* Clear validity of MU STAs */
+ v32 &= 0xFFFFFFC0;
+ rtw_write32(adapter, 0x14C0, v32);
+
+ /* MU-MIMO Option as default value */
+ rtw_write8(adapter, 0x167C, 0x70);
+ /*MU-MIMO Control as default value*/
+ rtw_write16(adapter, 0x1680, 0);
+
+ /* Set MU NDPA rate & BW source */
+ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */
+ v8 = rtw_read8(adapter, REG_TXBF_CTRL_8822B);
+ v8 |= BIT(6);
+ rtw_write8(adapter, REG_TXBF_CTRL_8822B, v8);
+ /* 0x45F[7:0] = 0x10 (Rate=OFDM_6M, BW20) */
+ rtw_write8(adapter, REG_NDPA_OPT_CTRL_8822B, 0x10);
+
+ /* Temp Settings */
+ /* STA2's CSI rate is fixed at 6M */
+ v8 = rtw_read8(adapter, 0x6DF);
+ v8 = (v8 & 0xC0) | 0x4;
+ rtw_write8(adapter, 0x6DF, v8);
+ /* Grouping bitmap parameters */
+ rtw_write32(adapter, 0x1C94, 0xAFFFAFFF);
+}
+
+static void _setbeamformrfmode(PADAPTER adapter, u8 cnt_bfee_su, u8 cnt_bfee_mu, u8 idx)
+{
+ BEAMFORMING_CAP bf_cap = BEAMFORMING_CAP_NONE;
+
+
+ if (GET_RF_TYPE(adapter) == RF_1T1R)
+ return;
+
+ /* RF Mode table write enable */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x1);
+ PHY_SetRFReg(adapter, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x1);
+
+ if (cnt_bfee_su || cnt_bfee_mu) {
+ /* Path_A */
+ /* Select RX mode */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000);
+ /* Set Table data */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0xBE77F);
+ /* Enable TXIQGEN in RX mode */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x226BF);
+ /* Path_B */
+ /* Select RX mode */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000);
+ /* Set Table data */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0xBE77F);
+ /* Enable TXIQGEN in RX mode */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x226BF);
+
+ /* Enable TXIQGEN in RX mode */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF);
+ }
+
+ /* RF Mode table write disable */
+ PHY_SetRFReg(adapter, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x0);
+ PHY_SetRFReg(adapter, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x0);
+
+ if (cnt_bfee_su) {
+ /* enable BB TxBF ant mapping register */
+ PHY_SetBBReg(adapter, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28)|BIT(29), 0x2);
+
+ if (idx == 0) {
+ /* Nsts = 2, AB */
+ PHY_SetBBReg(adapter, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433);
+ PHY_SetBBReg(adapter, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043);
+ /*PHY_SetBBReg(adapter, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430);*/
+
+ } else { /* idx = 1 */
+ PHY_SetBBReg(adapter, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433);
+ PHY_SetBBReg(adapter, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043);
+ /*PHY_SetBBReg(adapter, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430;*/
+ }
+ } else {
+ PHY_SetBBReg(adapter, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /* 1SS by path-A */
+ PHY_SetBBReg(adapter, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430); /* 2SS by path-A,B */
+ }
+
+ if (cnt_bfee_mu) {
+ /* MU STAs share the common setting */
+ PHY_SetBBReg(adapter, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1);
+ PHY_SetBBReg(adapter, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433);
+ PHY_SetBBReg(adapter, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043);
+ }
+}
+
+static u8 _get_txbf_nrx(PADAPTER adapter)
+{
+ u8 rf;
+ u8 nrx = 0;
+
+
+ rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, &rf);
+ switch (rf) {
+ case RF_1T1R:
+ nrx = 0;
+ break;
+ default:
+ case RF_1T2R:
+ case RF_2T2R:
+ nrx = 1;
+ break;
+ }
+
+ return nrx;
+}
+
+typedef enum _HW_CFG_SOUNDING_TYPE {
+ HW_CFG_SOUNDING_TYPE_SOUNDDOWN,
+ HW_CFG_SOUNDING_TYPE_LEAVE,
+ HW_CFG_SOUNDING_TYPE_RESET,
+ HW_CFG_SOUNDING_TYPE_MAX
+} HW_CFG_SOUNDING_TYPE, *PHW_CFG_SOUNDING_TYPE;
+
+static void _config_sounding(PADAPTER adapter, struct beamformee_entry *entry, u8 mu_sounding, HW_CFG_SOUNDING_TYPE cfg_type)
+{
+ struct mlme_priv *mlme;
+ struct beamforming_info *bf_info;
+ u8 su_cnt, mu_cnt;
+ u16 BeamCtrlVal;
+ u32 BeamCtrlReg;
+ u8 is_bitmap_ready = _FALSE;
+ u16 bitmap;
+ u8 gid, i, j, count = 0;
+ u8 id1, id0;
+ u32 gid_valid[6] = {0};
+ u32 val32;
+
+
+ mlme = &adapter->mlmepriv;
+ bf_info = GET_BEAMFORM_INFO(adapter);
+
+ if (cfg_type == HW_CFG_SOUNDING_TYPE_RESET) {
+ RTW_INFO("%s: HW_CFG_SOUNDING_TYPE_RESET\n", __FUNCTION__);
+
+ rtw_write8(adapter, REG_TXBF_CTRL_8822B+3, 0);
+
+ /* Clear all MU entry table */
+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) {
+ entry = &bf_info->bfee_entry[i];
+ for (i = 0; i < 8; i++)
+ entry->gid_valid[i] = 0;
+ }
+
+ val32 = rtw_read32(adapter, 0x14C0);
+ for (i = 0; i < 6; i++) {
+ val32 &= ~(BIT(8)|BIT(9)|BIT(10));
+ val32 |= ((i<<8) & (BIT(8)|BIT(9)|BIT(10)));
+ rtw_write32(adapter, 0x14C0, val32);
+ /* set MU STA gid valid table */
+ rtw_write32(adapter, 0x14C4, 0);
+ }
+
+ /* Disable TxMU PPDU */
+ val32 &= ~BIT(7);
+ rtw_write32(adapter, 0x14C0, val32);
+ } else {
+ if (_FALSE == mu_sounding) {
+ /* SU sounding */
+ if ((check_fwstate(mlme, WIFI_ADHOC_STATE) == _TRUE)
+ || (check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE) == _TRUE))
+ BeamCtrlVal = entry->mac_id;
+ else
+ BeamCtrlVal = entry->p_aid;
+
+ if (entry->su_reg_index == 0) {
+ BeamCtrlReg = REG_TXBF_CTRL_8822B;
+ } else {
+ BeamCtrlReg = REG_TXBF_CTRL_8822B+2;
+ BeamCtrlVal |= ((BIT_R_EN_NDPA_INT_8822B | BIT_USE_NDPA_PARAMETER_8822B | BIT_R_ENABLE_NDPA_8822B) >> 16);
+ }
+
+ /* Current BFee sound down */
+ if (entry->bDeleteSounding
+ || (cfg_type == HW_CFG_SOUNDING_TYPE_LEAVE)) {
+ RTW_INFO("%s: SU HW_CFG_SOUNDING_TYPE_LEAVE\n", __FUNCTION__);
+ RTW_INFO("%s: Don't apply Vmatrix\n", __FUNCTION__);
+ BeamCtrlVal &= ~(BIT(9)|BIT(10)|BIT(11));
+ } else {
+ if (entry->sound_bw == CHANNEL_WIDTH_20)
+ BeamCtrlVal |= BIT(9);
+ else if (entry->sound_bw == CHANNEL_WIDTH_40)
+ BeamCtrlVal |= (BIT(9)|BIT(10));
+ else if (entry->sound_bw == CHANNEL_WIDTH_80)
+ BeamCtrlVal |= (BIT(9)|BIT(10)|BIT(11));
+ }
+
+ rtw_write16(adapter, BeamCtrlReg, BeamCtrlVal);
+ } else {
+ /* MU sounding */
+ if (cfg_type == HW_CFG_SOUNDING_TYPE_LEAVE) {
+ RTW_INFO("%s: MU HW_CFG_SOUNDING_TYPE_LEAVE\n", __FUNCTION__);
+
+ /* Clear the entry table */
+ val32 = rtw_read32(adapter, 0x14C0);
+ if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) {
+ for (i = 0; i < 8; i++)
+ entry->gid_valid[i] = 0;
+
+ val32 &= ~(BIT(8)|BIT(9)|BIT(10));
+ val32 |= ((i<<8) & (BIT(8)|BIT(9)|BIT(10)));
+ rtw_write32(adapter, 0x14C0, val32);
+ /* Set MU STA gid valid table */
+ rtw_write32(adapter, 0x14C4, 0);
+ } else {
+ RTW_ERR("%s: ERROR! It is not an MU BFee entry!!\n", __FUNCTION__);
+ }
+
+ if (bf_info->beamformee_su_cnt == 0) {
+ /* Disable TxMU PPDU */
+ val32 &= ~BIT(7);
+ rtw_write32(adapter, 0x14C0, val32);
+ }
+ } else if (cfg_type == HW_CFG_SOUNDING_TYPE_SOUNDDOWN) {
+ RTW_INFO("%s: MU HW_CFG_SOUNDING_TYPE_SOUNDDOWN\n", __FUNCTION__);
+
+ /* Update all MU entry table */
+ do {
+ /* Check BB GID bitmap ready */
+ val32 = PHY_QueryBBReg(adapter, 0xF4C, 0xFFFF0000);
+
+ is_bitmap_ready = (val32 & BIT(15)) ? _TRUE : _FALSE;
+ count++;
+ rtw_udelay_os(5);
+ } while ((_FALSE == is_bitmap_ready) && (count < 100));
+
+ bitmap = (u16)(val32 & 0x3FFF);
+
+ for (i = 0; i < 15; i++) {
+ if (i < 5) {/*bit0~4*/
+ id0 = 0;
+ id1 = (u8)(i + 1);
+ } else if (i < 9) { /*bit5~8*/
+ id0 = 1;
+ id1 = (u8)(i - 3);
+ } else if (i < 12) { /*bit9~11*/
+ id0 = 2;
+ id1 = (u8)(i - 6);
+ } else if (i < 14) { /*bit12~13*/
+ id0 = 3;
+ id1 = (u8)(i - 8);
+ } else { /*bit14*/
+ id0 = 4;
+ id1 = (u8)(i - 9);
+ }
+ if (bitmap & BIT(i)) {
+ /*Pair 1*/
+ gid = (i << 1) + 1;
+ gid_valid[id0] |= (BIT(gid));
+ gid_valid[id1] |= (BIT(gid));
+ /*Pair 2*/
+ gid += 1;
+ gid_valid[id0] |= (BIT(gid));
+ gid_valid[id1] |= (BIT(gid));
+ } else {
+ /*Pair 1*/
+ gid = (i << 1) + 1;
+ gid_valid[id0] &= ~(BIT(gid));
+ gid_valid[id1] &= ~(BIT(gid));
+ /*Pair 2*/
+ gid += 1;
+ gid_valid[id0] &= ~(BIT(gid));
+ gid_valid[id1] &= ~(BIT(gid));
+ }
+ }
+
+ for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) {
+ entry = &bf_info->bfee_entry[i];
+ if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)
+ && (entry->mu_reg_index < 6)) {
+ val32 = gid_valid[entry->mu_reg_index];
+ for (j = 0; j < 4; j++) {
+ entry->gid_valid[j] = (u8)(val32 & 0xFF);
+ val32 >>= 8;
+ }
+ }
+ }
+
+ val32 = rtw_read32(adapter, 0x14C0);
+ for (i = 0; i < 6; i++) {
+ val32 &= ~(BIT8|BIT9|BIT10);
+ val32 |= ((i<<8) & (BIT8|BIT9|BIT10));
+ rtw_write32(adapter, 0x14C0, val32);
+ /* Set MU STA gid valid table */
+ rtw_write32(adapter, 0x14C4, gid_valid[i]);
+ }
+
+ /* Enable TxMU PPDU */
+ val32 |= BIT(7);
+ rtw_write32(adapter, 0x14C0, val32);
+ }
+ }
+ }
+}
+
+void rtl8822b_phy_sounding_enter(PADAPTER adapter, struct sta_info *sta)
+{
+ PHAL_DATA_TYPE hal;
+ struct mlme_priv *mlme;
+ struct beamforming_info *bf_info;
+ struct beamformer_entry *bfer;
+ struct beamformee_entry *bfee;
+ u8 cnt_bfee_su = 0, cnt_bfee_mu = 0;
+ u8 i = 0, idx;
+ u32 csi_param;
+ u16 p_aid = 0;
+ /* MU */
+ u8 nc_index = 0, nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0;
+ u32 gid_valid = 0, user_position_l = 0, user_position_h = 0;
+ u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168A, 0x168C, 0x168E};
+ /* General */
+ u8 val8;
+ u16 val16;
+ u32 val32;
+
+
+ RTW_INFO("+%s\n", __FUNCTION__);
+
+ hal = GET_HAL_DATA(adapter);
+ mlme = &adapter->mlmepriv;
+ bf_info = GET_BEAMFORM_INFO(adapter);
+
+ bfee = beamforming_get_bfee_entry_by_addr(adapter, sta->hwaddr);
+ bfer = beamforming_get_bfer_entry_by_addr(adapter, sta->hwaddr);
+
+ if (bfer) {
+ bfer->state = BEAMFORM_ENTRY_HW_STATE_ADDING;
+
+ if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_MU)) {
+ /* Config MU BFer entry */
+ RTW_INFO("%s: Config MU BFer entry HW setting\n", __FUNCTION__);
+
+ /* Reset GID table */
+ for (i = 0; i < 8; i++)
+ bfer->gid_valid[i] = 0;
+ for (i = 0; i < 16; i++)
+ bfer->user_position[i] = 0;
+
+ /* Sounding protocol control */
+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8822B, 0xDB);
+
+ /* MAC address */
+ for (i = 0; i < ETH_ALEN; i++)
+ rtw_write8(adapter, REG_ASSOCIATED_BFMER0_INFO_8822B+i, bfer->mac_addr[i]);
+
+ /* Set partial AID */
+ rtw_write16(adapter, REG_ASSOCIATED_BFMER0_INFO_8822B+6, bfer->p_aid);
+
+ /*
+ * Fill our AID to 0x1680[11:0] and
+ * [13:12] = 2b'00, BF report segement select to 3895 bytes
+ */
+ val16 = rtw_read16(adapter, 0x1680);
+ val16 &= ~0x3FFF;
+ val16 |= (bfer->aid & 0xFFF);
+ rtw_write16(adapter, 0x1680, val16);
+
+ /* Set 80us for leaving ndp_rx_standby_state */
+ rtw_write8(adapter, 0x71B, 0x50);
+
+ /* Set 0x6A0[14] = 1 to accept action_no_ack */
+ val8 = rtw_read8(adapter, REG_RXFLTMAP0_8822B+1);
+ val8 |= 0x40;
+ rtw_write8(adapter, REG_RXFLTMAP0_8822B+1, val8);
+
+ /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */
+ val8 = rtw_read8(adapter, REG_RXFLTMAP1_8822B);
+ val8 |= 0x30;
+ rtw_write8(adapter, REG_RXFLTMAP1_8822B, val8);
+
+ /* CSI report parameters of Beamformer */
+ nc_index = _get_txbf_nrx(adapter);
+ /*
+ * 0x718[7] = 1 use Nsts
+ * 0x718[7] = 0 use reg setting
+ * As Bfee, we use Nsts, so nr_index don't care
+ */
+ nr_index = 1;
+ grouping = 0; /* no grouping */
+ codebookinfo = 1; /* 7 bit for psi, 9 bit for phi */
+ coefficientsize = 0; /* This is nothing really matter */
+ csi_param = (u16)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(nr_index<<3)|(nc_index));
+ rtw_write16(adapter, REG_TX_CSI_RPT_PARAM_BW20_8822B, csi_param);
+ RTW_INFO("%s: nc=%d nr=%d group=%d codebookinfo=%d coefficientsize=%d\n",
+ __FUNCTION__, nc_index, nr_index, grouping, codebookinfo, coefficientsize);
+ RTW_INFO("%s: csi=0x%04x\n", __FUNCTION__, csi_param);
+
+ /*for B-Cut*/
+ PHY_SetBBReg(adapter, REG_RXFLTMAP0_8822B, BIT(20), 0);
+ PHY_SetBBReg(adapter, REG_RXFLTMAP3_8822B, BIT(20), 0);
+ } else if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) {
+ /* Config SU BFer entry */
+ RTW_INFO("%s: Config SU BFer entry HW setting.\n", __FUNCTION__);
+
+ /* Sounding protocol control */
+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8822B, 0xDB);
+
+ /* MAC address/Partial AID of Beamformer */
+ if (bfer->su_reg_index == 0)
+ for (i = 0; i < 6; i++)
+ rtw_write8(adapter, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), bfer->mac_addr[i]);
+ else
+ for (i = 0; i < 6; i++)
+ rtw_write8(adapter, (REG_ASSOCIATED_BFMER1_INFO_8822B+i), bfer->mac_addr[i]);
+
+ /* CSI report parameters of Beamformer */
+ nc_index = _get_txbf_nrx(adapter);
+ /*
+ * 0x718[7] = 1 use Nsts
+ * 0x718[7] = 0 use reg setting
+ * As Bfee, we use Nsts, so nr_index don't care
+ */
+ nr_index = bfer->NumofSoundingDim;
+
+ grouping = 0;
+
+ /* for ac = 1, for n = 3 */
+ if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_VHT_SU))
+ codebookinfo = 1;
+ else if (TEST_FLAG(bfer->cap, BEAMFORMER_CAP_HT_EXPLICIT))
+ codebookinfo = 3;
+
+ coefficientsize = 3;
+
+ csi_param = (u16)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(nr_index<<3)|(nc_index));
+
+ if (bfer->su_reg_index == 0)
+ rtw_write16(adapter, REG_TX_CSI_RPT_PARAM_BW20_8822B, csi_param);
+ else
+ rtw_write16(adapter, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, csi_param);
+ /* ndp_rx_standby_timer */
+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8822B+3, 0x70);
+ }
+
+ bfer->state = BEAMFORM_ENTRY_HW_STATE_ADDED;
+ }
+
+ if (bfee) {
+ bfee->state = BEAMFORM_ENTRY_HW_STATE_ADDING;
+
+ if (TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_MU)) {
+ idx = bfee->mu_reg_index;
+ /* User position table */
+ switch (idx) {
+ case 0:
+ gid_valid = 0x7fe;
+ user_position_l = 0x111110;
+ user_position_h = 0x0;
+ break;
+ case 1:
+ gid_valid = 0x7f806;
+ user_position_l = 0x11000004;
+ user_position_h = 0x11;
+ break;
+ case 2:
+ gid_valid = 0x1f81818;
+ user_position_l = 0x400040;
+ user_position_h = 0x11100;
+ break;
+ case 3:
+ gid_valid = 0x1e186060;
+ user_position_l = 0x4000400;
+ user_position_h = 0x1100040;
+ break;
+ case 4:
+ gid_valid = 0x66618180;
+ user_position_l = 0x40004000;
+ user_position_h = 0x10040400;
+ break;
+ case 5:
+ gid_valid = 0x79860600;
+ user_position_l = 0x40000;
+ user_position_h = 0x4404004;
+ break;
+ }
+
+ for (i = 0; i < 8; i++) {
+ if (i < 4) {
+ bfee->gid_valid[i] = (u8)(gid_valid & 0xFF);
+ gid_valid = (gid_valid >> 8);
+ } else
+ bfee->gid_valid[i] = 0;
+ }
+ for (i = 0; i < 16; i++) {
+ if (i < 4)
+ bfee->user_position[i] = (u8)((user_position_l >> (i*8)) & 0xFF);
+ else if (i < 8)
+ bfee->user_position[i] = (u8)((user_position_h >> ((i-4)*8)) & 0xFF);
+ else
+ bfee->user_position[i] = 0;
+ }
+
+ /* Sounding protocol control */
+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8822B, 0xDB);
+
+ /* select MU STA table */
+ val32 = rtw_read32(adapter, 0x14C0);
+ val32 &= ~(BIT(8)|BIT(9)|BIT(10));
+ val32 |= (idx << 8) & (BIT(8)|BIT(9)|BIT(10));
+ rtw_write32(adapter, 0x14C0, val32);
+
+ /* Reset gid_valid table */
+ rtw_write32(adapter, 0x14C4, 0);
+ rtw_write32(adapter, 0x14C8 , user_position_l);
+ rtw_write32(adapter, 0x14CC , user_position_h);
+
+ /* set validity of MU STAs */
+ val32 &= 0xFFFFFFC0;
+ val32 |= bf_info->beamformee_mu_reg_maping & 0x3F;
+ rtw_write32(adapter, 0x14C0, val32);
+
+ RTW_INFO("%s: RegMUTxCtrl=0x%x, user_position_l=0x%x, user_position_h=0x%x\n",
+ __FUNCTION__, val32, user_position_l, user_position_h);
+
+ val16 = rtw_read16(adapter, mu_reg[idx]);
+ val16 &= 0xFE00; /* Clear PAID */
+ val16 |= BIT(9); /* Enable MU BFee */
+ val16 |= bfee->p_aid;
+ rtw_write16(adapter, mu_reg[idx], val16);
+ RTW_INFO("%s: Write mu_reg 0x%x = 0x%x\n",
+ __FUNCTION__, mu_reg[idx], val16);
+
+ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */
+ val8 = rtw_read8(adapter, REG_TXBF_CTRL_8822B+3);
+ val8 |= 0xD0; /* Set bit 28, 30, 31 to 3b'111 */
+ rtw_write8(adapter, REG_TXBF_CTRL_8822B+3, val8);
+ /* Set NDPA to 6M*/
+ rtw_write8(adapter, REG_NDPA_RATE_8822B, 0x4); /* 6M */
+
+ val8 = rtw_read8(adapter, REG_NDPA_OPT_CTRL_8822B);
+ val8 &= 0xFC; /* Clear bit 0, 1 */
+ rtw_write8(adapter, REG_NDPA_OPT_CTRL_8822B, val8);
+
+ val32 = rtw_read32(adapter, REG_SND_PTCL_CTRL_8822B);
+ val32 = ((val32 & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202 */
+ rtw_write32(adapter, REG_SND_PTCL_CTRL_8822B, val32);
+
+ /* Set 0x6A0[14] = 1 to accept action_no_ack */
+ val8 = rtw_read8(adapter, REG_RXFLTMAP0_8822B+1);
+ val8 |= 0x40;
+ rtw_write8(adapter, REG_RXFLTMAP0_8822B+1, val8);
+ /* End of MAC registers setting */
+
+ _setbeamformrfmode(adapter, bf_info->beamformee_su_cnt, bf_info->beamformee_mu_cnt, 0);
+
+ /* <tynli_mark> <TODO> Need to set timer 2015.12.23 */
+ /* Special for plugfest */
+ rtw_mdelay_os(50); /* wait for 4-way handshake ending */
+ beamforming_send_vht_gid_mgnt_packet(adapter, bfee);
+
+#if 1 /* Fix rate. <tynli_note> Do we need to keep this action? */
+ /* Set Ctrl Info */
+ rtw_write16(adapter, 0x140, 0x660);
+
+ /* Reset Ctrl Info */
+ val32 = 0x8000 + 32 * bfee->mac_id;
+ for (i = 0; i < 8; i++)
+ rtw_write32(adapter, val32 + i*4, 0);
+
+ rtw_write32(adapter, val32, (idx + 1) << 16);
+ rtw_write8(adapter, 0x81, 0x80); /* RPTBUF ready */
+
+ RTW_INFO("%s: mac_id=%d, ctrl_info_offset=0x%x, mu_reg_index=%x\n",
+ __FUNCTION__, bfee->mac_id, val32, idx);
+#endif
+ } else if (TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) {
+ RTW_INFO("%s: Config SU BFee entry HW setting\n", __FUNCTION__);
+
+ idx = bfee->su_reg_index;
+
+ if ((check_fwstate(mlme, WIFI_ADHOC_STATE) == _TRUE)
+ || (check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE) == _TRUE))
+ p_aid = bfee->mac_id;
+ else
+ p_aid = bfee->p_aid;
+
+ _setbeamformrfmode(adapter, bf_info->beamformee_su_cnt, bf_info->beamformee_mu_cnt, idx);
+
+ /* P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt */
+ if (idx == 0) {
+ rtw_write16(adapter, REG_TXBF_CTRL_8822B, p_aid);
+ val8 = rtw_read8(adapter, REG_TXBF_CTRL_8822B+3);
+ val8 |= ((BIT_R_EN_NDPA_INT_8822B | BIT_USE_NDPA_PARAMETER_8822B | BIT_R_ENABLE_NDPA_8822B) >> 24);
+ rtw_write8(adapter, REG_TXBF_CTRL_8822B+3, val8);
+ } else {
+ val16 = p_aid;
+ val16 |= ((BIT_R_EN_NDPA_INT_8822B | BIT_USE_NDPA_PARAMETER_8822B | BIT_R_ENABLE_NDPA_8822B) >> 16);
+ rtw_write16(adapter, REG_TXBF_CTRL_8822B+2, val16);
+ }
+
+ /* CSI report parameters of Beamformee */
+ if (idx == 0) {
+ /* Get BIT24 & BIT(25)=BIT_TXUSER_ID1_8822B */
+ val8 = rtw_read8(adapter, REG_ASSOCIATED_BFMEE_SEL_8822B+3) & 0x3;
+ val8 |= 0x60;
+ rtw_write8(adapter, REG_ASSOCIATED_BFMEE_SEL_8822B+3, val8);
+
+ val16 = p_aid | BIT_TXUSER_ID0_8822B;
+ rtw_write16(adapter, REG_ASSOCIATED_BFMEE_SEL_8822B, val16);
+ } else {
+ /* Set BIT(25)=BIT_TXUSER_ID1_8822B */
+ val16 = p_aid | 0xE200;
+ rtw_write16(adapter, REG_ASSOCIATED_BFMEE_SEL_8822B+2, val16);
+ }
+ }
+
+ bfee->state = BEAMFORM_ENTRY_HW_STATE_ADDED;
+ }
+
+ RTW_INFO("-%s\n", __FUNCTION__);
+}
+
+void rtl8822b_phy_sounding_leave(PADAPTER adapter, u8 *addr)
+{
+ PHAL_DATA_TYPE hal;
+ struct beamforming_info *bf_info;
+ struct beamformer_entry *bfer_entry;
+ struct beamformee_entry *bfee_entry;
+ u8 cnt_bfee_su = 0, cnt_bfee_mu = 0;
+ u8 i = 0, idx;
+ u16 p_aid = 0;
+ /* MU */
+ u32 gid_valid, user_position_l, user_position_h;
+ u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e};
+ /* General */
+ u8 val8;
+ u16 val16;
+ u32 val32;
+
+
+ RTW_INFO("+%s\n", __FUNCTION__);
+
+ hal = GET_HAL_DATA(adapter);
+ bf_info = GET_BEAMFORM_INFO(adapter);
+
+ bfee_entry = beamforming_get_bfee_entry_by_addr(adapter, addr);
+ bfer_entry = beamforming_get_bfer_entry_by_addr(adapter, addr);
+
+ /* Clear P_AID of Beamformee */
+ /* Clear MAC address of Beamformer */
+ /* Clear Associated Bfmee Sel */
+ if (bfer_entry) {
+ bfer_entry->state = BEAMFORM_ENTRY_HW_STATE_DELETING;
+
+ rtw_write8(adapter, REG_SND_PTCL_CTRL_8822B, 0xD8);
+
+ if (TEST_FLAG(bfer_entry->cap, BEAMFORMER_CAP_VHT_MU)) {
+ /* MU BFer entry */
+ /* Clear validity of MU STA0 and MU STA1*/
+ val32 = rtw_read32(adapter, 0x14C0);
+ val32 &= 0xFFFFFFC0;
+ rtw_write32(adapter, 0x14C0, val32);
+
+ RTW_INFO("%s: Clear MU BFer entry HW setting\n", __FUNCTION__);
+ } else if (TEST_FLAG(bfer_entry->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) {
+ /* SU BFer entry */
+ idx = bfer_entry->su_reg_index;
+ if (idx == 0) {
+ rtw_write32(adapter, REG_ASSOCIATED_BFMER0_INFO_8822B, 0);
+ rtw_write16(adapter, REG_ASSOCIATED_BFMER0_INFO_8822B+4, 0);
+ rtw_write16(adapter, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0);
+ } else {
+ rtw_write32(adapter, REG_ASSOCIATED_BFMER1_INFO_8822B, 0);
+ rtw_write16(adapter, REG_ASSOCIATED_BFMER1_INFO_8822B+4, 0);
+ rtw_write16(adapter, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, 0);
+ }
+
+ bf_info->beamformer_su_reg_maping &= ~BIT(idx);
+ bfer_entry->su_reg_index = 0xFF;
+
+ RTW_INFO("%s: Clear SU BFer entry HW setting\n", __FUNCTION__);
+ }
+
+ bfer_entry->used = _FALSE;
+ bfer_entry->state = BEAMFORM_ENTRY_HW_STATE_NONE;
+ bfer_entry->cap = BEAMFORMING_CAP_NONE;
+ }
+
+ if (bfee_entry) {
+ bfee_entry->state = BEAMFORM_ENTRY_HW_STATE_DELETING;
+
+ _setbeamformrfmode(adapter, bf_info->beamformee_su_cnt, bf_info->beamformee_mu_cnt, bfee_entry->su_reg_index);
+
+ if (TEST_FLAG(bfee_entry->cap, BEAMFORMER_CAP_VHT_MU)) {
+ /*MU BFee */
+ idx = bfee_entry->mu_reg_index;
+
+ /* Disable sending NDPA & BF-rpt-poll to this BFee */
+ rtw_write16(adapter, mu_reg[idx] , 0);
+ /* Set validity of MU STA */
+ val32 = rtw_read32(adapter, 0x14C0);
+ val32 &= ~(BIT(idx));
+ rtw_write32(adapter, 0x14C0, val32);
+
+ /* Force disable sounding config */
+ _config_sounding(adapter, bfee_entry, _TRUE, HW_CFG_SOUNDING_TYPE_LEAVE);
+
+ bf_info->beamformee_mu_reg_maping &= ~BIT(idx);
+ bfee_entry->mu_reg_index = 0xFF;
+
+ RTW_INFO("%s: Clear MU BFee entry HW setting\n", __FUNCTION__);
+ } else if (TEST_FLAG(bfee_entry->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) {
+ /* SU BFee */
+ idx = bfee_entry->su_reg_index;
+
+ if (idx == 0) {
+ rtw_write16(adapter, REG_TXBF_CTRL_8822B, 0x0);
+ val8 = rtw_read8(adapter, REG_TXBF_CTRL_8822B+3);
+ val8 |= ((BIT_R_EN_NDPA_INT_8822B | BIT_USE_NDPA_PARAMETER_8822B | BIT_R_ENABLE_NDPA_8822B) >> 24);
+ rtw_write8(adapter, REG_TXBF_CTRL_8822B+3, val8);
+ rtw_write16(adapter, REG_ASSOCIATED_BFMEE_SEL_8822B, 0);
+ } else {
+ val16 = 0x0;
+ val16 |= ((BIT_R_EN_NDPA_INT_8822B | BIT_USE_NDPA_PARAMETER_8822B | BIT_R_ENABLE_NDPA_8822B) >> 16);
+ rtw_write16(adapter, REG_TXBF_CTRL_8822B+2, val16);
+
+ val16 = rtw_read16(adapter, REG_ASSOCIATED_BFMEE_SEL_8822B+2);
+ val16 &= 0x60;
+ rtw_write16(adapter, REG_ASSOCIATED_BFMEE_SEL_8822B+2, val16);
+ }
+
+ /* Force disable sounding config */
+ _config_sounding(adapter, bfee_entry, _FALSE, HW_CFG_SOUNDING_TYPE_LEAVE);
+
+ bf_info->beamformee_su_reg_maping &= ~BIT(idx);
+ bfee_entry->su_reg_index = 0xFF;
+
+ RTW_INFO("%s: Clear SU BFee entry HW setting\n", __FUNCTION__);
+ }
+ }
+
+ RTW_INFO("-%s\n", __FUNCTION__);
+}
+
+void rtl8822b_phy_sounding_set_gid_table(PADAPTER adapter, struct beamformer_entry *bfer)
+{
+ struct beamforming_info *bf_info;
+ u32 beamctrlreg;
+ u16 beamctrlval;
+ /* MU */
+ u32 gid_valid, user_position_l, user_position_h;
+ u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e};
+ /* General */
+ u8 val8;
+ u16 val16;
+ u32 val32;
+ int i;
+
+
+ bf_info = GET_BEAMFORM_INFO(adapter);
+
+ /* For GID 0~31 */
+ gid_valid = 0;
+ user_position_l = 0;
+ user_position_h = 0;
+ for (i = 0; i < 4; i++)
+ gid_valid |= (bfer->gid_valid[i] << (i << 3));
+ for (i = 0; i < 8; i++) {
+ if (i < 4)
+ user_position_l |= (bfer->user_position[i] << (i << 3));
+ else
+ user_position_h |= (bfer->user_position[i] << ((i - 4) << 3));
+ }
+ /* select MU STA0 table */
+ val32 = rtw_read32(adapter, 0x14C0);
+ val32 &= ~(BIT(8)|BIT(9)|BIT(10));
+ rtw_write32(adapter, 0x14C0, val32);
+ rtw_write32(adapter, 0x14C4, gid_valid);
+ rtw_write32(adapter, 0x14C8, user_position_l);
+ rtw_write32(adapter, 0x14CC, user_position_h);
+
+ RTW_INFO("%s: STA0: gid_valid=0x%x, user_position_l=0x%x, user_position_h=0x%x\n",
+ __FUNCTION__, gid_valid, user_position_l, user_position_h);
+
+ /* For GID 32~64 */
+ gid_valid = 0;
+ user_position_l = 0;
+ user_position_h = 0;
+ for (i = 4; i < 8; i++)
+ gid_valid |= (bfer->gid_valid[i] << ((i - 4)<<3));
+ for (i = 8; i < 16; i++) {
+ if (i < 12)
+ user_position_l |= (bfer->user_position[i] << ((i - 8) << 3));
+ else
+ user_position_h |= (bfer->user_position[i] << ((i - 12) << 3));
+ }
+ /* select MU STA1 table */
+ val32 = rtw_read32(adapter, 0x14C0);
+ val32 &= ~(BIT(8)|BIT(9)|BIT(10));
+ val32 |= BIT(8);
+ rtw_write32(adapter, 0x14C0, val32);
+ rtw_write32(adapter, 0x14C4, gid_valid);
+ rtw_write32(adapter, 0x14C8, user_position_l);
+ rtw_write32(adapter, 0x14CC, user_position_h);
+
+ RTW_INFO("%s: STA1: gid_valid=0x%x, user_position_l=0x%x, user_position_h=0x%x\n",
+ __FUNCTION__, gid_valid, user_position_l, user_position_h);
+
+ /* Set validity of MU STA0 and MU STA1 */
+ val32 = rtw_read32(adapter, 0x14C0);
+ val32 &= 0xFFFFFFC0;
+ val32 |= 0x3; /* STA0, STA1 */
+ rtw_write32(adapter, 0x14C0, val32);
+}
+#endif /* CONFIG_BEAMFORMING */
+