1*4882a593Smuzhiyun /******************************************************************************
2*4882a593Smuzhiyun *
3*4882a593Smuzhiyun * Copyright(c) 2007 - 2017 Realtek Corporation.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * This program is free software; you can redistribute it and/or modify it
6*4882a593Smuzhiyun * under the terms of version 2 of the GNU General Public License as
7*4882a593Smuzhiyun * published by the Free Software Foundation.
8*4882a593Smuzhiyun *
9*4882a593Smuzhiyun * This program is distributed in the hope that it will be useful, but WITHOUT
10*4882a593Smuzhiyun * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11*4882a593Smuzhiyun * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12*4882a593Smuzhiyun * more details.
13*4882a593Smuzhiyun *
14*4882a593Smuzhiyun * The full GNU General Public License is included in this distribution in the
15*4882a593Smuzhiyun * file called LICENSE.
16*4882a593Smuzhiyun *
17*4882a593Smuzhiyun * Contact Information:
18*4882a593Smuzhiyun * wlanfae <wlanfae@realtek.com>
19*4882a593Smuzhiyun * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
20*4882a593Smuzhiyun * Hsinchu 300, Taiwan.
21*4882a593Smuzhiyun *
22*4882a593Smuzhiyun * Larry Finger <Larry.Finger@lwfinger.net>
23*4882a593Smuzhiyun *
24*4882a593Smuzhiyun *****************************************************************************/
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun /*@************************************************************
27*4882a593Smuzhiyun * include files
28*4882a593Smuzhiyun ************************************************************/
29*4882a593Smuzhiyun #include "mp_precomp.h"
30*4882a593Smuzhiyun #include "phydm_precomp.h"
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE & ODM_WIN)
33*4882a593Smuzhiyun #if WPP_SOFTWARE_TRACE
34*4882a593Smuzhiyun #include "PhyDM_Adaptivity.tmh"
35*4882a593Smuzhiyun #endif
36*4882a593Smuzhiyun #endif
37*4882a593Smuzhiyun #ifdef PHYDM_SUPPORT_ADAPTIVITY
38*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
39*4882a593Smuzhiyun boolean
phydm_check_channel_plan(void * dm_void)40*4882a593Smuzhiyun phydm_check_channel_plan(void *dm_void)
41*4882a593Smuzhiyun {
42*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
43*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
44*4882a593Smuzhiyun void *adapter = dm->adapter;
45*4882a593Smuzhiyun PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo;
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun if (mgnt_info->RegEnableAdaptivity != 2)
48*4882a593Smuzhiyun return false;
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun if (!dm->carrier_sense_enable) { /*@check domain Code for adaptivity or CarrierSense*/
51*4882a593Smuzhiyun if ((*dm->band_type == ODM_BAND_5G) &&
52*4882a593Smuzhiyun !(adapt->regulation_5g == REGULATION_ETSI || adapt->regulation_5g == REGULATION_WW)) {
53*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
54*4882a593Smuzhiyun "adaptivity skip 5G domain code : %d\n",
55*4882a593Smuzhiyun adapt->regulation_5g);
56*4882a593Smuzhiyun return true;
57*4882a593Smuzhiyun } else if ((*dm->band_type == ODM_BAND_2_4G) &&
58*4882a593Smuzhiyun !(adapt->regulation_2g == REGULATION_ETSI || adapt->regulation_2g == REGULATION_WW)) {
59*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
60*4882a593Smuzhiyun "adaptivity skip 2.4G domain code : %d\n",
61*4882a593Smuzhiyun adapt->regulation_2g);
62*4882a593Smuzhiyun return true;
63*4882a593Smuzhiyun } else if ((*dm->band_type != ODM_BAND_2_4G) && (*dm->band_type != ODM_BAND_5G)) {
64*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
65*4882a593Smuzhiyun "adaptivity neither 2G nor 5G band, return\n");
66*4882a593Smuzhiyun return true;
67*4882a593Smuzhiyun }
68*4882a593Smuzhiyun } else {
69*4882a593Smuzhiyun if ((*dm->band_type == ODM_BAND_5G) &&
70*4882a593Smuzhiyun !(adapt->regulation_5g == REGULATION_MKK || adapt->regulation_5g == REGULATION_WW)) {
71*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
72*4882a593Smuzhiyun "CarrierSense skip 5G domain code : %d\n",
73*4882a593Smuzhiyun adapt->regulation_5g);
74*4882a593Smuzhiyun return true;
75*4882a593Smuzhiyun } else if ((*dm->band_type == ODM_BAND_2_4G) &&
76*4882a593Smuzhiyun !(adapt->regulation_2g == REGULATION_MKK || adapt->regulation_2g == REGULATION_WW)) {
77*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
78*4882a593Smuzhiyun "CarrierSense skip 2.4G domain code : %d\n",
79*4882a593Smuzhiyun adapt->regulation_2g);
80*4882a593Smuzhiyun return true;
81*4882a593Smuzhiyun } else if ((*dm->band_type != ODM_BAND_2_4G) && (*dm->band_type != ODM_BAND_5G)) {
82*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
83*4882a593Smuzhiyun "CarrierSense neither 2G nor 5G band, return\n");
84*4882a593Smuzhiyun return true;
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun }
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun return false;
89*4882a593Smuzhiyun }
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun boolean
phydm_soft_ap_special_set(void * dm_void)92*4882a593Smuzhiyun phydm_soft_ap_special_set(void *dm_void)
93*4882a593Smuzhiyun {
94*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
95*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
96*4882a593Smuzhiyun boolean disable_ap_adapt_setting = false;
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun if (dm->soft_ap_mode != NULL) {
99*4882a593Smuzhiyun if (*dm->soft_ap_mode != 0 &&
100*4882a593Smuzhiyun (dm->soft_ap_special_setting & BIT(0)))
101*4882a593Smuzhiyun disable_ap_adapt_setting = true;
102*4882a593Smuzhiyun else
103*4882a593Smuzhiyun disable_ap_adapt_setting = false;
104*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
105*4882a593Smuzhiyun "soft_ap_setting = %x, soft_ap = %d, dis_ap_adapt = %d\n",
106*4882a593Smuzhiyun dm->soft_ap_special_setting, *dm->soft_ap_mode,
107*4882a593Smuzhiyun disable_ap_adapt_setting);
108*4882a593Smuzhiyun }
109*4882a593Smuzhiyun
110*4882a593Smuzhiyun return disable_ap_adapt_setting;
111*4882a593Smuzhiyun }
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun boolean
phydm_ap_num_check(void * dm_void)114*4882a593Smuzhiyun phydm_ap_num_check(void *dm_void)
115*4882a593Smuzhiyun {
116*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
117*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
118*4882a593Smuzhiyun boolean dis_adapt = false;
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun if (dm->ap_total_num > adapt->ap_num_th)
121*4882a593Smuzhiyun dis_adapt = true;
122*4882a593Smuzhiyun else
123*4882a593Smuzhiyun dis_adapt = false;
124*4882a593Smuzhiyun
125*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "AP total num = %d, AP num threshold = %d\n",
126*4882a593Smuzhiyun dm->ap_total_num, adapt->ap_num_th);
127*4882a593Smuzhiyun return dis_adapt;
128*4882a593Smuzhiyun }
129*4882a593Smuzhiyun
phydm_check_adaptivity(void * dm_void)130*4882a593Smuzhiyun void phydm_check_adaptivity(void *dm_void)
131*4882a593Smuzhiyun {
132*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
133*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
134*4882a593Smuzhiyun boolean disable_adapt = false;
135*4882a593Smuzhiyun
136*4882a593Smuzhiyun if (!adapt->mode_cvrt_en)
137*4882a593Smuzhiyun return;
138*4882a593Smuzhiyun
139*4882a593Smuzhiyun if (phydm_check_channel_plan(dm) || phydm_ap_num_check(dm) ||
140*4882a593Smuzhiyun phydm_soft_ap_special_set(dm))
141*4882a593Smuzhiyun disable_adapt = true;
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE && disable_adapt)
144*4882a593Smuzhiyun *dm->edcca_mode = PHYDM_EDCCA_NORMAL_MODE;
145*4882a593Smuzhiyun else if (*dm->edcca_mode == PHYDM_EDCCA_NORMAL_MODE && !disable_adapt)
146*4882a593Smuzhiyun *dm->edcca_mode = PHYDM_EDCCA_ADAPT_MODE;
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun
phydm_set_l2h_th_ini_win(void * dm_void)149*4882a593Smuzhiyun void phydm_set_l2h_th_ini_win(void *dm_void)
150*4882a593Smuzhiyun {
151*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
152*4882a593Smuzhiyun
153*4882a593Smuzhiyun /*@ [New Format: JGR3]IGI-idx:45 = RSSI:35 = -65dBm*/
154*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_JGR3_SERIES) {
155*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8723F))
156*4882a593Smuzhiyun dm->th_l2h_ini = 45;
157*4882a593Smuzhiyun else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C))
158*4882a593Smuzhiyun dm->th_l2h_ini = 49;
159*4882a593Smuzhiyun } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) {
160*4882a593Smuzhiyun /*@ [Old Format] -11+base(50) = IGI_idx:39 = RSSI:29 = -71dBm*/
161*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812)) {
162*4882a593Smuzhiyun dm->th_l2h_ini = -17;
163*4882a593Smuzhiyun } else {
164*4882a593Smuzhiyun if (*dm->band_type == ODM_BAND_5G)
165*4882a593Smuzhiyun dm->th_l2h_ini = -14;
166*4882a593Smuzhiyun else if (*dm->band_type == ODM_BAND_2_4G)
167*4882a593Smuzhiyun dm->th_l2h_ini = -9;
168*4882a593Smuzhiyun }
169*4882a593Smuzhiyun } else { /*ODM_IC_11N_SERIES*/
170*4882a593Smuzhiyun dm->th_l2h_ini = -9;
171*4882a593Smuzhiyun }
172*4882a593Smuzhiyun }
173*4882a593Smuzhiyun
phydm_l2h_ini_recorder_reset(void * dm_void)174*4882a593Smuzhiyun void phydm_l2h_ini_recorder_reset(void *dm_void)
175*4882a593Smuzhiyun {
176*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
177*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
178*4882a593Smuzhiyun struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t;
179*4882a593Smuzhiyun
180*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__);
181*4882a593Smuzhiyun
182*4882a593Smuzhiyun odm_memory_set(dm, &adapt_rc->l2h_ini_bitmap, 0,
183*4882a593Smuzhiyun sizeof(struct phydm_l2h_ini_recorder_strcut));
184*4882a593Smuzhiyun }
185*4882a593Smuzhiyun
186*4882a593Smuzhiyun
phydm_l2h_ini_recorder(void * dm_void)187*4882a593Smuzhiyun void phydm_l2h_ini_recorder(void *dm_void)
188*4882a593Smuzhiyun {
189*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
190*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
191*4882a593Smuzhiyun struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t;
192*4882a593Smuzhiyun u32 low_rate_tx_fail_cnt = dm->low_rate_tx_fail_cnt;
193*4882a593Smuzhiyun s8 l2h_ini_curr = dm->th_l2h_ini;
194*4882a593Smuzhiyun s8 l2h_ini_pre = adapt_rc->l2h_ini_hist[0];
195*4882a593Smuzhiyun s8 l2h_ini_down = 0;
196*4882a593Smuzhiyun
197*4882a593Smuzhiyun if (!dm->is_linked || adapt->is_adapt_by_dig || adapt->rts_drop_en)
198*4882a593Smuzhiyun return;
199*4882a593Smuzhiyun
200*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__);
201*4882a593Smuzhiyun
202*4882a593Smuzhiyun if (dm->first_connect) {
203*4882a593Smuzhiyun phydm_l2h_ini_recorder_reset(dm);
204*4882a593Smuzhiyun adapt_rc->l2h_ini_hist[0] = l2h_ini_curr;
205*4882a593Smuzhiyun return;
206*4882a593Smuzhiyun }
207*4882a593Smuzhiyun
208*4882a593Smuzhiyun l2h_ini_down = (l2h_ini_curr < l2h_ini_pre) ? 1 : 0;
209*4882a593Smuzhiyun adapt_rc->l2h_ini_bitmap = ((adapt_rc->l2h_ini_bitmap << 1) & 0xfe) | l2h_ini_down;
210*4882a593Smuzhiyun
211*4882a593Smuzhiyun adapt_rc->l2h_ini_hist[3] = adapt_rc->l2h_ini_hist[2];
212*4882a593Smuzhiyun adapt_rc->l2h_ini_hist[2] = adapt_rc->l2h_ini_hist[1];
213*4882a593Smuzhiyun adapt_rc->l2h_ini_hist[1] = adapt_rc->l2h_ini_hist[0];
214*4882a593Smuzhiyun adapt_rc->l2h_ini_hist[0] = l2h_ini_curr;
215*4882a593Smuzhiyun
216*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[3] = adapt_rc->low_rate_tx_fail_hist[2];
217*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[2] = adapt_rc->low_rate_tx_fail_hist[1];
218*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[1] = adapt_rc->low_rate_tx_fail_hist[0];
219*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[0] = low_rate_tx_fail_cnt;
220*4882a593Smuzhiyun
221*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "l2h_ini_hist[3:0] = {0x%x, 0x%x, 0x%x, 0x%x}\n",
222*4882a593Smuzhiyun adapt_rc->l2h_ini_hist[3], adapt_rc->l2h_ini_hist[2],
223*4882a593Smuzhiyun adapt_rc->l2h_ini_hist[1], adapt_rc->l2h_ini_hist[0]);
224*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_hist[3:0] = {%d, %d, %d, %d}\n",
225*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[3], adapt_rc->low_rate_tx_fail_hist[2],
226*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[1], adapt_rc->low_rate_tx_fail_hist[0]);
227*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "l2h_ini_bitmap = {%d, %d, %d, %d} = 0x%x\n",
228*4882a593Smuzhiyun (u8)((adapt_rc->l2h_ini_bitmap & BIT(3)) >> 3),
229*4882a593Smuzhiyun (u8)((adapt_rc->l2h_ini_bitmap & BIT(2)) >> 2),
230*4882a593Smuzhiyun (u8)((adapt_rc->l2h_ini_bitmap & BIT(1)) >> 1),
231*4882a593Smuzhiyun (u8)(adapt_rc->l2h_ini_bitmap & BIT(0)),
232*4882a593Smuzhiyun adapt_rc->l2h_ini_bitmap);
233*4882a593Smuzhiyun }
234*4882a593Smuzhiyun
phydm_rts_drop_chk(void * dm_void)235*4882a593Smuzhiyun void phydm_rts_drop_chk(void *dm_void)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
238*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
239*4882a593Smuzhiyun u32 time_tmp = 0;
240*4882a593Smuzhiyun
241*4882a593Smuzhiyun if (!dm->is_linked || adapt->is_adapt_by_dig)
242*4882a593Smuzhiyun return;
243*4882a593Smuzhiyun
244*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__);
245*4882a593Smuzhiyun
246*4882a593Smuzhiyun if (dm->rts_drop_cnt > 0) {
247*4882a593Smuzhiyun adapt->rts_drop_en = 1;
248*4882a593Smuzhiyun adapt->rts_drop_limit_time = dm->phydm_sys_up_time;
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun
251*4882a593Smuzhiyun /*@== Fix l2h_ini to l2h_ini_range_min================================*/
252*4882a593Smuzhiyun if (adapt->rts_drop_en) {
253*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
254*4882a593Smuzhiyun "[RTS DROP!] rts_drop_limit_time=%d, phydm_sys_up_time=%d\n",
255*4882a593Smuzhiyun adapt->rts_drop_limit_time, dm->phydm_sys_up_time);
256*4882a593Smuzhiyun
257*4882a593Smuzhiyun time_tmp = adapt->rts_drop_limit_time + L2H_INI_LIMIT_PERIOD;
258*4882a593Smuzhiyun dm->th_l2h_ini = adapt->l2h_ini_range_min;
259*4882a593Smuzhiyun
260*4882a593Smuzhiyun if (time_tmp < dm->phydm_sys_up_time && dm->rts_drop_cnt == 0) {
261*4882a593Smuzhiyun adapt->rts_drop_en = 0;
262*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "rts_drop_cnt=%d\n",
263*4882a593Smuzhiyun dm->rts_drop_cnt);
264*4882a593Smuzhiyun }
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun return;
267*4882a593Smuzhiyun }
268*4882a593Smuzhiyun
269*4882a593Smuzhiyun
phydm_l2h_ini_damping_chk(void * dm_void)270*4882a593Smuzhiyun void phydm_l2h_ini_damping_chk(void *dm_void)
271*4882a593Smuzhiyun {
272*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
273*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
274*4882a593Smuzhiyun struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t;
275*4882a593Smuzhiyun u8 l2h_ini_bitmap_4bit = adapt_rc->l2h_ini_bitmap & 0xf;
276*4882a593Smuzhiyun s8 diff1 = 0, diff2 = 0, min_l2h_ini = 0x7f;
277*4882a593Smuzhiyun u32 tx_fail_low_th = adapt->low_rate_tx_fail_th[0];
278*4882a593Smuzhiyun u32 tx_fail_high_th = adapt->low_rate_tx_fail_th[1];
279*4882a593Smuzhiyun u32 tx_fail_high_th2 = adapt->low_rate_tx_fail_th[2];
280*4882a593Smuzhiyun u8 tx_fail_pattern_match = 0;
281*4882a593Smuzhiyun u32 time_tmp = 0;
282*4882a593Smuzhiyun u8 i = 0;
283*4882a593Smuzhiyun
284*4882a593Smuzhiyun if (!dm->is_linked || adapt->is_adapt_by_dig || adapt->rts_drop_en)
285*4882a593Smuzhiyun return;
286*4882a593Smuzhiyun
287*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "%s ======>\n", __func__);
288*4882a593Smuzhiyun
289*4882a593Smuzhiyun /*@== Release Damping ================================================*/
290*4882a593Smuzhiyun if (adapt_rc->damping_limit_en) {
291*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
292*4882a593Smuzhiyun "[Damping Limit!] limit_time=%d, phydm_sys_up_time=%d\n",
293*4882a593Smuzhiyun adapt_rc->limit_time, dm->phydm_sys_up_time);
294*4882a593Smuzhiyun
295*4882a593Smuzhiyun time_tmp = adapt_rc->limit_time + L2H_INI_LIMIT_PERIOD;
296*4882a593Smuzhiyun
297*4882a593Smuzhiyun if (DIFF_2(dm->low_rate_tx_fail_cnt, adapt_rc->limit_low_rate_tx_fail) > 3 ||
298*4882a593Smuzhiyun time_tmp < dm->phydm_sys_up_time) {
299*4882a593Smuzhiyun adapt_rc->damping_limit_en = 0;
300*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_cnt=%d, limit_low_rate_tx_fail=%d\n",
301*4882a593Smuzhiyun dm->low_rate_tx_fail_cnt, adapt_rc->limit_low_rate_tx_fail);
302*4882a593Smuzhiyun }
303*4882a593Smuzhiyun return;
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun /*@== Damping Pattern Check===========================================*/
307*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_th{H, L}= {%d,%d}\n", tx_fail_high_th, tx_fail_low_th);
308*4882a593Smuzhiyun
309*4882a593Smuzhiyun switch (l2h_ini_bitmap_4bit) {
310*4882a593Smuzhiyun case 0x5:
311*4882a593Smuzhiyun /*@ 4b'0101
312*4882a593Smuzhiyun * L2H_INI: [3]up(40) ->[2]down(38)->[1]up(40) ->[0]down(38)->[new](Lock @ 38)
313*4882a593Smuzhiyun * low_rate_tx_fail_cnt: [3] >high1 ->[2] <low ->[1] >high1 ->[0] <low ->[new] <low
314*4882a593Smuzhiyun *
315*4882a593Smuzhiyun * L2H_INI: [3]up(45) ->[2]down(40)->[1]up(42) ->[0]down(37)->[new](Lock @ 37)
316*4882a593Smuzhiyun * low_rate_tx_fail_cnt: [3] >high2 ->[2] <low ->[1] >high2 ->[0] <low ->[new] <low
317*4882a593Smuzhiyun */
318*4882a593Smuzhiyun if (adapt_rc->l2h_ini_hist[0] < adapt_rc->l2h_ini_hist[1])
319*4882a593Smuzhiyun diff1 = adapt_rc->l2h_ini_hist[1] - adapt_rc->l2h_ini_hist[0];
320*4882a593Smuzhiyun
321*4882a593Smuzhiyun if (adapt_rc->l2h_ini_hist[2] < adapt_rc->l2h_ini_hist[3])
322*4882a593Smuzhiyun diff2 = adapt_rc->l2h_ini_hist[3] - adapt_rc->l2h_ini_hist[2];
323*4882a593Smuzhiyun
324*4882a593Smuzhiyun if (adapt_rc->low_rate_tx_fail_hist[0] < tx_fail_low_th &&
325*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[1] > tx_fail_high_th &&
326*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[2] < tx_fail_low_th &&
327*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[3] > tx_fail_high_th) {
328*4882a593Smuzhiyun /*@Check each rts drop element*/
329*4882a593Smuzhiyun tx_fail_pattern_match = 1;
330*4882a593Smuzhiyun }
331*4882a593Smuzhiyun break;
332*4882a593Smuzhiyun case 0x9:
333*4882a593Smuzhiyun /*@ 4b'1001
334*4882a593Smuzhiyun * L2H_INI: [3]down(40)->[2]up(42)->[1]up(44) ->[0]down(39)->[new](Lock @ 39)
335*4882a593Smuzhiyun * low_rate_tx_fail_cnt: [3] <low ->[2] <low ->[1] >high2 ->[0] <low ->[new] <low
336*4882a593Smuzhiyun */
337*4882a593Smuzhiyun if (adapt_rc->l2h_ini_hist[0] < adapt_rc->l2h_ini_hist[1])
338*4882a593Smuzhiyun diff1 = adapt_rc->l2h_ini_hist[1] - adapt_rc->l2h_ini_hist[0];
339*4882a593Smuzhiyun
340*4882a593Smuzhiyun if (adapt_rc->l2h_ini_hist[2] > adapt_rc->l2h_ini_hist[3])
341*4882a593Smuzhiyun diff2 = adapt_rc->l2h_ini_hist[2] - adapt_rc->l2h_ini_hist[3];
342*4882a593Smuzhiyun
343*4882a593Smuzhiyun if (adapt_rc->low_rate_tx_fail_hist[0] < tx_fail_low_th &&
344*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[1] > tx_fail_high_th2 &&
345*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[2] < tx_fail_low_th &&
346*4882a593Smuzhiyun adapt_rc->low_rate_tx_fail_hist[3] < tx_fail_low_th) {
347*4882a593Smuzhiyun /*@Check each fa element*/
348*4882a593Smuzhiyun tx_fail_pattern_match = 1;
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun break;
351*4882a593Smuzhiyun default:
352*4882a593Smuzhiyun break;
353*4882a593Smuzhiyun }
354*4882a593Smuzhiyun
355*4882a593Smuzhiyun if (diff1 >= 2 && diff2 >= 2 && tx_fail_pattern_match) {
356*4882a593Smuzhiyun for (i = 0; i < L2H_INI_RECORD_NUM; i++) {
357*4882a593Smuzhiyun if (min_l2h_ini > adapt_rc->l2h_ini_hist[i])
358*4882a593Smuzhiyun min_l2h_ini = adapt_rc->l2h_ini_hist[i];
359*4882a593Smuzhiyun }
360*4882a593Smuzhiyun
361*4882a593Smuzhiyun adapt_rc->damping_limit_en = 1;
362*4882a593Smuzhiyun adapt_rc->damping_limit_val = min_l2h_ini;
363*4882a593Smuzhiyun adapt_rc->limit_time = dm->phydm_sys_up_time;
364*4882a593Smuzhiyun adapt_rc->limit_low_rate_tx_fail = dm->low_rate_tx_fail_cnt;
365*4882a593Smuzhiyun
366*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
367*4882a593Smuzhiyun "[Start damping_limit!] l2h_ini_min=0x%x, limit_time=%d, limit_low_rate_tx_fail=%d\n",
368*4882a593Smuzhiyun adapt_rc->damping_limit_val,
369*4882a593Smuzhiyun adapt_rc->limit_time, adapt_rc->limit_low_rate_tx_fail);
370*4882a593Smuzhiyun }
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "damping_limit=%d\n", adapt_rc->damping_limit_en);
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun
phydm_low_rate_tx_fail_threshold_check(void * dm_void)375*4882a593Smuzhiyun void phydm_low_rate_tx_fail_threshold_check(void *dm_void)
376*4882a593Smuzhiyun {
377*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
378*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
379*4882a593Smuzhiyun
380*4882a593Smuzhiyun if (adapt->is_dbg_low_rate_tx_fail_th) {
381*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "Manual Fix low_rate_tx_fail_th\n");
382*4882a593Smuzhiyun } else {
383*4882a593Smuzhiyun adapt->low_rate_tx_fail_th[0] = 2;
384*4882a593Smuzhiyun adapt->low_rate_tx_fail_th[1] = 2;
385*4882a593Smuzhiyun adapt->low_rate_tx_fail_th[2] = 5;
386*4882a593Smuzhiyun }
387*4882a593Smuzhiyun
388*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_th={%d,%d,%d}\n", adapt->low_rate_tx_fail_th[0],
389*4882a593Smuzhiyun adapt->low_rate_tx_fail_th[1], adapt->low_rate_tx_fail_th[2]);
390*4882a593Smuzhiyun }
391*4882a593Smuzhiyun
phydm_new_l2h_ini_by_low_rate_tx_fail(void * dm_void,s8 l2h_ini,u8 * step_size)392*4882a593Smuzhiyun s8 phydm_new_l2h_ini_by_low_rate_tx_fail(void *dm_void, s8 l2h_ini,
393*4882a593Smuzhiyun u8 *step_size)
394*4882a593Smuzhiyun {
395*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
396*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
397*4882a593Smuzhiyun u32 low_rate_tx_fail_cnt = dm->low_rate_tx_fail_cnt;
398*4882a593Smuzhiyun
399*4882a593Smuzhiyun if (low_rate_tx_fail_cnt > adapt->low_rate_tx_fail_th[2])
400*4882a593Smuzhiyun l2h_ini = l2h_ini - step_size[2];
401*4882a593Smuzhiyun else if (low_rate_tx_fail_cnt > adapt->low_rate_tx_fail_th[1])
402*4882a593Smuzhiyun l2h_ini = l2h_ini - step_size[1];
403*4882a593Smuzhiyun else if (low_rate_tx_fail_cnt < adapt->low_rate_tx_fail_th[0])
404*4882a593Smuzhiyun l2h_ini = l2h_ini + step_size[0];
405*4882a593Smuzhiyun
406*4882a593Smuzhiyun return l2h_ini;
407*4882a593Smuzhiyun }
408*4882a593Smuzhiyun
409*4882a593Smuzhiyun
phydm_get_new_l2h_ini(void * dm_void)410*4882a593Smuzhiyun void phydm_get_new_l2h_ini(void *dm_void)
411*4882a593Smuzhiyun {
412*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
413*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
414*4882a593Smuzhiyun struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adapt->l2h_ini_recorder_t;
415*4882a593Smuzhiyun u8 step[3] = {1, 2, 5};
416*4882a593Smuzhiyun u32 low_rate_tx_fail_cnt = dm->low_rate_tx_fail_cnt;
417*4882a593Smuzhiyun u32 low_rate_tx_ok_cnt = dm->low_rate_tx_ok_cnt;
418*4882a593Smuzhiyun s8 l2h_ini = dm->th_l2h_ini;
419*4882a593Smuzhiyun
420*4882a593Smuzhiyun if (!dm->is_linked || adapt->is_adapt_by_dig || adapt->rts_drop_en)
421*4882a593Smuzhiyun return;
422*4882a593Smuzhiyun
423*4882a593Smuzhiyun if (adapt_rc->damping_limit_en) {
424*4882a593Smuzhiyun dm->th_l2h_ini = adapt_rc->damping_limit_val;
425*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "[Limit by Damping] l2h_ini: 0x%x -> 0x%x\n",
426*4882a593Smuzhiyun l2h_ini, dm->th_l2h_ini);
427*4882a593Smuzhiyun return;
428*4882a593Smuzhiyun }
429*4882a593Smuzhiyun
430*4882a593Smuzhiyun l2h_ini = phydm_new_l2h_ini_by_low_rate_tx_fail(dm, l2h_ini, step);
431*4882a593Smuzhiyun
432*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "step = {-%d, -%d, +%d}\n", step[2], step[1],
433*4882a593Smuzhiyun step[0]);
434*4882a593Smuzhiyun
435*4882a593Smuzhiyun /*@Check th_l2h_ini by dyn-upper/lower bound */
436*4882a593Smuzhiyun if (l2h_ini < adapt->l2h_ini_range_min)
437*4882a593Smuzhiyun l2h_ini = adapt->l2h_ini_range_min;
438*4882a593Smuzhiyun
439*4882a593Smuzhiyun if (l2h_ini > adapt->l2h_ini_range_max)
440*4882a593Smuzhiyun l2h_ini = adapt->l2h_ini_range_max;
441*4882a593Smuzhiyun
442*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "low_rate_tx_fail_cnt = %d, low_rate_tx_ok_cnt = %d, l2h_ini: 0x%x -> 0x%x\n",
443*4882a593Smuzhiyun low_rate_tx_fail_cnt, low_rate_tx_ok_cnt, dm->th_l2h_ini,
444*4882a593Smuzhiyun l2h_ini);
445*4882a593Smuzhiyun
446*4882a593Smuzhiyun dm->th_l2h_ini = l2h_ini;
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun
phydm_dyn_l2h_ini(void * dm_void)449*4882a593Smuzhiyun void phydm_dyn_l2h_ini(void *dm_void)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
452*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
453*4882a593Smuzhiyun
454*4882a593Smuzhiyun if (dm->rssi_min <= 20 || !dm->is_linked) {
455*4882a593Smuzhiyun phydm_set_l2h_th_ini_win(dm);
456*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "th_l2h_ini = %d\n", dm->th_l2h_ini);
457*4882a593Smuzhiyun return;
458*4882a593Smuzhiyun }
459*4882a593Smuzhiyun
460*4882a593Smuzhiyun /*Check rts drop*/
461*4882a593Smuzhiyun phydm_rts_drop_chk(dm);
462*4882a593Smuzhiyun
463*4882a593Smuzhiyun /*Record l2h_ini History*/
464*4882a593Smuzhiyun phydm_l2h_ini_recorder(dm);
465*4882a593Smuzhiyun
466*4882a593Smuzhiyun /*@l2h_ini Damping Check*/
467*4882a593Smuzhiyun phydm_l2h_ini_damping_chk(dm);
468*4882a593Smuzhiyun
469*4882a593Smuzhiyun /*@low_rate_tx_fail threshold decision */
470*4882a593Smuzhiyun phydm_low_rate_tx_fail_threshold_check(dm);
471*4882a593Smuzhiyun
472*4882a593Smuzhiyun /*Select new l2h_ini by tx_fail */
473*4882a593Smuzhiyun phydm_get_new_l2h_ini(dm);
474*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "Adjust l2h init @ linked, th_l2h_ini = %d\n",
475*4882a593Smuzhiyun dm->th_l2h_ini);
476*4882a593Smuzhiyun }
477*4882a593Smuzhiyun
478*4882a593Smuzhiyun #endif
479*4882a593Smuzhiyun
phydm_dig_up_bound_lmt_en(void * dm_void)480*4882a593Smuzhiyun void phydm_dig_up_bound_lmt_en(void *dm_void)
481*4882a593Smuzhiyun {
482*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
483*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
484*4882a593Smuzhiyun
485*4882a593Smuzhiyun if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE ||
486*4882a593Smuzhiyun !dm->is_linked) {
487*4882a593Smuzhiyun adapt->igi_up_bound_lmt_cnt = 0;
488*4882a593Smuzhiyun adapt->igi_lmt_en = false;
489*4882a593Smuzhiyun return;
490*4882a593Smuzhiyun }
491*4882a593Smuzhiyun
492*4882a593Smuzhiyun if (dm->total_tp > 1) {
493*4882a593Smuzhiyun adapt->igi_lmt_en = true;
494*4882a593Smuzhiyun adapt->igi_up_bound_lmt_cnt = adapt->igi_up_bound_lmt_val;
495*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
496*4882a593Smuzhiyun "TP >1, Start limit IGI upper bound\n");
497*4882a593Smuzhiyun } else {
498*4882a593Smuzhiyun if (adapt->igi_up_bound_lmt_cnt == 0)
499*4882a593Smuzhiyun adapt->igi_lmt_en = false;
500*4882a593Smuzhiyun else
501*4882a593Smuzhiyun adapt->igi_up_bound_lmt_cnt--;
502*4882a593Smuzhiyun }
503*4882a593Smuzhiyun
504*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "IGI_lmt_cnt = %d\n",
505*4882a593Smuzhiyun adapt->igi_up_bound_lmt_cnt);
506*4882a593Smuzhiyun }
507*4882a593Smuzhiyun
phydm_set_edcca_threshold(void * dm_void,s8 H2L,s8 L2H)508*4882a593Smuzhiyun void phydm_set_edcca_threshold(void *dm_void, s8 H2L, s8 L2H)
509*4882a593Smuzhiyun {
510*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
511*4882a593Smuzhiyun
512*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_JGR3_SERIES) {
513*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x84c, MASKBYTE2, (u8)L2H + 0x80);
514*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x84c, MASKBYTE3, (u8)H2L + 0x80);
515*4882a593Smuzhiyun } else if (dm->support_ic_type & ODM_IC_11N_SERIES) {
516*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0xc4c, MASKBYTE0, (u8)L2H);
517*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0xc4c, MASKBYTE2, (u8)H2L);
518*4882a593Smuzhiyun } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) {
519*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x8a4, MASKBYTE0, (u8)L2H);
520*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x8a4, MASKBYTE1, (u8)H2L);
521*4882a593Smuzhiyun }
522*4882a593Smuzhiyun }
523*4882a593Smuzhiyun
phydm_mac_edcca_state(void * dm_void,enum phydm_mac_edcca_type state)524*4882a593Smuzhiyun void phydm_mac_edcca_state(void *dm_void, enum phydm_mac_edcca_type state)
525*4882a593Smuzhiyun {
526*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
527*4882a593Smuzhiyun
528*4882a593Smuzhiyun if (state == PHYDM_IGNORE_EDCCA) {
529*4882a593Smuzhiyun /*@ignore EDCCA*/
530*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x520, BIT(15), 1);
531*4882a593Smuzhiyun /*@enable EDCCA count down*/
532*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x524, BIT(11), 0);
533*4882a593Smuzhiyun } else { /*@don't set MAC ignore EDCCA signal*/
534*4882a593Smuzhiyun /*@don't ignore EDCCA*/
535*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x520, BIT(15), 0);
536*4882a593Smuzhiyun /*@disable EDCCA count down*/
537*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x524, BIT(11), 1);
538*4882a593Smuzhiyun }
539*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "EDCCA enable state = %d\n", state);
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun
phydm_search_pwdb_lower_bound(void * dm_void)542*4882a593Smuzhiyun void phydm_search_pwdb_lower_bound(void *dm_void)
543*4882a593Smuzhiyun {
544*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
545*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
546*4882a593Smuzhiyun u32 value32 = 0, reg_value32 = 0;
547*4882a593Smuzhiyun u8 cnt = 0, try_count = 0;
548*4882a593Smuzhiyun u8 tx_edcca1 = 0;
549*4882a593Smuzhiyun boolean is_adjust = true;
550*4882a593Smuzhiyun s8 th_l2h, th_h2l, igi_target_dc = 0x32;
551*4882a593Smuzhiyun s8 diff = 0;
552*4882a593Smuzhiyun s8 IGI = adapt->igi_base + 30 + dm->th_l2h_ini - dm->th_edcca_hl_diff;
553*4882a593Smuzhiyun
554*4882a593Smuzhiyun halrf_rf_lna_setting(dm, HALRF_LNA_DISABLE);
555*4882a593Smuzhiyun diff = igi_target_dc - IGI;
556*4882a593Smuzhiyun th_l2h = dm->th_l2h_ini + diff;
557*4882a593Smuzhiyun if (th_l2h > 10)
558*4882a593Smuzhiyun th_l2h = 10;
559*4882a593Smuzhiyun
560*4882a593Smuzhiyun th_h2l = th_l2h - dm->th_edcca_hl_diff;
561*4882a593Smuzhiyun phydm_set_edcca_threshold(dm, th_h2l, th_l2h);
562*4882a593Smuzhiyun ODM_delay_ms(30);
563*4882a593Smuzhiyun
564*4882a593Smuzhiyun while (is_adjust) {
565*4882a593Smuzhiyun /*@check CCA status*/
566*4882a593Smuzhiyun /*set debug port to 0x0*/
567*4882a593Smuzhiyun if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x0)) {
568*4882a593Smuzhiyun reg_value32 = phydm_get_bb_dbg_port_val(dm);
569*4882a593Smuzhiyun
570*4882a593Smuzhiyun while (reg_value32 & BIT(3) && try_count < 3) {
571*4882a593Smuzhiyun ODM_delay_ms(3);
572*4882a593Smuzhiyun try_count = try_count + 1;
573*4882a593Smuzhiyun reg_value32 = phydm_get_bb_dbg_port_val(dm);
574*4882a593Smuzhiyun }
575*4882a593Smuzhiyun phydm_release_bb_dbg_port(dm);
576*4882a593Smuzhiyun try_count = 0;
577*4882a593Smuzhiyun }
578*4882a593Smuzhiyun
579*4882a593Smuzhiyun /*@count EDCCA signal = 1 times*/
580*4882a593Smuzhiyun for (cnt = 0; cnt < 20; cnt++) {
581*4882a593Smuzhiyun if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1,
582*4882a593Smuzhiyun adapt->adaptivity_dbg_port)) {
583*4882a593Smuzhiyun value32 = phydm_get_bb_dbg_port_val(dm);
584*4882a593Smuzhiyun phydm_release_bb_dbg_port(dm);
585*4882a593Smuzhiyun }
586*4882a593Smuzhiyun
587*4882a593Smuzhiyun if (value32 & BIT(30) && dm->support_ic_type &
588*4882a593Smuzhiyun (ODM_RTL8723B | ODM_RTL8188E))
589*4882a593Smuzhiyun tx_edcca1 = tx_edcca1 + 1;
590*4882a593Smuzhiyun else if (value32 & BIT(29))
591*4882a593Smuzhiyun tx_edcca1 = tx_edcca1 + 1;
592*4882a593Smuzhiyun }
593*4882a593Smuzhiyun
594*4882a593Smuzhiyun if (tx_edcca1 > 1) {
595*4882a593Smuzhiyun IGI = IGI - 1;
596*4882a593Smuzhiyun th_l2h = th_l2h + 1;
597*4882a593Smuzhiyun if (th_l2h > 10)
598*4882a593Smuzhiyun th_l2h = 10;
599*4882a593Smuzhiyun
600*4882a593Smuzhiyun th_h2l = th_l2h - dm->th_edcca_hl_diff;
601*4882a593Smuzhiyun phydm_set_edcca_threshold(dm, th_h2l, th_l2h);
602*4882a593Smuzhiyun tx_edcca1 = 0;
603*4882a593Smuzhiyun if (th_l2h == 10)
604*4882a593Smuzhiyun is_adjust = false;
605*4882a593Smuzhiyun
606*4882a593Smuzhiyun } else {
607*4882a593Smuzhiyun is_adjust = false;
608*4882a593Smuzhiyun }
609*4882a593Smuzhiyun }
610*4882a593Smuzhiyun
611*4882a593Smuzhiyun adapt->adapt_igi_up = IGI - ADAPT_DC_BACKOFF;
612*4882a593Smuzhiyun adapt->h2l_lb = th_h2l + ADAPT_DC_BACKOFF;
613*4882a593Smuzhiyun adapt->l2h_lb = th_l2h + ADAPT_DC_BACKOFF;
614*4882a593Smuzhiyun
615*4882a593Smuzhiyun halrf_rf_lna_setting(dm, HALRF_LNA_ENABLE);
616*4882a593Smuzhiyun phydm_set_edcca_threshold(dm, 0x7f, 0x7f); /*resume to no link state*/
617*4882a593Smuzhiyun }
618*4882a593Smuzhiyun
phydm_re_search_condition(void * dm_void)619*4882a593Smuzhiyun boolean phydm_re_search_condition(void *dm_void)
620*4882a593Smuzhiyun {
621*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
622*4882a593Smuzhiyun struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity;
623*4882a593Smuzhiyun u8 adaptivity_igi_upper = adaptivity->adapt_igi_up + ADAPT_DC_BACKOFF;
624*4882a593Smuzhiyun
625*4882a593Smuzhiyun if (adaptivity_igi_upper <= 0x26)
626*4882a593Smuzhiyun return true;
627*4882a593Smuzhiyun else
628*4882a593Smuzhiyun return false;
629*4882a593Smuzhiyun }
630*4882a593Smuzhiyun
phydm_set_l2h_th_ini(void * dm_void)631*4882a593Smuzhiyun void phydm_set_l2h_th_ini(void *dm_void)
632*4882a593Smuzhiyun {
633*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
634*4882a593Smuzhiyun
635*4882a593Smuzhiyun /*@ [New Format: JGR3]IGI-idx:45 = RSSI:35 = -65dBm*/
636*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_JGR3_SERIES) {
637*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8723F))
638*4882a593Smuzhiyun dm->th_l2h_ini = 45;
639*4882a593Smuzhiyun else if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8814C))
640*4882a593Smuzhiyun dm->th_l2h_ini = 49;
641*4882a593Smuzhiyun } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) {
642*4882a593Smuzhiyun /*@ [Old Format] -11+base(50) = IGI_idx:39 = RSSI:29 = -71dBm*/
643*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812))
644*4882a593Smuzhiyun dm->th_l2h_ini = -17;
645*4882a593Smuzhiyun else
646*4882a593Smuzhiyun dm->th_l2h_ini = -14;
647*4882a593Smuzhiyun } else { /*ODM_IC_11N_SERIES*/
648*4882a593Smuzhiyun if (dm->support_ic_type & ODM_RTL8721D)
649*4882a593Smuzhiyun dm->th_l2h_ini = -14;
650*4882a593Smuzhiyun else
651*4882a593Smuzhiyun dm->th_l2h_ini = -11;
652*4882a593Smuzhiyun }
653*4882a593Smuzhiyun }
654*4882a593Smuzhiyun
phydm_set_l2h_th_ini_carrier_sense(void * dm_void)655*4882a593Smuzhiyun void phydm_set_l2h_th_ini_carrier_sense(void *dm_void)
656*4882a593Smuzhiyun {
657*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
658*4882a593Smuzhiyun
659*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_JGR3_SERIES)
660*4882a593Smuzhiyun dm->th_l2h_ini = 60; /*@ -50dBm*/
661*4882a593Smuzhiyun else
662*4882a593Smuzhiyun dm->th_l2h_ini = 10; /*@ -50dBm*/
663*4882a593Smuzhiyun }
664*4882a593Smuzhiyun
phydm_set_forgetting_factor(void * dm_void)665*4882a593Smuzhiyun void phydm_set_forgetting_factor(void *dm_void)
666*4882a593Smuzhiyun {
667*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
668*4882a593Smuzhiyun
669*4882a593Smuzhiyun if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE)
670*4882a593Smuzhiyun return;
671*4882a593Smuzhiyun
672*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814A |
673*4882a593Smuzhiyun ODM_RTL8195B))
674*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x8a0, BIT(1) | BIT(0), 0);
675*4882a593Smuzhiyun }
676*4882a593Smuzhiyun
phydm_edcca_decision_opt(void * dm_void)677*4882a593Smuzhiyun void phydm_edcca_decision_opt(void *dm_void)
678*4882a593Smuzhiyun {
679*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
680*4882a593Smuzhiyun
681*4882a593Smuzhiyun if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE)
682*4882a593Smuzhiyun return;
683*4882a593Smuzhiyun
684*4882a593Smuzhiyun if (dm->support_ic_type & ODM_RTL8822B)
685*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x8dc, BIT(5), 0x1);
686*4882a593Smuzhiyun else if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F))
687*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0xce8, BIT(13), 0x1);
688*4882a593Smuzhiyun else if (dm->support_ic_type & ODM_IC_JGR3_SERIES)
689*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x844, BIT(30) | BIT(29), 0x0);
690*4882a593Smuzhiyun }
691*4882a593Smuzhiyun
phydm_adaptivity_debug(void * dm_void,char input[][16],u32 * _used,char * output,u32 * _out_len)692*4882a593Smuzhiyun void phydm_adaptivity_debug(void *dm_void, char input[][16], u32 *_used,
693*4882a593Smuzhiyun char *output, u32 *_out_len)
694*4882a593Smuzhiyun {
695*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
696*4882a593Smuzhiyun struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity;
697*4882a593Smuzhiyun struct phydm_l2h_ini_recorder_strcut *adapt_rc = &adaptivity->l2h_ini_recorder_t;
698*4882a593Smuzhiyun u32 used = *_used;
699*4882a593Smuzhiyun u32 out_len = *_out_len;
700*4882a593Smuzhiyun char help[] = "-h";
701*4882a593Smuzhiyun u32 dm_value[10] = {0};
702*4882a593Smuzhiyun u8 i = 0, input_idx = 0;
703*4882a593Smuzhiyun u32 reg_value32 = 0;
704*4882a593Smuzhiyun s8 h2l_diff = 0;
705*4882a593Smuzhiyun
706*4882a593Smuzhiyun for (i = 0; i < 6; i++) {
707*4882a593Smuzhiyun PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]);
708*4882a593Smuzhiyun input_idx++;
709*4882a593Smuzhiyun }
710*4882a593Smuzhiyun if (strcmp(input[1], help) == 0) {
711*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
712*4882a593Smuzhiyun "Show adaptivity message: {0}\n");
713*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
714*4882a593Smuzhiyun "Enter debug mode: {1} {th_l2h_ini} {th_edcca_hl_diff}\n");
715*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
716*4882a593Smuzhiyun "Leave debug mode: {2}\n");
717*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
718*4882a593Smuzhiyun "RTS drop debug mode: {3} {en} {low_rate_tx_fail_th[0]} {low_rate_tx_fail_th[1]} {low_rate_tx_fail_th[2]}\n");
719*4882a593Smuzhiyun goto out;
720*4882a593Smuzhiyun }
721*4882a593Smuzhiyun
722*4882a593Smuzhiyun if (input_idx == 0)
723*4882a593Smuzhiyun return;
724*4882a593Smuzhiyun
725*4882a593Smuzhiyun if (dm_value[0] == PHYDM_ADAPT_DEBUG) {
726*4882a593Smuzhiyun adaptivity->debug_mode = true;
727*4882a593Smuzhiyun if (dm_value[1] != 0)
728*4882a593Smuzhiyun dm->th_l2h_ini = (s8)dm_value[1];
729*4882a593Smuzhiyun if (dm_value[2] != 0)
730*4882a593Smuzhiyun dm->th_edcca_hl_diff = (s8)dm_value[2];
731*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
732*4882a593Smuzhiyun "th_l2h_ini = %d, th_edcca_hl_diff = %d\n",
733*4882a593Smuzhiyun dm->th_l2h_ini, dm->th_edcca_hl_diff);
734*4882a593Smuzhiyun } else if (dm_value[0] == PHYDM_ADAPT_RESUME) {
735*4882a593Smuzhiyun adaptivity->debug_mode = false;
736*4882a593Smuzhiyun dm->th_l2h_ini = adaptivity->th_l2h_ini_backup;
737*4882a593Smuzhiyun dm->th_edcca_hl_diff = adaptivity->th_edcca_hl_diff_backup;
738*4882a593Smuzhiyun } else if (dm_value[0] == PHYDM_ADAPT_MSG) {
739*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
740*4882a593Smuzhiyun "debug_mode = %s, th_l2h_ini = %d\n",
741*4882a593Smuzhiyun (adaptivity->debug_mode ? "TRUE" : "FALSE"),
742*4882a593Smuzhiyun dm->th_l2h_ini);
743*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_JGR3_SERIES) {
744*4882a593Smuzhiyun reg_value32 = odm_get_bb_reg(dm, R_0x84c, MASKDWORD);
745*4882a593Smuzhiyun h2l_diff = (s8)((0x00ff0000 & reg_value32) >> 16) -
746*4882a593Smuzhiyun (s8)((0xff000000 & reg_value32) >> 24);
747*4882a593Smuzhiyun } else if (dm->support_ic_type & ODM_IC_11N_SERIES) {
748*4882a593Smuzhiyun reg_value32 = odm_get_bb_reg(dm, R_0xc4c, MASKDWORD);
749*4882a593Smuzhiyun h2l_diff = (s8)(0x000000ff & reg_value32) -
750*4882a593Smuzhiyun (s8)((0x00ff0000 & reg_value32) >> 16);
751*4882a593Smuzhiyun } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) {
752*4882a593Smuzhiyun reg_value32 = odm_get_bb_reg(dm, R_0x8a4, MASKDWORD);
753*4882a593Smuzhiyun h2l_diff = (s8)(0x000000ff & reg_value32) -
754*4882a593Smuzhiyun (s8)((0x0000ff00 & reg_value32) >> 8);
755*4882a593Smuzhiyun }
756*4882a593Smuzhiyun
757*4882a593Smuzhiyun if (h2l_diff == 7)
758*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
759*4882a593Smuzhiyun "adaptivity enable\n");
760*4882a593Smuzhiyun else
761*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
762*4882a593Smuzhiyun "adaptivity disable\n");
763*4882a593Smuzhiyun } else if (dm_value[0] == PHYDM_L2H_INI_DEBUG) {
764*4882a593Smuzhiyun if (dm_value[1] == 1) {
765*4882a593Smuzhiyun adaptivity->is_dbg_low_rate_tx_fail_th = true;
766*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[0] = (u32)dm_value[2];
767*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[1] = (u32)dm_value[3];
768*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[2] = (u32)dm_value[4];
769*4882a593Smuzhiyun
770*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
771*4882a593Smuzhiyun "Set low_rate_tx_fail_th={%d,%d,%d}\n",
772*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[0],
773*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[1],
774*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[2]);
775*4882a593Smuzhiyun } else {
776*4882a593Smuzhiyun adaptivity->is_dbg_low_rate_tx_fail_th = false;
777*4882a593Smuzhiyun }
778*4882a593Smuzhiyun }
779*4882a593Smuzhiyun
780*4882a593Smuzhiyun out:
781*4882a593Smuzhiyun *_used = used;
782*4882a593Smuzhiyun *_out_len = out_len;
783*4882a593Smuzhiyun }
784*4882a593Smuzhiyun
phydm_set_edcca_val(void * dm_void,u32 * val_buf,u8 val_len)785*4882a593Smuzhiyun void phydm_set_edcca_val(void *dm_void, u32 *val_buf, u8 val_len)
786*4882a593Smuzhiyun {
787*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
788*4882a593Smuzhiyun
789*4882a593Smuzhiyun if (val_len != 2) {
790*4882a593Smuzhiyun PHYDM_DBG(dm, ODM_COMP_API,
791*4882a593Smuzhiyun "[Error][adaptivity]Need val_len = 2\n");
792*4882a593Smuzhiyun return;
793*4882a593Smuzhiyun }
794*4882a593Smuzhiyun phydm_set_edcca_threshold(dm, (s8)val_buf[1], (s8)val_buf[0]);
795*4882a593Smuzhiyun }
796*4882a593Smuzhiyun
phydm_edcca_abort(void * dm_void)797*4882a593Smuzhiyun boolean phydm_edcca_abort(void *dm_void)
798*4882a593Smuzhiyun {
799*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
800*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
801*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
802*4882a593Smuzhiyun void *adapter = dm->adapter;
803*4882a593Smuzhiyun u32 is_fw_in_psmode = false;
804*4882a593Smuzhiyun #endif
805*4882a593Smuzhiyun
806*4882a593Smuzhiyun if (!(dm->support_ability & ODM_BB_ADAPTIVITY)) {
807*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "adaptivity disable\n");
808*4882a593Smuzhiyun return true;
809*4882a593Smuzhiyun }
810*4882a593Smuzhiyun
811*4882a593Smuzhiyun if (dm->pause_ability & ODM_BB_ADAPTIVITY) {
812*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "Return: Pause ADPTVTY in LV=%d\n",
813*4882a593Smuzhiyun dm->pause_lv_table.lv_adapt);
814*4882a593Smuzhiyun return true;
815*4882a593Smuzhiyun }
816*4882a593Smuzhiyun
817*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
818*4882a593Smuzhiyun ((PADAPTER)adapter)->HalFunc.GetHwRegHandler(adapter,
819*4882a593Smuzhiyun HW_VAR_FW_PSMODE_STATUS,
820*4882a593Smuzhiyun (u8 *)(&is_fw_in_psmode));
821*4882a593Smuzhiyun
822*4882a593Smuzhiyun /*@Disable EDCCA while under LPS mode, added by Roger, 2012.09.14.*/
823*4882a593Smuzhiyun if (is_fw_in_psmode)
824*4882a593Smuzhiyun return true;
825*4882a593Smuzhiyun #endif
826*4882a593Smuzhiyun
827*4882a593Smuzhiyun return false;
828*4882a593Smuzhiyun }
829*4882a593Smuzhiyun
phydm_edcca_thre_calc_jgr3(void * dm_void)830*4882a593Smuzhiyun void phydm_edcca_thre_calc_jgr3(void *dm_void)
831*4882a593Smuzhiyun {
832*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
833*4882a593Smuzhiyun struct phydm_dig_struct *dig_t = &dm->dm_dig_table;
834*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
835*4882a593Smuzhiyun u8 igi = dig_t->cur_ig_value;
836*4882a593Smuzhiyun s8 th_l2h = 0, th_h2l = 0;
837*4882a593Smuzhiyun
838*4882a593Smuzhiyun if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) {
839*4882a593Smuzhiyun /*prevent pwdB clipping and result in Miss Detection*/
840*4882a593Smuzhiyun adapt->l2h_dyn_min = (u8)(dm->th_l2h_ini - ADC_BACKOFF);
841*4882a593Smuzhiyun
842*4882a593Smuzhiyun if (igi < adapt->l2h_dyn_min)
843*4882a593Smuzhiyun th_l2h = igi + ADC_BACKOFF;
844*4882a593Smuzhiyun else
845*4882a593Smuzhiyun th_l2h = dm->th_l2h_ini;
846*4882a593Smuzhiyun
847*4882a593Smuzhiyun th_h2l = th_l2h - dm->th_edcca_hl_diff;
848*4882a593Smuzhiyun } else {
849*4882a593Smuzhiyun th_l2h = MAX_2(igi + TH_L2H_DIFF_IGI, EDCCA_TH_L2H_LB);
850*4882a593Smuzhiyun th_h2l = th_l2h - EDCCA_HL_DIFF_NORMAL;
851*4882a593Smuzhiyun }
852*4882a593Smuzhiyun adapt->th_l2h = th_l2h;
853*4882a593Smuzhiyun adapt->th_h2l = th_h2l;
854*4882a593Smuzhiyun
855*4882a593Smuzhiyun phydm_set_edcca_threshold(dm, adapt->th_h2l, adapt->th_l2h);
856*4882a593Smuzhiyun }
857*4882a593Smuzhiyun
phydm_edcca_thre_calc(void * dm_void)858*4882a593Smuzhiyun void phydm_edcca_thre_calc(void *dm_void)
859*4882a593Smuzhiyun {
860*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
861*4882a593Smuzhiyun struct phydm_dig_struct *dig_t = &dm->dm_dig_table;
862*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
863*4882a593Smuzhiyun u8 igi = dig_t->cur_ig_value;
864*4882a593Smuzhiyun s8 th_l2h = 0, th_h2l = 0;
865*4882a593Smuzhiyun s8 diff = 0, igi_target = adapt->igi_base;
866*4882a593Smuzhiyun
867*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_PWDB_EDCCA) {
868*4882a593Smuzhiyun /*@fix EDCCA hang issue*/
869*4882a593Smuzhiyun if (dm->support_ic_type & ODM_RTL8812) {
870*4882a593Smuzhiyun /*@ADC_mask disable*/
871*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x800, BIT(10), 1);
872*4882a593Smuzhiyun /*@ADC_mask enable*/
873*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x800, BIT(10), 0);
874*4882a593Smuzhiyun }
875*4882a593Smuzhiyun
876*4882a593Smuzhiyun if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) {
877*4882a593Smuzhiyun /*@Limit IGI upper bound for adaptivity*/
878*4882a593Smuzhiyun phydm_dig_up_bound_lmt_en(dm);
879*4882a593Smuzhiyun diff = igi_target - (s8)igi;
880*4882a593Smuzhiyun th_l2h = dm->th_l2h_ini + diff;
881*4882a593Smuzhiyun if (th_l2h > 10)
882*4882a593Smuzhiyun th_l2h = 10;
883*4882a593Smuzhiyun
884*4882a593Smuzhiyun th_h2l = th_l2h - dm->th_edcca_hl_diff;
885*4882a593Smuzhiyun } else {
886*4882a593Smuzhiyun th_l2h = 70 - igi;
887*4882a593Smuzhiyun th_h2l = th_l2h - EDCCA_HL_DIFF_NORMAL;
888*4882a593Smuzhiyun }
889*4882a593Smuzhiyun /*replace lower bound to prevent EDCCA always equal 1*/
890*4882a593Smuzhiyun if (th_h2l < adapt->h2l_lb)
891*4882a593Smuzhiyun th_h2l = adapt->h2l_lb;
892*4882a593Smuzhiyun if (th_l2h < adapt->l2h_lb)
893*4882a593Smuzhiyun th_l2h = adapt->l2h_lb;
894*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
895*4882a593Smuzhiyun "adapt_igi_up=0x%x, l2h_lb = %d dBm, h2l_lb = %d dBm\n",
896*4882a593Smuzhiyun adapt->adapt_igi_up,
897*4882a593Smuzhiyun IGI_2_DBM(adapt->l2h_lb + adapt->adapt_igi_up),
898*4882a593Smuzhiyun IGI_2_DBM(adapt->h2l_lb + adapt->adapt_igi_up));
899*4882a593Smuzhiyun } else { /* < JGR2 & N*/
900*4882a593Smuzhiyun if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE) {
901*4882a593Smuzhiyun /*need to consider PwdB upper bound for 8814 later IC*/
902*4882a593Smuzhiyun adapt->l2h_dyn_min = (u8)(dm->th_l2h_ini + igi_target);
903*4882a593Smuzhiyun
904*4882a593Smuzhiyun if (igi < adapt->l2h_dyn_min)
905*4882a593Smuzhiyun th_l2h = igi;
906*4882a593Smuzhiyun else
907*4882a593Smuzhiyun th_l2h = adapt->l2h_dyn_min;
908*4882a593Smuzhiyun
909*4882a593Smuzhiyun th_h2l = th_l2h - dm->th_edcca_hl_diff;
910*4882a593Smuzhiyun } else {
911*4882a593Smuzhiyun th_l2h = MAX_2(igi + TH_L2H_DIFF_IGI, EDCCA_TH_L2H_LB);
912*4882a593Smuzhiyun th_h2l = th_l2h - EDCCA_HL_DIFF_NORMAL;
913*4882a593Smuzhiyun }
914*4882a593Smuzhiyun }
915*4882a593Smuzhiyun
916*4882a593Smuzhiyun adapt->th_l2h = th_l2h;
917*4882a593Smuzhiyun adapt->th_h2l = th_h2l;
918*4882a593Smuzhiyun
919*4882a593Smuzhiyun phydm_set_edcca_threshold(dm, adapt->th_h2l, adapt->th_l2h);
920*4882a593Smuzhiyun }
921*4882a593Smuzhiyun #endif
922*4882a593Smuzhiyun
phydm_set_edcca_threshold_api(void * dm_void)923*4882a593Smuzhiyun void phydm_set_edcca_threshold_api(void *dm_void)
924*4882a593Smuzhiyun {
925*4882a593Smuzhiyun #ifdef PHYDM_SUPPORT_ADAPTIVITY
926*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
927*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
928*4882a593Smuzhiyun
929*4882a593Smuzhiyun if (*dm->edcca_mode != PHYDM_EDCCA_ADAPT_MODE)
930*4882a593Smuzhiyun return;
931*4882a593Smuzhiyun
932*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_JGR3_SERIES)
933*4882a593Smuzhiyun phydm_edcca_thre_calc_jgr3(dm);
934*4882a593Smuzhiyun else
935*4882a593Smuzhiyun phydm_edcca_thre_calc(dm);
936*4882a593Smuzhiyun
937*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
938*4882a593Smuzhiyun "API :IGI = 0x%x, th_l2h = %d, th_h2l = %d\n",
939*4882a593Smuzhiyun dm->dm_dig_table.cur_ig_value, adapt->th_l2h, adapt->th_h2l);
940*4882a593Smuzhiyun #endif
941*4882a593Smuzhiyun }
942*4882a593Smuzhiyun
phydm_adaptivity_info_init(void * dm_void,enum phydm_adapinfo cmn_info,u32 value)943*4882a593Smuzhiyun void phydm_adaptivity_info_init(void *dm_void, enum phydm_adapinfo cmn_info,
944*4882a593Smuzhiyun u32 value)
945*4882a593Smuzhiyun {
946*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
947*4882a593Smuzhiyun struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity;
948*4882a593Smuzhiyun
949*4882a593Smuzhiyun switch (cmn_info) {
950*4882a593Smuzhiyun case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE:
951*4882a593Smuzhiyun dm->carrier_sense_enable = (boolean)value;
952*4882a593Smuzhiyun break;
953*4882a593Smuzhiyun case PHYDM_ADAPINFO_TH_L2H_INI:
954*4882a593Smuzhiyun dm->th_l2h_ini = (s8)value;
955*4882a593Smuzhiyun break;
956*4882a593Smuzhiyun case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF:
957*4882a593Smuzhiyun dm->th_edcca_hl_diff = (s8)value;
958*4882a593Smuzhiyun break;
959*4882a593Smuzhiyun case PHYDM_ADAPINFO_AP_NUM_TH:
960*4882a593Smuzhiyun adaptivity->ap_num_th = (u8)value;
961*4882a593Smuzhiyun break;
962*4882a593Smuzhiyun case PHYDM_ADAPINFO_SWITCH_TH_L2H_INI_IN_BAND:
963*4882a593Smuzhiyun adaptivity->switch_th_l2h_ini_in_band = (u8)value;
964*4882a593Smuzhiyun break;
965*4882a593Smuzhiyun default:
966*4882a593Smuzhiyun break;
967*4882a593Smuzhiyun }
968*4882a593Smuzhiyun }
969*4882a593Smuzhiyun
phydm_adaptivity_info_update(void * dm_void,enum phydm_adapinfo cmn_info,u32 value)970*4882a593Smuzhiyun void phydm_adaptivity_info_update(void *dm_void, enum phydm_adapinfo cmn_info,
971*4882a593Smuzhiyun u32 value)
972*4882a593Smuzhiyun {
973*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
974*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
975*4882a593Smuzhiyun
976*4882a593Smuzhiyun /*This init variable may be changed in run time.*/
977*4882a593Smuzhiyun switch (cmn_info) {
978*4882a593Smuzhiyun case PHYDM_ADAPINFO_DOMAIN_CODE_2G:
979*4882a593Smuzhiyun adapt->regulation_2g = (u8)value;
980*4882a593Smuzhiyun break;
981*4882a593Smuzhiyun case PHYDM_ADAPINFO_DOMAIN_CODE_5G:
982*4882a593Smuzhiyun adapt->regulation_5g = (u8)value;
983*4882a593Smuzhiyun break;
984*4882a593Smuzhiyun default:
985*4882a593Smuzhiyun break;
986*4882a593Smuzhiyun }
987*4882a593Smuzhiyun }
988*4882a593Smuzhiyun
phydm_adaptivity_init(void * dm_void)989*4882a593Smuzhiyun void phydm_adaptivity_init(void *dm_void)
990*4882a593Smuzhiyun {
991*4882a593Smuzhiyun #ifdef PHYDM_SUPPORT_ADAPTIVITY
992*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
993*4882a593Smuzhiyun struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity;
994*4882a593Smuzhiyun
995*4882a593Smuzhiyun /* @[Config Adaptivity]*/
996*4882a593Smuzhiyun if (!dm->edcca_mode) {
997*4882a593Smuzhiyun pr_debug("[%s] warning!\n", __func__);
998*4882a593Smuzhiyun dm->edcca_mode = &dm->u8_dummy;
999*4882a593Smuzhiyun dm->support_ability &= ~ODM_BB_ADAPTIVITY;
1000*4882a593Smuzhiyun return;
1001*4882a593Smuzhiyun }
1002*4882a593Smuzhiyun
1003*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE & ODM_WIN)
1004*4882a593Smuzhiyun if (!dm->carrier_sense_enable) {
1005*4882a593Smuzhiyun if (dm->th_l2h_ini == 0 &&
1006*4882a593Smuzhiyun !adaptivity->switch_th_l2h_ini_in_band)
1007*4882a593Smuzhiyun phydm_set_l2h_th_ini(dm);
1008*4882a593Smuzhiyun } else {
1009*4882a593Smuzhiyun phydm_set_l2h_th_ini_carrier_sense(dm);
1010*4882a593Smuzhiyun }
1011*4882a593Smuzhiyun
1012*4882a593Smuzhiyun if (dm->th_edcca_hl_diff == 0)
1013*4882a593Smuzhiyun dm->th_edcca_hl_diff = 7;
1014*4882a593Smuzhiyun
1015*4882a593Smuzhiyun if (dm->wifi_test & RT_WIFI_LOGO)
1016*4882a593Smuzhiyun dm->support_ability &= ~ODM_BB_ADAPTIVITY;
1017*4882a593Smuzhiyun
1018*4882a593Smuzhiyun if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE)
1019*4882a593Smuzhiyun adaptivity->mode_cvrt_en = true;
1020*4882a593Smuzhiyun else
1021*4882a593Smuzhiyun adaptivity->mode_cvrt_en = false;
1022*4882a593Smuzhiyun
1023*4882a593Smuzhiyun if (dm->support_ic_type & ODM_RTL8822C) {
1024*4882a593Smuzhiyun adaptivity->l2h_ini_range_max = 45;
1025*4882a593Smuzhiyun adaptivity->l2h_ini_range_min = 35;
1026*4882a593Smuzhiyun } else {
1027*4882a593Smuzhiyun adaptivity->l2h_ini_range_max = dm->th_l2h_ini;
1028*4882a593Smuzhiyun adaptivity->l2h_ini_range_min = dm->th_l2h_ini;
1029*4882a593Smuzhiyun }
1030*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[0] = 2;
1031*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[1] = 2;
1032*4882a593Smuzhiyun adaptivity->low_rate_tx_fail_th[2] = 5;
1033*4882a593Smuzhiyun adaptivity->is_dbg_low_rate_tx_fail_th = false;
1034*4882a593Smuzhiyun adaptivity->rts_drop_en = false;
1035*4882a593Smuzhiyun phydm_l2h_ini_recorder_reset(dm);
1036*4882a593Smuzhiyun #elif (DM_ODM_SUPPORT_TYPE & ODM_CE)
1037*4882a593Smuzhiyun if (!dm->carrier_sense_enable) {
1038*4882a593Smuzhiyun if (dm->th_l2h_ini == 0)
1039*4882a593Smuzhiyun phydm_set_l2h_th_ini(dm);
1040*4882a593Smuzhiyun } else {
1041*4882a593Smuzhiyun phydm_set_l2h_th_ini_carrier_sense(dm);
1042*4882a593Smuzhiyun }
1043*4882a593Smuzhiyun
1044*4882a593Smuzhiyun if (dm->th_edcca_hl_diff == 0)
1045*4882a593Smuzhiyun dm->th_edcca_hl_diff = 7;
1046*4882a593Smuzhiyun
1047*4882a593Smuzhiyun if (dm->wifi_test || *dm->mp_mode)
1048*4882a593Smuzhiyun dm->support_ability &= ~ODM_BB_ADAPTIVITY;
1049*4882a593Smuzhiyun #elif (DM_ODM_SUPPORT_TYPE & ODM_AP)
1050*4882a593Smuzhiyun if (dm->carrier_sense_enable) {
1051*4882a593Smuzhiyun phydm_set_l2h_th_ini_carrier_sense(dm);
1052*4882a593Smuzhiyun dm->th_edcca_hl_diff = 7;
1053*4882a593Smuzhiyun } else {
1054*4882a593Smuzhiyun dm->th_l2h_ini = dm->TH_L2H_default; /*set by mib*/
1055*4882a593Smuzhiyun dm->th_edcca_hl_diff = dm->th_edcca_hl_diff_default;
1056*4882a593Smuzhiyun }
1057*4882a593Smuzhiyun #elif (DM_ODM_SUPPORT_TYPE & ODM_IOT)
1058*4882a593Smuzhiyun if (!dm->carrier_sense_enable) {
1059*4882a593Smuzhiyun if (dm->th_l2h_ini == 0)
1060*4882a593Smuzhiyun phydm_set_l2h_th_ini(dm);
1061*4882a593Smuzhiyun } else {
1062*4882a593Smuzhiyun phydm_set_l2h_th_ini_carrier_sense(dm);
1063*4882a593Smuzhiyun }
1064*4882a593Smuzhiyun
1065*4882a593Smuzhiyun if (dm->th_edcca_hl_diff == 0)
1066*4882a593Smuzhiyun dm->th_edcca_hl_diff = 7;
1067*4882a593Smuzhiyun #endif
1068*4882a593Smuzhiyun
1069*4882a593Smuzhiyun adaptivity->debug_mode = false;
1070*4882a593Smuzhiyun adaptivity->th_l2h_ini_backup = dm->th_l2h_ini;
1071*4882a593Smuzhiyun adaptivity->th_edcca_hl_diff_backup = dm->th_edcca_hl_diff;
1072*4882a593Smuzhiyun adaptivity->igi_base = 0x32;
1073*4882a593Smuzhiyun adaptivity->adapt_igi_up = 0;
1074*4882a593Smuzhiyun adaptivity->h2l_lb = 0;
1075*4882a593Smuzhiyun adaptivity->l2h_lb = 0;
1076*4882a593Smuzhiyun adaptivity->l2h_dyn_min = 0;
1077*4882a593Smuzhiyun adaptivity->th_l2h = 0x7f;
1078*4882a593Smuzhiyun adaptivity->th_h2l = 0x7f;
1079*4882a593Smuzhiyun
1080*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_11N_SERIES)
1081*4882a593Smuzhiyun adaptivity->adaptivity_dbg_port = 0x208;
1082*4882a593Smuzhiyun else if (dm->support_ic_type & ODM_IC_11AC_SERIES)
1083*4882a593Smuzhiyun adaptivity->adaptivity_dbg_port = 0x209;
1084*4882a593Smuzhiyun
1085*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_11N_SERIES &&
1086*4882a593Smuzhiyun !(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) {
1087*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) {
1088*4882a593Smuzhiyun /*set to page B1*/
1089*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0xe28, BIT(30), 0x1);
1090*4882a593Smuzhiyun /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/
1091*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0xbc0, BIT(27) | BIT(26), 0x1);
1092*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0xe28, BIT(30), 0x0);
1093*4882a593Smuzhiyun } else {
1094*4882a593Smuzhiyun /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/
1095*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0xe24, BIT(21) | BIT(20), 0x1);
1096*4882a593Smuzhiyun }
1097*4882a593Smuzhiyun } else if (dm->support_ic_type & ODM_IC_11AC_SERIES &&
1098*4882a593Smuzhiyun !(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) {
1099*4882a593Smuzhiyun /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/
1100*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x944, BIT(29) | BIT(28), 0x1);
1101*4882a593Smuzhiyun }
1102*4882a593Smuzhiyun
1103*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_PWDB_EDCCA) {
1104*4882a593Smuzhiyun phydm_search_pwdb_lower_bound(dm);
1105*4882a593Smuzhiyun if (phydm_re_search_condition(dm))
1106*4882a593Smuzhiyun phydm_search_pwdb_lower_bound(dm);
1107*4882a593Smuzhiyun } else {
1108*4882a593Smuzhiyun /*resume to no link state*/
1109*4882a593Smuzhiyun phydm_set_edcca_threshold(dm, 0x7f, 0x7f);
1110*4882a593Smuzhiyun }
1111*4882a593Smuzhiyun
1112*4882a593Smuzhiyun /*@whether to ignore EDCCA*/
1113*4882a593Smuzhiyun phydm_mac_edcca_state(dm, PHYDM_DONT_IGNORE_EDCCA);
1114*4882a593Smuzhiyun
1115*4882a593Smuzhiyun /*@forgetting factor setting*/
1116*4882a593Smuzhiyun phydm_set_forgetting_factor(dm);
1117*4882a593Smuzhiyun
1118*4882a593Smuzhiyun /*@EDCCA behavior based on maximum or mean power*/
1119*4882a593Smuzhiyun phydm_edcca_decision_opt(dm);
1120*4882a593Smuzhiyun
1121*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
1122*4882a593Smuzhiyun adaptivity->igi_up_bound_lmt_val = 180;
1123*4882a593Smuzhiyun #else
1124*4882a593Smuzhiyun adaptivity->igi_up_bound_lmt_val = 90;
1125*4882a593Smuzhiyun #endif
1126*4882a593Smuzhiyun adaptivity->igi_up_bound_lmt_cnt = 0;
1127*4882a593Smuzhiyun adaptivity->igi_lmt_en = false;
1128*4882a593Smuzhiyun #endif
1129*4882a593Smuzhiyun }
1130*4882a593Smuzhiyun
phydm_adaptivity(void * dm_void)1131*4882a593Smuzhiyun void phydm_adaptivity(void *dm_void)
1132*4882a593Smuzhiyun {
1133*4882a593Smuzhiyun #ifdef PHYDM_SUPPORT_ADAPTIVITY
1134*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1135*4882a593Smuzhiyun struct phydm_adaptivity_struct *adapt = &dm->adaptivity;
1136*4882a593Smuzhiyun struct phydm_dig_struct *dig_t = &dm->dm_dig_table;
1137*4882a593Smuzhiyun
1138*4882a593Smuzhiyun if (phydm_edcca_abort(dm))
1139*4882a593Smuzhiyun return;
1140*4882a593Smuzhiyun
1141*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
1142*4882a593Smuzhiyun phydm_check_adaptivity(dm); /*@Check adaptivity enable*/
1143*4882a593Smuzhiyun
1144*4882a593Smuzhiyun if (!dm->carrier_sense_enable &&
1145*4882a593Smuzhiyun !adapt->debug_mode &&
1146*4882a593Smuzhiyun adapt->switch_th_l2h_ini_in_band)
1147*4882a593Smuzhiyun phydm_set_l2h_th_ini_win(dm);
1148*4882a593Smuzhiyun
1149*4882a593Smuzhiyun if (dm->support_ic_type & ODM_RTL8822C)
1150*4882a593Smuzhiyun phydm_dyn_l2h_ini(dm);
1151*4882a593Smuzhiyun #endif
1152*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
1153*4882a593Smuzhiyun if (!adapt->debug_mode) {
1154*4882a593Smuzhiyun if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE &&
1155*4882a593Smuzhiyun dm->carrier_sense_enable)
1156*4882a593Smuzhiyun phydm_set_l2h_th_ini_carrier_sense(dm);
1157*4882a593Smuzhiyun else if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE)
1158*4882a593Smuzhiyun phydm_set_l2h_th_ini(dm);
1159*4882a593Smuzhiyun }
1160*4882a593Smuzhiyun #endif
1161*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "%s ====>\n", __func__);
1162*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY, "mode = %s, debug_mode = %d\n",
1163*4882a593Smuzhiyun (*dm->edcca_mode ?
1164*4882a593Smuzhiyun (dm->carrier_sense_enable ?
1165*4882a593Smuzhiyun "CARRIER SENSE" :
1166*4882a593Smuzhiyun "ADAPTIVITY") :
1167*4882a593Smuzhiyun "NORMAL"),
1168*4882a593Smuzhiyun adapt->debug_mode);
1169*4882a593Smuzhiyun
1170*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_JGR3_SERIES)
1171*4882a593Smuzhiyun phydm_edcca_thre_calc_jgr3(dm);
1172*4882a593Smuzhiyun else
1173*4882a593Smuzhiyun phydm_edcca_thre_calc(dm);
1174*4882a593Smuzhiyun
1175*4882a593Smuzhiyun if (*dm->edcca_mode == PHYDM_EDCCA_ADAPT_MODE)
1176*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
1177*4882a593Smuzhiyun "th_l2h_ini = %d, th_edcca_hl_diff = %d\n",
1178*4882a593Smuzhiyun dm->th_l2h_ini, dm->th_edcca_hl_diff);
1179*4882a593Smuzhiyun if (dm->support_ic_type & ODM_IC_PWDB_EDCCA)
1180*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
1181*4882a593Smuzhiyun "IGI = 0x%x, th_l2h = %d dBm, th_h2l = %d dBm\n",
1182*4882a593Smuzhiyun dig_t->cur_ig_value,
1183*4882a593Smuzhiyun IGI_2_DBM(adapt->th_l2h + dig_t->cur_ig_value),
1184*4882a593Smuzhiyun IGI_2_DBM(adapt->th_h2l + dig_t->cur_ig_value));
1185*4882a593Smuzhiyun else
1186*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_ADPTVTY,
1187*4882a593Smuzhiyun "IGI = 0x%x, th_l2h = %d dBm, th_h2l = %d dBm\n",
1188*4882a593Smuzhiyun dig_t->cur_ig_value,
1189*4882a593Smuzhiyun IGI_2_DBM(adapt->th_l2h),
1190*4882a593Smuzhiyun IGI_2_DBM(adapt->th_h2l));
1191*4882a593Smuzhiyun #endif
1192*4882a593Smuzhiyun }
1193*4882a593Smuzhiyun
1194