18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/* Copyright(c) 2009-2014  Realtek Corporation.*/
38c2ecf20Sopenharmony_ci
48c2ecf20Sopenharmony_ci#include "../wifi.h"
58c2ecf20Sopenharmony_ci#include "../base.h"
68c2ecf20Sopenharmony_ci#include "../pci.h"
78c2ecf20Sopenharmony_ci#include "../core.h"
88c2ecf20Sopenharmony_ci#include "reg.h"
98c2ecf20Sopenharmony_ci#include "def.h"
108c2ecf20Sopenharmony_ci#include "phy.h"
118c2ecf20Sopenharmony_ci#include "dm.h"
128c2ecf20Sopenharmony_ci#include "fw.h"
138c2ecf20Sopenharmony_ci#include "trx.h"
148c2ecf20Sopenharmony_ci
158c2ecf20Sopenharmony_cistatic void rtl92ee_dm_false_alarm_counter_statistics(struct ieee80211_hw *hw)
168c2ecf20Sopenharmony_ci{
178c2ecf20Sopenharmony_ci	u32 ret_value;
188c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
198c2ecf20Sopenharmony_ci	struct false_alarm_statistics *falsealm_cnt = &rtlpriv->falsealm_cnt;
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_HOLDC_11N, BIT(31), 1);
228c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(31), 1);
238c2ecf20Sopenharmony_ci
248c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE1_11N, MASKDWORD);
258c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_fast_fsync_fail = (ret_value & 0xffff);
268c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_sb_search_fail = ((ret_value & 0xffff0000) >> 16);
278c2ecf20Sopenharmony_ci
288c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE2_11N, MASKDWORD);
298c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_ofdm_cca = (ret_value & 0xffff);
308c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_parity_fail = ((ret_value & 0xffff0000) >> 16);
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE3_11N, MASKDWORD);
338c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_rate_illegal = (ret_value & 0xffff);
348c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_crc8_fail = ((ret_value & 0xffff0000) >> 16);
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE4_11N, MASKDWORD);
378c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_mcs_fail = (ret_value & 0xffff);
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_ofdm_fail = falsealm_cnt->cnt_parity_fail +
408c2ecf20Sopenharmony_ci				      falsealm_cnt->cnt_rate_illegal +
418c2ecf20Sopenharmony_ci				      falsealm_cnt->cnt_crc8_fail +
428c2ecf20Sopenharmony_ci				      falsealm_cnt->cnt_mcs_fail +
438c2ecf20Sopenharmony_ci				      falsealm_cnt->cnt_fast_fsync_fail +
448c2ecf20Sopenharmony_ci				      falsealm_cnt->cnt_sb_search_fail;
458c2ecf20Sopenharmony_ci
468c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_SC_CNT_11N, MASKDWORD);
478c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_bw_lsc = (ret_value & 0xffff);
488c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_bw_usc = ((ret_value & 0xffff0000) >> 16);
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(12), 1);
518c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(14), 1);
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_CCK_FA_LSB_11N, MASKBYTE0);
548c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_cck_fail = ret_value;
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_CCK_FA_MSB_11N, MASKBYTE3);
578c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_cck_fail += (ret_value & 0xff) << 8;
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci	ret_value = rtl_get_bbreg(hw, DM_REG_CCK_CCA_CNT_11N, MASKDWORD);
608c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_cck_cca = ((ret_value & 0xff) << 8) |
618c2ecf20Sopenharmony_ci				    ((ret_value & 0xFF00) >> 8);
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_all = falsealm_cnt->cnt_fast_fsync_fail +
648c2ecf20Sopenharmony_ci				falsealm_cnt->cnt_sb_search_fail +
658c2ecf20Sopenharmony_ci				falsealm_cnt->cnt_parity_fail +
668c2ecf20Sopenharmony_ci				falsealm_cnt->cnt_rate_illegal +
678c2ecf20Sopenharmony_ci				falsealm_cnt->cnt_crc8_fail +
688c2ecf20Sopenharmony_ci				falsealm_cnt->cnt_mcs_fail +
698c2ecf20Sopenharmony_ci				falsealm_cnt->cnt_cck_fail;
708c2ecf20Sopenharmony_ci
718c2ecf20Sopenharmony_ci	falsealm_cnt->cnt_cca_all = falsealm_cnt->cnt_ofdm_cca +
728c2ecf20Sopenharmony_ci				    falsealm_cnt->cnt_cck_cca;
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_ci	/*reset false alarm counter registers*/
758c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTC_11N, BIT(31), 1);
768c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTC_11N, BIT(31), 0);
778c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(27), 1);
788c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(27), 0);
798c2ecf20Sopenharmony_ci	/*update ofdm counter*/
808c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_HOLDC_11N, BIT(31), 0);
818c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(31), 0);
828c2ecf20Sopenharmony_ci	/*reset CCK CCA counter*/
838c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(13) | BIT(12), 0);
848c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(13) | BIT(12), 2);
858c2ecf20Sopenharmony_ci	/*reset CCK FA counter*/
868c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(15) | BIT(14), 0);
878c2ecf20Sopenharmony_ci	rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(15) | BIT(14), 2);
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_ci	rtl_dbg(rtlpriv, COMP_DIG, DBG_TRACE,
908c2ecf20Sopenharmony_ci		"cnt_parity_fail = %d, cnt_rate_illegal = %d, cnt_crc8_fail = %d, cnt_mcs_fail = %d\n",
918c2ecf20Sopenharmony_ci		falsealm_cnt->cnt_parity_fail,
928c2ecf20Sopenharmony_ci		falsealm_cnt->cnt_rate_illegal,
938c2ecf20Sopenharmony_ci		falsealm_cnt->cnt_crc8_fail, falsealm_cnt->cnt_mcs_fail);
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci	rtl_dbg(rtlpriv, COMP_DIG, DBG_TRACE,
968c2ecf20Sopenharmony_ci		"cnt_ofdm_fail = %x, cnt_cck_fail = %x, cnt_all = %x\n",
978c2ecf20Sopenharmony_ci		falsealm_cnt->cnt_ofdm_fail,
988c2ecf20Sopenharmony_ci		falsealm_cnt->cnt_cck_fail, falsealm_cnt->cnt_all);
998c2ecf20Sopenharmony_ci}
1008c2ecf20Sopenharmony_ci
1018c2ecf20Sopenharmony_cistatic void rtl92ee_dm_cck_packet_detection_thresh(struct ieee80211_hw *hw)
1028c2ecf20Sopenharmony_ci{
1038c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
1048c2ecf20Sopenharmony_ci	struct dig_t *dm_dig = &rtlpriv->dm_digtable;
1058c2ecf20Sopenharmony_ci	u8 cur_cck_cca_thresh;
1068c2ecf20Sopenharmony_ci
1078c2ecf20Sopenharmony_ci	if (rtlpriv->mac80211.link_state >= MAC80211_LINKED) {
1088c2ecf20Sopenharmony_ci		if (dm_dig->rssi_val_min > 25) {
1098c2ecf20Sopenharmony_ci			cur_cck_cca_thresh = 0xcd;
1108c2ecf20Sopenharmony_ci		} else if ((dm_dig->rssi_val_min <= 25) &&
1118c2ecf20Sopenharmony_ci			   (dm_dig->rssi_val_min > 10)) {
1128c2ecf20Sopenharmony_ci			cur_cck_cca_thresh = 0x83;
1138c2ecf20Sopenharmony_ci		} else {
1148c2ecf20Sopenharmony_ci			if (rtlpriv->falsealm_cnt.cnt_cck_fail > 1000)
1158c2ecf20Sopenharmony_ci				cur_cck_cca_thresh = 0x83;
1168c2ecf20Sopenharmony_ci			else
1178c2ecf20Sopenharmony_ci				cur_cck_cca_thresh = 0x40;
1188c2ecf20Sopenharmony_ci		}
1198c2ecf20Sopenharmony_ci	} else {
1208c2ecf20Sopenharmony_ci		if (rtlpriv->falsealm_cnt.cnt_cck_fail > 1000)
1218c2ecf20Sopenharmony_ci			cur_cck_cca_thresh = 0x83;
1228c2ecf20Sopenharmony_ci		else
1238c2ecf20Sopenharmony_ci			cur_cck_cca_thresh = 0x40;
1248c2ecf20Sopenharmony_ci	}
1258c2ecf20Sopenharmony_ci	rtl92ee_dm_write_cck_cca_thres(hw, cur_cck_cca_thresh);
1268c2ecf20Sopenharmony_ci}
1278c2ecf20Sopenharmony_ci
1288c2ecf20Sopenharmony_cistatic void rtl92ee_dm_dig(struct ieee80211_hw *hw)
1298c2ecf20Sopenharmony_ci{
1308c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
1318c2ecf20Sopenharmony_ci	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
1328c2ecf20Sopenharmony_ci	struct dig_t *dm_dig = &rtlpriv->dm_digtable;
1338c2ecf20Sopenharmony_ci	u8 dig_min_0, dig_maxofmin;
1348c2ecf20Sopenharmony_ci	bool bfirstconnect , bfirstdisconnect;
1358c2ecf20Sopenharmony_ci	u8 dm_dig_max, dm_dig_min;
1368c2ecf20Sopenharmony_ci	u8 current_igi = dm_dig->cur_igvalue;
1378c2ecf20Sopenharmony_ci	u8 offset;
1388c2ecf20Sopenharmony_ci
1398c2ecf20Sopenharmony_ci	/* AP,BT */
1408c2ecf20Sopenharmony_ci	if (mac->act_scanning)
1418c2ecf20Sopenharmony_ci		return;
1428c2ecf20Sopenharmony_ci
1438c2ecf20Sopenharmony_ci	dig_min_0 = dm_dig->dig_min_0;
1448c2ecf20Sopenharmony_ci	bfirstconnect = (mac->link_state >= MAC80211_LINKED) &&
1458c2ecf20Sopenharmony_ci			!dm_dig->media_connect_0;
1468c2ecf20Sopenharmony_ci	bfirstdisconnect = (mac->link_state < MAC80211_LINKED) &&
1478c2ecf20Sopenharmony_ci			   dm_dig->media_connect_0;
1488c2ecf20Sopenharmony_ci
1498c2ecf20Sopenharmony_ci	dm_dig_max = 0x5a;
1508c2ecf20Sopenharmony_ci	dm_dig_min = DM_DIG_MIN;
1518c2ecf20Sopenharmony_ci	dig_maxofmin = DM_DIG_MAX_AP;
1528c2ecf20Sopenharmony_ci
1538c2ecf20Sopenharmony_ci	if (mac->link_state >= MAC80211_LINKED) {
1548c2ecf20Sopenharmony_ci		if ((dm_dig->rssi_val_min + 10) > dm_dig_max)
1558c2ecf20Sopenharmony_ci			dm_dig->rx_gain_max = dm_dig_max;
1568c2ecf20Sopenharmony_ci		else if ((dm_dig->rssi_val_min + 10) < dm_dig_min)
1578c2ecf20Sopenharmony_ci			dm_dig->rx_gain_max = dm_dig_min;
1588c2ecf20Sopenharmony_ci		else
1598c2ecf20Sopenharmony_ci			dm_dig->rx_gain_max = dm_dig->rssi_val_min + 10;
1608c2ecf20Sopenharmony_ci
1618c2ecf20Sopenharmony_ci		if (rtlpriv->dm.one_entry_only) {
1628c2ecf20Sopenharmony_ci			offset = 0;
1638c2ecf20Sopenharmony_ci			if (dm_dig->rssi_val_min - offset < dm_dig_min)
1648c2ecf20Sopenharmony_ci				dig_min_0 = dm_dig_min;
1658c2ecf20Sopenharmony_ci			else if (dm_dig->rssi_val_min - offset >
1668c2ecf20Sopenharmony_ci				 dig_maxofmin)
1678c2ecf20Sopenharmony_ci				dig_min_0 = dig_maxofmin;
1688c2ecf20Sopenharmony_ci			else
1698c2ecf20Sopenharmony_ci				dig_min_0 = dm_dig->rssi_val_min - offset;
1708c2ecf20Sopenharmony_ci		} else {
1718c2ecf20Sopenharmony_ci			dig_min_0 = dm_dig_min;
1728c2ecf20Sopenharmony_ci		}
1738c2ecf20Sopenharmony_ci
1748c2ecf20Sopenharmony_ci	} else {
1758c2ecf20Sopenharmony_ci		dm_dig->rx_gain_max = dm_dig_max;
1768c2ecf20Sopenharmony_ci		dig_min_0 = dm_dig_min;
1778c2ecf20Sopenharmony_ci		rtl_dbg(rtlpriv, COMP_DIG, DBG_LOUD, "no link\n");
1788c2ecf20Sopenharmony_ci	}
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_ci	if (rtlpriv->falsealm_cnt.cnt_all > 10000) {
1818c2ecf20Sopenharmony_ci		if (dm_dig->large_fa_hit != 3)
1828c2ecf20Sopenharmony_ci			dm_dig->large_fa_hit++;
1838c2ecf20Sopenharmony_ci		if (dm_dig->forbidden_igi < current_igi) {
1848c2ecf20Sopenharmony_ci			dm_dig->forbidden_igi = current_igi;
1858c2ecf20Sopenharmony_ci			dm_dig->large_fa_hit = 1;
1868c2ecf20Sopenharmony_ci		}
1878c2ecf20Sopenharmony_ci
1888c2ecf20Sopenharmony_ci		if (dm_dig->large_fa_hit >= 3) {
1898c2ecf20Sopenharmony_ci			if (dm_dig->forbidden_igi + 1 > dm_dig->rx_gain_max)
1908c2ecf20Sopenharmony_ci				dm_dig->rx_gain_min =
1918c2ecf20Sopenharmony_ci						dm_dig->rx_gain_max;
1928c2ecf20Sopenharmony_ci			else
1938c2ecf20Sopenharmony_ci				dm_dig->rx_gain_min =
1948c2ecf20Sopenharmony_ci						dm_dig->forbidden_igi + 1;
1958c2ecf20Sopenharmony_ci			dm_dig->recover_cnt = 3600;
1968c2ecf20Sopenharmony_ci		}
1978c2ecf20Sopenharmony_ci	} else {
1988c2ecf20Sopenharmony_ci		if (dm_dig->recover_cnt != 0) {
1998c2ecf20Sopenharmony_ci			dm_dig->recover_cnt--;
2008c2ecf20Sopenharmony_ci		} else {
2018c2ecf20Sopenharmony_ci			if (dm_dig->large_fa_hit < 3) {
2028c2ecf20Sopenharmony_ci				if ((dm_dig->forbidden_igi - 1) <
2038c2ecf20Sopenharmony_ci				    dig_min_0) {
2048c2ecf20Sopenharmony_ci					dm_dig->forbidden_igi = dig_min_0;
2058c2ecf20Sopenharmony_ci					dm_dig->rx_gain_min =
2068c2ecf20Sopenharmony_ci								dig_min_0;
2078c2ecf20Sopenharmony_ci				} else {
2088c2ecf20Sopenharmony_ci					dm_dig->forbidden_igi--;
2098c2ecf20Sopenharmony_ci					dm_dig->rx_gain_min =
2108c2ecf20Sopenharmony_ci						dm_dig->forbidden_igi + 1;
2118c2ecf20Sopenharmony_ci				}
2128c2ecf20Sopenharmony_ci			} else {
2138c2ecf20Sopenharmony_ci				dm_dig->large_fa_hit = 0;
2148c2ecf20Sopenharmony_ci			}
2158c2ecf20Sopenharmony_ci		}
2168c2ecf20Sopenharmony_ci	}
2178c2ecf20Sopenharmony_ci
2188c2ecf20Sopenharmony_ci	if (rtlpriv->dm.dbginfo.num_qry_beacon_pkt < 5)
2198c2ecf20Sopenharmony_ci		dm_dig->rx_gain_min = dm_dig_min;
2208c2ecf20Sopenharmony_ci
2218c2ecf20Sopenharmony_ci	if (dm_dig->rx_gain_min > dm_dig->rx_gain_max)
2228c2ecf20Sopenharmony_ci		dm_dig->rx_gain_min = dm_dig->rx_gain_max;
2238c2ecf20Sopenharmony_ci
2248c2ecf20Sopenharmony_ci	if (mac->link_state >= MAC80211_LINKED) {
2258c2ecf20Sopenharmony_ci		if (bfirstconnect) {
2268c2ecf20Sopenharmony_ci			if (dm_dig->rssi_val_min <= dig_maxofmin)
2278c2ecf20Sopenharmony_ci				current_igi = dm_dig->rssi_val_min;
2288c2ecf20Sopenharmony_ci			else
2298c2ecf20Sopenharmony_ci				current_igi = dig_maxofmin;
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci			dm_dig->large_fa_hit = 0;
2328c2ecf20Sopenharmony_ci		} else {
2338c2ecf20Sopenharmony_ci			if (rtlpriv->falsealm_cnt.cnt_all > DM_DIG_FA_TH2)
2348c2ecf20Sopenharmony_ci				current_igi += 4;
2358c2ecf20Sopenharmony_ci			else if (rtlpriv->falsealm_cnt.cnt_all > DM_DIG_FA_TH1)
2368c2ecf20Sopenharmony_ci				current_igi += 2;
2378c2ecf20Sopenharmony_ci			else if (rtlpriv->falsealm_cnt.cnt_all < DM_DIG_FA_TH0)
2388c2ecf20Sopenharmony_ci				current_igi -= 2;
2398c2ecf20Sopenharmony_ci
2408c2ecf20Sopenharmony_ci			if (rtlpriv->dm.dbginfo.num_qry_beacon_pkt < 5 &&
2418c2ecf20Sopenharmony_ci			    rtlpriv->falsealm_cnt.cnt_all < DM_DIG_FA_TH1)
2428c2ecf20Sopenharmony_ci				current_igi = dm_dig->rx_gain_min;
2438c2ecf20Sopenharmony_ci		}
2448c2ecf20Sopenharmony_ci	} else {
2458c2ecf20Sopenharmony_ci		if (bfirstdisconnect) {
2468c2ecf20Sopenharmony_ci			current_igi = dm_dig->rx_gain_min;
2478c2ecf20Sopenharmony_ci		} else {
2488c2ecf20Sopenharmony_ci			if (rtlpriv->falsealm_cnt.cnt_all > 10000)
2498c2ecf20Sopenharmony_ci				current_igi += 4;
2508c2ecf20Sopenharmony_ci			else if (rtlpriv->falsealm_cnt.cnt_all > 8000)
2518c2ecf20Sopenharmony_ci				current_igi += 2;
2528c2ecf20Sopenharmony_ci			else if (rtlpriv->falsealm_cnt.cnt_all < 500)
2538c2ecf20Sopenharmony_ci				current_igi -= 2;
2548c2ecf20Sopenharmony_ci		}
2558c2ecf20Sopenharmony_ci	}
2568c2ecf20Sopenharmony_ci
2578c2ecf20Sopenharmony_ci	if (current_igi > dm_dig->rx_gain_max)
2588c2ecf20Sopenharmony_ci		current_igi = dm_dig->rx_gain_max;
2598c2ecf20Sopenharmony_ci	if (current_igi < dm_dig->rx_gain_min)
2608c2ecf20Sopenharmony_ci		current_igi = dm_dig->rx_gain_min;
2618c2ecf20Sopenharmony_ci
2628c2ecf20Sopenharmony_ci	rtl92ee_dm_write_dig(hw , current_igi);
2638c2ecf20Sopenharmony_ci	dm_dig->media_connect_0 = ((mac->link_state >= MAC80211_LINKED) ?
2648c2ecf20Sopenharmony_ci				   true : false);
2658c2ecf20Sopenharmony_ci	dm_dig->dig_min_0 = dig_min_0;
2668c2ecf20Sopenharmony_ci}
2678c2ecf20Sopenharmony_ci
2688c2ecf20Sopenharmony_civoid rtl92ee_dm_write_cck_cca_thres(struct ieee80211_hw *hw, u8 cur_thres)
2698c2ecf20Sopenharmony_ci{
2708c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
2718c2ecf20Sopenharmony_ci	struct dig_t *dm_dig = &rtlpriv->dm_digtable;
2728c2ecf20Sopenharmony_ci
2738c2ecf20Sopenharmony_ci	if (dm_dig->cur_cck_cca_thres != cur_thres)
2748c2ecf20Sopenharmony_ci		rtl_write_byte(rtlpriv, DM_REG_CCK_CCA_11N, cur_thres);
2758c2ecf20Sopenharmony_ci
2768c2ecf20Sopenharmony_ci	dm_dig->pre_cck_cca_thres = dm_dig->cur_cck_cca_thres;
2778c2ecf20Sopenharmony_ci	dm_dig->cur_cck_cca_thres = cur_thres;
2788c2ecf20Sopenharmony_ci}
2798c2ecf20Sopenharmony_ci
2808c2ecf20Sopenharmony_civoid rtl92ee_dm_write_dig(struct ieee80211_hw *hw, u8 current_igi)
2818c2ecf20Sopenharmony_ci{
2828c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
2838c2ecf20Sopenharmony_ci	struct dig_t *dm_dig = &rtlpriv->dm_digtable;
2848c2ecf20Sopenharmony_ci
2858c2ecf20Sopenharmony_ci	if (dm_dig->stop_dig)
2868c2ecf20Sopenharmony_ci		return;
2878c2ecf20Sopenharmony_ci
2888c2ecf20Sopenharmony_ci	if (dm_dig->cur_igvalue != current_igi) {
2898c2ecf20Sopenharmony_ci		rtl_set_bbreg(hw, ROFDM0_XAAGCCORE1, 0x7f, current_igi);
2908c2ecf20Sopenharmony_ci		if (rtlpriv->phy.rf_type != RF_1T1R)
2918c2ecf20Sopenharmony_ci			rtl_set_bbreg(hw, ROFDM0_XBAGCCORE1, 0x7f, current_igi);
2928c2ecf20Sopenharmony_ci	}
2938c2ecf20Sopenharmony_ci	dm_dig->pre_igvalue = dm_dig->cur_igvalue;
2948c2ecf20Sopenharmony_ci	dm_dig->cur_igvalue = current_igi;
2958c2ecf20Sopenharmony_ci}
2968c2ecf20Sopenharmony_ci
2978c2ecf20Sopenharmony_cistatic void rtl92ee_rssi_dump_to_register(struct ieee80211_hw *hw)
2988c2ecf20Sopenharmony_ci{
2998c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
3008c2ecf20Sopenharmony_ci
3018c2ecf20Sopenharmony_ci	rtl_write_byte(rtlpriv, RA_RSSIDUMP,
3028c2ecf20Sopenharmony_ci		       rtlpriv->stats.rx_rssi_percentage[0]);
3038c2ecf20Sopenharmony_ci	rtl_write_byte(rtlpriv, RB_RSSIDUMP,
3048c2ecf20Sopenharmony_ci		       rtlpriv->stats.rx_rssi_percentage[1]);
3058c2ecf20Sopenharmony_ci	/*It seems the following values are not initialized.
3068c2ecf20Sopenharmony_ci	  *According to Windows code,
3078c2ecf20Sopenharmony_ci	  *these value will only be valid with JAGUAR chips
3088c2ecf20Sopenharmony_ci	  */
3098c2ecf20Sopenharmony_ci	/* Rx EVM */
3108c2ecf20Sopenharmony_ci	rtl_write_byte(rtlpriv, RS1_RXEVMDUMP, rtlpriv->stats.rx_evm_dbm[0]);
3118c2ecf20Sopenharmony_ci	rtl_write_byte(rtlpriv, RS2_RXEVMDUMP, rtlpriv->stats.rx_evm_dbm[1]);
3128c2ecf20Sopenharmony_ci	/* Rx SNR */
3138c2ecf20Sopenharmony_ci	rtl_write_byte(rtlpriv, RA_RXSNRDUMP,
3148c2ecf20Sopenharmony_ci		       (u8)(rtlpriv->stats.rx_snr_db[0]));
3158c2ecf20Sopenharmony_ci	rtl_write_byte(rtlpriv, RB_RXSNRDUMP,
3168c2ecf20Sopenharmony_ci		       (u8)(rtlpriv->stats.rx_snr_db[1]));
3178c2ecf20Sopenharmony_ci	/* Rx Cfo_Short */
3188c2ecf20Sopenharmony_ci	rtl_write_word(rtlpriv, RA_CFOSHORTDUMP,
3198c2ecf20Sopenharmony_ci		       rtlpriv->stats.rx_cfo_short[0]);
3208c2ecf20Sopenharmony_ci	rtl_write_word(rtlpriv, RB_CFOSHORTDUMP,
3218c2ecf20Sopenharmony_ci		       rtlpriv->stats.rx_cfo_short[1]);
3228c2ecf20Sopenharmony_ci	/* Rx Cfo_Tail */
3238c2ecf20Sopenharmony_ci	rtl_write_word(rtlpriv, RA_CFOLONGDUMP, rtlpriv->stats.rx_cfo_tail[0]);
3248c2ecf20Sopenharmony_ci	rtl_write_word(rtlpriv, RB_CFOLONGDUMP, rtlpriv->stats.rx_cfo_tail[1]);
3258c2ecf20Sopenharmony_ci}
3268c2ecf20Sopenharmony_ci
3278c2ecf20Sopenharmony_cistatic void rtl92ee_dm_find_minimum_rssi(struct ieee80211_hw *hw)
3288c2ecf20Sopenharmony_ci{
3298c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
3308c2ecf20Sopenharmony_ci	struct dig_t *rtl_dm_dig = &rtlpriv->dm_digtable;
3318c2ecf20Sopenharmony_ci	struct rtl_mac *mac = rtl_mac(rtlpriv);
3328c2ecf20Sopenharmony_ci
3338c2ecf20Sopenharmony_ci	/* Determine the minimum RSSI  */
3348c2ecf20Sopenharmony_ci	if ((mac->link_state < MAC80211_LINKED) &&
3358c2ecf20Sopenharmony_ci	    (rtlpriv->dm.entry_min_undec_sm_pwdb == 0)) {
3368c2ecf20Sopenharmony_ci		rtl_dm_dig->min_undec_pwdb_for_dm = 0;
3378c2ecf20Sopenharmony_ci		rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
3388c2ecf20Sopenharmony_ci			"Not connected to any\n");
3398c2ecf20Sopenharmony_ci	}
3408c2ecf20Sopenharmony_ci	if (mac->link_state >= MAC80211_LINKED) {
3418c2ecf20Sopenharmony_ci		if (mac->opmode == NL80211_IFTYPE_AP ||
3428c2ecf20Sopenharmony_ci		    mac->opmode == NL80211_IFTYPE_ADHOC) {
3438c2ecf20Sopenharmony_ci			rtl_dm_dig->min_undec_pwdb_for_dm =
3448c2ecf20Sopenharmony_ci				rtlpriv->dm.entry_min_undec_sm_pwdb;
3458c2ecf20Sopenharmony_ci			rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
3468c2ecf20Sopenharmony_ci				"AP Client PWDB = 0x%lx\n",
3478c2ecf20Sopenharmony_ci				rtlpriv->dm.entry_min_undec_sm_pwdb);
3488c2ecf20Sopenharmony_ci		} else {
3498c2ecf20Sopenharmony_ci			rtl_dm_dig->min_undec_pwdb_for_dm =
3508c2ecf20Sopenharmony_ci			    rtlpriv->dm.undec_sm_pwdb;
3518c2ecf20Sopenharmony_ci			rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
3528c2ecf20Sopenharmony_ci				"STA Default Port PWDB = 0x%x\n",
3538c2ecf20Sopenharmony_ci				rtl_dm_dig->min_undec_pwdb_for_dm);
3548c2ecf20Sopenharmony_ci		}
3558c2ecf20Sopenharmony_ci	} else {
3568c2ecf20Sopenharmony_ci		rtl_dm_dig->min_undec_pwdb_for_dm =
3578c2ecf20Sopenharmony_ci			rtlpriv->dm.entry_min_undec_sm_pwdb;
3588c2ecf20Sopenharmony_ci		rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
3598c2ecf20Sopenharmony_ci			"AP Ext Port or disconnect PWDB = 0x%x\n",
3608c2ecf20Sopenharmony_ci			rtl_dm_dig->min_undec_pwdb_for_dm);
3618c2ecf20Sopenharmony_ci	}
3628c2ecf20Sopenharmony_ci	rtl_dbg(rtlpriv, COMP_DIG, DBG_LOUD,
3638c2ecf20Sopenharmony_ci		"MinUndecoratedPWDBForDM =%d\n",
3648c2ecf20Sopenharmony_ci		rtl_dm_dig->min_undec_pwdb_for_dm);
3658c2ecf20Sopenharmony_ci}
3668c2ecf20Sopenharmony_ci
3678c2ecf20Sopenharmony_cistatic void rtl92ee_dm_check_rssi_monitor(struct ieee80211_hw *hw)
3688c2ecf20Sopenharmony_ci{
3698c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
3708c2ecf20Sopenharmony_ci	struct dig_t *dm_dig = &rtlpriv->dm_digtable;
3718c2ecf20Sopenharmony_ci	struct rtl_mac *mac = rtl_mac(rtlpriv);
3728c2ecf20Sopenharmony_ci	struct rtl_dm *dm = rtl_dm(rtlpriv);
3738c2ecf20Sopenharmony_ci	struct rtl_sta_info *drv_priv;
3748c2ecf20Sopenharmony_ci	u8 h2c[4] = { 0 };
3758c2ecf20Sopenharmony_ci	long max = 0, min = 0xff;
3768c2ecf20Sopenharmony_ci	u8 i = 0;
3778c2ecf20Sopenharmony_ci
3788c2ecf20Sopenharmony_ci	if (mac->opmode == NL80211_IFTYPE_AP ||
3798c2ecf20Sopenharmony_ci	    mac->opmode == NL80211_IFTYPE_ADHOC ||
3808c2ecf20Sopenharmony_ci	    mac->opmode == NL80211_IFTYPE_MESH_POINT) {
3818c2ecf20Sopenharmony_ci		/* AP & ADHOC & MESH */
3828c2ecf20Sopenharmony_ci		spin_lock_bh(&rtlpriv->locks.entry_list_lock);
3838c2ecf20Sopenharmony_ci		list_for_each_entry(drv_priv, &rtlpriv->entry_list, list) {
3848c2ecf20Sopenharmony_ci			struct rssi_sta *stat = &drv_priv->rssi_stat;
3858c2ecf20Sopenharmony_ci
3868c2ecf20Sopenharmony_ci			if (stat->undec_sm_pwdb < min)
3878c2ecf20Sopenharmony_ci				min = stat->undec_sm_pwdb;
3888c2ecf20Sopenharmony_ci			if (stat->undec_sm_pwdb > max)
3898c2ecf20Sopenharmony_ci				max = stat->undec_sm_pwdb;
3908c2ecf20Sopenharmony_ci
3918c2ecf20Sopenharmony_ci			h2c[3] = 0;
3928c2ecf20Sopenharmony_ci			h2c[2] = (u8)(dm->undec_sm_pwdb & 0xFF);
3938c2ecf20Sopenharmony_ci			h2c[1] = 0x20;
3948c2ecf20Sopenharmony_ci			h2c[0] = ++i;
3958c2ecf20Sopenharmony_ci			rtl92ee_fill_h2c_cmd(hw, H2C_92E_RSSI_REPORT, 4, h2c);
3968c2ecf20Sopenharmony_ci		}
3978c2ecf20Sopenharmony_ci		spin_unlock_bh(&rtlpriv->locks.entry_list_lock);
3988c2ecf20Sopenharmony_ci
3998c2ecf20Sopenharmony_ci		/* If associated entry is found */
4008c2ecf20Sopenharmony_ci		if (max != 0) {
4018c2ecf20Sopenharmony_ci			dm->entry_max_undec_sm_pwdb = max;
4028c2ecf20Sopenharmony_ci			RTPRINT(rtlpriv, FDM, DM_PWDB,
4038c2ecf20Sopenharmony_ci				"EntryMaxPWDB = 0x%lx(%ld)\n", max, max);
4048c2ecf20Sopenharmony_ci		} else {
4058c2ecf20Sopenharmony_ci			dm->entry_max_undec_sm_pwdb = 0;
4068c2ecf20Sopenharmony_ci		}
4078c2ecf20Sopenharmony_ci		/* If associated entry is found */
4088c2ecf20Sopenharmony_ci		if (min != 0xff) {
4098c2ecf20Sopenharmony_ci			dm->entry_min_undec_sm_pwdb = min;
4108c2ecf20Sopenharmony_ci			RTPRINT(rtlpriv, FDM, DM_PWDB,
4118c2ecf20Sopenharmony_ci				"EntryMinPWDB = 0x%lx(%ld)\n", min, min);
4128c2ecf20Sopenharmony_ci		} else {
4138c2ecf20Sopenharmony_ci			dm->entry_min_undec_sm_pwdb = 0;
4148c2ecf20Sopenharmony_ci		}
4158c2ecf20Sopenharmony_ci	}
4168c2ecf20Sopenharmony_ci
4178c2ecf20Sopenharmony_ci	/* Indicate Rx signal strength to FW. */
4188c2ecf20Sopenharmony_ci	if (dm->useramask) {
4198c2ecf20Sopenharmony_ci		h2c[3] = 0;
4208c2ecf20Sopenharmony_ci		h2c[2] = (u8)(dm->undec_sm_pwdb & 0xFF);
4218c2ecf20Sopenharmony_ci		h2c[1] = 0x20;
4228c2ecf20Sopenharmony_ci		h2c[0] = 0;
4238c2ecf20Sopenharmony_ci		rtl92ee_fill_h2c_cmd(hw, H2C_92E_RSSI_REPORT, 4, h2c);
4248c2ecf20Sopenharmony_ci	} else {
4258c2ecf20Sopenharmony_ci		rtl_write_byte(rtlpriv, 0x4fe, dm->undec_sm_pwdb);
4268c2ecf20Sopenharmony_ci	}
4278c2ecf20Sopenharmony_ci	rtl92ee_rssi_dump_to_register(hw);
4288c2ecf20Sopenharmony_ci	rtl92ee_dm_find_minimum_rssi(hw);
4298c2ecf20Sopenharmony_ci	dm_dig->rssi_val_min = rtlpriv->dm_digtable.min_undec_pwdb_for_dm;
4308c2ecf20Sopenharmony_ci}
4318c2ecf20Sopenharmony_ci
4328c2ecf20Sopenharmony_cistatic void rtl92ee_dm_init_primary_cca_check(struct ieee80211_hw *hw)
4338c2ecf20Sopenharmony_ci{
4348c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
4358c2ecf20Sopenharmony_ci	struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
4368c2ecf20Sopenharmony_ci	struct dynamic_primary_cca *primarycca = &rtlpriv->primarycca;
4378c2ecf20Sopenharmony_ci
4388c2ecf20Sopenharmony_ci	rtlhal->rts_en = 0;
4398c2ecf20Sopenharmony_ci	primarycca->dup_rts_flag = 0;
4408c2ecf20Sopenharmony_ci	primarycca->intf_flag = 0;
4418c2ecf20Sopenharmony_ci	primarycca->intf_type = 0;
4428c2ecf20Sopenharmony_ci	primarycca->monitor_flag = 0;
4438c2ecf20Sopenharmony_ci	primarycca->ch_offset = 0;
4448c2ecf20Sopenharmony_ci	primarycca->mf_state = 0;
4458c2ecf20Sopenharmony_ci}
4468c2ecf20Sopenharmony_ci
4478c2ecf20Sopenharmony_cistatic bool rtl92ee_dm_is_edca_turbo_disable(struct ieee80211_hw *hw)
4488c2ecf20Sopenharmony_ci{
4498c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
4508c2ecf20Sopenharmony_ci
4518c2ecf20Sopenharmony_ci	if (rtlpriv->mac80211.mode == WIRELESS_MODE_B)
4528c2ecf20Sopenharmony_ci		return true;
4538c2ecf20Sopenharmony_ci
4548c2ecf20Sopenharmony_ci	return false;
4558c2ecf20Sopenharmony_ci}
4568c2ecf20Sopenharmony_ci
4578c2ecf20Sopenharmony_civoid rtl92ee_dm_init_edca_turbo(struct ieee80211_hw *hw)
4588c2ecf20Sopenharmony_ci{
4598c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
4608c2ecf20Sopenharmony_ci
4618c2ecf20Sopenharmony_ci	rtlpriv->dm.current_turbo_edca = false;
4628c2ecf20Sopenharmony_ci	rtlpriv->dm.is_cur_rdlstate = false;
4638c2ecf20Sopenharmony_ci	rtlpriv->dm.is_any_nonbepkts = false;
4648c2ecf20Sopenharmony_ci}
4658c2ecf20Sopenharmony_ci
4668c2ecf20Sopenharmony_cistatic void rtl92ee_dm_check_edca_turbo(struct ieee80211_hw *hw)
4678c2ecf20Sopenharmony_ci{
4688c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
4698c2ecf20Sopenharmony_ci
4708c2ecf20Sopenharmony_ci	static u64 last_txok_cnt;
4718c2ecf20Sopenharmony_ci	static u64 last_rxok_cnt;
4728c2ecf20Sopenharmony_ci	u64 cur_txok_cnt = 0;
4738c2ecf20Sopenharmony_ci	u64 cur_rxok_cnt = 0;
4748c2ecf20Sopenharmony_ci	u32 edca_be_ul = 0x5ea42b;
4758c2ecf20Sopenharmony_ci	u32 edca_be_dl = 0x5ea42b; /*not sure*/
4768c2ecf20Sopenharmony_ci	u32 edca_be = 0x5ea42b;
4778c2ecf20Sopenharmony_ci	bool is_cur_rdlstate;
4788c2ecf20Sopenharmony_ci	bool b_edca_turbo_on = false;
4798c2ecf20Sopenharmony_ci
4808c2ecf20Sopenharmony_ci	if (rtlpriv->dm.dbginfo.num_non_be_pkt > 0x100)
4818c2ecf20Sopenharmony_ci		rtlpriv->dm.is_any_nonbepkts = true;
4828c2ecf20Sopenharmony_ci	rtlpriv->dm.dbginfo.num_non_be_pkt = 0;
4838c2ecf20Sopenharmony_ci
4848c2ecf20Sopenharmony_ci	cur_txok_cnt = rtlpriv->stats.txbytesunicast - last_txok_cnt;
4858c2ecf20Sopenharmony_ci	cur_rxok_cnt = rtlpriv->stats.rxbytesunicast - last_rxok_cnt;
4868c2ecf20Sopenharmony_ci
4878c2ecf20Sopenharmony_ci	/*b_bias_on_rx = false;*/
4888c2ecf20Sopenharmony_ci	b_edca_turbo_on = ((!rtlpriv->dm.is_any_nonbepkts) &&
4898c2ecf20Sopenharmony_ci			   (!rtlpriv->dm.disable_framebursting)) ?
4908c2ecf20Sopenharmony_ci			  true : false;
4918c2ecf20Sopenharmony_ci
4928c2ecf20Sopenharmony_ci	if (rtl92ee_dm_is_edca_turbo_disable(hw))
4938c2ecf20Sopenharmony_ci		goto check_exit;
4948c2ecf20Sopenharmony_ci
4958c2ecf20Sopenharmony_ci	if (b_edca_turbo_on) {
4968c2ecf20Sopenharmony_ci		is_cur_rdlstate = (cur_rxok_cnt > cur_txok_cnt * 4) ?
4978c2ecf20Sopenharmony_ci				    true : false;
4988c2ecf20Sopenharmony_ci
4998c2ecf20Sopenharmony_ci		edca_be = is_cur_rdlstate ? edca_be_dl : edca_be_ul;
5008c2ecf20Sopenharmony_ci		rtl_write_dword(rtlpriv , REG_EDCA_BE_PARAM , edca_be);
5018c2ecf20Sopenharmony_ci		rtlpriv->dm.is_cur_rdlstate = is_cur_rdlstate;
5028c2ecf20Sopenharmony_ci		rtlpriv->dm.current_turbo_edca = true;
5038c2ecf20Sopenharmony_ci	} else {
5048c2ecf20Sopenharmony_ci		if (rtlpriv->dm.current_turbo_edca) {
5058c2ecf20Sopenharmony_ci			u8 tmp = AC0_BE;
5068c2ecf20Sopenharmony_ci
5078c2ecf20Sopenharmony_ci			rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AC_PARAM,
5088c2ecf20Sopenharmony_ci						      (u8 *)(&tmp));
5098c2ecf20Sopenharmony_ci		}
5108c2ecf20Sopenharmony_ci		rtlpriv->dm.current_turbo_edca = false;
5118c2ecf20Sopenharmony_ci	}
5128c2ecf20Sopenharmony_ci
5138c2ecf20Sopenharmony_cicheck_exit:
5148c2ecf20Sopenharmony_ci	rtlpriv->dm.is_any_nonbepkts = false;
5158c2ecf20Sopenharmony_ci	last_txok_cnt = rtlpriv->stats.txbytesunicast;
5168c2ecf20Sopenharmony_ci	last_rxok_cnt = rtlpriv->stats.rxbytesunicast;
5178c2ecf20Sopenharmony_ci}
5188c2ecf20Sopenharmony_ci
5198c2ecf20Sopenharmony_cistatic void rtl92ee_dm_dynamic_edcca(struct ieee80211_hw *hw)
5208c2ecf20Sopenharmony_ci{
5218c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
5228c2ecf20Sopenharmony_ci	u8 reg_c50 , reg_c58;
5238c2ecf20Sopenharmony_ci	bool fw_current_in_ps_mode = false;
5248c2ecf20Sopenharmony_ci
5258c2ecf20Sopenharmony_ci	rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FW_PSMODE_STATUS,
5268c2ecf20Sopenharmony_ci				      (u8 *)(&fw_current_in_ps_mode));
5278c2ecf20Sopenharmony_ci	if (fw_current_in_ps_mode)
5288c2ecf20Sopenharmony_ci		return;
5298c2ecf20Sopenharmony_ci
5308c2ecf20Sopenharmony_ci	reg_c50 = rtl_get_bbreg(hw, ROFDM0_XAAGCCORE1, MASKBYTE0);
5318c2ecf20Sopenharmony_ci	reg_c58 = rtl_get_bbreg(hw, ROFDM0_XBAGCCORE1, MASKBYTE0);
5328c2ecf20Sopenharmony_ci
5338c2ecf20Sopenharmony_ci	if (reg_c50 > 0x28 && reg_c58 > 0x28) {
5348c2ecf20Sopenharmony_ci		if (!rtlpriv->rtlhal.pre_edcca_enable) {
5358c2ecf20Sopenharmony_ci			rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD, 0x03);
5368c2ecf20Sopenharmony_ci			rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD + 2, 0x00);
5378c2ecf20Sopenharmony_ci			rtlpriv->rtlhal.pre_edcca_enable = true;
5388c2ecf20Sopenharmony_ci		}
5398c2ecf20Sopenharmony_ci	} else if (reg_c50 < 0x25 && reg_c58 < 0x25) {
5408c2ecf20Sopenharmony_ci		if (rtlpriv->rtlhal.pre_edcca_enable) {
5418c2ecf20Sopenharmony_ci			rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD, 0x7f);
5428c2ecf20Sopenharmony_ci			rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD + 2, 0x7f);
5438c2ecf20Sopenharmony_ci			rtlpriv->rtlhal.pre_edcca_enable = false;
5448c2ecf20Sopenharmony_ci		}
5458c2ecf20Sopenharmony_ci	}
5468c2ecf20Sopenharmony_ci}
5478c2ecf20Sopenharmony_ci
5488c2ecf20Sopenharmony_cistatic void rtl92ee_dm_adaptivity(struct ieee80211_hw *hw)
5498c2ecf20Sopenharmony_ci{
5508c2ecf20Sopenharmony_ci	rtl92ee_dm_dynamic_edcca(hw);
5518c2ecf20Sopenharmony_ci}
5528c2ecf20Sopenharmony_ci
5538c2ecf20Sopenharmony_cistatic void rtl92ee_dm_write_dynamic_cca(struct ieee80211_hw *hw,
5548c2ecf20Sopenharmony_ci					 u8 cur_mf_state)
5558c2ecf20Sopenharmony_ci{
5568c2ecf20Sopenharmony_ci	struct dynamic_primary_cca *primarycca = &rtl_priv(hw)->primarycca;
5578c2ecf20Sopenharmony_ci
5588c2ecf20Sopenharmony_ci	if (primarycca->mf_state != cur_mf_state)
5598c2ecf20Sopenharmony_ci		rtl_set_bbreg(hw, DM_REG_L1SBD_PD_CH_11N, BIT(8) | BIT(7),
5608c2ecf20Sopenharmony_ci			      cur_mf_state);
5618c2ecf20Sopenharmony_ci
5628c2ecf20Sopenharmony_ci	primarycca->mf_state = cur_mf_state;
5638c2ecf20Sopenharmony_ci}
5648c2ecf20Sopenharmony_ci
5658c2ecf20Sopenharmony_cistatic void rtl92ee_dm_dynamic_primary_cca_ckeck(struct ieee80211_hw *hw)
5668c2ecf20Sopenharmony_ci{
5678c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
5688c2ecf20Sopenharmony_ci	struct false_alarm_statistics *falsealm_cnt = &rtlpriv->falsealm_cnt;
5698c2ecf20Sopenharmony_ci	struct dynamic_primary_cca *primarycca = &rtlpriv->primarycca;
5708c2ecf20Sopenharmony_ci	bool is40mhz = false;
5718c2ecf20Sopenharmony_ci	u64 ofdm_cca, ofdm_fa, bw_usc_cnt, bw_lsc_cnt;
5728c2ecf20Sopenharmony_ci	u8 sec_ch_offset;
5738c2ecf20Sopenharmony_ci	u8 cur_mf_state;
5748c2ecf20Sopenharmony_ci	static u8 count_down = MONITOR_TIME;
5758c2ecf20Sopenharmony_ci
5768c2ecf20Sopenharmony_ci	ofdm_cca = falsealm_cnt->cnt_ofdm_cca;
5778c2ecf20Sopenharmony_ci	ofdm_fa = falsealm_cnt->cnt_ofdm_fail;
5788c2ecf20Sopenharmony_ci	bw_usc_cnt = falsealm_cnt->cnt_bw_usc;
5798c2ecf20Sopenharmony_ci	bw_lsc_cnt = falsealm_cnt->cnt_bw_lsc;
5808c2ecf20Sopenharmony_ci	is40mhz = rtlpriv->mac80211.bw_40;
5818c2ecf20Sopenharmony_ci	sec_ch_offset = rtlpriv->mac80211.cur_40_prime_sc;
5828c2ecf20Sopenharmony_ci	/* NIC: 2: sec is below,  1: sec is above */
5838c2ecf20Sopenharmony_ci
5848c2ecf20Sopenharmony_ci	if (rtlpriv->mac80211.opmode == NL80211_IFTYPE_AP) {
5858c2ecf20Sopenharmony_ci		cur_mf_state = MF_USC_LSC;
5868c2ecf20Sopenharmony_ci		rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
5878c2ecf20Sopenharmony_ci		return;
5888c2ecf20Sopenharmony_ci	}
5898c2ecf20Sopenharmony_ci
5908c2ecf20Sopenharmony_ci	if (rtlpriv->mac80211.link_state < MAC80211_LINKED)
5918c2ecf20Sopenharmony_ci		return;
5928c2ecf20Sopenharmony_ci
5938c2ecf20Sopenharmony_ci	if (is40mhz)
5948c2ecf20Sopenharmony_ci		return;
5958c2ecf20Sopenharmony_ci
5968c2ecf20Sopenharmony_ci	if (primarycca->pricca_flag == 0) {
5978c2ecf20Sopenharmony_ci		/* Primary channel is above
5988c2ecf20Sopenharmony_ci		 * NOTE: duplicate CTS can remove this condition
5998c2ecf20Sopenharmony_ci		 */
6008c2ecf20Sopenharmony_ci		if (sec_ch_offset == 2) {
6018c2ecf20Sopenharmony_ci			if ((ofdm_cca > OFDMCCA_TH) &&
6028c2ecf20Sopenharmony_ci			    (bw_lsc_cnt > (bw_usc_cnt + BW_IND_BIAS)) &&
6038c2ecf20Sopenharmony_ci			    (ofdm_fa > (ofdm_cca >> 1))) {
6048c2ecf20Sopenharmony_ci				primarycca->intf_type = 1;
6058c2ecf20Sopenharmony_ci				primarycca->intf_flag = 1;
6068c2ecf20Sopenharmony_ci				cur_mf_state = MF_USC;
6078c2ecf20Sopenharmony_ci				rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
6088c2ecf20Sopenharmony_ci				primarycca->pricca_flag = 1;
6098c2ecf20Sopenharmony_ci			} else if ((ofdm_cca > OFDMCCA_TH) &&
6108c2ecf20Sopenharmony_ci				   (bw_lsc_cnt > (bw_usc_cnt + BW_IND_BIAS)) &&
6118c2ecf20Sopenharmony_ci				   (ofdm_fa < (ofdm_cca >> 1))) {
6128c2ecf20Sopenharmony_ci				primarycca->intf_type = 2;
6138c2ecf20Sopenharmony_ci				primarycca->intf_flag = 1;
6148c2ecf20Sopenharmony_ci				cur_mf_state = MF_USC;
6158c2ecf20Sopenharmony_ci				rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
6168c2ecf20Sopenharmony_ci				primarycca->pricca_flag = 1;
6178c2ecf20Sopenharmony_ci				primarycca->dup_rts_flag = 1;
6188c2ecf20Sopenharmony_ci				rtlpriv->rtlhal.rts_en = 1;
6198c2ecf20Sopenharmony_ci			} else {
6208c2ecf20Sopenharmony_ci				primarycca->intf_type = 0;
6218c2ecf20Sopenharmony_ci				primarycca->intf_flag = 0;
6228c2ecf20Sopenharmony_ci				cur_mf_state = MF_USC_LSC;
6238c2ecf20Sopenharmony_ci				rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
6248c2ecf20Sopenharmony_ci				rtlpriv->rtlhal.rts_en = 0;
6258c2ecf20Sopenharmony_ci				primarycca->dup_rts_flag = 0;
6268c2ecf20Sopenharmony_ci			}
6278c2ecf20Sopenharmony_ci		} else if (sec_ch_offset == 1) {
6288c2ecf20Sopenharmony_ci			if ((ofdm_cca > OFDMCCA_TH) &&
6298c2ecf20Sopenharmony_ci			    (bw_usc_cnt > (bw_lsc_cnt + BW_IND_BIAS)) &&
6308c2ecf20Sopenharmony_ci			    (ofdm_fa > (ofdm_cca >> 1))) {
6318c2ecf20Sopenharmony_ci				primarycca->intf_type = 1;
6328c2ecf20Sopenharmony_ci				primarycca->intf_flag = 1;
6338c2ecf20Sopenharmony_ci				cur_mf_state = MF_LSC;
6348c2ecf20Sopenharmony_ci				rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
6358c2ecf20Sopenharmony_ci				primarycca->pricca_flag = 1;
6368c2ecf20Sopenharmony_ci			} else if ((ofdm_cca > OFDMCCA_TH) &&
6378c2ecf20Sopenharmony_ci				   (bw_usc_cnt > (bw_lsc_cnt + BW_IND_BIAS)) &&
6388c2ecf20Sopenharmony_ci				   (ofdm_fa < (ofdm_cca >> 1))) {
6398c2ecf20Sopenharmony_ci				primarycca->intf_type = 2;
6408c2ecf20Sopenharmony_ci				primarycca->intf_flag = 1;
6418c2ecf20Sopenharmony_ci				cur_mf_state = MF_LSC;
6428c2ecf20Sopenharmony_ci				rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
6438c2ecf20Sopenharmony_ci				primarycca->pricca_flag = 1;
6448c2ecf20Sopenharmony_ci				primarycca->dup_rts_flag = 1;
6458c2ecf20Sopenharmony_ci				rtlpriv->rtlhal.rts_en = 1;
6468c2ecf20Sopenharmony_ci			} else {
6478c2ecf20Sopenharmony_ci				primarycca->intf_type = 0;
6488c2ecf20Sopenharmony_ci				primarycca->intf_flag = 0;
6498c2ecf20Sopenharmony_ci				cur_mf_state = MF_USC_LSC;
6508c2ecf20Sopenharmony_ci				rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
6518c2ecf20Sopenharmony_ci				rtlpriv->rtlhal.rts_en = 0;
6528c2ecf20Sopenharmony_ci				primarycca->dup_rts_flag = 0;
6538c2ecf20Sopenharmony_ci			}
6548c2ecf20Sopenharmony_ci		}
6558c2ecf20Sopenharmony_ci	} else {/* PrimaryCCA->PriCCA_flag==1 */
6568c2ecf20Sopenharmony_ci		count_down--;
6578c2ecf20Sopenharmony_ci		if (count_down == 0) {
6588c2ecf20Sopenharmony_ci			count_down = MONITOR_TIME;
6598c2ecf20Sopenharmony_ci			primarycca->pricca_flag = 0;
6608c2ecf20Sopenharmony_ci			cur_mf_state = MF_USC_LSC;
6618c2ecf20Sopenharmony_ci			/* default */
6628c2ecf20Sopenharmony_ci			rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
6638c2ecf20Sopenharmony_ci			rtlpriv->rtlhal.rts_en = 0;
6648c2ecf20Sopenharmony_ci			primarycca->dup_rts_flag = 0;
6658c2ecf20Sopenharmony_ci			primarycca->intf_type = 0;
6668c2ecf20Sopenharmony_ci			primarycca->intf_flag = 0;
6678c2ecf20Sopenharmony_ci		}
6688c2ecf20Sopenharmony_ci	}
6698c2ecf20Sopenharmony_ci}
6708c2ecf20Sopenharmony_ci
6718c2ecf20Sopenharmony_cistatic void rtl92ee_dm_dynamic_atc_switch(struct ieee80211_hw *hw)
6728c2ecf20Sopenharmony_ci{
6738c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
6748c2ecf20Sopenharmony_ci	struct rtl_dm *rtldm = rtl_dm(rtl_priv(hw));
6758c2ecf20Sopenharmony_ci	u8 crystal_cap;
6768c2ecf20Sopenharmony_ci	u32 packet_count;
6778c2ecf20Sopenharmony_ci	int cfo_khz_a , cfo_khz_b , cfo_ave = 0, adjust_xtal = 0;
6788c2ecf20Sopenharmony_ci	int cfo_ave_diff;
6798c2ecf20Sopenharmony_ci
6808c2ecf20Sopenharmony_ci	if (rtlpriv->mac80211.link_state < MAC80211_LINKED) {
6818c2ecf20Sopenharmony_ci		if (rtldm->atc_status == ATC_STATUS_OFF) {
6828c2ecf20Sopenharmony_ci			rtl_set_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11),
6838c2ecf20Sopenharmony_ci				      ATC_STATUS_ON);
6848c2ecf20Sopenharmony_ci			rtldm->atc_status = ATC_STATUS_ON;
6858c2ecf20Sopenharmony_ci		}
6868c2ecf20Sopenharmony_ci		/* Disable CFO tracking for BT */
6878c2ecf20Sopenharmony_ci		if (rtlpriv->cfg->ops->get_btc_status()) {
6888c2ecf20Sopenharmony_ci			if (!rtlpriv->btcoexist.btc_ops->
6898c2ecf20Sopenharmony_ci			    btc_is_bt_disabled(rtlpriv)) {
6908c2ecf20Sopenharmony_ci				rtl_dbg(rtlpriv, COMP_BT_COEXIST, DBG_LOUD,
6918c2ecf20Sopenharmony_ci					"odm_DynamicATCSwitch(): Disable CFO tracking for BT!!\n");
6928c2ecf20Sopenharmony_ci				return;
6938c2ecf20Sopenharmony_ci			}
6948c2ecf20Sopenharmony_ci		}
6958c2ecf20Sopenharmony_ci		/* Reset Crystal Cap */
6968c2ecf20Sopenharmony_ci		if (rtldm->crystal_cap != rtlpriv->efuse.crystalcap) {
6978c2ecf20Sopenharmony_ci			rtldm->crystal_cap = rtlpriv->efuse.crystalcap;
6988c2ecf20Sopenharmony_ci			crystal_cap = rtldm->crystal_cap & 0x3f;
6998c2ecf20Sopenharmony_ci			rtl_set_bbreg(hw, REG_MAC_PHY_CTRL, 0xFFF000,
7008c2ecf20Sopenharmony_ci				      (crystal_cap | (crystal_cap << 6)));
7018c2ecf20Sopenharmony_ci		}
7028c2ecf20Sopenharmony_ci	} else {
7038c2ecf20Sopenharmony_ci		cfo_khz_a = (int)(rtldm->cfo_tail[0] * 3125) / 1280;
7048c2ecf20Sopenharmony_ci		cfo_khz_b = (int)(rtldm->cfo_tail[1] * 3125) / 1280;
7058c2ecf20Sopenharmony_ci		packet_count = rtldm->packet_count;
7068c2ecf20Sopenharmony_ci
7078c2ecf20Sopenharmony_ci		if (packet_count == rtldm->packet_count_pre)
7088c2ecf20Sopenharmony_ci			return;
7098c2ecf20Sopenharmony_ci
7108c2ecf20Sopenharmony_ci		rtldm->packet_count_pre = packet_count;
7118c2ecf20Sopenharmony_ci
7128c2ecf20Sopenharmony_ci		if (rtlpriv->phy.rf_type == RF_1T1R)
7138c2ecf20Sopenharmony_ci			cfo_ave = cfo_khz_a;
7148c2ecf20Sopenharmony_ci		else
7158c2ecf20Sopenharmony_ci			cfo_ave = (int)(cfo_khz_a + cfo_khz_b) >> 1;
7168c2ecf20Sopenharmony_ci
7178c2ecf20Sopenharmony_ci		cfo_ave_diff = (rtldm->cfo_ave_pre >= cfo_ave) ?
7188c2ecf20Sopenharmony_ci			       (rtldm->cfo_ave_pre - cfo_ave) :
7198c2ecf20Sopenharmony_ci			       (cfo_ave - rtldm->cfo_ave_pre);
7208c2ecf20Sopenharmony_ci
7218c2ecf20Sopenharmony_ci		if (cfo_ave_diff > 20 && !rtldm->large_cfo_hit) {
7228c2ecf20Sopenharmony_ci			rtldm->large_cfo_hit = true;
7238c2ecf20Sopenharmony_ci			return;
7248c2ecf20Sopenharmony_ci		}
7258c2ecf20Sopenharmony_ci		rtldm->large_cfo_hit = false;
7268c2ecf20Sopenharmony_ci
7278c2ecf20Sopenharmony_ci		rtldm->cfo_ave_pre = cfo_ave;
7288c2ecf20Sopenharmony_ci
7298c2ecf20Sopenharmony_ci		if (cfo_ave >= -rtldm->cfo_threshold &&
7308c2ecf20Sopenharmony_ci		    cfo_ave <= rtldm->cfo_threshold && rtldm->is_freeze == 0) {
7318c2ecf20Sopenharmony_ci			if (rtldm->cfo_threshold == CFO_THRESHOLD_XTAL) {
7328c2ecf20Sopenharmony_ci				rtldm->cfo_threshold = CFO_THRESHOLD_XTAL + 10;
7338c2ecf20Sopenharmony_ci				rtldm->is_freeze = 1;
7348c2ecf20Sopenharmony_ci			} else {
7358c2ecf20Sopenharmony_ci				rtldm->cfo_threshold = CFO_THRESHOLD_XTAL;
7368c2ecf20Sopenharmony_ci			}
7378c2ecf20Sopenharmony_ci		}
7388c2ecf20Sopenharmony_ci
7398c2ecf20Sopenharmony_ci		if (cfo_ave > rtldm->cfo_threshold && rtldm->crystal_cap < 0x3f)
7408c2ecf20Sopenharmony_ci			adjust_xtal = ((cfo_ave - CFO_THRESHOLD_XTAL) >> 2) + 1;
7418c2ecf20Sopenharmony_ci		else if ((cfo_ave < -rtlpriv->dm.cfo_threshold) &&
7428c2ecf20Sopenharmony_ci			 rtlpriv->dm.crystal_cap > 0)
7438c2ecf20Sopenharmony_ci			adjust_xtal = ((cfo_ave + CFO_THRESHOLD_XTAL) >> 2) - 1;
7448c2ecf20Sopenharmony_ci
7458c2ecf20Sopenharmony_ci		if (adjust_xtal != 0) {
7468c2ecf20Sopenharmony_ci			rtldm->is_freeze = 0;
7478c2ecf20Sopenharmony_ci			rtldm->crystal_cap += adjust_xtal;
7488c2ecf20Sopenharmony_ci
7498c2ecf20Sopenharmony_ci			if (rtldm->crystal_cap > 0x3f)
7508c2ecf20Sopenharmony_ci				rtldm->crystal_cap = 0x3f;
7518c2ecf20Sopenharmony_ci			else if (rtldm->crystal_cap < 0)
7528c2ecf20Sopenharmony_ci				rtldm->crystal_cap = 0;
7538c2ecf20Sopenharmony_ci
7548c2ecf20Sopenharmony_ci			crystal_cap = rtldm->crystal_cap & 0x3f;
7558c2ecf20Sopenharmony_ci			rtl_set_bbreg(hw, REG_MAC_PHY_CTRL, 0xFFF000,
7568c2ecf20Sopenharmony_ci				      (crystal_cap | (crystal_cap << 6)));
7578c2ecf20Sopenharmony_ci		}
7588c2ecf20Sopenharmony_ci
7598c2ecf20Sopenharmony_ci		if (cfo_ave < CFO_THRESHOLD_ATC &&
7608c2ecf20Sopenharmony_ci		    cfo_ave > -CFO_THRESHOLD_ATC) {
7618c2ecf20Sopenharmony_ci			if (rtldm->atc_status == ATC_STATUS_ON) {
7628c2ecf20Sopenharmony_ci				rtl_set_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11),
7638c2ecf20Sopenharmony_ci					      ATC_STATUS_OFF);
7648c2ecf20Sopenharmony_ci				rtldm->atc_status = ATC_STATUS_OFF;
7658c2ecf20Sopenharmony_ci			}
7668c2ecf20Sopenharmony_ci		} else {
7678c2ecf20Sopenharmony_ci			if (rtldm->atc_status == ATC_STATUS_OFF) {
7688c2ecf20Sopenharmony_ci				rtl_set_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11),
7698c2ecf20Sopenharmony_ci					      ATC_STATUS_ON);
7708c2ecf20Sopenharmony_ci				rtldm->atc_status = ATC_STATUS_ON;
7718c2ecf20Sopenharmony_ci			}
7728c2ecf20Sopenharmony_ci		}
7738c2ecf20Sopenharmony_ci	}
7748c2ecf20Sopenharmony_ci}
7758c2ecf20Sopenharmony_ci
7768c2ecf20Sopenharmony_cistatic void rtl92ee_dm_init_txpower_tracking(struct ieee80211_hw *hw)
7778c2ecf20Sopenharmony_ci{
7788c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
7798c2ecf20Sopenharmony_ci	struct rtl_dm *dm = rtl_dm(rtlpriv);
7808c2ecf20Sopenharmony_ci	u8 path;
7818c2ecf20Sopenharmony_ci
7828c2ecf20Sopenharmony_ci	dm->txpower_tracking = true;
7838c2ecf20Sopenharmony_ci	dm->default_ofdm_index = 30;
7848c2ecf20Sopenharmony_ci	dm->default_cck_index = 20;
7858c2ecf20Sopenharmony_ci
7868c2ecf20Sopenharmony_ci	dm->swing_idx_cck_base = dm->default_cck_index;
7878c2ecf20Sopenharmony_ci	dm->cck_index = dm->default_cck_index;
7888c2ecf20Sopenharmony_ci
7898c2ecf20Sopenharmony_ci	for (path = RF90_PATH_A; path < MAX_RF_PATH; path++) {
7908c2ecf20Sopenharmony_ci		dm->swing_idx_ofdm_base[path] = dm->default_ofdm_index;
7918c2ecf20Sopenharmony_ci		dm->ofdm_index[path] = dm->default_ofdm_index;
7928c2ecf20Sopenharmony_ci		dm->delta_power_index[path] = 0;
7938c2ecf20Sopenharmony_ci		dm->delta_power_index_last[path] = 0;
7948c2ecf20Sopenharmony_ci		dm->power_index_offset[path] = 0;
7958c2ecf20Sopenharmony_ci	}
7968c2ecf20Sopenharmony_ci}
7978c2ecf20Sopenharmony_ci
7988c2ecf20Sopenharmony_civoid rtl92ee_dm_init_rate_adaptive_mask(struct ieee80211_hw *hw)
7998c2ecf20Sopenharmony_ci{
8008c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
8018c2ecf20Sopenharmony_ci	struct rate_adaptive *p_ra = &rtlpriv->ra;
8028c2ecf20Sopenharmony_ci
8038c2ecf20Sopenharmony_ci	p_ra->ratr_state = DM_RATR_STA_INIT;
8048c2ecf20Sopenharmony_ci	p_ra->pre_ratr_state = DM_RATR_STA_INIT;
8058c2ecf20Sopenharmony_ci
8068c2ecf20Sopenharmony_ci	if (rtlpriv->dm.dm_type == DM_TYPE_BYDRIVER)
8078c2ecf20Sopenharmony_ci		rtlpriv->dm.useramask = true;
8088c2ecf20Sopenharmony_ci	else
8098c2ecf20Sopenharmony_ci		rtlpriv->dm.useramask = false;
8108c2ecf20Sopenharmony_ci
8118c2ecf20Sopenharmony_ci	p_ra->ldpc_thres = 35;
8128c2ecf20Sopenharmony_ci	p_ra->use_ldpc = false;
8138c2ecf20Sopenharmony_ci	p_ra->high_rssi_thresh_for_ra = 50;
8148c2ecf20Sopenharmony_ci	p_ra->low_rssi_thresh_for_ra40m = 20;
8158c2ecf20Sopenharmony_ci}
8168c2ecf20Sopenharmony_ci
8178c2ecf20Sopenharmony_cistatic bool _rtl92ee_dm_ra_state_check(struct ieee80211_hw *hw,
8188c2ecf20Sopenharmony_ci				       s32 rssi, u8 *ratr_state)
8198c2ecf20Sopenharmony_ci{
8208c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
8218c2ecf20Sopenharmony_ci	struct rate_adaptive *p_ra = &rtlpriv->ra;
8228c2ecf20Sopenharmony_ci	const u8 go_up_gap = 5;
8238c2ecf20Sopenharmony_ci	u32 high_rssithresh_for_ra = p_ra->high_rssi_thresh_for_ra;
8248c2ecf20Sopenharmony_ci	u32 low_rssithresh_for_ra = p_ra->low_rssi_thresh_for_ra40m;
8258c2ecf20Sopenharmony_ci	u8 state;
8268c2ecf20Sopenharmony_ci
8278c2ecf20Sopenharmony_ci	/* Threshold Adjustment:
8288c2ecf20Sopenharmony_ci	 * when RSSI state trends to go up one or two levels,
8298c2ecf20Sopenharmony_ci	 * make sure RSSI is high enough.
8308c2ecf20Sopenharmony_ci	 * Here GoUpGap is added to solve
8318c2ecf20Sopenharmony_ci	 * the boundary's level alternation issue.
8328c2ecf20Sopenharmony_ci	 */
8338c2ecf20Sopenharmony_ci	switch (*ratr_state) {
8348c2ecf20Sopenharmony_ci	case DM_RATR_STA_INIT:
8358c2ecf20Sopenharmony_ci	case DM_RATR_STA_HIGH:
8368c2ecf20Sopenharmony_ci		break;
8378c2ecf20Sopenharmony_ci	case DM_RATR_STA_MIDDLE:
8388c2ecf20Sopenharmony_ci		high_rssithresh_for_ra += go_up_gap;
8398c2ecf20Sopenharmony_ci		break;
8408c2ecf20Sopenharmony_ci	case DM_RATR_STA_LOW:
8418c2ecf20Sopenharmony_ci		high_rssithresh_for_ra += go_up_gap;
8428c2ecf20Sopenharmony_ci		low_rssithresh_for_ra += go_up_gap;
8438c2ecf20Sopenharmony_ci		break;
8448c2ecf20Sopenharmony_ci	default:
8458c2ecf20Sopenharmony_ci		rtl_dbg(rtlpriv, COMP_RATR, DBG_DMESG,
8468c2ecf20Sopenharmony_ci			"wrong rssi level setting %d !\n", *ratr_state);
8478c2ecf20Sopenharmony_ci		break;
8488c2ecf20Sopenharmony_ci	}
8498c2ecf20Sopenharmony_ci
8508c2ecf20Sopenharmony_ci	/* Decide RATRState by RSSI. */
8518c2ecf20Sopenharmony_ci	if (rssi > high_rssithresh_for_ra)
8528c2ecf20Sopenharmony_ci		state = DM_RATR_STA_HIGH;
8538c2ecf20Sopenharmony_ci	else if (rssi > low_rssithresh_for_ra)
8548c2ecf20Sopenharmony_ci		state = DM_RATR_STA_MIDDLE;
8558c2ecf20Sopenharmony_ci	else
8568c2ecf20Sopenharmony_ci		state = DM_RATR_STA_LOW;
8578c2ecf20Sopenharmony_ci
8588c2ecf20Sopenharmony_ci	if (*ratr_state != state) {
8598c2ecf20Sopenharmony_ci		*ratr_state = state;
8608c2ecf20Sopenharmony_ci		return true;
8618c2ecf20Sopenharmony_ci	}
8628c2ecf20Sopenharmony_ci
8638c2ecf20Sopenharmony_ci	return false;
8648c2ecf20Sopenharmony_ci}
8658c2ecf20Sopenharmony_ci
8668c2ecf20Sopenharmony_cistatic void rtl92ee_dm_refresh_rate_adaptive_mask(struct ieee80211_hw *hw)
8678c2ecf20Sopenharmony_ci{
8688c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
8698c2ecf20Sopenharmony_ci	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
8708c2ecf20Sopenharmony_ci	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
8718c2ecf20Sopenharmony_ci	struct rate_adaptive *p_ra = &rtlpriv->ra;
8728c2ecf20Sopenharmony_ci	struct ieee80211_sta *sta = NULL;
8738c2ecf20Sopenharmony_ci
8748c2ecf20Sopenharmony_ci	if (is_hal_stop(rtlhal)) {
8758c2ecf20Sopenharmony_ci		rtl_dbg(rtlpriv, COMP_RATE, DBG_LOUD,
8768c2ecf20Sopenharmony_ci			"driver is going to unload\n");
8778c2ecf20Sopenharmony_ci		return;
8788c2ecf20Sopenharmony_ci	}
8798c2ecf20Sopenharmony_ci
8808c2ecf20Sopenharmony_ci	if (!rtlpriv->dm.useramask) {
8818c2ecf20Sopenharmony_ci		rtl_dbg(rtlpriv, COMP_RATE, DBG_LOUD,
8828c2ecf20Sopenharmony_ci			"driver does not control rate adaptive mask\n");
8838c2ecf20Sopenharmony_ci		return;
8848c2ecf20Sopenharmony_ci	}
8858c2ecf20Sopenharmony_ci
8868c2ecf20Sopenharmony_ci	if (mac->link_state == MAC80211_LINKED &&
8878c2ecf20Sopenharmony_ci	    mac->opmode == NL80211_IFTYPE_STATION) {
8888c2ecf20Sopenharmony_ci		if (rtlpriv->dm.undec_sm_pwdb < p_ra->ldpc_thres) {
8898c2ecf20Sopenharmony_ci			p_ra->use_ldpc = true;
8908c2ecf20Sopenharmony_ci			p_ra->lower_rts_rate = true;
8918c2ecf20Sopenharmony_ci		} else if (rtlpriv->dm.undec_sm_pwdb >
8928c2ecf20Sopenharmony_ci			   (p_ra->ldpc_thres - 5)) {
8938c2ecf20Sopenharmony_ci			p_ra->use_ldpc = false;
8948c2ecf20Sopenharmony_ci			p_ra->lower_rts_rate = false;
8958c2ecf20Sopenharmony_ci		}
8968c2ecf20Sopenharmony_ci		if (_rtl92ee_dm_ra_state_check(hw, rtlpriv->dm.undec_sm_pwdb,
8978c2ecf20Sopenharmony_ci					       &p_ra->ratr_state)) {
8988c2ecf20Sopenharmony_ci			rcu_read_lock();
8998c2ecf20Sopenharmony_ci			sta = rtl_find_sta(hw, mac->bssid);
9008c2ecf20Sopenharmony_ci			if (sta)
9018c2ecf20Sopenharmony_ci				rtlpriv->cfg->ops->update_rate_tbl(hw, sta,
9028c2ecf20Sopenharmony_ci							      p_ra->ratr_state,
9038c2ecf20Sopenharmony_ci							      true);
9048c2ecf20Sopenharmony_ci			rcu_read_unlock();
9058c2ecf20Sopenharmony_ci
9068c2ecf20Sopenharmony_ci			p_ra->pre_ratr_state = p_ra->ratr_state;
9078c2ecf20Sopenharmony_ci		}
9088c2ecf20Sopenharmony_ci	}
9098c2ecf20Sopenharmony_ci}
9108c2ecf20Sopenharmony_ci
9118c2ecf20Sopenharmony_cistatic void rtl92ee_dm_init_dynamic_atc_switch(struct ieee80211_hw *hw)
9128c2ecf20Sopenharmony_ci{
9138c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
9148c2ecf20Sopenharmony_ci
9158c2ecf20Sopenharmony_ci	rtlpriv->dm.crystal_cap = rtlpriv->efuse.crystalcap;
9168c2ecf20Sopenharmony_ci
9178c2ecf20Sopenharmony_ci	rtlpriv->dm.atc_status = rtl_get_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11));
9188c2ecf20Sopenharmony_ci	rtlpriv->dm.cfo_threshold = CFO_THRESHOLD_XTAL;
9198c2ecf20Sopenharmony_ci}
9208c2ecf20Sopenharmony_ci
9218c2ecf20Sopenharmony_civoid rtl92ee_dm_init(struct ieee80211_hw *hw)
9228c2ecf20Sopenharmony_ci{
9238c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
9248c2ecf20Sopenharmony_ci	u32 cur_igvalue = rtl_get_bbreg(hw, DM_REG_IGI_A_11N, DM_BIT_IGI_11N);
9258c2ecf20Sopenharmony_ci
9268c2ecf20Sopenharmony_ci	rtlpriv->dm.dm_type = DM_TYPE_BYDRIVER;
9278c2ecf20Sopenharmony_ci
9288c2ecf20Sopenharmony_ci	rtl_dm_diginit(hw, cur_igvalue);
9298c2ecf20Sopenharmony_ci	rtl92ee_dm_init_rate_adaptive_mask(hw);
9308c2ecf20Sopenharmony_ci	rtl92ee_dm_init_primary_cca_check(hw);
9318c2ecf20Sopenharmony_ci	rtl92ee_dm_init_edca_turbo(hw);
9328c2ecf20Sopenharmony_ci	rtl92ee_dm_init_txpower_tracking(hw);
9338c2ecf20Sopenharmony_ci	rtl92ee_dm_init_dynamic_atc_switch(hw);
9348c2ecf20Sopenharmony_ci}
9358c2ecf20Sopenharmony_ci
9368c2ecf20Sopenharmony_cistatic void rtl92ee_dm_common_info_self_update(struct ieee80211_hw *hw)
9378c2ecf20Sopenharmony_ci{
9388c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
9398c2ecf20Sopenharmony_ci	struct rtl_sta_info *drv_priv;
9408c2ecf20Sopenharmony_ci	u8 cnt = 0;
9418c2ecf20Sopenharmony_ci
9428c2ecf20Sopenharmony_ci	rtlpriv->dm.one_entry_only = false;
9438c2ecf20Sopenharmony_ci
9448c2ecf20Sopenharmony_ci	if (rtlpriv->mac80211.opmode == NL80211_IFTYPE_STATION &&
9458c2ecf20Sopenharmony_ci	    rtlpriv->mac80211.link_state >= MAC80211_LINKED) {
9468c2ecf20Sopenharmony_ci		rtlpriv->dm.one_entry_only = true;
9478c2ecf20Sopenharmony_ci		return;
9488c2ecf20Sopenharmony_ci	}
9498c2ecf20Sopenharmony_ci
9508c2ecf20Sopenharmony_ci	if (rtlpriv->mac80211.opmode == NL80211_IFTYPE_AP ||
9518c2ecf20Sopenharmony_ci	    rtlpriv->mac80211.opmode == NL80211_IFTYPE_ADHOC ||
9528c2ecf20Sopenharmony_ci	    rtlpriv->mac80211.opmode == NL80211_IFTYPE_MESH_POINT) {
9538c2ecf20Sopenharmony_ci		spin_lock_bh(&rtlpriv->locks.entry_list_lock);
9548c2ecf20Sopenharmony_ci		list_for_each_entry(drv_priv, &rtlpriv->entry_list, list) {
9558c2ecf20Sopenharmony_ci			cnt++;
9568c2ecf20Sopenharmony_ci		}
9578c2ecf20Sopenharmony_ci		spin_unlock_bh(&rtlpriv->locks.entry_list_lock);
9588c2ecf20Sopenharmony_ci
9598c2ecf20Sopenharmony_ci		if (cnt == 1)
9608c2ecf20Sopenharmony_ci			rtlpriv->dm.one_entry_only = true;
9618c2ecf20Sopenharmony_ci	}
9628c2ecf20Sopenharmony_ci}
9638c2ecf20Sopenharmony_ci
9648c2ecf20Sopenharmony_civoid rtl92ee_dm_dynamic_arfb_select(struct ieee80211_hw *hw,
9658c2ecf20Sopenharmony_ci				    u8 rate, bool collision_state)
9668c2ecf20Sopenharmony_ci{
9678c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
9688c2ecf20Sopenharmony_ci
9698c2ecf20Sopenharmony_ci	if (rate >= DESC92C_RATEMCS8  && rate <= DESC92C_RATEMCS12) {
9708c2ecf20Sopenharmony_ci		if (collision_state == 1) {
9718c2ecf20Sopenharmony_ci			if (rate == DESC92C_RATEMCS12) {
9728c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
9738c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
9748c2ecf20Sopenharmony_ci						0x07060501);
9758c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS11) {
9768c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
9778c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
9788c2ecf20Sopenharmony_ci						0x07070605);
9798c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS10) {
9808c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
9818c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
9828c2ecf20Sopenharmony_ci						0x08080706);
9838c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS9) {
9848c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
9858c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
9868c2ecf20Sopenharmony_ci						0x08080707);
9878c2ecf20Sopenharmony_ci			} else {
9888c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
9898c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
9908c2ecf20Sopenharmony_ci						0x09090808);
9918c2ecf20Sopenharmony_ci			}
9928c2ecf20Sopenharmony_ci		} else {   /* collision_state == 0 */
9938c2ecf20Sopenharmony_ci			if (rate == DESC92C_RATEMCS12) {
9948c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
9958c2ecf20Sopenharmony_ci						0x05010000);
9968c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
9978c2ecf20Sopenharmony_ci						0x09080706);
9988c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS11) {
9998c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10008c2ecf20Sopenharmony_ci						0x06050000);
10018c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10028c2ecf20Sopenharmony_ci						0x09080807);
10038c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS10) {
10048c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10058c2ecf20Sopenharmony_ci						0x07060000);
10068c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10078c2ecf20Sopenharmony_ci						0x0a090908);
10088c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS9) {
10098c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10108c2ecf20Sopenharmony_ci						0x07070000);
10118c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10128c2ecf20Sopenharmony_ci						0x0a090808);
10138c2ecf20Sopenharmony_ci			} else {
10148c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10158c2ecf20Sopenharmony_ci						0x08080000);
10168c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10178c2ecf20Sopenharmony_ci						0x0b0a0909);
10188c2ecf20Sopenharmony_ci			}
10198c2ecf20Sopenharmony_ci		}
10208c2ecf20Sopenharmony_ci	} else {  /* MCS13~MCS15,  1SS, G-mode */
10218c2ecf20Sopenharmony_ci		if (collision_state == 1) {
10228c2ecf20Sopenharmony_ci			if (rate == DESC92C_RATEMCS15) {
10238c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10248c2ecf20Sopenharmony_ci						0x00000000);
10258c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10268c2ecf20Sopenharmony_ci						0x05040302);
10278c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS14) {
10288c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10298c2ecf20Sopenharmony_ci						0x00000000);
10308c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10318c2ecf20Sopenharmony_ci						0x06050302);
10328c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS13) {
10338c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10348c2ecf20Sopenharmony_ci						0x00000000);
10358c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10368c2ecf20Sopenharmony_ci						0x07060502);
10378c2ecf20Sopenharmony_ci			} else {
10388c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10398c2ecf20Sopenharmony_ci						0x00000000);
10408c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10418c2ecf20Sopenharmony_ci						0x06050402);
10428c2ecf20Sopenharmony_ci			}
10438c2ecf20Sopenharmony_ci		} else{   /* collision_state == 0 */
10448c2ecf20Sopenharmony_ci			if (rate == DESC92C_RATEMCS15) {
10458c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10468c2ecf20Sopenharmony_ci						0x03020000);
10478c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10488c2ecf20Sopenharmony_ci						0x07060504);
10498c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS14) {
10508c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10518c2ecf20Sopenharmony_ci						0x03020000);
10528c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10538c2ecf20Sopenharmony_ci						0x08070605);
10548c2ecf20Sopenharmony_ci			} else if (rate == DESC92C_RATEMCS13) {
10558c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10568c2ecf20Sopenharmony_ci						0x05020000);
10578c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10588c2ecf20Sopenharmony_ci						0x09080706);
10598c2ecf20Sopenharmony_ci			} else {
10608c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC,
10618c2ecf20Sopenharmony_ci						0x04020000);
10628c2ecf20Sopenharmony_ci				rtl_write_dword(rtlpriv, REG_DARFRC + 4,
10638c2ecf20Sopenharmony_ci						0x08070605);
10648c2ecf20Sopenharmony_ci			}
10658c2ecf20Sopenharmony_ci		}
10668c2ecf20Sopenharmony_ci	}
10678c2ecf20Sopenharmony_ci}
10688c2ecf20Sopenharmony_ci
10698c2ecf20Sopenharmony_civoid rtl92ee_dm_watchdog(struct ieee80211_hw *hw)
10708c2ecf20Sopenharmony_ci{
10718c2ecf20Sopenharmony_ci	struct rtl_priv *rtlpriv = rtl_priv(hw);
10728c2ecf20Sopenharmony_ci	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
10738c2ecf20Sopenharmony_ci	bool fw_current_inpsmode = false;
10748c2ecf20Sopenharmony_ci	bool fw_ps_awake = true;
10758c2ecf20Sopenharmony_ci
10768c2ecf20Sopenharmony_ci	rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FW_PSMODE_STATUS,
10778c2ecf20Sopenharmony_ci				      (u8 *)(&fw_current_inpsmode));
10788c2ecf20Sopenharmony_ci	rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FWLPS_RF_ON,
10798c2ecf20Sopenharmony_ci				      (u8 *)(&fw_ps_awake));
10808c2ecf20Sopenharmony_ci	if (ppsc->p2p_ps_info.p2p_ps_mode)
10818c2ecf20Sopenharmony_ci		fw_ps_awake = false;
10828c2ecf20Sopenharmony_ci
10838c2ecf20Sopenharmony_ci	spin_lock(&rtlpriv->locks.rf_ps_lock);
10848c2ecf20Sopenharmony_ci	if ((ppsc->rfpwr_state == ERFON) &&
10858c2ecf20Sopenharmony_ci	    ((!fw_current_inpsmode) && fw_ps_awake) &&
10868c2ecf20Sopenharmony_ci	    (!ppsc->rfchange_inprogress)) {
10878c2ecf20Sopenharmony_ci		rtl92ee_dm_common_info_self_update(hw);
10888c2ecf20Sopenharmony_ci		rtl92ee_dm_false_alarm_counter_statistics(hw);
10898c2ecf20Sopenharmony_ci		rtl92ee_dm_check_rssi_monitor(hw);
10908c2ecf20Sopenharmony_ci		rtl92ee_dm_dig(hw);
10918c2ecf20Sopenharmony_ci		rtl92ee_dm_adaptivity(hw);
10928c2ecf20Sopenharmony_ci		rtl92ee_dm_cck_packet_detection_thresh(hw);
10938c2ecf20Sopenharmony_ci		rtl92ee_dm_refresh_rate_adaptive_mask(hw);
10948c2ecf20Sopenharmony_ci		rtl92ee_dm_check_edca_turbo(hw);
10958c2ecf20Sopenharmony_ci		rtl92ee_dm_dynamic_atc_switch(hw);
10968c2ecf20Sopenharmony_ci		rtl92ee_dm_dynamic_primary_cca_ckeck(hw);
10978c2ecf20Sopenharmony_ci	}
10988c2ecf20Sopenharmony_ci	spin_unlock(&rtlpriv->locks.rf_ps_lock);
10998c2ecf20Sopenharmony_ci}
1100