net: wireless: rockchip_wlan: add rtl8723bs support
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / rockchip_wlan / rtl8723bs / core / rtw_odm.c
old mode 100755 (executable)
new mode 100644 (file)
index 05063bf..7b733a9
@@ -40,23 +40,24 @@ const char *odm_comp_str[] = {
        /* BIT15 */"ODM_COMP_CFO_TRACKING",
        /* BIT16 */"ODM_COMP_ACS",
        /* BIT17 */"PHYDM_COMP_ADAPTIVITY",
-       /* BIT18 */NULL,
-       /* BIT19 */NULL,
+       /* BIT18 */"PHYDM_COMP_RA_DBG",
+       /* BIT19 */"PHYDM_COMP_TXBF",
        /* BIT20 */"ODM_COMP_EDCA_TURBO",
        /* BIT21 */"ODM_COMP_EARLY_MODE",
-       /* BIT22 */NULL,
+       /* BIT22 */"ODM_FW_DEBUG_TRACE",
        /* BIT23 */NULL,
        /* BIT24 */"ODM_COMP_TX_PWR_TRACK",
        /* BIT25 */"ODM_COMP_RX_GAIN_TRACK",
        /* BIT26 */"ODM_COMP_CALIBRATION",
        /* BIT27 */NULL,
-       /* BIT28 */NULL,
-       /* BIT29 */NULL,
+       /* BIT28 */"ODM_PHY_CONFIG",
+       /* BIT29 */"BEAMFORMING_DEBUG",
        /* BIT30 */"ODM_COMP_COMMON",
        /* BIT31 */"ODM_COMP_INIT",
+       /* BIT32 */"ODM_COMP_NOISY_DETECT",
 };
 
-#define RTW_ODM_COMP_MAX 32
+#define RTW_ODM_COMP_MAX 33
 
 const char *odm_ability_str[] = {
        /* BIT0 */"ODM_BB_DIG",
@@ -76,7 +77,7 @@ const char *odm_ability_str[] = {
        /* BIT14 */"ODM_BB_CFO_TRACKING",
        /* BIT15 */"ODM_BB_NHM_CNT",
        /* BIT16 */"ODM_BB_PRIMARY_CCA",
-       /* BIT17 */NULL,
+       /* BIT17 */"ODM_BB_TXBF",
        /* BIT18 */NULL,
        /* BIT19 */NULL,
        /* BIT20 */"ODM_MAC_EDCA_TURBO",
@@ -106,21 +107,22 @@ void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter)
        HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter);
        DM_ODM_T *odm = &pHalData->odmpriv;
        int cnt = 0;
-       u64 dbg_comp;
+       u64 dbg_comp = 0;
        int i;
 
-       rtw_hal_get_def_var(adapter, HW_DEF_ODM_DBG_FLAG, &dbg_comp);
-       DBG_871X_SEL_NL(sel, "odm.DebugComponents = 0x%016llx \n", dbg_comp);
+       rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_FLAG, &dbg_comp, NULL);
+
+       DBG_871X_SEL_NL(sel, "odm.DebugComponents = 0x%016llx\n", dbg_comp);
        for (i=0;i<RTW_ODM_COMP_MAX;i++) {
                if (odm_comp_str[i])
-               DBG_871X_SEL_NL(sel, "%cBIT%-2d %s\n",
-                       (BIT0 << i) & dbg_comp ? '+' : ' ', i, odm_comp_str[i]);
+                       DBG_871X_SEL_NL(sel, "%cBIT%-2d %s\n",
+                               (BIT0 << i) & dbg_comp ? '+' : ' ', i, odm_comp_str[i]);
        }
 }
 
 inline void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps)
 {
-       rtw_hal_set_def_var(adapter, HW_DEF_ODM_DBG_FLAG, &comps);
+       rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_FLAG, &comps, _FALSE);
 }
 
 void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter)
@@ -128,10 +130,10 @@ void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter)
        HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter);
        DM_ODM_T *odm = &pHalData->odmpriv;
        int cnt = 0;
-       u32 dbg_level;
+       u32 dbg_level = 0;
        int i;
 
-       rtw_hal_get_def_var(adapter, HW_DEF_ODM_DBG_LEVEL, &dbg_level);
+       rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_LEVEL, &dbg_level, NULL);
        DBG_871X_SEL_NL(sel, "odm.DebugLevel = %u\n", dbg_level);
        for (i=0;i<RTW_ODM_DBG_LEVEL_NUM;i++) {
                if (odm_dbg_level_str[i])
@@ -141,7 +143,7 @@ void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter)
 
 inline void rtw_odm_dbg_level_set(_adapter *adapter, u32 level)
 {
-       rtw_hal_set_def_var(adapter, HW_DEF_ODM_DBG_LEVEL, &level);
+       rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_LEVEL, &level, _FALSE);
 }
 
 void rtw_odm_ability_msg(void *sel, _adapter *adapter)
@@ -152,18 +154,30 @@ void rtw_odm_ability_msg(void *sel, _adapter *adapter)
        u32 ability = 0;
        int i;
 
-       rtw_hal_get_hwreg(adapter, HW_VAR_DM_FLAG, (u8*)&ability);
+       ability = rtw_phydm_ability_get(adapter);
        DBG_871X_SEL_NL(sel, "odm.SupportAbility = 0x%08x\n", ability);
        for (i=0;i<RTW_ODM_ABILITY_MAX;i++) {
                if (odm_ability_str[i])
-               DBG_871X_SEL_NL(sel, "%cBIT%-2d %s\n",
-                       (BIT0 << i) & ability ? '+' : ' ', i, odm_ability_str[i]);
+                       DBG_871X_SEL_NL(sel, "%cBIT%-2d %s\n",
+                               (BIT0 << i) & ability ? '+' : ' ', i, odm_ability_str[i]);
        }
 }
 
 inline void rtw_odm_ability_set(_adapter *adapter, u32 ability)
 {
-       rtw_hal_set_hwreg(adapter, HW_VAR_DM_FLAG, (u8*)&ability);
+       rtw_phydm_ability_set(adapter, ability);
+}
+
+/* set ODM_CMNINFO_IC_TYPE based on chip_type */
+void rtw_odm_init_ic_type(_adapter *adapter)
+{
+       HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
+       DM_ODM_T *odm = &hal_data->odmpriv;
+       u4Byte ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter));
+
+       rtw_warn_on(!ic_type);
+
+       ODM_CmnInfoInit(odm, ODM_CMNINFO_IC_TYPE, ic_type);
 }
 
 void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter)
@@ -173,7 +187,6 @@ void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter)
 
 #define RTW_ADAPTIVITY_EN_DISABLE 0
 #define RTW_ADAPTIVITY_EN_ENABLE 1
-#define RTW_ADAPTIVITY_EN_AUTO 2
 
 void rtw_odm_adaptivity_en_msg(void *sel, _adapter *adapter)
 {
@@ -188,9 +201,6 @@ void rtw_odm_adaptivity_en_msg(void *sel, _adapter *adapter)
                DBG_871X_SEL(sel, "DISABLE\n");
        } else if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) {
                DBG_871X_SEL(sel, "ENABLE\n");
-       } else if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_AUTO) {
-               DBG_871X_SEL(sel, "AUTO, chplan:0x%02x, Regulation:%u,%u\n"
-                       , mlme->ChannelPlan, odm->odm_Regulation2_4G, odm->odm_Regulation5G);
        } else {
                DBG_871X_SEL(sel, "INVALID\n");
        }
@@ -214,41 +224,49 @@ void rtw_odm_adaptivity_mode_msg(void *sel, _adapter *adapter)
        }
 }
 
-#define RTW_NHM_EN_DISABLE 0
-#define RTW_NHM_EN_ENABLE 1
+#define RTW_ADAPTIVITY_DML_DISABLE 0
+#define RTW_ADAPTIVITY_DML_ENABLE 1
 
-void rtw_odm_nhm_en_msg(void *sel, _adapter *adapter)
+void rtw_odm_adaptivity_dml_msg(void *sel, _adapter *adapter)
 {
        struct registry_priv *regsty = &adapter->registrypriv;
 
-       DBG_871X_SEL_NL(sel, "RTW_NHM_EN_");
+       DBG_871X_SEL_NL(sel, "RTW_ADAPTIVITY_DML_");
 
-       if (regsty->nhm_en == RTW_NHM_EN_DISABLE) {
+       if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_DISABLE) {
                DBG_871X_SEL(sel, "DISABLE\n");
-       } else if (regsty->nhm_en == RTW_NHM_EN_ENABLE) {
+       } else if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_ENABLE) {
                DBG_871X_SEL(sel, "ENABLE\n");
        } else {
                DBG_871X_SEL(sel, "INVALID\n");
        }
 }
 
+void rtw_odm_adaptivity_dc_backoff_msg(void *sel, _adapter *adapter)
+{
+       struct registry_priv *regsty = &adapter->registrypriv;
+
+       DBG_871X_SEL_NL(sel, "RTW_ADAPTIVITY_DC_BACKOFF:%u\n", regsty->adaptivity_dc_backoff);
+}
+
+void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter)
+{
+       rtw_odm_adaptivity_ver_msg(sel, adapter);
+       rtw_odm_adaptivity_en_msg(sel, adapter);
+       rtw_odm_adaptivity_mode_msg(sel, adapter);
+       rtw_odm_adaptivity_dml_msg(sel, adapter);
+       rtw_odm_adaptivity_dc_backoff_msg(sel, adapter);
+}
+
 bool rtw_odm_adaptivity_needed(_adapter *adapter)
 {
        struct registry_priv *regsty = &adapter->registrypriv;
        struct mlme_priv *mlme = &adapter->mlmepriv;
        bool ret = _FALSE;
 
-       if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE
-               || regsty->adaptivity_en == RTW_ADAPTIVITY_EN_AUTO)
+       if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE)
                ret = _TRUE;
 
-       if (ret == _TRUE) {
-               rtw_odm_adaptivity_ver_msg(RTW_DBGDUMP, adapter);
-               rtw_odm_adaptivity_en_msg(RTW_DBGDUMP, adapter);
-               rtw_odm_adaptivity_mode_msg(RTW_DBGDUMP, adapter);
-               rtw_odm_nhm_en_msg(RTW_DBGDUMP, adapter);
-       }
-
        return ret;
 }
 
@@ -257,43 +275,35 @@ void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter)
        HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter);
        DM_ODM_T *odm = &pHalData->odmpriv;
 
-       rtw_odm_adaptivity_ver_msg(sel, adapter);
-       rtw_odm_adaptivity_en_msg(sel, adapter);
-       rtw_odm_adaptivity_mode_msg(sel, adapter);
-       rtw_odm_nhm_en_msg(sel, adapter);
+       rtw_odm_adaptivity_config_msg(sel, adapter);
 
-       DBG_871X_SEL_NL(sel, "%10s %16s %8s %10s %11s %14s\n"
-               , "TH_L2H_ini", "TH_EDCCA_HL_diff", "IGI_Base", "ForceEDCCA", "AdapEn_RSSI", "IGI_LowerBound");
-       DBG_871X_SEL_NL(sel, "0x%-8x %-16d 0x%-6x %-10d %-11u %-14u\n"
+       DBG_871X_SEL_NL(sel, "%10s %16s %16s %22s %12s\n"
+               , "TH_L2H_ini", "TH_EDCCA_HL_diff", "TH_L2H_ini_mode2", "TH_EDCCA_HL_diff_mode2", "EDCCA_enable");
+       DBG_871X_SEL_NL(sel, "0x%-8x %-16d 0x%-14x %-22d %-12d\n"
                , (u8)odm->TH_L2H_ini
                , odm->TH_EDCCA_HL_diff
-               , odm->IGI_Base
-               , odm->ForceEDCCA
-               , odm->AdapEn_RSSI
-               , odm->IGI_LowerBound
+               , (u8)odm->TH_L2H_ini_mode2
+               , odm->TH_EDCCA_HL_diff_mode2
+               , odm->EDCCA_enable
        );
 
-       DBG_871X_SEL_NL(sel, "%8s %9s\n", "EDCCA_ES","Adap_Flag");
-       DBG_871X_SEL_NL(sel, "%-8x %-9x \n"
-               , odm->EDCCA_enable_state
+       DBG_871X_SEL_NL(sel, "%15s %9s\n", "AdapEnableState", "Adap_Flag");
+       DBG_871X_SEL_NL(sel, "%-15x %-9x\n"
+               , odm->Adaptivity_enable
                , odm->adaptivity_flag
        );
-       
-       
 }
 
-void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff,
-       s8 IGI_Base, bool ForceEDCCA, u8 AdapEn_RSSI, u8 IGI_LowerBound)
+void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable)
 {
        HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter);
        DM_ODM_T *odm = &pHalData->odmpriv;
 
        odm->TH_L2H_ini = TH_L2H_ini;
        odm->TH_EDCCA_HL_diff = TH_EDCCA_HL_diff;
-       odm->IGI_Base = IGI_Base;
-       odm->ForceEDCCA = ForceEDCCA;
-       odm->AdapEn_RSSI = AdapEn_RSSI;
-       odm->IGI_LowerBound = IGI_LowerBound;
+       odm->TH_L2H_ini_mode2 = TH_L2H_ini_mode2;
+       odm->TH_EDCCA_HL_diff_mode2 = TH_EDCCA_HL_diff_mode2;
+       odm->EDCCA_enable = EDCCA_enable;
 }
 
 void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter)
@@ -309,13 +319,12 @@ void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter)
 void rtw_odm_acquirespinlock(_adapter *adapter,        RT_SPINLOCK_TYPE type)
 {
        PHAL_DATA_TYPE  pHalData = GET_HAL_DATA(adapter);
-       struct dm_priv  *pdmpriv = &pHalData->dmpriv;
        _irqL irqL;
 
        switch(type)
        {
                case RT_IQK_SPINLOCK:
-                       _enter_critical_bh(&pdmpriv->IQKSpinLock, &irqL);
+                       _enter_critical_bh(&pHalData->IQKSpinLock, &irqL);
                default:
                        break;
        }
@@ -324,15 +333,129 @@ void rtw_odm_acquirespinlock(_adapter *adapter,  RT_SPINLOCK_TYPE type)
 void rtw_odm_releasespinlock(_adapter *adapter,        RT_SPINLOCK_TYPE type)
 {
        PHAL_DATA_TYPE  pHalData = GET_HAL_DATA(adapter);
-       struct dm_priv  *pdmpriv = &pHalData->dmpriv;
        _irqL irqL;
 
        switch(type)
        {
                case RT_IQK_SPINLOCK:
-                       _exit_critical_bh(&pdmpriv->IQKSpinLock, &irqL);
+                       _exit_critical_bh(&pHalData->IQKSpinLock, &irqL);
                default:
                        break;
        }
 }
 
+#ifdef CONFIG_DFS_MASTER
+VOID rtw_odm_radar_detect_reset(_adapter *adapter)
+{
+       HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
+       PDM_ODM_T pDM_Odm = &(hal_data->odmpriv);
+
+       if (pDM_Odm->SupportICType & ODM_RTL8192D) {
+               ODM_SetBBReg(pDM_Odm, 0xc84 , BIT25, 0);
+               ODM_SetBBReg(pDM_Odm, 0xc84 , BIT25, 1);
+       } else if (pDM_Odm->SupportICType & ODM_RTL8821) {
+               ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0);
+               ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 1);
+       } else {
+               /* not supported yet */
+               rtw_warn_on(1);
+       }
+}
+
+VOID rtw_odm_radar_detect_disable(_adapter *adapter)
+{
+       HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
+       PDM_ODM_T pDM_Odm = &(hal_data->odmpriv);
+
+       if (pDM_Odm->SupportICType & ODM_RTL8192D)
+               ODM_SetBBReg(pDM_Odm, 0xc84 , BIT25, 0);
+       else if (pDM_Odm->SupportICType & ODM_RTL8821)
+               ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0);
+       else
+               rtw_warn_on(1);
+}
+
+/* called after ch, bw is set, chance to adjust parameter for different ch conditions */
+VOID rtw_odm_radar_detect_enable(_adapter *adapter)
+{
+       HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
+       PDM_ODM_T pDM_Odm = &(hal_data->odmpriv);
+
+       if (pDM_Odm->SupportICType & ODM_RTL8192D) {
+               ODM_SetBBReg(pDM_Odm, 0xc38, BIT23 | BIT22, 2);
+               ODM_SetBBReg(pDM_Odm, 0x814, bMaskDWord, 0x04cc4d10);
+               ODM_SetBBReg(pDM_Odm, 0xc8c, BIT23 | BIT22, 3);
+               ODM_SetBBReg(pDM_Odm, 0xc30, 0xf, 0xa);
+               ODM_SetBBReg(pDM_Odm, 0xcdc, 0xf0000, 4);
+       } else if (pDM_Odm->SupportICType & ODM_RTL8821) {
+               ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10);
+               ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06);
+               ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf);
+               ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x0152a400);
+               ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20);
+               ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f57204);
+       } else {
+               /* not supported yet */
+               rtw_warn_on(1);
+       }
+
+       rtw_odm_radar_detect_reset(adapter);
+}
+
+BOOLEAN rtw_odm_radar_detect(_adapter *adapter)
+{
+       HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
+       PDM_ODM_T pDM_Odm = &(hal_data->odmpriv);
+       BOOLEAN enable_DFS = FALSE;
+       BOOLEAN bypass = FALSE;
+       BOOLEAN radar_detected = FALSE;
+
+       static u8Byte last_tx_unicast = 0;
+       static u8Byte last_rx_unicast = 0;
+       static u8Byte throughput = 0;
+       int tp_th = ((*pDM_Odm->pBandWidth == ODM_BW40M) ? 45 : 20); /*refer AP team's testing number*/
+
+       throughput = (*(pDM_Odm->pNumTxBytesUnicast) - last_tx_unicast) + (*(pDM_Odm->pNumRxBytesUnicast) - last_rx_unicast);
+       last_tx_unicast = *(pDM_Odm->pNumTxBytesUnicast);
+       last_rx_unicast = *(pDM_Odm->pNumRxBytesUnicast);
+
+       if (throughput>>18 > tp_th) {
+               if (pDM_Odm->SupportICType & ODM_RTL8192D)
+                       ODM_SetBBReg(pDM_Odm, 0xcdc, BIT8|BIT9, 0);
+               bypass = TRUE;
+       } else {
+               if (pDM_Odm->SupportICType & ODM_RTL8192D)
+                       ODM_SetBBReg(pDM_Odm, 0xcdc, BIT8|BIT9, 1);
+       }
+
+       if (pDM_Odm->SupportICType & ODM_RTL8192D) {
+               if (ODM_GetBBReg(pDM_Odm , 0xc84, BIT25))
+                       enable_DFS = TRUE;
+       } else if (pDM_Odm->SupportICType & ODM_RTL8821) {
+               if (ODM_GetBBReg(pDM_Odm , 0x924, BIT15))
+                       enable_DFS = TRUE;
+       }
+
+       if (pDM_Odm->SupportICType & ODM_RTL8192D) {
+               if (ODM_GetBBReg(pDM_Odm , 0xcf8, BIT23))
+                       radar_detected = TRUE;
+       } else if (pDM_Odm->SupportICType & ODM_RTL8821) {
+               if (ODM_GetBBReg(pDM_Odm , 0xf98, BIT17))
+                       radar_detected = TRUE;
+       }
+
+       ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD
+               , ("Radar detect: enable_DFS:%d, radar_detected:%d, bypass:%d\n"
+                       , enable_DFS, radar_detected, bypass));
+       if (0)
+               DBG_871X("Radar detect: enable_DFS:%d, radar_detected:%d, bypass:%d(throughput:%llu, tp_th:%d)\n"
+                       , enable_DFS, radar_detected, bypass, throughput, tp_th);
+
+       if (enable_DFS && radar_detected)
+               rtw_odm_radar_detect_reset(adapter);
+
+exit:
+       return (enable_DFS && radar_detected && !bypass);
+}
+#endif /* CONFIG_DFS_MASTER */
+