1647f21b1SLarry Finger // SPDX-License-Identifier: GPL-2.0
2647f21b1SLarry Finger /* Copyright(c) 2009-2014 Realtek Corporation.*/
3f1d2b4d3SLarry Finger
4f1d2b4d3SLarry Finger #include "../wifi.h"
5f1d2b4d3SLarry Finger #include "../base.h"
6f1d2b4d3SLarry Finger #include "../pci.h"
7f1d2b4d3SLarry Finger #include "../core.h"
8f1d2b4d3SLarry Finger #include "reg.h"
9f1d2b4d3SLarry Finger #include "def.h"
10f1d2b4d3SLarry Finger #include "phy.h"
11f1d2b4d3SLarry Finger #include "dm.h"
12f1d2b4d3SLarry Finger #include "fw.h"
13f1d2b4d3SLarry Finger #include "trx.h"
14f1d2b4d3SLarry Finger
rtl92ee_dm_false_alarm_counter_statistics(struct ieee80211_hw * hw)15f1d2b4d3SLarry Finger static void rtl92ee_dm_false_alarm_counter_statistics(struct ieee80211_hw *hw)
16f1d2b4d3SLarry Finger {
17f1d2b4d3SLarry Finger u32 ret_value;
18f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
19f1d2b4d3SLarry Finger struct false_alarm_statistics *falsealm_cnt = &rtlpriv->falsealm_cnt;
20f1d2b4d3SLarry Finger
21f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_HOLDC_11N, BIT(31), 1);
22f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(31), 1);
23f1d2b4d3SLarry Finger
24f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE1_11N, MASKDWORD);
25f1d2b4d3SLarry Finger falsealm_cnt->cnt_fast_fsync_fail = (ret_value & 0xffff);
26f1d2b4d3SLarry Finger falsealm_cnt->cnt_sb_search_fail = ((ret_value & 0xffff0000) >> 16);
27f1d2b4d3SLarry Finger
28f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE2_11N, MASKDWORD);
29f1d2b4d3SLarry Finger falsealm_cnt->cnt_ofdm_cca = (ret_value & 0xffff);
30f1d2b4d3SLarry Finger falsealm_cnt->cnt_parity_fail = ((ret_value & 0xffff0000) >> 16);
31f1d2b4d3SLarry Finger
32f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE3_11N, MASKDWORD);
33f1d2b4d3SLarry Finger falsealm_cnt->cnt_rate_illegal = (ret_value & 0xffff);
34f1d2b4d3SLarry Finger falsealm_cnt->cnt_crc8_fail = ((ret_value & 0xffff0000) >> 16);
35f1d2b4d3SLarry Finger
36f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_OFDM_FA_TYPE4_11N, MASKDWORD);
37f1d2b4d3SLarry Finger falsealm_cnt->cnt_mcs_fail = (ret_value & 0xffff);
38f1d2b4d3SLarry Finger
39f1d2b4d3SLarry Finger falsealm_cnt->cnt_ofdm_fail = falsealm_cnt->cnt_parity_fail +
40f1d2b4d3SLarry Finger falsealm_cnt->cnt_rate_illegal +
41f1d2b4d3SLarry Finger falsealm_cnt->cnt_crc8_fail +
42f1d2b4d3SLarry Finger falsealm_cnt->cnt_mcs_fail +
43f1d2b4d3SLarry Finger falsealm_cnt->cnt_fast_fsync_fail +
44f1d2b4d3SLarry Finger falsealm_cnt->cnt_sb_search_fail;
45f1d2b4d3SLarry Finger
46f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_SC_CNT_11N, MASKDWORD);
47f1d2b4d3SLarry Finger falsealm_cnt->cnt_bw_lsc = (ret_value & 0xffff);
48f1d2b4d3SLarry Finger falsealm_cnt->cnt_bw_usc = ((ret_value & 0xffff0000) >> 16);
49f1d2b4d3SLarry Finger
50f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(12), 1);
51f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(14), 1);
52f1d2b4d3SLarry Finger
53f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_CCK_FA_LSB_11N, MASKBYTE0);
54f1d2b4d3SLarry Finger falsealm_cnt->cnt_cck_fail = ret_value;
55f1d2b4d3SLarry Finger
56f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_CCK_FA_MSB_11N, MASKBYTE3);
57f1d2b4d3SLarry Finger falsealm_cnt->cnt_cck_fail += (ret_value & 0xff) << 8;
58f1d2b4d3SLarry Finger
59f1d2b4d3SLarry Finger ret_value = rtl_get_bbreg(hw, DM_REG_CCK_CCA_CNT_11N, MASKDWORD);
60f1d2b4d3SLarry Finger falsealm_cnt->cnt_cck_cca = ((ret_value & 0xff) << 8) |
61f1d2b4d3SLarry Finger ((ret_value & 0xFF00) >> 8);
62f1d2b4d3SLarry Finger
63f1d2b4d3SLarry Finger falsealm_cnt->cnt_all = falsealm_cnt->cnt_fast_fsync_fail +
64f1d2b4d3SLarry Finger falsealm_cnt->cnt_sb_search_fail +
65f1d2b4d3SLarry Finger falsealm_cnt->cnt_parity_fail +
66f1d2b4d3SLarry Finger falsealm_cnt->cnt_rate_illegal +
67f1d2b4d3SLarry Finger falsealm_cnt->cnt_crc8_fail +
68f1d2b4d3SLarry Finger falsealm_cnt->cnt_mcs_fail +
69f1d2b4d3SLarry Finger falsealm_cnt->cnt_cck_fail;
70f1d2b4d3SLarry Finger
71f1d2b4d3SLarry Finger falsealm_cnt->cnt_cca_all = falsealm_cnt->cnt_ofdm_cca +
72f1d2b4d3SLarry Finger falsealm_cnt->cnt_cck_cca;
73f1d2b4d3SLarry Finger
74f1d2b4d3SLarry Finger /*reset false alarm counter registers*/
75f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTC_11N, BIT(31), 1);
76f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTC_11N, BIT(31), 0);
77f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(27), 1);
78f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(27), 0);
79f1d2b4d3SLarry Finger /*update ofdm counter*/
80f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_HOLDC_11N, BIT(31), 0);
81f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_OFDM_FA_RSTD_11N, BIT(31), 0);
82f1d2b4d3SLarry Finger /*reset CCK CCA counter*/
83f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(13) | BIT(12), 0);
84f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(13) | BIT(12), 2);
85f1d2b4d3SLarry Finger /*reset CCK FA counter*/
86f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(15) | BIT(14), 0);
87f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_CCK_FA_RST_11N, BIT(15) | BIT(14), 2);
88f1d2b4d3SLarry Finger
89e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_DIG, DBG_TRACE,
90f1d2b4d3SLarry Finger "cnt_parity_fail = %d, cnt_rate_illegal = %d, cnt_crc8_fail = %d, cnt_mcs_fail = %d\n",
91f1d2b4d3SLarry Finger falsealm_cnt->cnt_parity_fail,
92f1d2b4d3SLarry Finger falsealm_cnt->cnt_rate_illegal,
93f1d2b4d3SLarry Finger falsealm_cnt->cnt_crc8_fail, falsealm_cnt->cnt_mcs_fail);
94f1d2b4d3SLarry Finger
95e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_DIG, DBG_TRACE,
96f1d2b4d3SLarry Finger "cnt_ofdm_fail = %x, cnt_cck_fail = %x, cnt_all = %x\n",
97f1d2b4d3SLarry Finger falsealm_cnt->cnt_ofdm_fail,
98f1d2b4d3SLarry Finger falsealm_cnt->cnt_cck_fail, falsealm_cnt->cnt_all);
99f1d2b4d3SLarry Finger }
100f1d2b4d3SLarry Finger
rtl92ee_dm_cck_packet_detection_thresh(struct ieee80211_hw * hw)101f1d2b4d3SLarry Finger static void rtl92ee_dm_cck_packet_detection_thresh(struct ieee80211_hw *hw)
102f1d2b4d3SLarry Finger {
103f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
104f1d2b4d3SLarry Finger struct dig_t *dm_dig = &rtlpriv->dm_digtable;
105f1d2b4d3SLarry Finger u8 cur_cck_cca_thresh;
106f1d2b4d3SLarry Finger
107f1d2b4d3SLarry Finger if (rtlpriv->mac80211.link_state >= MAC80211_LINKED) {
108f1d2b4d3SLarry Finger if (dm_dig->rssi_val_min > 25) {
109f1d2b4d3SLarry Finger cur_cck_cca_thresh = 0xcd;
110f1d2b4d3SLarry Finger } else if ((dm_dig->rssi_val_min <= 25) &&
111f1d2b4d3SLarry Finger (dm_dig->rssi_val_min > 10)) {
112f1d2b4d3SLarry Finger cur_cck_cca_thresh = 0x83;
113f1d2b4d3SLarry Finger } else {
114f1d2b4d3SLarry Finger if (rtlpriv->falsealm_cnt.cnt_cck_fail > 1000)
115f1d2b4d3SLarry Finger cur_cck_cca_thresh = 0x83;
116f1d2b4d3SLarry Finger else
117f1d2b4d3SLarry Finger cur_cck_cca_thresh = 0x40;
118f1d2b4d3SLarry Finger }
119f1d2b4d3SLarry Finger } else {
120f1d2b4d3SLarry Finger if (rtlpriv->falsealm_cnt.cnt_cck_fail > 1000)
121f1d2b4d3SLarry Finger cur_cck_cca_thresh = 0x83;
122f1d2b4d3SLarry Finger else
123f1d2b4d3SLarry Finger cur_cck_cca_thresh = 0x40;
124f1d2b4d3SLarry Finger }
125f1d2b4d3SLarry Finger rtl92ee_dm_write_cck_cca_thres(hw, cur_cck_cca_thresh);
126f1d2b4d3SLarry Finger }
127f1d2b4d3SLarry Finger
rtl92ee_dm_dig(struct ieee80211_hw * hw)128f1d2b4d3SLarry Finger static void rtl92ee_dm_dig(struct ieee80211_hw *hw)
129f1d2b4d3SLarry Finger {
130f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
131f1d2b4d3SLarry Finger struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
132f1d2b4d3SLarry Finger struct dig_t *dm_dig = &rtlpriv->dm_digtable;
133f1d2b4d3SLarry Finger u8 dig_min_0, dig_maxofmin;
134f1d2b4d3SLarry Finger bool bfirstconnect , bfirstdisconnect;
135f1d2b4d3SLarry Finger u8 dm_dig_max, dm_dig_min;
136f1d2b4d3SLarry Finger u8 current_igi = dm_dig->cur_igvalue;
137f1d2b4d3SLarry Finger u8 offset;
138f1d2b4d3SLarry Finger
139f1d2b4d3SLarry Finger /* AP,BT */
140f1d2b4d3SLarry Finger if (mac->act_scanning)
141f1d2b4d3SLarry Finger return;
142f1d2b4d3SLarry Finger
143f1d2b4d3SLarry Finger dig_min_0 = dm_dig->dig_min_0;
144f1d2b4d3SLarry Finger bfirstconnect = (mac->link_state >= MAC80211_LINKED) &&
145f1d2b4d3SLarry Finger !dm_dig->media_connect_0;
146f1d2b4d3SLarry Finger bfirstdisconnect = (mac->link_state < MAC80211_LINKED) &&
147f1d2b4d3SLarry Finger dm_dig->media_connect_0;
148f1d2b4d3SLarry Finger
149f1d2b4d3SLarry Finger dm_dig_max = 0x5a;
150f1d2b4d3SLarry Finger dm_dig_min = DM_DIG_MIN;
151f1d2b4d3SLarry Finger dig_maxofmin = DM_DIG_MAX_AP;
152f1d2b4d3SLarry Finger
153f1d2b4d3SLarry Finger if (mac->link_state >= MAC80211_LINKED) {
154f1d2b4d3SLarry Finger if ((dm_dig->rssi_val_min + 10) > dm_dig_max)
155f1d2b4d3SLarry Finger dm_dig->rx_gain_max = dm_dig_max;
156f1d2b4d3SLarry Finger else if ((dm_dig->rssi_val_min + 10) < dm_dig_min)
157f1d2b4d3SLarry Finger dm_dig->rx_gain_max = dm_dig_min;
158f1d2b4d3SLarry Finger else
159f1d2b4d3SLarry Finger dm_dig->rx_gain_max = dm_dig->rssi_val_min + 10;
160f1d2b4d3SLarry Finger
161f1d2b4d3SLarry Finger if (rtlpriv->dm.one_entry_only) {
162f1d2b4d3SLarry Finger offset = 0;
163f1d2b4d3SLarry Finger if (dm_dig->rssi_val_min - offset < dm_dig_min)
164f1d2b4d3SLarry Finger dig_min_0 = dm_dig_min;
165f1d2b4d3SLarry Finger else if (dm_dig->rssi_val_min - offset >
166f1d2b4d3SLarry Finger dig_maxofmin)
167f1d2b4d3SLarry Finger dig_min_0 = dig_maxofmin;
168f1d2b4d3SLarry Finger else
169f1d2b4d3SLarry Finger dig_min_0 = dm_dig->rssi_val_min - offset;
170f1d2b4d3SLarry Finger } else {
171f1d2b4d3SLarry Finger dig_min_0 = dm_dig_min;
172f1d2b4d3SLarry Finger }
173f1d2b4d3SLarry Finger
174f1d2b4d3SLarry Finger } else {
175f1d2b4d3SLarry Finger dm_dig->rx_gain_max = dm_dig_max;
176f1d2b4d3SLarry Finger dig_min_0 = dm_dig_min;
177e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_DIG, DBG_LOUD, "no link\n");
178f1d2b4d3SLarry Finger }
179f1d2b4d3SLarry Finger
180f1d2b4d3SLarry Finger if (rtlpriv->falsealm_cnt.cnt_all > 10000) {
181f1d2b4d3SLarry Finger if (dm_dig->large_fa_hit != 3)
182f1d2b4d3SLarry Finger dm_dig->large_fa_hit++;
183f1d2b4d3SLarry Finger if (dm_dig->forbidden_igi < current_igi) {
184f1d2b4d3SLarry Finger dm_dig->forbidden_igi = current_igi;
185f1d2b4d3SLarry Finger dm_dig->large_fa_hit = 1;
186f1d2b4d3SLarry Finger }
187f1d2b4d3SLarry Finger
188f1d2b4d3SLarry Finger if (dm_dig->large_fa_hit >= 3) {
189f1d2b4d3SLarry Finger if (dm_dig->forbidden_igi + 1 > dm_dig->rx_gain_max)
190f1d2b4d3SLarry Finger dm_dig->rx_gain_min =
191f1d2b4d3SLarry Finger dm_dig->rx_gain_max;
192f1d2b4d3SLarry Finger else
193f1d2b4d3SLarry Finger dm_dig->rx_gain_min =
194f1d2b4d3SLarry Finger dm_dig->forbidden_igi + 1;
195f1d2b4d3SLarry Finger dm_dig->recover_cnt = 3600;
196f1d2b4d3SLarry Finger }
197f1d2b4d3SLarry Finger } else {
198f1d2b4d3SLarry Finger if (dm_dig->recover_cnt != 0) {
199f1d2b4d3SLarry Finger dm_dig->recover_cnt--;
200f1d2b4d3SLarry Finger } else {
201f1d2b4d3SLarry Finger if (dm_dig->large_fa_hit < 3) {
202f1d2b4d3SLarry Finger if ((dm_dig->forbidden_igi - 1) <
203f1d2b4d3SLarry Finger dig_min_0) {
204f1d2b4d3SLarry Finger dm_dig->forbidden_igi = dig_min_0;
205f1d2b4d3SLarry Finger dm_dig->rx_gain_min =
206f1d2b4d3SLarry Finger dig_min_0;
207f1d2b4d3SLarry Finger } else {
208f1d2b4d3SLarry Finger dm_dig->forbidden_igi--;
209f1d2b4d3SLarry Finger dm_dig->rx_gain_min =
210f1d2b4d3SLarry Finger dm_dig->forbidden_igi + 1;
211f1d2b4d3SLarry Finger }
212f1d2b4d3SLarry Finger } else {
213f1d2b4d3SLarry Finger dm_dig->large_fa_hit = 0;
214f1d2b4d3SLarry Finger }
215f1d2b4d3SLarry Finger }
216f1d2b4d3SLarry Finger }
217f1d2b4d3SLarry Finger
218f1d2b4d3SLarry Finger if (rtlpriv->dm.dbginfo.num_qry_beacon_pkt < 5)
219f1d2b4d3SLarry Finger dm_dig->rx_gain_min = dm_dig_min;
220f1d2b4d3SLarry Finger
221f1d2b4d3SLarry Finger if (dm_dig->rx_gain_min > dm_dig->rx_gain_max)
222f1d2b4d3SLarry Finger dm_dig->rx_gain_min = dm_dig->rx_gain_max;
223f1d2b4d3SLarry Finger
224f1d2b4d3SLarry Finger if (mac->link_state >= MAC80211_LINKED) {
225f1d2b4d3SLarry Finger if (bfirstconnect) {
226f1d2b4d3SLarry Finger if (dm_dig->rssi_val_min <= dig_maxofmin)
227f1d2b4d3SLarry Finger current_igi = dm_dig->rssi_val_min;
228f1d2b4d3SLarry Finger else
229f1d2b4d3SLarry Finger current_igi = dig_maxofmin;
230f1d2b4d3SLarry Finger
231f1d2b4d3SLarry Finger dm_dig->large_fa_hit = 0;
232f1d2b4d3SLarry Finger } else {
233f1d2b4d3SLarry Finger if (rtlpriv->falsealm_cnt.cnt_all > DM_DIG_FA_TH2)
234f1d2b4d3SLarry Finger current_igi += 4;
235f1d2b4d3SLarry Finger else if (rtlpriv->falsealm_cnt.cnt_all > DM_DIG_FA_TH1)
236f1d2b4d3SLarry Finger current_igi += 2;
237f1d2b4d3SLarry Finger else if (rtlpriv->falsealm_cnt.cnt_all < DM_DIG_FA_TH0)
238f1d2b4d3SLarry Finger current_igi -= 2;
239f1d2b4d3SLarry Finger
240f1d2b4d3SLarry Finger if (rtlpriv->dm.dbginfo.num_qry_beacon_pkt < 5 &&
241f1d2b4d3SLarry Finger rtlpriv->falsealm_cnt.cnt_all < DM_DIG_FA_TH1)
242f1d2b4d3SLarry Finger current_igi = dm_dig->rx_gain_min;
243f1d2b4d3SLarry Finger }
244f1d2b4d3SLarry Finger } else {
245f1d2b4d3SLarry Finger if (bfirstdisconnect) {
246f1d2b4d3SLarry Finger current_igi = dm_dig->rx_gain_min;
247f1d2b4d3SLarry Finger } else {
248f1d2b4d3SLarry Finger if (rtlpriv->falsealm_cnt.cnt_all > 10000)
249f1d2b4d3SLarry Finger current_igi += 4;
250f1d2b4d3SLarry Finger else if (rtlpriv->falsealm_cnt.cnt_all > 8000)
251f1d2b4d3SLarry Finger current_igi += 2;
252f1d2b4d3SLarry Finger else if (rtlpriv->falsealm_cnt.cnt_all < 500)
253f1d2b4d3SLarry Finger current_igi -= 2;
254f1d2b4d3SLarry Finger }
255f1d2b4d3SLarry Finger }
256f1d2b4d3SLarry Finger
257f1d2b4d3SLarry Finger if (current_igi > dm_dig->rx_gain_max)
258f1d2b4d3SLarry Finger current_igi = dm_dig->rx_gain_max;
259f1d2b4d3SLarry Finger if (current_igi < dm_dig->rx_gain_min)
260f1d2b4d3SLarry Finger current_igi = dm_dig->rx_gain_min;
261f1d2b4d3SLarry Finger
262f1d2b4d3SLarry Finger rtl92ee_dm_write_dig(hw , current_igi);
263f1d2b4d3SLarry Finger dm_dig->media_connect_0 = ((mac->link_state >= MAC80211_LINKED) ?
264f1d2b4d3SLarry Finger true : false);
265f1d2b4d3SLarry Finger dm_dig->dig_min_0 = dig_min_0;
266f1d2b4d3SLarry Finger }
267f1d2b4d3SLarry Finger
rtl92ee_dm_write_cck_cca_thres(struct ieee80211_hw * hw,u8 cur_thres)268f1d2b4d3SLarry Finger void rtl92ee_dm_write_cck_cca_thres(struct ieee80211_hw *hw, u8 cur_thres)
269f1d2b4d3SLarry Finger {
270f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
271f1d2b4d3SLarry Finger struct dig_t *dm_dig = &rtlpriv->dm_digtable;
272f1d2b4d3SLarry Finger
273f1d2b4d3SLarry Finger if (dm_dig->cur_cck_cca_thres != cur_thres)
274f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, DM_REG_CCK_CCA_11N, cur_thres);
275f1d2b4d3SLarry Finger
276f1d2b4d3SLarry Finger dm_dig->pre_cck_cca_thres = dm_dig->cur_cck_cca_thres;
277f1d2b4d3SLarry Finger dm_dig->cur_cck_cca_thres = cur_thres;
278f1d2b4d3SLarry Finger }
279f1d2b4d3SLarry Finger
rtl92ee_dm_write_dig(struct ieee80211_hw * hw,u8 current_igi)280f1d2b4d3SLarry Finger void rtl92ee_dm_write_dig(struct ieee80211_hw *hw, u8 current_igi)
281f1d2b4d3SLarry Finger {
282f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
283f1d2b4d3SLarry Finger struct dig_t *dm_dig = &rtlpriv->dm_digtable;
284f1d2b4d3SLarry Finger
285f1d2b4d3SLarry Finger if (dm_dig->stop_dig)
286f1d2b4d3SLarry Finger return;
287f1d2b4d3SLarry Finger
288f1d2b4d3SLarry Finger if (dm_dig->cur_igvalue != current_igi) {
289f1d2b4d3SLarry Finger rtl_set_bbreg(hw, ROFDM0_XAAGCCORE1, 0x7f, current_igi);
290f1d2b4d3SLarry Finger if (rtlpriv->phy.rf_type != RF_1T1R)
291f1d2b4d3SLarry Finger rtl_set_bbreg(hw, ROFDM0_XBAGCCORE1, 0x7f, current_igi);
292f1d2b4d3SLarry Finger }
293f1d2b4d3SLarry Finger dm_dig->pre_igvalue = dm_dig->cur_igvalue;
294f1d2b4d3SLarry Finger dm_dig->cur_igvalue = current_igi;
295f1d2b4d3SLarry Finger }
296f1d2b4d3SLarry Finger
rtl92ee_rssi_dump_to_register(struct ieee80211_hw * hw)297f1d2b4d3SLarry Finger static void rtl92ee_rssi_dump_to_register(struct ieee80211_hw *hw)
298f1d2b4d3SLarry Finger {
299f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
300f1d2b4d3SLarry Finger
301f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, RA_RSSIDUMP,
302f1d2b4d3SLarry Finger rtlpriv->stats.rx_rssi_percentage[0]);
303f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, RB_RSSIDUMP,
304f1d2b4d3SLarry Finger rtlpriv->stats.rx_rssi_percentage[1]);
305f1d2b4d3SLarry Finger /*It seems the following values are not initialized.
306f1d2b4d3SLarry Finger *According to Windows code,
307f1d2b4d3SLarry Finger *these value will only be valid with JAGUAR chips
308f1d2b4d3SLarry Finger */
309f1d2b4d3SLarry Finger /* Rx EVM */
310f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, RS1_RXEVMDUMP, rtlpriv->stats.rx_evm_dbm[0]);
311f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, RS2_RXEVMDUMP, rtlpriv->stats.rx_evm_dbm[1]);
312f1d2b4d3SLarry Finger /* Rx SNR */
313f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, RA_RXSNRDUMP,
314f1d2b4d3SLarry Finger (u8)(rtlpriv->stats.rx_snr_db[0]));
315f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, RB_RXSNRDUMP,
316f1d2b4d3SLarry Finger (u8)(rtlpriv->stats.rx_snr_db[1]));
317f1d2b4d3SLarry Finger /* Rx Cfo_Short */
318f1d2b4d3SLarry Finger rtl_write_word(rtlpriv, RA_CFOSHORTDUMP,
319f1d2b4d3SLarry Finger rtlpriv->stats.rx_cfo_short[0]);
320f1d2b4d3SLarry Finger rtl_write_word(rtlpriv, RB_CFOSHORTDUMP,
321f1d2b4d3SLarry Finger rtlpriv->stats.rx_cfo_short[1]);
322f1d2b4d3SLarry Finger /* Rx Cfo_Tail */
323f1d2b4d3SLarry Finger rtl_write_word(rtlpriv, RA_CFOLONGDUMP, rtlpriv->stats.rx_cfo_tail[0]);
324f1d2b4d3SLarry Finger rtl_write_word(rtlpriv, RB_CFOLONGDUMP, rtlpriv->stats.rx_cfo_tail[1]);
325f1d2b4d3SLarry Finger }
326f1d2b4d3SLarry Finger
rtl92ee_dm_find_minimum_rssi(struct ieee80211_hw * hw)327f1d2b4d3SLarry Finger static void rtl92ee_dm_find_minimum_rssi(struct ieee80211_hw *hw)
328f1d2b4d3SLarry Finger {
329f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
330f1d2b4d3SLarry Finger struct dig_t *rtl_dm_dig = &rtlpriv->dm_digtable;
331f1d2b4d3SLarry Finger struct rtl_mac *mac = rtl_mac(rtlpriv);
332f1d2b4d3SLarry Finger
333f1d2b4d3SLarry Finger /* Determine the minimum RSSI */
334f1d2b4d3SLarry Finger if ((mac->link_state < MAC80211_LINKED) &&
335f1d2b4d3SLarry Finger (rtlpriv->dm.entry_min_undec_sm_pwdb == 0)) {
336f1d2b4d3SLarry Finger rtl_dm_dig->min_undec_pwdb_for_dm = 0;
337e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
338f1d2b4d3SLarry Finger "Not connected to any\n");
339f1d2b4d3SLarry Finger }
340f1d2b4d3SLarry Finger if (mac->link_state >= MAC80211_LINKED) {
341f1d2b4d3SLarry Finger if (mac->opmode == NL80211_IFTYPE_AP ||
342f1d2b4d3SLarry Finger mac->opmode == NL80211_IFTYPE_ADHOC) {
343f1d2b4d3SLarry Finger rtl_dm_dig->min_undec_pwdb_for_dm =
344f1d2b4d3SLarry Finger rtlpriv->dm.entry_min_undec_sm_pwdb;
345e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
346f1d2b4d3SLarry Finger "AP Client PWDB = 0x%lx\n",
347f1d2b4d3SLarry Finger rtlpriv->dm.entry_min_undec_sm_pwdb);
348f1d2b4d3SLarry Finger } else {
349f1d2b4d3SLarry Finger rtl_dm_dig->min_undec_pwdb_for_dm =
350f1d2b4d3SLarry Finger rtlpriv->dm.undec_sm_pwdb;
351e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
352f1d2b4d3SLarry Finger "STA Default Port PWDB = 0x%x\n",
353f1d2b4d3SLarry Finger rtl_dm_dig->min_undec_pwdb_for_dm);
354f1d2b4d3SLarry Finger }
355f1d2b4d3SLarry Finger } else {
356f1d2b4d3SLarry Finger rtl_dm_dig->min_undec_pwdb_for_dm =
357f1d2b4d3SLarry Finger rtlpriv->dm.entry_min_undec_sm_pwdb;
358e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_BB_POWERSAVING, DBG_LOUD,
3598a190237SMasanari Iida "AP Ext Port or disconnect PWDB = 0x%x\n",
360f1d2b4d3SLarry Finger rtl_dm_dig->min_undec_pwdb_for_dm);
361f1d2b4d3SLarry Finger }
362e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_DIG, DBG_LOUD,
363f1d2b4d3SLarry Finger "MinUndecoratedPWDBForDM =%d\n",
364f1d2b4d3SLarry Finger rtl_dm_dig->min_undec_pwdb_for_dm);
365f1d2b4d3SLarry Finger }
366f1d2b4d3SLarry Finger
rtl92ee_dm_check_rssi_monitor(struct ieee80211_hw * hw)367f1d2b4d3SLarry Finger static void rtl92ee_dm_check_rssi_monitor(struct ieee80211_hw *hw)
368f1d2b4d3SLarry Finger {
369f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
370f1d2b4d3SLarry Finger struct dig_t *dm_dig = &rtlpriv->dm_digtable;
371f1d2b4d3SLarry Finger struct rtl_mac *mac = rtl_mac(rtlpriv);
372f1d2b4d3SLarry Finger struct rtl_dm *dm = rtl_dm(rtlpriv);
373f1d2b4d3SLarry Finger struct rtl_sta_info *drv_priv;
374f1d2b4d3SLarry Finger u8 h2c[4] = { 0 };
375f1d2b4d3SLarry Finger long max = 0, min = 0xff;
376f1d2b4d3SLarry Finger u8 i = 0;
377f1d2b4d3SLarry Finger
378f1d2b4d3SLarry Finger if (mac->opmode == NL80211_IFTYPE_AP ||
379f1d2b4d3SLarry Finger mac->opmode == NL80211_IFTYPE_ADHOC ||
380f1d2b4d3SLarry Finger mac->opmode == NL80211_IFTYPE_MESH_POINT) {
381f1d2b4d3SLarry Finger /* AP & ADHOC & MESH */
382f1d2b4d3SLarry Finger spin_lock_bh(&rtlpriv->locks.entry_list_lock);
383f1d2b4d3SLarry Finger list_for_each_entry(drv_priv, &rtlpriv->entry_list, list) {
384f1d2b4d3SLarry Finger struct rssi_sta *stat = &drv_priv->rssi_stat;
385f1d2b4d3SLarry Finger
386f1d2b4d3SLarry Finger if (stat->undec_sm_pwdb < min)
387f1d2b4d3SLarry Finger min = stat->undec_sm_pwdb;
388f1d2b4d3SLarry Finger if (stat->undec_sm_pwdb > max)
389f1d2b4d3SLarry Finger max = stat->undec_sm_pwdb;
390f1d2b4d3SLarry Finger
391f1d2b4d3SLarry Finger h2c[3] = 0;
392f1d2b4d3SLarry Finger h2c[2] = (u8)(dm->undec_sm_pwdb & 0xFF);
393f1d2b4d3SLarry Finger h2c[1] = 0x20;
394f1d2b4d3SLarry Finger h2c[0] = ++i;
395f1d2b4d3SLarry Finger rtl92ee_fill_h2c_cmd(hw, H2C_92E_RSSI_REPORT, 4, h2c);
396f1d2b4d3SLarry Finger }
397f1d2b4d3SLarry Finger spin_unlock_bh(&rtlpriv->locks.entry_list_lock);
398f1d2b4d3SLarry Finger
399f1d2b4d3SLarry Finger /* If associated entry is found */
400f1d2b4d3SLarry Finger if (max != 0) {
401f1d2b4d3SLarry Finger dm->entry_max_undec_sm_pwdb = max;
402f1d2b4d3SLarry Finger RTPRINT(rtlpriv, FDM, DM_PWDB,
403f1d2b4d3SLarry Finger "EntryMaxPWDB = 0x%lx(%ld)\n", max, max);
404f1d2b4d3SLarry Finger } else {
405f1d2b4d3SLarry Finger dm->entry_max_undec_sm_pwdb = 0;
406f1d2b4d3SLarry Finger }
407f1d2b4d3SLarry Finger /* If associated entry is found */
408f1d2b4d3SLarry Finger if (min != 0xff) {
409f1d2b4d3SLarry Finger dm->entry_min_undec_sm_pwdb = min;
410f1d2b4d3SLarry Finger RTPRINT(rtlpriv, FDM, DM_PWDB,
411f1d2b4d3SLarry Finger "EntryMinPWDB = 0x%lx(%ld)\n", min, min);
412f1d2b4d3SLarry Finger } else {
413f1d2b4d3SLarry Finger dm->entry_min_undec_sm_pwdb = 0;
414f1d2b4d3SLarry Finger }
415f1d2b4d3SLarry Finger }
416f1d2b4d3SLarry Finger
417f1d2b4d3SLarry Finger /* Indicate Rx signal strength to FW. */
418f1d2b4d3SLarry Finger if (dm->useramask) {
419f1d2b4d3SLarry Finger h2c[3] = 0;
420f1d2b4d3SLarry Finger h2c[2] = (u8)(dm->undec_sm_pwdb & 0xFF);
421f1d2b4d3SLarry Finger h2c[1] = 0x20;
422f1d2b4d3SLarry Finger h2c[0] = 0;
423f1d2b4d3SLarry Finger rtl92ee_fill_h2c_cmd(hw, H2C_92E_RSSI_REPORT, 4, h2c);
424f1d2b4d3SLarry Finger } else {
425f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, 0x4fe, dm->undec_sm_pwdb);
426f1d2b4d3SLarry Finger }
427f1d2b4d3SLarry Finger rtl92ee_rssi_dump_to_register(hw);
428f1d2b4d3SLarry Finger rtl92ee_dm_find_minimum_rssi(hw);
429f1d2b4d3SLarry Finger dm_dig->rssi_val_min = rtlpriv->dm_digtable.min_undec_pwdb_for_dm;
430f1d2b4d3SLarry Finger }
431f1d2b4d3SLarry Finger
rtl92ee_dm_init_primary_cca_check(struct ieee80211_hw * hw)432f1d2b4d3SLarry Finger static void rtl92ee_dm_init_primary_cca_check(struct ieee80211_hw *hw)
433f1d2b4d3SLarry Finger {
434f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
435f1d2b4d3SLarry Finger struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
436f1d2b4d3SLarry Finger struct dynamic_primary_cca *primarycca = &rtlpriv->primarycca;
437f1d2b4d3SLarry Finger
438f1d2b4d3SLarry Finger rtlhal->rts_en = 0;
439f1d2b4d3SLarry Finger primarycca->dup_rts_flag = 0;
440f1d2b4d3SLarry Finger primarycca->intf_flag = 0;
441f1d2b4d3SLarry Finger primarycca->intf_type = 0;
442f1d2b4d3SLarry Finger primarycca->monitor_flag = 0;
443f1d2b4d3SLarry Finger primarycca->ch_offset = 0;
444f1d2b4d3SLarry Finger primarycca->mf_state = 0;
445f1d2b4d3SLarry Finger }
446f1d2b4d3SLarry Finger
rtl92ee_dm_is_edca_turbo_disable(struct ieee80211_hw * hw)447f1d2b4d3SLarry Finger static bool rtl92ee_dm_is_edca_turbo_disable(struct ieee80211_hw *hw)
448f1d2b4d3SLarry Finger {
449f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
450f1d2b4d3SLarry Finger
451f1d2b4d3SLarry Finger if (rtlpriv->mac80211.mode == WIRELESS_MODE_B)
452f1d2b4d3SLarry Finger return true;
453f1d2b4d3SLarry Finger
454f1d2b4d3SLarry Finger return false;
455f1d2b4d3SLarry Finger }
456f1d2b4d3SLarry Finger
rtl92ee_dm_init_edca_turbo(struct ieee80211_hw * hw)457f1d2b4d3SLarry Finger void rtl92ee_dm_init_edca_turbo(struct ieee80211_hw *hw)
458f1d2b4d3SLarry Finger {
459f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
460f1d2b4d3SLarry Finger
461f1d2b4d3SLarry Finger rtlpriv->dm.current_turbo_edca = false;
462f1d2b4d3SLarry Finger rtlpriv->dm.is_cur_rdlstate = false;
463f1d2b4d3SLarry Finger rtlpriv->dm.is_any_nonbepkts = false;
464f1d2b4d3SLarry Finger }
465f1d2b4d3SLarry Finger
rtl92ee_dm_check_edca_turbo(struct ieee80211_hw * hw)466f1d2b4d3SLarry Finger static void rtl92ee_dm_check_edca_turbo(struct ieee80211_hw *hw)
467f1d2b4d3SLarry Finger {
468f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
469f1d2b4d3SLarry Finger
470f1d2b4d3SLarry Finger static u64 last_txok_cnt;
471f1d2b4d3SLarry Finger static u64 last_rxok_cnt;
472f1d2b4d3SLarry Finger u64 cur_txok_cnt = 0;
473f1d2b4d3SLarry Finger u64 cur_rxok_cnt = 0;
474f1d2b4d3SLarry Finger u32 edca_be_ul = 0x5ea42b;
475f1d2b4d3SLarry Finger u32 edca_be_dl = 0x5ea42b; /*not sure*/
476f1d2b4d3SLarry Finger u32 edca_be = 0x5ea42b;
477f1d2b4d3SLarry Finger bool is_cur_rdlstate;
478f1d2b4d3SLarry Finger bool b_edca_turbo_on = false;
479f1d2b4d3SLarry Finger
480f1d2b4d3SLarry Finger if (rtlpriv->dm.dbginfo.num_non_be_pkt > 0x100)
481f1d2b4d3SLarry Finger rtlpriv->dm.is_any_nonbepkts = true;
482f1d2b4d3SLarry Finger rtlpriv->dm.dbginfo.num_non_be_pkt = 0;
483f1d2b4d3SLarry Finger
484f1d2b4d3SLarry Finger cur_txok_cnt = rtlpriv->stats.txbytesunicast - last_txok_cnt;
485f1d2b4d3SLarry Finger cur_rxok_cnt = rtlpriv->stats.rxbytesunicast - last_rxok_cnt;
486f1d2b4d3SLarry Finger
487f1d2b4d3SLarry Finger /*b_bias_on_rx = false;*/
488f1d2b4d3SLarry Finger b_edca_turbo_on = ((!rtlpriv->dm.is_any_nonbepkts) &&
489f1d2b4d3SLarry Finger (!rtlpriv->dm.disable_framebursting)) ?
490f1d2b4d3SLarry Finger true : false;
491f1d2b4d3SLarry Finger
492f1d2b4d3SLarry Finger if (rtl92ee_dm_is_edca_turbo_disable(hw))
493f1d2b4d3SLarry Finger goto check_exit;
494f1d2b4d3SLarry Finger
495f1d2b4d3SLarry Finger if (b_edca_turbo_on) {
496f1d2b4d3SLarry Finger is_cur_rdlstate = (cur_rxok_cnt > cur_txok_cnt * 4) ?
497f1d2b4d3SLarry Finger true : false;
498f1d2b4d3SLarry Finger
499f1d2b4d3SLarry Finger edca_be = is_cur_rdlstate ? edca_be_dl : edca_be_ul;
500f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv , REG_EDCA_BE_PARAM , edca_be);
501f1d2b4d3SLarry Finger rtlpriv->dm.is_cur_rdlstate = is_cur_rdlstate;
502f1d2b4d3SLarry Finger rtlpriv->dm.current_turbo_edca = true;
503f1d2b4d3SLarry Finger } else {
504f1d2b4d3SLarry Finger if (rtlpriv->dm.current_turbo_edca) {
505f1d2b4d3SLarry Finger u8 tmp = AC0_BE;
506f1d2b4d3SLarry Finger
507f1d2b4d3SLarry Finger rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AC_PARAM,
508f1d2b4d3SLarry Finger (u8 *)(&tmp));
509f1d2b4d3SLarry Finger }
510f1d2b4d3SLarry Finger rtlpriv->dm.current_turbo_edca = false;
511f1d2b4d3SLarry Finger }
512f1d2b4d3SLarry Finger
513f1d2b4d3SLarry Finger check_exit:
514f1d2b4d3SLarry Finger rtlpriv->dm.is_any_nonbepkts = false;
515f1d2b4d3SLarry Finger last_txok_cnt = rtlpriv->stats.txbytesunicast;
516f1d2b4d3SLarry Finger last_rxok_cnt = rtlpriv->stats.rxbytesunicast;
517f1d2b4d3SLarry Finger }
518f1d2b4d3SLarry Finger
rtl92ee_dm_dynamic_edcca(struct ieee80211_hw * hw)519f1d2b4d3SLarry Finger static void rtl92ee_dm_dynamic_edcca(struct ieee80211_hw *hw)
520f1d2b4d3SLarry Finger {
521f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
522f1d2b4d3SLarry Finger u8 reg_c50 , reg_c58;
523f1d2b4d3SLarry Finger bool fw_current_in_ps_mode = false;
524f1d2b4d3SLarry Finger
525f1d2b4d3SLarry Finger rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FW_PSMODE_STATUS,
526f1d2b4d3SLarry Finger (u8 *)(&fw_current_in_ps_mode));
527f1d2b4d3SLarry Finger if (fw_current_in_ps_mode)
528f1d2b4d3SLarry Finger return;
529f1d2b4d3SLarry Finger
530f1d2b4d3SLarry Finger reg_c50 = rtl_get_bbreg(hw, ROFDM0_XAAGCCORE1, MASKBYTE0);
531f1d2b4d3SLarry Finger reg_c58 = rtl_get_bbreg(hw, ROFDM0_XBAGCCORE1, MASKBYTE0);
532f1d2b4d3SLarry Finger
533f1d2b4d3SLarry Finger if (reg_c50 > 0x28 && reg_c58 > 0x28) {
534f1d2b4d3SLarry Finger if (!rtlpriv->rtlhal.pre_edcca_enable) {
535f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD, 0x03);
536f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD + 2, 0x00);
537f1d2b4d3SLarry Finger rtlpriv->rtlhal.pre_edcca_enable = true;
538f1d2b4d3SLarry Finger }
539f1d2b4d3SLarry Finger } else if (reg_c50 < 0x25 && reg_c58 < 0x25) {
540f1d2b4d3SLarry Finger if (rtlpriv->rtlhal.pre_edcca_enable) {
541f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD, 0x7f);
542f1d2b4d3SLarry Finger rtl_write_byte(rtlpriv, ROFDM0_ECCATHRESHOLD + 2, 0x7f);
543f1d2b4d3SLarry Finger rtlpriv->rtlhal.pre_edcca_enable = false;
544f1d2b4d3SLarry Finger }
545f1d2b4d3SLarry Finger }
546f1d2b4d3SLarry Finger }
547f1d2b4d3SLarry Finger
rtl92ee_dm_adaptivity(struct ieee80211_hw * hw)548f1d2b4d3SLarry Finger static void rtl92ee_dm_adaptivity(struct ieee80211_hw *hw)
549f1d2b4d3SLarry Finger {
550f1d2b4d3SLarry Finger rtl92ee_dm_dynamic_edcca(hw);
551f1d2b4d3SLarry Finger }
552f1d2b4d3SLarry Finger
rtl92ee_dm_write_dynamic_cca(struct ieee80211_hw * hw,u8 cur_mf_state)553f1d2b4d3SLarry Finger static void rtl92ee_dm_write_dynamic_cca(struct ieee80211_hw *hw,
554f1d2b4d3SLarry Finger u8 cur_mf_state)
555f1d2b4d3SLarry Finger {
556f1d2b4d3SLarry Finger struct dynamic_primary_cca *primarycca = &rtl_priv(hw)->primarycca;
557f1d2b4d3SLarry Finger
558f1d2b4d3SLarry Finger if (primarycca->mf_state != cur_mf_state)
559f1d2b4d3SLarry Finger rtl_set_bbreg(hw, DM_REG_L1SBD_PD_CH_11N, BIT(8) | BIT(7),
560f1d2b4d3SLarry Finger cur_mf_state);
561f1d2b4d3SLarry Finger
562f1d2b4d3SLarry Finger primarycca->mf_state = cur_mf_state;
563f1d2b4d3SLarry Finger }
564f1d2b4d3SLarry Finger
rtl92ee_dm_dynamic_primary_cca_ckeck(struct ieee80211_hw * hw)565f1d2b4d3SLarry Finger static void rtl92ee_dm_dynamic_primary_cca_ckeck(struct ieee80211_hw *hw)
566f1d2b4d3SLarry Finger {
567f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
568f1d2b4d3SLarry Finger struct false_alarm_statistics *falsealm_cnt = &rtlpriv->falsealm_cnt;
569f1d2b4d3SLarry Finger struct dynamic_primary_cca *primarycca = &rtlpriv->primarycca;
570f1d2b4d3SLarry Finger bool is40mhz = false;
571f1d2b4d3SLarry Finger u64 ofdm_cca, ofdm_fa, bw_usc_cnt, bw_lsc_cnt;
572f1d2b4d3SLarry Finger u8 sec_ch_offset;
573f1d2b4d3SLarry Finger u8 cur_mf_state;
574f1d2b4d3SLarry Finger static u8 count_down = MONITOR_TIME;
575f1d2b4d3SLarry Finger
576f1d2b4d3SLarry Finger ofdm_cca = falsealm_cnt->cnt_ofdm_cca;
577f1d2b4d3SLarry Finger ofdm_fa = falsealm_cnt->cnt_ofdm_fail;
578f1d2b4d3SLarry Finger bw_usc_cnt = falsealm_cnt->cnt_bw_usc;
579f1d2b4d3SLarry Finger bw_lsc_cnt = falsealm_cnt->cnt_bw_lsc;
580f1d2b4d3SLarry Finger is40mhz = rtlpriv->mac80211.bw_40;
581f1d2b4d3SLarry Finger sec_ch_offset = rtlpriv->mac80211.cur_40_prime_sc;
582f1d2b4d3SLarry Finger /* NIC: 2: sec is below, 1: sec is above */
583f1d2b4d3SLarry Finger
584f1d2b4d3SLarry Finger if (rtlpriv->mac80211.opmode == NL80211_IFTYPE_AP) {
585f1d2b4d3SLarry Finger cur_mf_state = MF_USC_LSC;
586f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
587f1d2b4d3SLarry Finger return;
588f1d2b4d3SLarry Finger }
589f1d2b4d3SLarry Finger
590f1d2b4d3SLarry Finger if (rtlpriv->mac80211.link_state < MAC80211_LINKED)
591f1d2b4d3SLarry Finger return;
592f1d2b4d3SLarry Finger
593f1d2b4d3SLarry Finger if (is40mhz)
594f1d2b4d3SLarry Finger return;
595f1d2b4d3SLarry Finger
596f1d2b4d3SLarry Finger if (primarycca->pricca_flag == 0) {
597f1d2b4d3SLarry Finger /* Primary channel is above
598f1d2b4d3SLarry Finger * NOTE: duplicate CTS can remove this condition
599f1d2b4d3SLarry Finger */
600f1d2b4d3SLarry Finger if (sec_ch_offset == 2) {
601f1d2b4d3SLarry Finger if ((ofdm_cca > OFDMCCA_TH) &&
602f1d2b4d3SLarry Finger (bw_lsc_cnt > (bw_usc_cnt + BW_IND_BIAS)) &&
603f1d2b4d3SLarry Finger (ofdm_fa > (ofdm_cca >> 1))) {
604f1d2b4d3SLarry Finger primarycca->intf_type = 1;
605f1d2b4d3SLarry Finger primarycca->intf_flag = 1;
606f1d2b4d3SLarry Finger cur_mf_state = MF_USC;
607f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
608f1d2b4d3SLarry Finger primarycca->pricca_flag = 1;
609f1d2b4d3SLarry Finger } else if ((ofdm_cca > OFDMCCA_TH) &&
610f1d2b4d3SLarry Finger (bw_lsc_cnt > (bw_usc_cnt + BW_IND_BIAS)) &&
611f1d2b4d3SLarry Finger (ofdm_fa < (ofdm_cca >> 1))) {
612f1d2b4d3SLarry Finger primarycca->intf_type = 2;
613f1d2b4d3SLarry Finger primarycca->intf_flag = 1;
614f1d2b4d3SLarry Finger cur_mf_state = MF_USC;
615f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
616f1d2b4d3SLarry Finger primarycca->pricca_flag = 1;
617f1d2b4d3SLarry Finger primarycca->dup_rts_flag = 1;
618f1d2b4d3SLarry Finger rtlpriv->rtlhal.rts_en = 1;
619f1d2b4d3SLarry Finger } else {
620f1d2b4d3SLarry Finger primarycca->intf_type = 0;
621f1d2b4d3SLarry Finger primarycca->intf_flag = 0;
622f1d2b4d3SLarry Finger cur_mf_state = MF_USC_LSC;
623f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
624f1d2b4d3SLarry Finger rtlpriv->rtlhal.rts_en = 0;
625f1d2b4d3SLarry Finger primarycca->dup_rts_flag = 0;
626f1d2b4d3SLarry Finger }
627f1d2b4d3SLarry Finger } else if (sec_ch_offset == 1) {
628f1d2b4d3SLarry Finger if ((ofdm_cca > OFDMCCA_TH) &&
629f1d2b4d3SLarry Finger (bw_usc_cnt > (bw_lsc_cnt + BW_IND_BIAS)) &&
630f1d2b4d3SLarry Finger (ofdm_fa > (ofdm_cca >> 1))) {
631f1d2b4d3SLarry Finger primarycca->intf_type = 1;
632f1d2b4d3SLarry Finger primarycca->intf_flag = 1;
633f1d2b4d3SLarry Finger cur_mf_state = MF_LSC;
634f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
635f1d2b4d3SLarry Finger primarycca->pricca_flag = 1;
636f1d2b4d3SLarry Finger } else if ((ofdm_cca > OFDMCCA_TH) &&
637f1d2b4d3SLarry Finger (bw_usc_cnt > (bw_lsc_cnt + BW_IND_BIAS)) &&
638f1d2b4d3SLarry Finger (ofdm_fa < (ofdm_cca >> 1))) {
639f1d2b4d3SLarry Finger primarycca->intf_type = 2;
640f1d2b4d3SLarry Finger primarycca->intf_flag = 1;
641f1d2b4d3SLarry Finger cur_mf_state = MF_LSC;
642f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
643f1d2b4d3SLarry Finger primarycca->pricca_flag = 1;
644f1d2b4d3SLarry Finger primarycca->dup_rts_flag = 1;
645f1d2b4d3SLarry Finger rtlpriv->rtlhal.rts_en = 1;
646f1d2b4d3SLarry Finger } else {
647f1d2b4d3SLarry Finger primarycca->intf_type = 0;
648f1d2b4d3SLarry Finger primarycca->intf_flag = 0;
649f1d2b4d3SLarry Finger cur_mf_state = MF_USC_LSC;
650f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
651f1d2b4d3SLarry Finger rtlpriv->rtlhal.rts_en = 0;
652f1d2b4d3SLarry Finger primarycca->dup_rts_flag = 0;
653f1d2b4d3SLarry Finger }
654f1d2b4d3SLarry Finger }
655f1d2b4d3SLarry Finger } else {/* PrimaryCCA->PriCCA_flag==1 */
656f1d2b4d3SLarry Finger count_down--;
657f1d2b4d3SLarry Finger if (count_down == 0) {
658f1d2b4d3SLarry Finger count_down = MONITOR_TIME;
659f1d2b4d3SLarry Finger primarycca->pricca_flag = 0;
660f1d2b4d3SLarry Finger cur_mf_state = MF_USC_LSC;
661f1d2b4d3SLarry Finger /* default */
662f1d2b4d3SLarry Finger rtl92ee_dm_write_dynamic_cca(hw, cur_mf_state);
663f1d2b4d3SLarry Finger rtlpriv->rtlhal.rts_en = 0;
664f1d2b4d3SLarry Finger primarycca->dup_rts_flag = 0;
665f1d2b4d3SLarry Finger primarycca->intf_type = 0;
666f1d2b4d3SLarry Finger primarycca->intf_flag = 0;
667f1d2b4d3SLarry Finger }
668f1d2b4d3SLarry Finger }
669f1d2b4d3SLarry Finger }
670f1d2b4d3SLarry Finger
rtl92ee_dm_dynamic_atc_switch(struct ieee80211_hw * hw)671f1d2b4d3SLarry Finger static void rtl92ee_dm_dynamic_atc_switch(struct ieee80211_hw *hw)
672f1d2b4d3SLarry Finger {
673f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
674f1d2b4d3SLarry Finger struct rtl_dm *rtldm = rtl_dm(rtl_priv(hw));
675f1d2b4d3SLarry Finger u8 crystal_cap;
676f1d2b4d3SLarry Finger u32 packet_count;
677f1d2b4d3SLarry Finger int cfo_khz_a , cfo_khz_b , cfo_ave = 0, adjust_xtal = 0;
678f1d2b4d3SLarry Finger int cfo_ave_diff;
679f1d2b4d3SLarry Finger
680f1d2b4d3SLarry Finger if (rtlpriv->mac80211.link_state < MAC80211_LINKED) {
681f1d2b4d3SLarry Finger if (rtldm->atc_status == ATC_STATUS_OFF) {
682f1d2b4d3SLarry Finger rtl_set_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11),
683f1d2b4d3SLarry Finger ATC_STATUS_ON);
684f1d2b4d3SLarry Finger rtldm->atc_status = ATC_STATUS_ON;
685f1d2b4d3SLarry Finger }
686f1d2b4d3SLarry Finger /* Disable CFO tracking for BT */
687f1d2b4d3SLarry Finger if (rtlpriv->cfg->ops->get_btc_status()) {
688f1d2b4d3SLarry Finger if (!rtlpriv->btcoexist.btc_ops->
689f1d2b4d3SLarry Finger btc_is_bt_disabled(rtlpriv)) {
690e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_BT_COEXIST, DBG_LOUD,
691f1d2b4d3SLarry Finger "odm_DynamicATCSwitch(): Disable CFO tracking for BT!!\n");
692f1d2b4d3SLarry Finger return;
693f1d2b4d3SLarry Finger }
694f1d2b4d3SLarry Finger }
695f1d2b4d3SLarry Finger /* Reset Crystal Cap */
696f1d2b4d3SLarry Finger if (rtldm->crystal_cap != rtlpriv->efuse.crystalcap) {
697f1d2b4d3SLarry Finger rtldm->crystal_cap = rtlpriv->efuse.crystalcap;
698f1d2b4d3SLarry Finger crystal_cap = rtldm->crystal_cap & 0x3f;
699f1d2b4d3SLarry Finger rtl_set_bbreg(hw, REG_MAC_PHY_CTRL, 0xFFF000,
700f1d2b4d3SLarry Finger (crystal_cap | (crystal_cap << 6)));
701f1d2b4d3SLarry Finger }
702f1d2b4d3SLarry Finger } else {
703f1d2b4d3SLarry Finger cfo_khz_a = (int)(rtldm->cfo_tail[0] * 3125) / 1280;
704f1d2b4d3SLarry Finger cfo_khz_b = (int)(rtldm->cfo_tail[1] * 3125) / 1280;
705f1d2b4d3SLarry Finger packet_count = rtldm->packet_count;
706f1d2b4d3SLarry Finger
707f1d2b4d3SLarry Finger if (packet_count == rtldm->packet_count_pre)
708f1d2b4d3SLarry Finger return;
709f1d2b4d3SLarry Finger
710f1d2b4d3SLarry Finger rtldm->packet_count_pre = packet_count;
711f1d2b4d3SLarry Finger
712f1d2b4d3SLarry Finger if (rtlpriv->phy.rf_type == RF_1T1R)
713f1d2b4d3SLarry Finger cfo_ave = cfo_khz_a;
714f1d2b4d3SLarry Finger else
715f1d2b4d3SLarry Finger cfo_ave = (int)(cfo_khz_a + cfo_khz_b) >> 1;
716f1d2b4d3SLarry Finger
717f1d2b4d3SLarry Finger cfo_ave_diff = (rtldm->cfo_ave_pre >= cfo_ave) ?
718f1d2b4d3SLarry Finger (rtldm->cfo_ave_pre - cfo_ave) :
719f1d2b4d3SLarry Finger (cfo_ave - rtldm->cfo_ave_pre);
720f1d2b4d3SLarry Finger
721*a03efb41SJason Yan if (cfo_ave_diff > 20 && !rtldm->large_cfo_hit) {
722*a03efb41SJason Yan rtldm->large_cfo_hit = true;
723f1d2b4d3SLarry Finger return;
724f1d2b4d3SLarry Finger }
725*a03efb41SJason Yan rtldm->large_cfo_hit = false;
726f1d2b4d3SLarry Finger
727f1d2b4d3SLarry Finger rtldm->cfo_ave_pre = cfo_ave;
728f1d2b4d3SLarry Finger
729f1d2b4d3SLarry Finger if (cfo_ave >= -rtldm->cfo_threshold &&
730f1d2b4d3SLarry Finger cfo_ave <= rtldm->cfo_threshold && rtldm->is_freeze == 0) {
731f1d2b4d3SLarry Finger if (rtldm->cfo_threshold == CFO_THRESHOLD_XTAL) {
732f1d2b4d3SLarry Finger rtldm->cfo_threshold = CFO_THRESHOLD_XTAL + 10;
733f1d2b4d3SLarry Finger rtldm->is_freeze = 1;
734f1d2b4d3SLarry Finger } else {
735f1d2b4d3SLarry Finger rtldm->cfo_threshold = CFO_THRESHOLD_XTAL;
736f1d2b4d3SLarry Finger }
737f1d2b4d3SLarry Finger }
738f1d2b4d3SLarry Finger
739f1d2b4d3SLarry Finger if (cfo_ave > rtldm->cfo_threshold && rtldm->crystal_cap < 0x3f)
740f1d2b4d3SLarry Finger adjust_xtal = ((cfo_ave - CFO_THRESHOLD_XTAL) >> 2) + 1;
741f1d2b4d3SLarry Finger else if ((cfo_ave < -rtlpriv->dm.cfo_threshold) &&
742f1d2b4d3SLarry Finger rtlpriv->dm.crystal_cap > 0)
743f1d2b4d3SLarry Finger adjust_xtal = ((cfo_ave + CFO_THRESHOLD_XTAL) >> 2) - 1;
744f1d2b4d3SLarry Finger
745f1d2b4d3SLarry Finger if (adjust_xtal != 0) {
746f1d2b4d3SLarry Finger rtldm->is_freeze = 0;
747f1d2b4d3SLarry Finger rtldm->crystal_cap += adjust_xtal;
748f1d2b4d3SLarry Finger
749f1d2b4d3SLarry Finger if (rtldm->crystal_cap > 0x3f)
750f1d2b4d3SLarry Finger rtldm->crystal_cap = 0x3f;
751f1d2b4d3SLarry Finger else if (rtldm->crystal_cap < 0)
752f1d2b4d3SLarry Finger rtldm->crystal_cap = 0;
753f1d2b4d3SLarry Finger
754f1d2b4d3SLarry Finger crystal_cap = rtldm->crystal_cap & 0x3f;
755f1d2b4d3SLarry Finger rtl_set_bbreg(hw, REG_MAC_PHY_CTRL, 0xFFF000,
756f1d2b4d3SLarry Finger (crystal_cap | (crystal_cap << 6)));
757f1d2b4d3SLarry Finger }
758f1d2b4d3SLarry Finger
759f1d2b4d3SLarry Finger if (cfo_ave < CFO_THRESHOLD_ATC &&
760f1d2b4d3SLarry Finger cfo_ave > -CFO_THRESHOLD_ATC) {
761f1d2b4d3SLarry Finger if (rtldm->atc_status == ATC_STATUS_ON) {
762f1d2b4d3SLarry Finger rtl_set_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11),
763f1d2b4d3SLarry Finger ATC_STATUS_OFF);
764f1d2b4d3SLarry Finger rtldm->atc_status = ATC_STATUS_OFF;
765f1d2b4d3SLarry Finger }
766f1d2b4d3SLarry Finger } else {
767f1d2b4d3SLarry Finger if (rtldm->atc_status == ATC_STATUS_OFF) {
768f1d2b4d3SLarry Finger rtl_set_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11),
769f1d2b4d3SLarry Finger ATC_STATUS_ON);
770f1d2b4d3SLarry Finger rtldm->atc_status = ATC_STATUS_ON;
771f1d2b4d3SLarry Finger }
772f1d2b4d3SLarry Finger }
773f1d2b4d3SLarry Finger }
774f1d2b4d3SLarry Finger }
775f1d2b4d3SLarry Finger
rtl92ee_dm_init_txpower_tracking(struct ieee80211_hw * hw)776f1d2b4d3SLarry Finger static void rtl92ee_dm_init_txpower_tracking(struct ieee80211_hw *hw)
777f1d2b4d3SLarry Finger {
778f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
779f1d2b4d3SLarry Finger struct rtl_dm *dm = rtl_dm(rtlpriv);
780f1d2b4d3SLarry Finger u8 path;
781f1d2b4d3SLarry Finger
782f1d2b4d3SLarry Finger dm->txpower_tracking = true;
783f1d2b4d3SLarry Finger dm->default_ofdm_index = 30;
784f1d2b4d3SLarry Finger dm->default_cck_index = 20;
785f1d2b4d3SLarry Finger
786f1d2b4d3SLarry Finger dm->swing_idx_cck_base = dm->default_cck_index;
787f1d2b4d3SLarry Finger dm->cck_index = dm->default_cck_index;
788f1d2b4d3SLarry Finger
789f1d2b4d3SLarry Finger for (path = RF90_PATH_A; path < MAX_RF_PATH; path++) {
790f1d2b4d3SLarry Finger dm->swing_idx_ofdm_base[path] = dm->default_ofdm_index;
791f1d2b4d3SLarry Finger dm->ofdm_index[path] = dm->default_ofdm_index;
792f1d2b4d3SLarry Finger dm->delta_power_index[path] = 0;
793f1d2b4d3SLarry Finger dm->delta_power_index_last[path] = 0;
794f1d2b4d3SLarry Finger dm->power_index_offset[path] = 0;
795f1d2b4d3SLarry Finger }
796f1d2b4d3SLarry Finger }
797f1d2b4d3SLarry Finger
rtl92ee_dm_init_rate_adaptive_mask(struct ieee80211_hw * hw)798f1d2b4d3SLarry Finger void rtl92ee_dm_init_rate_adaptive_mask(struct ieee80211_hw *hw)
799f1d2b4d3SLarry Finger {
800f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
801f1d2b4d3SLarry Finger struct rate_adaptive *p_ra = &rtlpriv->ra;
802f1d2b4d3SLarry Finger
803f1d2b4d3SLarry Finger p_ra->ratr_state = DM_RATR_STA_INIT;
804f1d2b4d3SLarry Finger p_ra->pre_ratr_state = DM_RATR_STA_INIT;
805f1d2b4d3SLarry Finger
806f1d2b4d3SLarry Finger if (rtlpriv->dm.dm_type == DM_TYPE_BYDRIVER)
807f1d2b4d3SLarry Finger rtlpriv->dm.useramask = true;
808f1d2b4d3SLarry Finger else
809f1d2b4d3SLarry Finger rtlpriv->dm.useramask = false;
810f1d2b4d3SLarry Finger
811f1d2b4d3SLarry Finger p_ra->ldpc_thres = 35;
812f1d2b4d3SLarry Finger p_ra->use_ldpc = false;
813f1d2b4d3SLarry Finger p_ra->high_rssi_thresh_for_ra = 50;
814f1d2b4d3SLarry Finger p_ra->low_rssi_thresh_for_ra40m = 20;
815f1d2b4d3SLarry Finger }
816f1d2b4d3SLarry Finger
_rtl92ee_dm_ra_state_check(struct ieee80211_hw * hw,s32 rssi,u8 * ratr_state)817f1d2b4d3SLarry Finger static bool _rtl92ee_dm_ra_state_check(struct ieee80211_hw *hw,
818f1d2b4d3SLarry Finger s32 rssi, u8 *ratr_state)
819f1d2b4d3SLarry Finger {
820f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
821f1d2b4d3SLarry Finger struct rate_adaptive *p_ra = &rtlpriv->ra;
822f1d2b4d3SLarry Finger const u8 go_up_gap = 5;
823f1d2b4d3SLarry Finger u32 high_rssithresh_for_ra = p_ra->high_rssi_thresh_for_ra;
824f1d2b4d3SLarry Finger u32 low_rssithresh_for_ra = p_ra->low_rssi_thresh_for_ra40m;
825f1d2b4d3SLarry Finger u8 state;
826f1d2b4d3SLarry Finger
827f1d2b4d3SLarry Finger /* Threshold Adjustment:
828f1d2b4d3SLarry Finger * when RSSI state trends to go up one or two levels,
829f1d2b4d3SLarry Finger * make sure RSSI is high enough.
830f1d2b4d3SLarry Finger * Here GoUpGap is added to solve
831f1d2b4d3SLarry Finger * the boundary's level alternation issue.
832f1d2b4d3SLarry Finger */
833f1d2b4d3SLarry Finger switch (*ratr_state) {
834f1d2b4d3SLarry Finger case DM_RATR_STA_INIT:
835f1d2b4d3SLarry Finger case DM_RATR_STA_HIGH:
836f1d2b4d3SLarry Finger break;
837f1d2b4d3SLarry Finger case DM_RATR_STA_MIDDLE:
838f1d2b4d3SLarry Finger high_rssithresh_for_ra += go_up_gap;
839f1d2b4d3SLarry Finger break;
840f1d2b4d3SLarry Finger case DM_RATR_STA_LOW:
841f1d2b4d3SLarry Finger high_rssithresh_for_ra += go_up_gap;
842f1d2b4d3SLarry Finger low_rssithresh_for_ra += go_up_gap;
843f1d2b4d3SLarry Finger break;
844f1d2b4d3SLarry Finger default:
845e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_RATR, DBG_DMESG,
8464713bd1cSJoe Perches "wrong rssi level setting %d !\n", *ratr_state);
847f1d2b4d3SLarry Finger break;
848f1d2b4d3SLarry Finger }
849f1d2b4d3SLarry Finger
850f1d2b4d3SLarry Finger /* Decide RATRState by RSSI. */
851f1d2b4d3SLarry Finger if (rssi > high_rssithresh_for_ra)
852f1d2b4d3SLarry Finger state = DM_RATR_STA_HIGH;
853f1d2b4d3SLarry Finger else if (rssi > low_rssithresh_for_ra)
854f1d2b4d3SLarry Finger state = DM_RATR_STA_MIDDLE;
855f1d2b4d3SLarry Finger else
856f1d2b4d3SLarry Finger state = DM_RATR_STA_LOW;
857f1d2b4d3SLarry Finger
858f1d2b4d3SLarry Finger if (*ratr_state != state) {
859f1d2b4d3SLarry Finger *ratr_state = state;
860f1d2b4d3SLarry Finger return true;
861f1d2b4d3SLarry Finger }
862f1d2b4d3SLarry Finger
863f1d2b4d3SLarry Finger return false;
864f1d2b4d3SLarry Finger }
865f1d2b4d3SLarry Finger
rtl92ee_dm_refresh_rate_adaptive_mask(struct ieee80211_hw * hw)866f1d2b4d3SLarry Finger static void rtl92ee_dm_refresh_rate_adaptive_mask(struct ieee80211_hw *hw)
867f1d2b4d3SLarry Finger {
868f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
869f1d2b4d3SLarry Finger struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
870f1d2b4d3SLarry Finger struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
871f1d2b4d3SLarry Finger struct rate_adaptive *p_ra = &rtlpriv->ra;
872f1d2b4d3SLarry Finger struct ieee80211_sta *sta = NULL;
873f1d2b4d3SLarry Finger
874f1d2b4d3SLarry Finger if (is_hal_stop(rtlhal)) {
875e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_RATE, DBG_LOUD,
876f1d2b4d3SLarry Finger "driver is going to unload\n");
877f1d2b4d3SLarry Finger return;
878f1d2b4d3SLarry Finger }
879f1d2b4d3SLarry Finger
880f1d2b4d3SLarry Finger if (!rtlpriv->dm.useramask) {
881e24a2a87SLarry Finger rtl_dbg(rtlpriv, COMP_RATE, DBG_LOUD,
882f1d2b4d3SLarry Finger "driver does not control rate adaptive mask\n");
883f1d2b4d3SLarry Finger return;
884f1d2b4d3SLarry Finger }
885f1d2b4d3SLarry Finger
886f1d2b4d3SLarry Finger if (mac->link_state == MAC80211_LINKED &&
887f1d2b4d3SLarry Finger mac->opmode == NL80211_IFTYPE_STATION) {
888f1d2b4d3SLarry Finger if (rtlpriv->dm.undec_sm_pwdb < p_ra->ldpc_thres) {
889f1d2b4d3SLarry Finger p_ra->use_ldpc = true;
890f1d2b4d3SLarry Finger p_ra->lower_rts_rate = true;
891f1d2b4d3SLarry Finger } else if (rtlpriv->dm.undec_sm_pwdb >
892f1d2b4d3SLarry Finger (p_ra->ldpc_thres - 5)) {
893f1d2b4d3SLarry Finger p_ra->use_ldpc = false;
894f1d2b4d3SLarry Finger p_ra->lower_rts_rate = false;
895f1d2b4d3SLarry Finger }
896f1d2b4d3SLarry Finger if (_rtl92ee_dm_ra_state_check(hw, rtlpriv->dm.undec_sm_pwdb,
897f1d2b4d3SLarry Finger &p_ra->ratr_state)) {
898f1d2b4d3SLarry Finger rcu_read_lock();
899f1d2b4d3SLarry Finger sta = rtl_find_sta(hw, mac->bssid);
900f1d2b4d3SLarry Finger if (sta)
901f1d2b4d3SLarry Finger rtlpriv->cfg->ops->update_rate_tbl(hw, sta,
9021d22b177SPing-Ke Shih p_ra->ratr_state,
9031d22b177SPing-Ke Shih true);
904f1d2b4d3SLarry Finger rcu_read_unlock();
905f1d2b4d3SLarry Finger
906f1d2b4d3SLarry Finger p_ra->pre_ratr_state = p_ra->ratr_state;
907f1d2b4d3SLarry Finger }
908f1d2b4d3SLarry Finger }
909f1d2b4d3SLarry Finger }
910f1d2b4d3SLarry Finger
rtl92ee_dm_init_dynamic_atc_switch(struct ieee80211_hw * hw)911f1d2b4d3SLarry Finger static void rtl92ee_dm_init_dynamic_atc_switch(struct ieee80211_hw *hw)
912f1d2b4d3SLarry Finger {
913f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
914f1d2b4d3SLarry Finger
915f1d2b4d3SLarry Finger rtlpriv->dm.crystal_cap = rtlpriv->efuse.crystalcap;
916f1d2b4d3SLarry Finger
917f1d2b4d3SLarry Finger rtlpriv->dm.atc_status = rtl_get_bbreg(hw, ROFDM1_CFOTRACKING, BIT(11));
918f1d2b4d3SLarry Finger rtlpriv->dm.cfo_threshold = CFO_THRESHOLD_XTAL;
919f1d2b4d3SLarry Finger }
920f1d2b4d3SLarry Finger
rtl92ee_dm_init(struct ieee80211_hw * hw)921f1d2b4d3SLarry Finger void rtl92ee_dm_init(struct ieee80211_hw *hw)
922f1d2b4d3SLarry Finger {
923f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
924f1d2b4d3SLarry Finger u32 cur_igvalue = rtl_get_bbreg(hw, DM_REG_IGI_A_11N, DM_BIT_IGI_11N);
925f1d2b4d3SLarry Finger
926f1d2b4d3SLarry Finger rtlpriv->dm.dm_type = DM_TYPE_BYDRIVER;
927f1d2b4d3SLarry Finger
928f1d2b4d3SLarry Finger rtl_dm_diginit(hw, cur_igvalue);
929f1d2b4d3SLarry Finger rtl92ee_dm_init_rate_adaptive_mask(hw);
930f1d2b4d3SLarry Finger rtl92ee_dm_init_primary_cca_check(hw);
931f1d2b4d3SLarry Finger rtl92ee_dm_init_edca_turbo(hw);
932f1d2b4d3SLarry Finger rtl92ee_dm_init_txpower_tracking(hw);
933f1d2b4d3SLarry Finger rtl92ee_dm_init_dynamic_atc_switch(hw);
934f1d2b4d3SLarry Finger }
935f1d2b4d3SLarry Finger
rtl92ee_dm_common_info_self_update(struct ieee80211_hw * hw)936f1d2b4d3SLarry Finger static void rtl92ee_dm_common_info_self_update(struct ieee80211_hw *hw)
937f1d2b4d3SLarry Finger {
938f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
939f1d2b4d3SLarry Finger struct rtl_sta_info *drv_priv;
940f1d2b4d3SLarry Finger u8 cnt = 0;
941f1d2b4d3SLarry Finger
942f1d2b4d3SLarry Finger rtlpriv->dm.one_entry_only = false;
943f1d2b4d3SLarry Finger
944f1d2b4d3SLarry Finger if (rtlpriv->mac80211.opmode == NL80211_IFTYPE_STATION &&
945f1d2b4d3SLarry Finger rtlpriv->mac80211.link_state >= MAC80211_LINKED) {
946f1d2b4d3SLarry Finger rtlpriv->dm.one_entry_only = true;
947f1d2b4d3SLarry Finger return;
948f1d2b4d3SLarry Finger }
949f1d2b4d3SLarry Finger
950f1d2b4d3SLarry Finger if (rtlpriv->mac80211.opmode == NL80211_IFTYPE_AP ||
951f1d2b4d3SLarry Finger rtlpriv->mac80211.opmode == NL80211_IFTYPE_ADHOC ||
952f1d2b4d3SLarry Finger rtlpriv->mac80211.opmode == NL80211_IFTYPE_MESH_POINT) {
953f1d2b4d3SLarry Finger spin_lock_bh(&rtlpriv->locks.entry_list_lock);
954f1d2b4d3SLarry Finger list_for_each_entry(drv_priv, &rtlpriv->entry_list, list) {
955f1d2b4d3SLarry Finger cnt++;
956f1d2b4d3SLarry Finger }
957f1d2b4d3SLarry Finger spin_unlock_bh(&rtlpriv->locks.entry_list_lock);
958f1d2b4d3SLarry Finger
959f1d2b4d3SLarry Finger if (cnt == 1)
960f1d2b4d3SLarry Finger rtlpriv->dm.one_entry_only = true;
961f1d2b4d3SLarry Finger }
962f1d2b4d3SLarry Finger }
963f1d2b4d3SLarry Finger
rtl92ee_dm_dynamic_arfb_select(struct ieee80211_hw * hw,u8 rate,bool collision_state)964f1d2b4d3SLarry Finger void rtl92ee_dm_dynamic_arfb_select(struct ieee80211_hw *hw,
965f1d2b4d3SLarry Finger u8 rate, bool collision_state)
966f1d2b4d3SLarry Finger {
967f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
968f1d2b4d3SLarry Finger
969f1d2b4d3SLarry Finger if (rate >= DESC92C_RATEMCS8 && rate <= DESC92C_RATEMCS12) {
970f1d2b4d3SLarry Finger if (collision_state == 1) {
971f1d2b4d3SLarry Finger if (rate == DESC92C_RATEMCS12) {
972f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
973f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
974f1d2b4d3SLarry Finger 0x07060501);
975f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS11) {
976f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
977f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
978f1d2b4d3SLarry Finger 0x07070605);
979f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS10) {
980f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
981f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
982f1d2b4d3SLarry Finger 0x08080706);
983f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS9) {
984f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
985f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
986f1d2b4d3SLarry Finger 0x08080707);
987f1d2b4d3SLarry Finger } else {
988f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC, 0x0);
989f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
990f1d2b4d3SLarry Finger 0x09090808);
991f1d2b4d3SLarry Finger }
992f1d2b4d3SLarry Finger } else { /* collision_state == 0 */
993f1d2b4d3SLarry Finger if (rate == DESC92C_RATEMCS12) {
994f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
995f1d2b4d3SLarry Finger 0x05010000);
996f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
997f1d2b4d3SLarry Finger 0x09080706);
998f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS11) {
999f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1000f1d2b4d3SLarry Finger 0x06050000);
1001f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1002f1d2b4d3SLarry Finger 0x09080807);
1003f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS10) {
1004f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1005f1d2b4d3SLarry Finger 0x07060000);
1006f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1007f1d2b4d3SLarry Finger 0x0a090908);
1008f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS9) {
1009f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1010f1d2b4d3SLarry Finger 0x07070000);
1011f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1012f1d2b4d3SLarry Finger 0x0a090808);
1013f1d2b4d3SLarry Finger } else {
1014f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1015f1d2b4d3SLarry Finger 0x08080000);
1016f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1017f1d2b4d3SLarry Finger 0x0b0a0909);
1018f1d2b4d3SLarry Finger }
1019f1d2b4d3SLarry Finger }
1020f1d2b4d3SLarry Finger } else { /* MCS13~MCS15, 1SS, G-mode */
1021f1d2b4d3SLarry Finger if (collision_state == 1) {
1022f1d2b4d3SLarry Finger if (rate == DESC92C_RATEMCS15) {
1023f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1024f1d2b4d3SLarry Finger 0x00000000);
1025f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1026f1d2b4d3SLarry Finger 0x05040302);
1027f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS14) {
1028f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1029f1d2b4d3SLarry Finger 0x00000000);
1030f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1031f1d2b4d3SLarry Finger 0x06050302);
1032f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS13) {
1033f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1034f1d2b4d3SLarry Finger 0x00000000);
1035f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1036f1d2b4d3SLarry Finger 0x07060502);
1037f1d2b4d3SLarry Finger } else {
1038f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1039f1d2b4d3SLarry Finger 0x00000000);
1040f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1041f1d2b4d3SLarry Finger 0x06050402);
1042f1d2b4d3SLarry Finger }
1043f1d2b4d3SLarry Finger } else{ /* collision_state == 0 */
1044f1d2b4d3SLarry Finger if (rate == DESC92C_RATEMCS15) {
1045f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1046f1d2b4d3SLarry Finger 0x03020000);
1047f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1048f1d2b4d3SLarry Finger 0x07060504);
1049f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS14) {
1050f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1051f1d2b4d3SLarry Finger 0x03020000);
1052f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1053f1d2b4d3SLarry Finger 0x08070605);
1054f1d2b4d3SLarry Finger } else if (rate == DESC92C_RATEMCS13) {
1055f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1056f1d2b4d3SLarry Finger 0x05020000);
1057f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1058f1d2b4d3SLarry Finger 0x09080706);
1059f1d2b4d3SLarry Finger } else {
1060f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC,
1061f1d2b4d3SLarry Finger 0x04020000);
1062f1d2b4d3SLarry Finger rtl_write_dword(rtlpriv, REG_DARFRC + 4,
1063f1d2b4d3SLarry Finger 0x08070605);
1064f1d2b4d3SLarry Finger }
1065f1d2b4d3SLarry Finger }
1066f1d2b4d3SLarry Finger }
1067f1d2b4d3SLarry Finger }
1068f1d2b4d3SLarry Finger
rtl92ee_dm_watchdog(struct ieee80211_hw * hw)1069f1d2b4d3SLarry Finger void rtl92ee_dm_watchdog(struct ieee80211_hw *hw)
1070f1d2b4d3SLarry Finger {
1071f1d2b4d3SLarry Finger struct rtl_priv *rtlpriv = rtl_priv(hw);
1072f1d2b4d3SLarry Finger struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
1073f1d2b4d3SLarry Finger bool fw_current_inpsmode = false;
1074f1d2b4d3SLarry Finger bool fw_ps_awake = true;
1075f1d2b4d3SLarry Finger
1076f1d2b4d3SLarry Finger rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FW_PSMODE_STATUS,
1077f1d2b4d3SLarry Finger (u8 *)(&fw_current_inpsmode));
1078f1d2b4d3SLarry Finger rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FWLPS_RF_ON,
1079f1d2b4d3SLarry Finger (u8 *)(&fw_ps_awake));
1080f1d2b4d3SLarry Finger if (ppsc->p2p_ps_info.p2p_ps_mode)
1081f1d2b4d3SLarry Finger fw_ps_awake = false;
1082f1d2b4d3SLarry Finger
1083c3ae8ec4SLarry Finger spin_lock(&rtlpriv->locks.rf_ps_lock);
1084f1d2b4d3SLarry Finger if ((ppsc->rfpwr_state == ERFON) &&
1085f1d2b4d3SLarry Finger ((!fw_current_inpsmode) && fw_ps_awake) &&
1086f1d2b4d3SLarry Finger (!ppsc->rfchange_inprogress)) {
1087f1d2b4d3SLarry Finger rtl92ee_dm_common_info_self_update(hw);
1088f1d2b4d3SLarry Finger rtl92ee_dm_false_alarm_counter_statistics(hw);
1089f1d2b4d3SLarry Finger rtl92ee_dm_check_rssi_monitor(hw);
1090f1d2b4d3SLarry Finger rtl92ee_dm_dig(hw);
1091f1d2b4d3SLarry Finger rtl92ee_dm_adaptivity(hw);
1092f1d2b4d3SLarry Finger rtl92ee_dm_cck_packet_detection_thresh(hw);
1093f1d2b4d3SLarry Finger rtl92ee_dm_refresh_rate_adaptive_mask(hw);
1094f1d2b4d3SLarry Finger rtl92ee_dm_check_edca_turbo(hw);
1095f1d2b4d3SLarry Finger rtl92ee_dm_dynamic_atc_switch(hw);
1096f1d2b4d3SLarry Finger rtl92ee_dm_dynamic_primary_cca_ckeck(hw);
1097f1d2b4d3SLarry Finger }
1098c3ae8ec4SLarry Finger spin_unlock(&rtlpriv->locks.rf_ps_lock);
1099f1d2b4d3SLarry Finger }
1100