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
phydm_is_vht_rate(void * dm_void,u8 rate)32*4882a593Smuzhiyun boolean phydm_is_vht_rate(void *dm_void, u8 rate)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun return ((rate & 0x7f) >= ODM_RATEVHTSS1MCS0) ? true : false;
35*4882a593Smuzhiyun }
36*4882a593Smuzhiyun
phydm_is_ht_rate(void * dm_void,u8 rate)37*4882a593Smuzhiyun boolean phydm_is_ht_rate(void *dm_void, u8 rate)
38*4882a593Smuzhiyun {
39*4882a593Smuzhiyun return (((rate & 0x7f) >= ODM_RATEMCS0) &&
40*4882a593Smuzhiyun ((rate & 0x7f) <= ODM_RATEMCS31)) ? true : false;
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun
phydm_is_ofdm_rate(void * dm_void,u8 rate)43*4882a593Smuzhiyun boolean phydm_is_ofdm_rate(void *dm_void, u8 rate)
44*4882a593Smuzhiyun {
45*4882a593Smuzhiyun return (((rate & 0x7f) >= ODM_RATE6M) &&
46*4882a593Smuzhiyun ((rate & 0x7f) <= ODM_RATE54M)) ? true : false;
47*4882a593Smuzhiyun }
48*4882a593Smuzhiyun
phydm_is_cck_rate(void * dm_void,u8 rate)49*4882a593Smuzhiyun boolean phydm_is_cck_rate(void *dm_void, u8 rate)
50*4882a593Smuzhiyun {
51*4882a593Smuzhiyun return ((rate & 0x7f) <= ODM_RATE11M) ? true : false;
52*4882a593Smuzhiyun }
53*4882a593Smuzhiyun
phydm_legacy_rate_2_spec_rate(void * dm_void,u8 rate)54*4882a593Smuzhiyun u8 phydm_legacy_rate_2_spec_rate(void *dm_void, u8 rate)
55*4882a593Smuzhiyun {
56*4882a593Smuzhiyun u8 rate_idx = 0x0;
57*4882a593Smuzhiyun u8 legacy_spec_rate_t[8] = {PHYDM_SPEC_RATE_6M, PHYDM_SPEC_RATE_9M,
58*4882a593Smuzhiyun PHYDM_SPEC_RATE_12M, PHYDM_SPEC_RATE_18M,
59*4882a593Smuzhiyun PHYDM_SPEC_RATE_24M, PHYDM_SPEC_RATE_36M,
60*4882a593Smuzhiyun PHYDM_SPEC_RATE_48M, PHYDM_SPEC_RATE_54M};
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun if ((rate >= ODM_RATE6M) && (rate <= ODM_RATE54M))
63*4882a593Smuzhiyun rate_idx = rate - ODM_RATE6M;
64*4882a593Smuzhiyun return legacy_spec_rate_t[rate_idx];
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
phydm_rate_2_rate_digit(void * dm_void,u8 rate)67*4882a593Smuzhiyun u8 phydm_rate_2_rate_digit(void *dm_void, u8 rate)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun u8 legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54};
70*4882a593Smuzhiyun u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/
71*4882a593Smuzhiyun u8 rate_digit = 0;
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun if (rate_idx >= ODM_RATEVHTSS1MCS0)
74*4882a593Smuzhiyun rate_digit = (rate_idx - ODM_RATEVHTSS1MCS0) % 10;
75*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEMCS0)
76*4882a593Smuzhiyun rate_digit = (rate_idx - ODM_RATEMCS0);
77*4882a593Smuzhiyun else if (rate_idx <= ODM_RATE54M)
78*4882a593Smuzhiyun rate_digit = legacy_table[rate_idx];
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun return rate_digit;
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun
phydm_rate_type_2_num_ss(void * dm_void,enum PDM_RATE_TYPE type)83*4882a593Smuzhiyun u8 phydm_rate_type_2_num_ss(void *dm_void, enum PDM_RATE_TYPE type)
84*4882a593Smuzhiyun {
85*4882a593Smuzhiyun u8 num_ss = 1;
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun switch (type) {
88*4882a593Smuzhiyun case PDM_CCK:
89*4882a593Smuzhiyun case PDM_OFDM:
90*4882a593Smuzhiyun case PDM_1SS:
91*4882a593Smuzhiyun num_ss = 1;
92*4882a593Smuzhiyun break;
93*4882a593Smuzhiyun case PDM_2SS:
94*4882a593Smuzhiyun num_ss = 2;
95*4882a593Smuzhiyun break;
96*4882a593Smuzhiyun case PDM_3SS:
97*4882a593Smuzhiyun num_ss = 3;
98*4882a593Smuzhiyun break;
99*4882a593Smuzhiyun case PDM_4SS:
100*4882a593Smuzhiyun num_ss = 4;
101*4882a593Smuzhiyun break;
102*4882a593Smuzhiyun default:
103*4882a593Smuzhiyun break;
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun return num_ss;
107*4882a593Smuzhiyun }
108*4882a593Smuzhiyun
phydm_rate_to_num_ss(void * dm_void,u8 data_rate)109*4882a593Smuzhiyun u8 phydm_rate_to_num_ss(void *dm_void, u8 data_rate)
110*4882a593Smuzhiyun {
111*4882a593Smuzhiyun u8 num_ss = 1;
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun if (data_rate <= ODM_RATE54M)
114*4882a593Smuzhiyun num_ss = 1;
115*4882a593Smuzhiyun else if (data_rate <= ODM_RATEMCS31)
116*4882a593Smuzhiyun num_ss = ((data_rate - ODM_RATEMCS0) >> 3) + 1;
117*4882a593Smuzhiyun else if (data_rate <= ODM_RATEVHTSS1MCS9)
118*4882a593Smuzhiyun num_ss = 1;
119*4882a593Smuzhiyun else if (data_rate <= ODM_RATEVHTSS2MCS9)
120*4882a593Smuzhiyun num_ss = 2;
121*4882a593Smuzhiyun else if (data_rate <= ODM_RATEVHTSS3MCS9)
122*4882a593Smuzhiyun num_ss = 3;
123*4882a593Smuzhiyun else if (data_rate <= ODM_RATEVHTSS4MCS9)
124*4882a593Smuzhiyun num_ss = 4;
125*4882a593Smuzhiyun
126*4882a593Smuzhiyun return num_ss;
127*4882a593Smuzhiyun }
128*4882a593Smuzhiyun
phydm_h2C_debug(void * dm_void,char input[][16],u32 * _used,char * output,u32 * _out_len)129*4882a593Smuzhiyun void phydm_h2C_debug(void *dm_void, char input[][16], u32 *_used,
130*4882a593Smuzhiyun char *output, u32 *_out_len)
131*4882a593Smuzhiyun {
132*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
133*4882a593Smuzhiyun u32 used = *_used;
134*4882a593Smuzhiyun u32 out_len = *_out_len;
135*4882a593Smuzhiyun u32 dm_value[10] = {0};
136*4882a593Smuzhiyun u8 i = 0, input_idx = 0;
137*4882a593Smuzhiyun u8 h2c_parameter[H2C_MAX_LENGTH] = {0};
138*4882a593Smuzhiyun u8 phydm_h2c_id = 0;
139*4882a593Smuzhiyun
140*4882a593Smuzhiyun for (i = 0; i < 8; i++) {
141*4882a593Smuzhiyun PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]);
142*4882a593Smuzhiyun input_idx++;
143*4882a593Smuzhiyun }
144*4882a593Smuzhiyun
145*4882a593Smuzhiyun if (input_idx == 0)
146*4882a593Smuzhiyun return;
147*4882a593Smuzhiyun
148*4882a593Smuzhiyun phydm_h2c_id = (u8)dm_value[0];
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
151*4882a593Smuzhiyun "Phydm Send H2C_ID (( 0x%x))\n", phydm_h2c_id);
152*4882a593Smuzhiyun
153*4882a593Smuzhiyun for (i = 0; i < H2C_MAX_LENGTH; i++) {
154*4882a593Smuzhiyun h2c_parameter[i] = (u8)dm_value[i + 1];
155*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
156*4882a593Smuzhiyun "H2C: Byte[%d] = ((0x%x))\n", i, h2c_parameter[i]);
157*4882a593Smuzhiyun }
158*4882a593Smuzhiyun
159*4882a593Smuzhiyun odm_fill_h2c_cmd(dm, phydm_h2c_id, H2C_MAX_LENGTH, h2c_parameter);
160*4882a593Smuzhiyun
161*4882a593Smuzhiyun *_used = used;
162*4882a593Smuzhiyun *_out_len = out_len;
163*4882a593Smuzhiyun }
164*4882a593Smuzhiyun
phydm_fw_fix_rate(void * dm_void,u8 en,u8 macid,u8 bw,u8 rate)165*4882a593Smuzhiyun void phydm_fw_fix_rate(void *dm_void, u8 en, u8 macid, u8 bw, u8 rate)
166*4882a593Smuzhiyun {
167*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
168*4882a593Smuzhiyun u32 reg_u32_tmp;
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun if (dm->support_ic_type & PHYDM_IC_8051_SERIES) {
171*4882a593Smuzhiyun reg_u32_tmp = (bw << 24) | (rate << 16) | (macid << 8) | en;
172*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4a0, MASKDWORD, reg_u32_tmp);
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun } else {
175*4882a593Smuzhiyun if (en == 1)
176*4882a593Smuzhiyun reg_u32_tmp = BYTE_2_DWORD(0x60, macid, bw, rate);
177*4882a593Smuzhiyun else
178*4882a593Smuzhiyun reg_u32_tmp = 0x40000000;
179*4882a593Smuzhiyun if (dm->support_ic_type & ODM_RTL8814B)
180*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x448, MASKDWORD, reg_u32_tmp);
181*4882a593Smuzhiyun else
182*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x450, MASKDWORD, reg_u32_tmp);
183*4882a593Smuzhiyun }
184*4882a593Smuzhiyun if (en == 1) {
185*4882a593Smuzhiyun PHYDM_DBG(dm, ODM_COMP_API,
186*4882a593Smuzhiyun "FW fix TX rate[id =%d], %dM, Rate(%d)=", macid,
187*4882a593Smuzhiyun (20 << bw), rate);
188*4882a593Smuzhiyun phydm_print_rate(dm, rate, ODM_COMP_API);
189*4882a593Smuzhiyun } else {
190*4882a593Smuzhiyun PHYDM_DBG(dm, ODM_COMP_API, "Auto Rate\n");
191*4882a593Smuzhiyun }
192*4882a593Smuzhiyun }
193*4882a593Smuzhiyun
phydm_ra_debug(void * dm_void,char input[][16],u32 * _used,char * output,u32 * _out_len)194*4882a593Smuzhiyun void phydm_ra_debug(void *dm_void, char input[][16], u32 *_used, char *output,
195*4882a593Smuzhiyun u32 *_out_len)
196*4882a593Smuzhiyun {
197*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
198*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
199*4882a593Smuzhiyun u32 used = *_used;
200*4882a593Smuzhiyun u32 out_len = *_out_len;
201*4882a593Smuzhiyun char help[] = "-h";
202*4882a593Smuzhiyun u32 var[5] = {0};
203*4882a593Smuzhiyun u8 macid = 0, bw = 0, rate = 0;
204*4882a593Smuzhiyun u8 tx_cls_en = 0, tx_cls_th = 0, tmp = 0;
205*4882a593Smuzhiyun u8 i = 0;
206*4882a593Smuzhiyun
207*4882a593Smuzhiyun for (i = 0; i < 5; i++) {
208*4882a593Smuzhiyun PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var[i]);
209*4882a593Smuzhiyun }
210*4882a593Smuzhiyun
211*4882a593Smuzhiyun if ((strcmp(input[1], help) == 0)) {
212*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
213*4882a593Smuzhiyun "{1} {0:-,1:+} {ofst}: set offset\n");
214*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
215*4882a593Smuzhiyun "{1} {100}: show offset\n");
216*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
217*4882a593Smuzhiyun "{2} {en} {macid} {bw} {rate}: fw fix rate\n");
218*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
219*4882a593Smuzhiyun "{3} {en}: Dynamic RRSR\n");
220*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
221*4882a593Smuzhiyun "{4} {0:pkt RA, 1:TBTT RA, 100:query RA mode}\n");
222*4882a593Smuzhiyun #ifdef CONFIG_DYNAMIC_TXCOLLISION_TH
223*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
224*4882a593Smuzhiyun "{5} {0:dis, 1:en}{th; 255:auto, xx:dB}: Tx CLS\n");
225*4882a593Smuzhiyun #endif
226*4882a593Smuzhiyun } else if (var[0] == 1) { /*@Adjust PCR offset*/
227*4882a593Smuzhiyun
228*4882a593Smuzhiyun if (var[1] == 100) {
229*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
230*4882a593Smuzhiyun "[Get] RA_ofst=((%s%d))\n",
231*4882a593Smuzhiyun ((ra_tab->ra_ofst_direc) ? "+" : "-"),
232*4882a593Smuzhiyun ra_tab->ra_th_ofst);
233*4882a593Smuzhiyun
234*4882a593Smuzhiyun } else if (var[1] == 0) {
235*4882a593Smuzhiyun ra_tab->ra_ofst_direc = 0;
236*4882a593Smuzhiyun ra_tab->ra_th_ofst = (u8)var[2];
237*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
238*4882a593Smuzhiyun "[Set] RA_ofst=((-%d))\n", ra_tab->ra_th_ofst);
239*4882a593Smuzhiyun } else if (var[1] == 1) {
240*4882a593Smuzhiyun ra_tab->ra_ofst_direc = 1;
241*4882a593Smuzhiyun ra_tab->ra_th_ofst = (u8)var[2];
242*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
243*4882a593Smuzhiyun "[Set] RA_ofst=((+%d))\n", ra_tab->ra_th_ofst);
244*4882a593Smuzhiyun }
245*4882a593Smuzhiyun
246*4882a593Smuzhiyun } else if (var[0] == 2) { /*@FW fix rate*/
247*4882a593Smuzhiyun macid = (u8)var[2];
248*4882a593Smuzhiyun bw = (u8)var[3];
249*4882a593Smuzhiyun rate = (u8)var[4];
250*4882a593Smuzhiyun
251*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
252*4882a593Smuzhiyun "[FW fix TX Rate] {en, macid,bw,rate}={%d, %d, %d, 0x%x}",
253*4882a593Smuzhiyun var[1], macid, bw, rate);
254*4882a593Smuzhiyun
255*4882a593Smuzhiyun phydm_fw_fix_rate(dm, (u8)var[1], macid, bw, rate);
256*4882a593Smuzhiyun } else if (var[0] == 3) { /*@Dynamic RRSR*/
257*4882a593Smuzhiyun ra_tab->dynamic_rrsr_en = (boolean)var[1];
258*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
259*4882a593Smuzhiyun "[Dynamic RRSR] enable=%d", ra_tab->dynamic_rrsr_en);
260*4882a593Smuzhiyun } else if (var[0] == 4) { /*@RA trigger mode*/
261*4882a593Smuzhiyun if (var[1] == 0 || var[1] == 1)
262*4882a593Smuzhiyun ra_tab->ra_trigger_mode = (u8)var[1];
263*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
264*4882a593Smuzhiyun "[RA trigger] mode=%d\n", ra_tab->ra_trigger_mode);
265*4882a593Smuzhiyun #ifdef CONFIG_DYNAMIC_TXCOLLISION_TH
266*4882a593Smuzhiyun } else if (var[0] == 5) { /*@Tx Collision Detection*/
267*4882a593Smuzhiyun tx_cls_en = (u8)var[1];
268*4882a593Smuzhiyun ra_tab->ra_tx_cls_th = (u8)var[2];
269*4882a593Smuzhiyun tmp = (u8)var[2];
270*4882a593Smuzhiyun tx_cls_th = (tmp < 50) ? 0 : (tmp > 81) ? 31 : tmp - 50;
271*4882a593Smuzhiyun if (tx_cls_en) {
272*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x8f8, BIT(16), 1);
273*4882a593Smuzhiyun if (ra_tab->ra_tx_cls_th != 255) {
274*4882a593Smuzhiyun phydm_tx_collsion_th_set(dm, tx_cls_th,
275*4882a593Smuzhiyun tx_cls_th);
276*4882a593Smuzhiyun }
277*4882a593Smuzhiyun
278*4882a593Smuzhiyun } else {
279*4882a593Smuzhiyun odm_set_bb_reg(dm, R_0x8f8, BIT(16), 0);
280*4882a593Smuzhiyun }
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun if (tx_cls_en & ra_tab->ra_tx_cls_th != 255) {
283*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
284*4882a593Smuzhiyun "[Tx Collision Detec] {en, th}={%d, %d}\n",
285*4882a593Smuzhiyun tx_cls_en, tx_cls_th + 50);
286*4882a593Smuzhiyun } else if (tx_cls_en & ra_tab->ra_tx_cls_th == 255) {
287*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
288*4882a593Smuzhiyun "[Tx Collision Detec] {en, th}={%d, auto}\n",
289*4882a593Smuzhiyun tx_cls_en);
290*4882a593Smuzhiyun } else {
291*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
292*4882a593Smuzhiyun "[Tx Collision Detec] {en, th}={%d, xx}\n",
293*4882a593Smuzhiyun tx_cls_en);
294*4882a593Smuzhiyun }
295*4882a593Smuzhiyun #endif
296*4882a593Smuzhiyun } else {
297*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
298*4882a593Smuzhiyun "[Set] Error\n");
299*4882a593Smuzhiyun }
300*4882a593Smuzhiyun *_used = used;
301*4882a593Smuzhiyun *_out_len = out_len;
302*4882a593Smuzhiyun }
303*4882a593Smuzhiyun
phydm_ra_mask_report_h2c_trigger(void * dm_void,struct ra_mask_rpt_trig * trig_rpt)304*4882a593Smuzhiyun void phydm_ra_mask_report_h2c_trigger(void *dm_void,
305*4882a593Smuzhiyun struct ra_mask_rpt_trig *trig_rpt)
306*4882a593Smuzhiyun {
307*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
308*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
309*4882a593Smuzhiyun
310*4882a593Smuzhiyun phydm_fw_trace_en_h2c(dm, true, 1, 2, trig_rpt->macid);
311*4882a593Smuzhiyun
312*4882a593Smuzhiyun trig_rpt->ra_mask_rpt_stamp = ra_tab->ra_mask_rpt_stamp;
313*4882a593Smuzhiyun }
phydm_ra_mask_report_c2h_result(void * dm_void,struct ra_mask_rpt * rpt)314*4882a593Smuzhiyun void phydm_ra_mask_report_c2h_result(void *dm_void, struct ra_mask_rpt *rpt)
315*4882a593Smuzhiyun {
316*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
317*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
318*4882a593Smuzhiyun u8 i = 0;
319*4882a593Smuzhiyun
320*4882a593Smuzhiyun rpt->ra_mask_rpt_stamp = ra_tab->ra_mask_rpt_stamp;
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun odm_move_memory(dm, &rpt->ra_mask_buf[0], &ra_tab->ra_mask_buf[0], 8);
323*4882a593Smuzhiyun }
324*4882a593Smuzhiyun
odm_c2h_ra_para_report_handler(void * dm_void,u8 * cmd_buf,u8 cmd_len)325*4882a593Smuzhiyun void odm_c2h_ra_para_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len)
326*4882a593Smuzhiyun {
327*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
328*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
329*4882a593Smuzhiyun u8 mode = cmd_buf[0]; /*Retry Penalty, NH, NL*/
330*4882a593Smuzhiyun u8 i;
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "[%s] [mode: %d]----------------------->\n",
333*4882a593Smuzhiyun __func__, mode);
334*4882a593Smuzhiyun
335*4882a593Smuzhiyun if (mode == RADBG_DEBUG_MONITOR1) {
336*4882a593Smuzhiyun if (dm->support_ic_type & PHYDM_IC_3081_SERIES) {
337*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "RSSI =",
338*4882a593Smuzhiyun cmd_buf[1]);
339*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "rate =",
340*4882a593Smuzhiyun cmd_buf[2] & 0x7f);
341*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "SGI =",
342*4882a593Smuzhiyun (cmd_buf[2] & 0x80) >> 7);
343*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "BW =",
344*4882a593Smuzhiyun cmd_buf[3]);
345*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "BW_max =",
346*4882a593Smuzhiyun cmd_buf[4]);
347*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n",
348*4882a593Smuzhiyun "multi_rate0 =", cmd_buf[5]);
349*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n",
350*4882a593Smuzhiyun "multi_rate1 =", cmd_buf[6]);
351*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "DISRA =",
352*4882a593Smuzhiyun cmd_buf[7]);
353*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "VHT_EN =",
354*4882a593Smuzhiyun cmd_buf[8]);
355*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n",
356*4882a593Smuzhiyun "SGI_support =", cmd_buf[9]);
357*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "try_ness =",
358*4882a593Smuzhiyun cmd_buf[10]);
359*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "pre_rate =",
360*4882a593Smuzhiyun cmd_buf[11]);
361*4882a593Smuzhiyun } else {
362*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "RSSI =",
363*4882a593Smuzhiyun cmd_buf[1]);
364*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %x\n", "BW =",
365*4882a593Smuzhiyun cmd_buf[2]);
366*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "DISRA =",
367*4882a593Smuzhiyun cmd_buf[3]);
368*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "VHT_EN =",
369*4882a593Smuzhiyun cmd_buf[4]);
370*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n",
371*4882a593Smuzhiyun "Hightest rate =", cmd_buf[5]);
372*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n",
373*4882a593Smuzhiyun "Lowest rate =", cmd_buf[6]);
374*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n",
375*4882a593Smuzhiyun "SGI_support =", cmd_buf[7]);
376*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "Rate_ID =",
377*4882a593Smuzhiyun cmd_buf[8]);
378*4882a593Smuzhiyun }
379*4882a593Smuzhiyun } else if (mode == RADBG_DEBUG_MONITOR2) {
380*4882a593Smuzhiyun if (dm->support_ic_type & PHYDM_IC_3081_SERIES) {
381*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "rate_id =",
382*4882a593Smuzhiyun cmd_buf[1]);
383*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n",
384*4882a593Smuzhiyun "highest_rate =", cmd_buf[2]);
385*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n",
386*4882a593Smuzhiyun "lowest_rate =", cmd_buf[3]);
387*4882a593Smuzhiyun
388*4882a593Smuzhiyun for (i = 4; i <= 11; i++)
389*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "RAMASK = 0x%x\n",
390*4882a593Smuzhiyun cmd_buf[i]);
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun odm_move_memory(dm, &ra_tab->ra_mask_buf[0], &cmd_buf[4], 8);
393*4882a593Smuzhiyun ra_tab->ra_mask_rpt_stamp++;
394*4882a593Smuzhiyun } else {
395*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE,
396*4882a593Smuzhiyun "%5s %x%x %x%x %x%x %x%x\n", "RA Mask:",
397*4882a593Smuzhiyun cmd_buf[8], cmd_buf[7], cmd_buf[6],
398*4882a593Smuzhiyun cmd_buf[5], cmd_buf[4], cmd_buf[3],
399*4882a593Smuzhiyun cmd_buf[2], cmd_buf[1]);
400*4882a593Smuzhiyun }
401*4882a593Smuzhiyun } else if (mode == RADBG_DEBUG_MONITOR3) {
402*4882a593Smuzhiyun for (i = 0; i < (cmd_len - 1); i++)
403*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "content[%d] = %d\n", i,
404*4882a593Smuzhiyun cmd_buf[1 + i]);
405*4882a593Smuzhiyun } else if (mode == RADBG_DEBUG_MONITOR4)
406*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s {%d.%d}\n", "RA version =",
407*4882a593Smuzhiyun cmd_buf[1], cmd_buf[2]);
408*4882a593Smuzhiyun else if (mode == RADBG_DEBUG_MONITOR5) {
409*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "Current rate =",
410*4882a593Smuzhiyun cmd_buf[1]);
411*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "Retry ratio =",
412*4882a593Smuzhiyun cmd_buf[2]);
413*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "rate down ratio =",
414*4882a593Smuzhiyun cmd_buf[3]);
415*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "highest rate =",
416*4882a593Smuzhiyun cmd_buf[4]);
417*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s {0x%x 0x%x}\n", "Muti-try =",
418*4882a593Smuzhiyun cmd_buf[5], cmd_buf[6]);
419*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x%x%x%x%x\n", "RA mask =",
420*4882a593Smuzhiyun cmd_buf[11], cmd_buf[10], cmd_buf[9], cmd_buf[8],
421*4882a593Smuzhiyun cmd_buf[7]);
422*4882a593Smuzhiyun }
423*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_FW_TRACE, "-------------------------------\n");
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun
phydm_ra_dynamic_retry_count(void * dm_void)426*4882a593Smuzhiyun void phydm_ra_dynamic_retry_count(void *dm_void)
427*4882a593Smuzhiyun {
428*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
429*4882a593Smuzhiyun
430*4882a593Smuzhiyun if (!(dm->support_ability & ODM_BB_DYNAMIC_ARFR))
431*4882a593Smuzhiyun return;
432*4882a593Smuzhiyun
433*4882a593Smuzhiyun /*PHYDM_DBG(dm, DBG_RA, "dm->pre_b_noisy = %d\n", dm->pre_b_noisy );*/
434*4882a593Smuzhiyun
435*4882a593Smuzhiyun if (dm->pre_b_noisy != dm->noisy_decision) {
436*4882a593Smuzhiyun if (dm->noisy_decision) {
437*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_DYN_ARFR, "Noisy Env. RA fallback\n");
438*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x430, MASKDWORD, 0x0);
439*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x434, MASKDWORD, 0x04030201);
440*4882a593Smuzhiyun } else {
441*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_DYN_ARFR, "Clean Env. RA fallback\n");
442*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x430, MASKDWORD, 0x01000000);
443*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x434, MASKDWORD, 0x06050402);
444*4882a593Smuzhiyun }
445*4882a593Smuzhiyun dm->pre_b_noisy = dm->noisy_decision;
446*4882a593Smuzhiyun }
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun
phydm_print_rate(void * dm_void,u8 rate,u32 dbg_component)449*4882a593Smuzhiyun void phydm_print_rate(void *dm_void, u8 rate, u32 dbg_component)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
452*4882a593Smuzhiyun u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/
453*4882a593Smuzhiyun boolean vht_en = phydm_is_vht_rate(dm, rate_idx);
454*4882a593Smuzhiyun u8 b_sgi = (rate & 0x80) >> 7;
455*4882a593Smuzhiyun u8 rate_ss = phydm_rate_to_num_ss(dm, rate_idx);
456*4882a593Smuzhiyun u8 rate_digit = phydm_rate_2_rate_digit(dm, rate_idx);
457*4882a593Smuzhiyun
458*4882a593Smuzhiyun PHYDM_DBG_F(dm, dbg_component, "( %s%s%s%s%s%d%s%s)\n",
459*4882a593Smuzhiyun (vht_en && (rate_ss == 1)) ? "VHT 1ss " : "",
460*4882a593Smuzhiyun (vht_en && (rate_ss == 2)) ? "VHT 2ss " : "",
461*4882a593Smuzhiyun (vht_en && (rate_ss == 3)) ? "VHT 3ss " : "",
462*4882a593Smuzhiyun (vht_en && (rate_ss == 4)) ? "VHT 4ss " : "",
463*4882a593Smuzhiyun (rate_idx >= ODM_RATEMCS0) ? "MCS " : "",
464*4882a593Smuzhiyun rate_digit,
465*4882a593Smuzhiyun (b_sgi) ? "-S" : " ",
466*4882a593Smuzhiyun (rate_idx >= ODM_RATEMCS0) ? "" : "M");
467*4882a593Smuzhiyun }
468*4882a593Smuzhiyun
phydm_print_rate_2_buff(void * dm_void,u8 rate,char * buf,u16 buf_size)469*4882a593Smuzhiyun void phydm_print_rate_2_buff(void *dm_void, u8 rate, char *buf, u16 buf_size)
470*4882a593Smuzhiyun {
471*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
472*4882a593Smuzhiyun u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/
473*4882a593Smuzhiyun boolean vht_en = phydm_is_vht_rate(dm, rate_idx);
474*4882a593Smuzhiyun u8 b_sgi = (rate & 0x80) >> 7;
475*4882a593Smuzhiyun u8 rate_ss = phydm_rate_to_num_ss(dm, rate_idx);
476*4882a593Smuzhiyun u8 rate_digit = phydm_rate_2_rate_digit(dm, rate_idx);
477*4882a593Smuzhiyun
478*4882a593Smuzhiyun PHYDM_SNPRINTF(buf, buf_size, "( %s%s%s%s%s%d%s%s)",
479*4882a593Smuzhiyun (vht_en && (rate_ss == 1)) ? "VHT 1ss " : "",
480*4882a593Smuzhiyun (vht_en && (rate_ss == 2)) ? "VHT 2ss " : "",
481*4882a593Smuzhiyun (vht_en && (rate_ss == 3)) ? "VHT 3ss " : "",
482*4882a593Smuzhiyun (vht_en && (rate_ss == 4)) ? "VHT 4ss " : "",
483*4882a593Smuzhiyun (rate_idx >= ODM_RATEMCS0) ? "MCS " : "",
484*4882a593Smuzhiyun rate_digit,
485*4882a593Smuzhiyun (b_sgi) ? "-S" : " ",
486*4882a593Smuzhiyun (rate_idx >= ODM_RATEMCS0) ? "" : "M");
487*4882a593Smuzhiyun }
488*4882a593Smuzhiyun
phydm_c2h_ra_report_handler(void * dm_void,u8 * cmd_buf,u8 cmd_len)489*4882a593Smuzhiyun void phydm_c2h_ra_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len)
490*4882a593Smuzhiyun {
491*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
492*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
493*4882a593Smuzhiyun struct cmn_sta_info *sta = NULL;
494*4882a593Smuzhiyun u8 macid = cmd_buf[1];
495*4882a593Smuzhiyun u8 rate = cmd_buf[0];
496*4882a593Smuzhiyun u8 ra_ratio = 0xff;
497*4882a593Smuzhiyun u8 curr_bw = 0xff;
498*4882a593Smuzhiyun u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/
499*4882a593Smuzhiyun u8 rate_order;
500*4882a593Smuzhiyun u8 gid_index = 0;
501*4882a593Smuzhiyun u8 txcls_rate = 0;
502*4882a593Smuzhiyun char dbg_buf[PHYDM_SNPRINT_SIZE] = {0};
503*4882a593Smuzhiyun
504*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
505*4882a593Smuzhiyun sta = dm->phydm_sta_info[dm->phydm_macid_table[macid]];
506*4882a593Smuzhiyun #else
507*4882a593Smuzhiyun sta = dm->phydm_sta_info[macid];
508*4882a593Smuzhiyun #endif
509*4882a593Smuzhiyun
510*4882a593Smuzhiyun if (cmd_len == 7) {
511*4882a593Smuzhiyun ra_ratio = cmd_buf[5];
512*4882a593Smuzhiyun curr_bw = cmd_buf[6];
513*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[%d] PER=%d\n", macid, ra_ratio);
514*4882a593Smuzhiyun } else if (cmd_len == 8) {
515*4882a593Smuzhiyun ra_ratio = cmd_buf[5];
516*4882a593Smuzhiyun curr_bw = cmd_buf[6];
517*4882a593Smuzhiyun txcls_rate = cmd_buf[7];
518*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[%d] PER=%d TxCLS=%d\n", macid, ra_ratio,
519*4882a593Smuzhiyun txcls_rate);
520*4882a593Smuzhiyun }
521*4882a593Smuzhiyun
522*4882a593Smuzhiyun if (cmd_buf[3] != 0) {
523*4882a593Smuzhiyun if (cmd_buf[3] == 0xff)
524*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "FW Fix Rate\n");
525*4882a593Smuzhiyun else if (cmd_buf[3] == 1)
526*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Try Success\n");
527*4882a593Smuzhiyun else if (cmd_buf[3] == 2)
528*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Try Fail & Again\n");
529*4882a593Smuzhiyun else if (cmd_buf[3] == 3)
530*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Rate Back\n");
531*4882a593Smuzhiyun else if (cmd_buf[3] == 4)
532*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Start rate by RSSI\n");
533*4882a593Smuzhiyun else if (cmd_buf[3] == 5)
534*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Try rate\n");
535*4882a593Smuzhiyun }
536*4882a593Smuzhiyun phydm_print_rate_2_buff(dm, rate, dbg_buf, PHYDM_SNPRINT_SIZE);
537*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Tx Rate=%s (%d)\n", dbg_buf, rate);
538*4882a593Smuzhiyun
539*4882a593Smuzhiyun #ifdef MU_EX_MACID
540*4882a593Smuzhiyun if (macid >= 128 && macid < (128 + MU_EX_MACID)) {
541*4882a593Smuzhiyun gid_index = macid - 128;
542*4882a593Smuzhiyun ra_tab->mu1_rate[gid_index] = rate;
543*4882a593Smuzhiyun }
544*4882a593Smuzhiyun if (macid >= ODM_ASSOCIATE_ENTRY_NUM)
545*4882a593Smuzhiyun return;
546*4882a593Smuzhiyun #endif
547*4882a593Smuzhiyun if (is_sta_active(sta)) {
548*4882a593Smuzhiyun sta->ra_info.curr_tx_rate = rate;
549*4882a593Smuzhiyun sta->ra_info.curr_tx_bw = (enum channel_width)curr_bw;
550*4882a593Smuzhiyun sta->ra_info.curr_retry_ratio = ra_ratio;
551*4882a593Smuzhiyun }
552*4882a593Smuzhiyun
553*4882a593Smuzhiyun /*trigger power training*/
554*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))
555*4882a593Smuzhiyun
556*4882a593Smuzhiyun rate_order = phydm_rate_order_compute(dm, rate_idx);
557*4882a593Smuzhiyun
558*4882a593Smuzhiyun if (dm->is_one_entry_only ||
559*4882a593Smuzhiyun (rate_order > ra_tab->highest_client_tx_order &&
560*4882a593Smuzhiyun ra_tab->power_tracking_flag == 1)) {
561*4882a593Smuzhiyun halrf_update_pwr_track(dm, rate_idx);
562*4882a593Smuzhiyun ra_tab->power_tracking_flag = 0;
563*4882a593Smuzhiyun }
564*4882a593Smuzhiyun
565*4882a593Smuzhiyun #endif
566*4882a593Smuzhiyun
567*4882a593Smuzhiyun #if 0
568*4882a593Smuzhiyun /*trigger dynamic rate ID*/
569*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E))
570*4882a593Smuzhiyun phydm_update_rate_id(dm, rate, macid);
571*4882a593Smuzhiyun #endif
572*4882a593Smuzhiyun }
573*4882a593Smuzhiyun
odm_ra_post_action_on_assoc(void * dm_void)574*4882a593Smuzhiyun void odm_ra_post_action_on_assoc(void *dm_void)
575*4882a593Smuzhiyun {
576*4882a593Smuzhiyun }
577*4882a593Smuzhiyun
phydm_modify_RA_PCR_threshold(void * dm_void,u8 ra_ofst_direc,u8 ra_th_ofst)578*4882a593Smuzhiyun void phydm_modify_RA_PCR_threshold(void *dm_void, u8 ra_ofst_direc,
579*4882a593Smuzhiyun u8 ra_th_ofst)
580*4882a593Smuzhiyun {
581*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
582*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
583*4882a593Smuzhiyun
584*4882a593Smuzhiyun ra_tab->ra_ofst_direc = ra_ofst_direc;
585*4882a593Smuzhiyun ra_tab->ra_th_ofst = ra_th_ofst;
586*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "Set ra_th_offset=(( %s%d ))\n",
587*4882a593Smuzhiyun ((ra_ofst_direc) ? "+" : "-"), ra_th_ofst);
588*4882a593Smuzhiyun }
589*4882a593Smuzhiyun
590*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
591*4882a593Smuzhiyun
phydm_gen_ramask_h2c_AP(void * dm_void,struct rtl8192cd_priv * priv,struct sta_info * entry,u8 rssi_level)592*4882a593Smuzhiyun void phydm_gen_ramask_h2c_AP(
593*4882a593Smuzhiyun void *dm_void,
594*4882a593Smuzhiyun struct rtl8192cd_priv *priv,
595*4882a593Smuzhiyun struct sta_info *entry,
596*4882a593Smuzhiyun u8 rssi_level)
597*4882a593Smuzhiyun {
598*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
599*4882a593Smuzhiyun
600*4882a593Smuzhiyun if (dm->support_ic_type == ODM_RTL8812) {
601*4882a593Smuzhiyun #if (RTL8812A_SUPPORT == 1)
602*4882a593Smuzhiyun UpdateHalRAMask8812(priv, entry, rssi_level);
603*4882a593Smuzhiyun #endif
604*4882a593Smuzhiyun } else if (dm->support_ic_type == ODM_RTL8188E) {
605*4882a593Smuzhiyun #if (RTL8188E_SUPPORT == 1)
606*4882a593Smuzhiyun #ifdef TXREPORT
607*4882a593Smuzhiyun add_RATid(priv, entry);
608*4882a593Smuzhiyun #endif
609*4882a593Smuzhiyun #endif
610*4882a593Smuzhiyun } else {
611*4882a593Smuzhiyun #ifdef CONFIG_WLAN_HAL
612*4882a593Smuzhiyun GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, entry, rssi_level);
613*4882a593Smuzhiyun #endif
614*4882a593Smuzhiyun }
615*4882a593Smuzhiyun }
616*4882a593Smuzhiyun
phydm_update_hal_ra_mask(void * dm_void,u32 wireless_mode,u8 rf_type,u8 bw,u8 mimo_ps_enable,u8 disable_cck_rate,u32 * ratr_bitmap_msb_in,u32 * ratr_bitmap_lsb_in,u8 tx_rate_level)617*4882a593Smuzhiyun void phydm_update_hal_ra_mask(
618*4882a593Smuzhiyun void *dm_void,
619*4882a593Smuzhiyun u32 wireless_mode,
620*4882a593Smuzhiyun u8 rf_type,
621*4882a593Smuzhiyun u8 bw,
622*4882a593Smuzhiyun u8 mimo_ps_enable,
623*4882a593Smuzhiyun u8 disable_cck_rate,
624*4882a593Smuzhiyun u32 *ratr_bitmap_msb_in,
625*4882a593Smuzhiyun u32 *ratr_bitmap_lsb_in,
626*4882a593Smuzhiyun u8 tx_rate_level)
627*4882a593Smuzhiyun {
628*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
629*4882a593Smuzhiyun u32 ratr_bitmap = *ratr_bitmap_lsb_in;
630*4882a593Smuzhiyun u32 ratr_bitmap_msb = *ratr_bitmap_msb_in;
631*4882a593Smuzhiyun
632*4882a593Smuzhiyun #if 0
633*4882a593Smuzhiyun /*PHYDM_DBG(dm, DBG_RA_MASK, "phydm_rf_type = (( %x )), rf_type = (( %x ))\n", phydm_rf_type, rf_type);*/
634*4882a593Smuzhiyun #endif
635*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK,
636*4882a593Smuzhiyun "Platfoem original RA Mask = (( 0x %x | %x ))\n",
637*4882a593Smuzhiyun ratr_bitmap_msb, ratr_bitmap);
638*4882a593Smuzhiyun
639*4882a593Smuzhiyun switch (wireless_mode) {
640*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_B: {
641*4882a593Smuzhiyun ratr_bitmap &= 0x0000000f;
642*4882a593Smuzhiyun } break;
643*4882a593Smuzhiyun
644*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_G: {
645*4882a593Smuzhiyun ratr_bitmap &= 0x00000ff5;
646*4882a593Smuzhiyun } break;
647*4882a593Smuzhiyun
648*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_A: {
649*4882a593Smuzhiyun ratr_bitmap &= 0x00000ff0;
650*4882a593Smuzhiyun } break;
651*4882a593Smuzhiyun
652*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_N_24G:
653*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_N_5G: {
654*4882a593Smuzhiyun if (mimo_ps_enable)
655*4882a593Smuzhiyun rf_type = RF_1T1R;
656*4882a593Smuzhiyun
657*4882a593Smuzhiyun if (rf_type == RF_1T1R) {
658*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40)
659*4882a593Smuzhiyun ratr_bitmap &= 0x000ff015;
660*4882a593Smuzhiyun else
661*4882a593Smuzhiyun ratr_bitmap &= 0x000ff005;
662*4882a593Smuzhiyun } else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) {
663*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40)
664*4882a593Smuzhiyun ratr_bitmap &= 0x0ffff015;
665*4882a593Smuzhiyun else
666*4882a593Smuzhiyun ratr_bitmap &= 0x0ffff005;
667*4882a593Smuzhiyun } else { /*@3T*/
668*4882a593Smuzhiyun
669*4882a593Smuzhiyun ratr_bitmap &= 0xfffff015;
670*4882a593Smuzhiyun ratr_bitmap_msb &= 0xf;
671*4882a593Smuzhiyun }
672*4882a593Smuzhiyun } break;
673*4882a593Smuzhiyun
674*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_AC_24G: {
675*4882a593Smuzhiyun if (rf_type == RF_1T1R) {
676*4882a593Smuzhiyun ratr_bitmap &= 0x003ff015;
677*4882a593Smuzhiyun } else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) {
678*4882a593Smuzhiyun ratr_bitmap &= 0xfffff015;
679*4882a593Smuzhiyun } else { /*@3T*/
680*4882a593Smuzhiyun
681*4882a593Smuzhiyun ratr_bitmap &= 0xfffff010;
682*4882a593Smuzhiyun ratr_bitmap_msb &= 0x3ff;
683*4882a593Smuzhiyun }
684*4882a593Smuzhiyun
685*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_20) { /*@AC 20MHz not support MCS9*/
686*4882a593Smuzhiyun ratr_bitmap &= 0x7fdfffff;
687*4882a593Smuzhiyun ratr_bitmap_msb &= 0x1ff;
688*4882a593Smuzhiyun }
689*4882a593Smuzhiyun } break;
690*4882a593Smuzhiyun
691*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_AC_5G: {
692*4882a593Smuzhiyun if (rf_type == RF_1T1R) {
693*4882a593Smuzhiyun ratr_bitmap &= 0x003ff010;
694*4882a593Smuzhiyun } else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) {
695*4882a593Smuzhiyun ratr_bitmap &= 0xfffff010;
696*4882a593Smuzhiyun } else { /*@3T*/
697*4882a593Smuzhiyun
698*4882a593Smuzhiyun ratr_bitmap &= 0xfffff010;
699*4882a593Smuzhiyun ratr_bitmap_msb &= 0x3ff;
700*4882a593Smuzhiyun }
701*4882a593Smuzhiyun
702*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_20) { /*@AC 20MHz not support MCS9*/
703*4882a593Smuzhiyun ratr_bitmap &= 0x7fdfffff;
704*4882a593Smuzhiyun ratr_bitmap_msb &= 0x1ff;
705*4882a593Smuzhiyun }
706*4882a593Smuzhiyun } break;
707*4882a593Smuzhiyun
708*4882a593Smuzhiyun default:
709*4882a593Smuzhiyun break;
710*4882a593Smuzhiyun }
711*4882a593Smuzhiyun
712*4882a593Smuzhiyun if (wireless_mode != PHYDM_WIRELESS_MODE_B) {
713*4882a593Smuzhiyun if (tx_rate_level == 0)
714*4882a593Smuzhiyun ratr_bitmap &= 0xffffffff;
715*4882a593Smuzhiyun else if (tx_rate_level == 1)
716*4882a593Smuzhiyun ratr_bitmap &= 0xfffffff0;
717*4882a593Smuzhiyun else if (tx_rate_level == 2)
718*4882a593Smuzhiyun ratr_bitmap &= 0xffffefe0;
719*4882a593Smuzhiyun else if (tx_rate_level == 3)
720*4882a593Smuzhiyun ratr_bitmap &= 0xffffcfc0;
721*4882a593Smuzhiyun else if (tx_rate_level == 4)
722*4882a593Smuzhiyun ratr_bitmap &= 0xffff8f80;
723*4882a593Smuzhiyun else if (tx_rate_level >= 5)
724*4882a593Smuzhiyun ratr_bitmap &= 0xffff0f00;
725*4882a593Smuzhiyun }
726*4882a593Smuzhiyun
727*4882a593Smuzhiyun if (disable_cck_rate)
728*4882a593Smuzhiyun ratr_bitmap &= 0xfffffff0;
729*4882a593Smuzhiyun
730*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK,
731*4882a593Smuzhiyun "wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x )), MimoPs_en = (( %d )), tx_rate_level= (( 0x%x ))\n",
732*4882a593Smuzhiyun wireless_mode, rf_type, bw, mimo_ps_enable, tx_rate_level);
733*4882a593Smuzhiyun
734*4882a593Smuzhiyun #if 0
735*4882a593Smuzhiyun /*PHYDM_DBG(dm, DBG_RA_MASK, "111 Phydm modified RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap);*/
736*4882a593Smuzhiyun #endif
737*4882a593Smuzhiyun
738*4882a593Smuzhiyun *ratr_bitmap_lsb_in = ratr_bitmap;
739*4882a593Smuzhiyun *ratr_bitmap_msb_in = ratr_bitmap_msb;
740*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK,
741*4882a593Smuzhiyun "Phydm modified RA Mask = (( 0x %x | %x ))\n",
742*4882a593Smuzhiyun *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in);
743*4882a593Smuzhiyun }
744*4882a593Smuzhiyun
745*4882a593Smuzhiyun #endif
746*4882a593Smuzhiyun
phydm_rate_adaptive_mask_init(void * dm_void)747*4882a593Smuzhiyun void phydm_rate_adaptive_mask_init(void *dm_void)
748*4882a593Smuzhiyun {
749*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
750*4882a593Smuzhiyun struct ra_table *ra_t = &dm->dm_ra_table;
751*4882a593Smuzhiyun
752*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
753*4882a593Smuzhiyun PADAPTER adapter = dm->adapter;
754*4882a593Smuzhiyun PMGNT_INFO mgnt_info = &(adapter->MgntInfo);
755*4882a593Smuzhiyun HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)dm->adapter));
756*4882a593Smuzhiyun
757*4882a593Smuzhiyun if (mgnt_info->DM_Type == dm_type_by_driver)
758*4882a593Smuzhiyun hal_data->bUseRAMask = true;
759*4882a593Smuzhiyun else
760*4882a593Smuzhiyun hal_data->bUseRAMask = false;
761*4882a593Smuzhiyun
762*4882a593Smuzhiyun #endif
763*4882a593Smuzhiyun
764*4882a593Smuzhiyun ra_t->ldpc_thres = 35;
765*4882a593Smuzhiyun ra_t->up_ramask_cnt = 0;
766*4882a593Smuzhiyun ra_t->up_ramask_cnt_tmp = 0;
767*4882a593Smuzhiyun }
768*4882a593Smuzhiyun
phydm_refresh_rate_adaptive_mask(void * dm_void)769*4882a593Smuzhiyun void phydm_refresh_rate_adaptive_mask(void *dm_void)
770*4882a593Smuzhiyun {
771*4882a593Smuzhiyun /*@Will be removed*/
772*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
773*4882a593Smuzhiyun
774*4882a593Smuzhiyun phydm_ra_mask_watchdog(dm);
775*4882a593Smuzhiyun }
776*4882a593Smuzhiyun
phydm_show_sta_info(void * dm_void,char input[][16],u32 * _used,char * output,u32 * _out_len)777*4882a593Smuzhiyun void phydm_show_sta_info(void *dm_void, char input[][16], u32 *_used,
778*4882a593Smuzhiyun char *output, u32 *_out_len)
779*4882a593Smuzhiyun {
780*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
781*4882a593Smuzhiyun struct cmn_sta_info *sta = NULL;
782*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
783*4882a593Smuzhiyun #ifdef CONFIG_BEAMFORMING
784*4882a593Smuzhiyun struct bf_cmn_info *bf = NULL;
785*4882a593Smuzhiyun #endif
786*4882a593Smuzhiyun char help[] = "-h";
787*4882a593Smuzhiyun u32 var[10] = {0};
788*4882a593Smuzhiyun u32 used = *_used;
789*4882a593Smuzhiyun u32 out_len = *_out_len;
790*4882a593Smuzhiyun u32 i, sta_idx_start, sta_idx_end;
791*4882a593Smuzhiyun u8 tatal_sta_num = 0;
792*4882a593Smuzhiyun
793*4882a593Smuzhiyun PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var[0]);
794*4882a593Smuzhiyun
795*4882a593Smuzhiyun if ((strcmp(input[1], help) == 0)) {
796*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
797*4882a593Smuzhiyun "All STA: {1}\n");
798*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
799*4882a593Smuzhiyun "STA[macid]: {2} {macid}\n");
800*4882a593Smuzhiyun return;
801*4882a593Smuzhiyun } else if (var[0] == 1) {
802*4882a593Smuzhiyun sta_idx_start = 0;
803*4882a593Smuzhiyun sta_idx_end = ODM_ASSOCIATE_ENTRY_NUM;
804*4882a593Smuzhiyun } else if (var[0] == 2) {
805*4882a593Smuzhiyun sta_idx_start = var[1];
806*4882a593Smuzhiyun sta_idx_end = var[1];
807*4882a593Smuzhiyun } else {
808*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
809*4882a593Smuzhiyun "Warning input value!\n");
810*4882a593Smuzhiyun return;
811*4882a593Smuzhiyun }
812*4882a593Smuzhiyun
813*4882a593Smuzhiyun for (i = sta_idx_start; i < sta_idx_end; i++) {
814*4882a593Smuzhiyun sta = dm->phydm_sta_info[i];
815*4882a593Smuzhiyun
816*4882a593Smuzhiyun if (!is_sta_active(sta))
817*4882a593Smuzhiyun continue;
818*4882a593Smuzhiyun
819*4882a593Smuzhiyun ra = &sta->ra_info;
820*4882a593Smuzhiyun #ifdef CONFIG_BEAMFORMING
821*4882a593Smuzhiyun bf = &sta->bf_info;
822*4882a593Smuzhiyun #endif
823*4882a593Smuzhiyun
824*4882a593Smuzhiyun tatal_sta_num++;
825*4882a593Smuzhiyun
826*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
827*4882a593Smuzhiyun "==[sta_idx: %d][MACID: %d]============>\n", i,
828*4882a593Smuzhiyun sta->mac_id);
829*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
830*4882a593Smuzhiyun "AID:%d\n", sta->aid);
831*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
832*4882a593Smuzhiyun "ADDR:%x-%x-%x-%x-%x-%x\n", sta->mac_addr[5],
833*4882a593Smuzhiyun sta->mac_addr[4], sta->mac_addr[3], sta->mac_addr[2],
834*4882a593Smuzhiyun sta->mac_addr[1], sta->mac_addr[0]);
835*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
836*4882a593Smuzhiyun "DM_ctrl:0x%x\n", sta->dm_ctrl);
837*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
838*4882a593Smuzhiyun "BW:%d, MIMO_Type:0x%x\n", sta->bw_mode,
839*4882a593Smuzhiyun sta->mimo_type);
840*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
841*4882a593Smuzhiyun "STBC_en:%d, LDPC_en=%d\n", sta->stbc_en,
842*4882a593Smuzhiyun sta->ldpc_en);
843*4882a593Smuzhiyun
844*4882a593Smuzhiyun /*@[RSSI Info]*/
845*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
846*4882a593Smuzhiyun "RSSI{All, OFDM, CCK}={%d, %d, %d}\n",
847*4882a593Smuzhiyun sta->rssi_stat.rssi, sta->rssi_stat.rssi_ofdm,
848*4882a593Smuzhiyun sta->rssi_stat.rssi_cck);
849*4882a593Smuzhiyun
850*4882a593Smuzhiyun /*@[RA Info]*/
851*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
852*4882a593Smuzhiyun "Rate_ID:%d, RSSI_LV:%d, ra_bw:%d, SGI_en:%d\n",
853*4882a593Smuzhiyun ra->rate_id, ra->rssi_level, ra->ra_bw_mode,
854*4882a593Smuzhiyun ra->is_support_sgi);
855*4882a593Smuzhiyun
856*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
857*4882a593Smuzhiyun "VHT_en:%d, Wireless_set=0x%x, sm_ps=%d\n",
858*4882a593Smuzhiyun ra->is_vht_enable, sta->support_wireless_set,
859*4882a593Smuzhiyun sta->sm_ps);
860*4882a593Smuzhiyun
861*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
862*4882a593Smuzhiyun "Dis{RA, PT}={%d, %d}, TxRx:%d, Noisy:%d\n",
863*4882a593Smuzhiyun ra->disable_ra, ra->disable_pt, ra->txrx_state,
864*4882a593Smuzhiyun ra->is_noisy);
865*4882a593Smuzhiyun
866*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
867*4882a593Smuzhiyun "TX{Rate, BW}={0x%x, %d}, RTY:%d\n", ra->curr_tx_rate,
868*4882a593Smuzhiyun ra->curr_tx_bw, ra->curr_retry_ratio);
869*4882a593Smuzhiyun
870*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
871*4882a593Smuzhiyun "RA_Mask:0x%llx\n", ra->ramask);
872*4882a593Smuzhiyun
873*4882a593Smuzhiyun /*@[TP]*/
874*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
875*4882a593Smuzhiyun "TP{TX,RX}={%d, %d}\n", sta->tx_moving_average_tp,
876*4882a593Smuzhiyun sta->rx_moving_average_tp);
877*4882a593Smuzhiyun
878*4882a593Smuzhiyun #ifdef CONFIG_BEAMFORMING
879*4882a593Smuzhiyun /*@[Beamforming]*/
880*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
881*4882a593Smuzhiyun "BF CAP{HT,VHT}={0x%x, 0x%x}\n", bf->ht_beamform_cap,
882*4882a593Smuzhiyun bf->vht_beamform_cap);
883*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
884*4882a593Smuzhiyun "BF {p_aid,g_id}={0x%x, 0x%x}\n\n", bf->p_aid,
885*4882a593Smuzhiyun bf->g_id);
886*4882a593Smuzhiyun #endif
887*4882a593Smuzhiyun }
888*4882a593Smuzhiyun
889*4882a593Smuzhiyun if (tatal_sta_num == 0) {
890*4882a593Smuzhiyun PDM_SNPF(out_len, used, output + used, out_len - used,
891*4882a593Smuzhiyun "No Linked STA\n");
892*4882a593Smuzhiyun }
893*4882a593Smuzhiyun
894*4882a593Smuzhiyun *_used = used;
895*4882a593Smuzhiyun *_out_len = out_len;
896*4882a593Smuzhiyun }
897*4882a593Smuzhiyun
phydm_get_rx_stream_num(void * dm_void,enum rf_type type)898*4882a593Smuzhiyun u8 phydm_get_rx_stream_num(void *dm_void, enum rf_type type)
899*4882a593Smuzhiyun {
900*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
901*4882a593Smuzhiyun u8 rx_num = 1;
902*4882a593Smuzhiyun
903*4882a593Smuzhiyun if (type == RF_1T1R)
904*4882a593Smuzhiyun rx_num = 1;
905*4882a593Smuzhiyun else if (type == RF_2T2R || type == RF_1T2R)
906*4882a593Smuzhiyun rx_num = 2;
907*4882a593Smuzhiyun else if (type == RF_3T3R || type == RF_2T3R)
908*4882a593Smuzhiyun rx_num = 3;
909*4882a593Smuzhiyun else if (type == RF_4T4R || type == RF_3T4R || type == RF_2T4R)
910*4882a593Smuzhiyun rx_num = 4;
911*4882a593Smuzhiyun else
912*4882a593Smuzhiyun pr_debug("[Warrning] %s\n", __func__);
913*4882a593Smuzhiyun
914*4882a593Smuzhiyun return rx_num;
915*4882a593Smuzhiyun }
916*4882a593Smuzhiyun
phydm_get_tx_stream_num(void * dm_void,enum rf_type type)917*4882a593Smuzhiyun u8 phydm_get_tx_stream_num(void *dm_void, enum rf_type type)
918*4882a593Smuzhiyun {
919*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
920*4882a593Smuzhiyun u8 tx_num = 1;
921*4882a593Smuzhiyun
922*4882a593Smuzhiyun if (type == RF_1T1R || type == RF_1T2R)
923*4882a593Smuzhiyun tx_num = 1;
924*4882a593Smuzhiyun else if (type == RF_2T2R || type == RF_2T3R || type == RF_2T4R)
925*4882a593Smuzhiyun tx_num = 2;
926*4882a593Smuzhiyun else if (type == RF_3T3R || type == RF_3T4R)
927*4882a593Smuzhiyun tx_num = 3;
928*4882a593Smuzhiyun else if (type == RF_4T4R)
929*4882a593Smuzhiyun tx_num = 4;
930*4882a593Smuzhiyun else
931*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[Warrning] no mimo_type is found\n");
932*4882a593Smuzhiyun
933*4882a593Smuzhiyun return tx_num;
934*4882a593Smuzhiyun }
935*4882a593Smuzhiyun
phydm_get_bb_mod_ra_mask(void * dm_void,u8 sta_idx)936*4882a593Smuzhiyun u64 phydm_get_bb_mod_ra_mask(void *dm_void, u8 sta_idx)
937*4882a593Smuzhiyun {
938*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
939*4882a593Smuzhiyun struct phydm_iot_center *iot_table = &dm->iot_table;
940*4882a593Smuzhiyun struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx];
941*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
942*4882a593Smuzhiyun enum channel_width bw = 0;
943*4882a593Smuzhiyun enum wireless_set wrls_mode = 0;
944*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
945*4882a593Smuzhiyun struct rtl8192cd_priv *priv = dm->priv;
946*4882a593Smuzhiyun #endif
947*4882a593Smuzhiyun u8 tx_stream_num = 1;
948*4882a593Smuzhiyun u8 rssi_lv = 0;
949*4882a593Smuzhiyun u64 ra_mask_bitmap = 0;
950*4882a593Smuzhiyun
951*4882a593Smuzhiyun if (is_sta_active(sta)) {
952*4882a593Smuzhiyun ra = &sta->ra_info;
953*4882a593Smuzhiyun bw = ra->ra_bw_mode;
954*4882a593Smuzhiyun wrls_mode = sta->support_wireless_set;
955*4882a593Smuzhiyun tx_stream_num = phydm_get_tx_stream_num(dm, sta->mimo_type);
956*4882a593Smuzhiyun rssi_lv = ra->rssi_level;
957*4882a593Smuzhiyun ra_mask_bitmap = ra->ramask;
958*4882a593Smuzhiyun } else {
959*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid STA\n", __func__);
960*4882a593Smuzhiyun return 0;
961*4882a593Smuzhiyun }
962*4882a593Smuzhiyun
963*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "macid=%d ori_RA_Mask= 0x%llx\n", sta->mac_id,
964*4882a593Smuzhiyun ra_mask_bitmap);
965*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
966*4882a593Smuzhiyun "wireless_mode=0x%x, tx_ss=%d, BW=%d, MimoPs=%d, rssi_lv=%d\n",
967*4882a593Smuzhiyun wrls_mode, tx_stream_num, bw, sta->sm_ps, rssi_lv);
968*4882a593Smuzhiyun
969*4882a593Smuzhiyun if (sta->sm_ps == SM_PS_STATIC) /*@mimo_ps_enable*/
970*4882a593Smuzhiyun tx_stream_num = 1;
971*4882a593Smuzhiyun
972*4882a593Smuzhiyun /*@[Modify RA Mask by Wireless Mode]*/
973*4882a593Smuzhiyun
974*4882a593Smuzhiyun if (wrls_mode == WIRELESS_CCK) { /*@B mode*/
975*4882a593Smuzhiyun ra_mask_bitmap &= 0x0000000f;
976*4882a593Smuzhiyun } else if (wrls_mode == WIRELESS_OFDM) { /*@G mode*/
977*4882a593Smuzhiyun ra_mask_bitmap &= 0x00000ff0;
978*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM)) { /*@BG mode*/
979*4882a593Smuzhiyun ra_mask_bitmap &= 0x00000ff5;
980*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT)) {
981*4882a593Smuzhiyun /*N_2G*/
982*4882a593Smuzhiyun if (tx_stream_num == 1) {
983*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40)
984*4882a593Smuzhiyun ra_mask_bitmap &= 0x000ff015;
985*4882a593Smuzhiyun else
986*4882a593Smuzhiyun ra_mask_bitmap &= 0x000ff005;
987*4882a593Smuzhiyun } else if (tx_stream_num == 2) {
988*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40)
989*4882a593Smuzhiyun ra_mask_bitmap &= 0x0ffff015;
990*4882a593Smuzhiyun else
991*4882a593Smuzhiyun ra_mask_bitmap &= 0x0ffff005;
992*4882a593Smuzhiyun } else if (tx_stream_num == 3) {
993*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffff015;
994*4882a593Smuzhiyun } else {
995*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffffff015;
996*4882a593Smuzhiyun }
997*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_HT)) { /*N_5G*/
998*4882a593Smuzhiyun
999*4882a593Smuzhiyun if (tx_stream_num == 1) {
1000*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40)
1001*4882a593Smuzhiyun ra_mask_bitmap &= 0x000ff030;
1002*4882a593Smuzhiyun else
1003*4882a593Smuzhiyun ra_mask_bitmap &= 0x000ff010;
1004*4882a593Smuzhiyun } else if (tx_stream_num == 2) {
1005*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40)
1006*4882a593Smuzhiyun ra_mask_bitmap &= 0x0ffff030;
1007*4882a593Smuzhiyun else
1008*4882a593Smuzhiyun ra_mask_bitmap &= 0x0ffff010;
1009*4882a593Smuzhiyun } else if (tx_stream_num == 3) {
1010*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffff010;
1011*4882a593Smuzhiyun } else {
1012*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffffff010;
1013*4882a593Smuzhiyun }
1014*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_VHT)) {
1015*4882a593Smuzhiyun /*@AC_2G*/
1016*4882a593Smuzhiyun if (tx_stream_num == 1)
1017*4882a593Smuzhiyun ra_mask_bitmap &= 0x003ff015;
1018*4882a593Smuzhiyun else if (tx_stream_num == 2)
1019*4882a593Smuzhiyun ra_mask_bitmap &= 0xfffff015;
1020*4882a593Smuzhiyun else if (tx_stream_num == 3)
1021*4882a593Smuzhiyun ra_mask_bitmap &= 0x3fffffff015;
1022*4882a593Smuzhiyun else /*@AC_4SS 2G*/
1023*4882a593Smuzhiyun ra_mask_bitmap &= 0x000ffffffffff015;
1024*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_20) {
1025*4882a593Smuzhiyun /* @AC 20MHz doesn't support MCS9 except 3SS & 6SS*/
1026*4882a593Smuzhiyun ra_mask_bitmap &= 0x0007ffff7fdff015;
1027*4882a593Smuzhiyun } else if (bw == CHANNEL_WIDTH_80) {
1028*4882a593Smuzhiyun /* @AC 80MHz doesn't support 3SS MCS6*/
1029*4882a593Smuzhiyun ra_mask_bitmap &= 0x000fffbffffff015;
1030*4882a593Smuzhiyun }
1031*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_VHT)) { /*@AC_5G*/
1032*4882a593Smuzhiyun
1033*4882a593Smuzhiyun if (tx_stream_num == 1)
1034*4882a593Smuzhiyun ra_mask_bitmap &= 0x003ff010;
1035*4882a593Smuzhiyun else if (tx_stream_num == 2)
1036*4882a593Smuzhiyun ra_mask_bitmap &= 0xfffff010;
1037*4882a593Smuzhiyun else if (tx_stream_num == 3)
1038*4882a593Smuzhiyun ra_mask_bitmap &= 0x3fffffff010;
1039*4882a593Smuzhiyun else /*@AC_4SS 5G*/
1040*4882a593Smuzhiyun ra_mask_bitmap &= 0x000ffffffffff010;
1041*4882a593Smuzhiyun
1042*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_20) {
1043*4882a593Smuzhiyun /* @AC 20MHz doesn't support MCS9 except 3SS & 6SS*/
1044*4882a593Smuzhiyun ra_mask_bitmap &= 0x0007ffff7fdff010;
1045*4882a593Smuzhiyun } else if (bw == CHANNEL_WIDTH_80) {
1046*4882a593Smuzhiyun /* @AC 80MHz doesn't support 3SS MCS6*/
1047*4882a593Smuzhiyun ra_mask_bitmap &= 0x000fffbffffff010;
1048*4882a593Smuzhiyun } else if (bw == CHANNEL_WIDTH_160) {
1049*4882a593Smuzhiyun /* @AC 80M+80M doesn't support 3SS & 4SS*/
1050*4882a593Smuzhiyun ra_mask_bitmap &= 0xfffff010;
1051*4882a593Smuzhiyun }
1052*4882a593Smuzhiyun } else {
1053*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[Warrning] RA mask is Not found\n");
1054*4882a593Smuzhiyun }
1055*4882a593Smuzhiyun
1056*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Mod by mode=0x%llx\n", ra_mask_bitmap);
1057*4882a593Smuzhiyun
1058*4882a593Smuzhiyun #if ((DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(PHYDM_IC_JGR3_SERIES_SUPPORT))
1059*4882a593Smuzhiyun if (priv->pshare->veriwave_sta_num > 0) {
1060*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Mod by RSSI=0x%llx\n", ra_mask_bitmap);
1061*4882a593Smuzhiyun return ra_mask_bitmap;
1062*4882a593Smuzhiyun }
1063*4882a593Smuzhiyun #endif
1064*4882a593Smuzhiyun /*@[Modify RA Mask by RSSI level]*/
1065*4882a593Smuzhiyun if (wrls_mode != WIRELESS_CCK) {
1066*4882a593Smuzhiyun if (iot_table->patch_id_40010700) {
1067*4882a593Smuzhiyun ra_mask_bitmap &= (rssi_lv == 0 ?
1068*4882a593Smuzhiyun 0xffffffffffffffff :
1069*4882a593Smuzhiyun 0xfffffffffffffff0);
1070*4882a593Smuzhiyun return ra_mask_bitmap;
1071*4882a593Smuzhiyun }
1072*4882a593Smuzhiyun
1073*4882a593Smuzhiyun if (rssi_lv == 0)
1074*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffffffffffffff;
1075*4882a593Smuzhiyun else if (rssi_lv == 1)
1076*4882a593Smuzhiyun ra_mask_bitmap &= 0xfffffffffffffff0;
1077*4882a593Smuzhiyun else if (rssi_lv == 2)
1078*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffffffffffefe0;
1079*4882a593Smuzhiyun else if (rssi_lv == 3)
1080*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffffffffffcfc0;
1081*4882a593Smuzhiyun else if (rssi_lv == 4)
1082*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffffffffff8f80;
1083*4882a593Smuzhiyun else if (rssi_lv >= 5)
1084*4882a593Smuzhiyun ra_mask_bitmap &= 0xffffffffffff0f00;
1085*4882a593Smuzhiyun }
1086*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Mod by RSSI=0x%llx\n", ra_mask_bitmap);
1087*4882a593Smuzhiyun
1088*4882a593Smuzhiyun return ra_mask_bitmap;
1089*4882a593Smuzhiyun }
1090*4882a593Smuzhiyun
phydm_get_rate_from_rssi_lv(void * dm_void,u8 sta_idx)1091*4882a593Smuzhiyun u8 phydm_get_rate_from_rssi_lv(void *dm_void, u8 sta_idx)
1092*4882a593Smuzhiyun {
1093*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1094*4882a593Smuzhiyun struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx];
1095*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
1096*4882a593Smuzhiyun enum wireless_set wrls_set = 0;
1097*4882a593Smuzhiyun u8 rssi_lv = 0;
1098*4882a593Smuzhiyun u8 rate_idx = 0;
1099*4882a593Smuzhiyun u8 rate_ofst = 0;
1100*4882a593Smuzhiyun
1101*4882a593Smuzhiyun if (is_sta_active(sta)) {
1102*4882a593Smuzhiyun ra = &sta->ra_info;
1103*4882a593Smuzhiyun wrls_set = sta->support_wireless_set;
1104*4882a593Smuzhiyun rssi_lv = ra->rssi_level;
1105*4882a593Smuzhiyun } else {
1106*4882a593Smuzhiyun pr_debug("[Warning] %s: invalid STA\n", __func__);
1107*4882a593Smuzhiyun return 0;
1108*4882a593Smuzhiyun }
1109*4882a593Smuzhiyun
1110*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[%s]macid=%d, wireless_set=0x%x, rssi_lv=%d\n",
1111*4882a593Smuzhiyun __func__, sta->mac_id, wrls_set, rssi_lv);
1112*4882a593Smuzhiyun
1113*4882a593Smuzhiyun rate_ofst = (rssi_lv <= 1) ? 0 : (rssi_lv - 1);
1114*4882a593Smuzhiyun
1115*4882a593Smuzhiyun if (wrls_set & WIRELESS_VHT) {
1116*4882a593Smuzhiyun rate_idx = ODM_RATEVHTSS1MCS0 + rate_ofst;
1117*4882a593Smuzhiyun } else if (wrls_set & WIRELESS_HT) {
1118*4882a593Smuzhiyun rate_idx = ODM_RATEMCS0 + rate_ofst;
1119*4882a593Smuzhiyun } else if (wrls_set & WIRELESS_OFDM) {
1120*4882a593Smuzhiyun rate_idx = ODM_RATE6M + rate_ofst;
1121*4882a593Smuzhiyun } else {
1122*4882a593Smuzhiyun rate_idx = ODM_RATE1M + rate_ofst;
1123*4882a593Smuzhiyun
1124*4882a593Smuzhiyun if (rate_idx > ODM_RATE11M)
1125*4882a593Smuzhiyun rate_idx = ODM_RATE11M;
1126*4882a593Smuzhiyun }
1127*4882a593Smuzhiyun return rate_idx;
1128*4882a593Smuzhiyun }
1129*4882a593Smuzhiyun
phydm_get_rate_id(void * dm_void,u8 sta_idx)1130*4882a593Smuzhiyun u8 phydm_get_rate_id(void *dm_void, u8 sta_idx)
1131*4882a593Smuzhiyun {
1132*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1133*4882a593Smuzhiyun struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx];
1134*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
1135*4882a593Smuzhiyun enum channel_width bw = 0;
1136*4882a593Smuzhiyun enum wireless_set wrls_mode = 0;
1137*4882a593Smuzhiyun u8 tx_stream_num = 1;
1138*4882a593Smuzhiyun u8 rate_id_idx = PHYDM_BGN_20M_1SS;
1139*4882a593Smuzhiyun
1140*4882a593Smuzhiyun if (is_sta_active(sta)) {
1141*4882a593Smuzhiyun ra = &sta->ra_info;
1142*4882a593Smuzhiyun bw = ra->ra_bw_mode;
1143*4882a593Smuzhiyun wrls_mode = sta->support_wireless_set;
1144*4882a593Smuzhiyun tx_stream_num = phydm_get_tx_stream_num(dm, sta->mimo_type);
1145*4882a593Smuzhiyun
1146*4882a593Smuzhiyun } else {
1147*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[Warning] %s: invalid STA\n", __func__);
1148*4882a593Smuzhiyun return 0;
1149*4882a593Smuzhiyun }
1150*4882a593Smuzhiyun
1151*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "macid=%d,wireless_set=0x%x,tx_SS_num=%d,BW=%d\n",
1152*4882a593Smuzhiyun sta->mac_id, wrls_mode, tx_stream_num, bw);
1153*4882a593Smuzhiyun
1154*4882a593Smuzhiyun if (wrls_mode == WIRELESS_CCK) {
1155*4882a593Smuzhiyun /*@B mode*/
1156*4882a593Smuzhiyun rate_id_idx = PHYDM_B_20M;
1157*4882a593Smuzhiyun } else if (wrls_mode == WIRELESS_OFDM) {
1158*4882a593Smuzhiyun /*@G mode*/
1159*4882a593Smuzhiyun rate_id_idx = PHYDM_G;
1160*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM)) {
1161*4882a593Smuzhiyun /*@BG mode*/
1162*4882a593Smuzhiyun rate_id_idx = PHYDM_BG;
1163*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_HT)) {
1164*4882a593Smuzhiyun /*@GN mode*/
1165*4882a593Smuzhiyun if (tx_stream_num == 1)
1166*4882a593Smuzhiyun rate_id_idx = PHYDM_GN_N1SS;
1167*4882a593Smuzhiyun else if (tx_stream_num == 2)
1168*4882a593Smuzhiyun rate_id_idx = PHYDM_GN_N2SS;
1169*4882a593Smuzhiyun else if (tx_stream_num == 3)
1170*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR5_N_3SS;
1171*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT)) {
1172*4882a593Smuzhiyun /*@BGN mode*/
1173*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40) {
1174*4882a593Smuzhiyun if (tx_stream_num == 1)
1175*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_40M_1SS;
1176*4882a593Smuzhiyun else if (tx_stream_num == 2)
1177*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_40M_2SS;
1178*4882a593Smuzhiyun else if (tx_stream_num == 3)
1179*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR5_N_3SS;
1180*4882a593Smuzhiyun else if (tx_stream_num == 4)
1181*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR7_N_4SS;
1182*4882a593Smuzhiyun
1183*4882a593Smuzhiyun } else {
1184*4882a593Smuzhiyun if (tx_stream_num == 1)
1185*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_20M_1SS;
1186*4882a593Smuzhiyun else if (tx_stream_num == 2)
1187*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_20M_2SS;
1188*4882a593Smuzhiyun else if (tx_stream_num == 3)
1189*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR5_N_3SS;
1190*4882a593Smuzhiyun else if (tx_stream_num == 4)
1191*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR7_N_4SS;
1192*4882a593Smuzhiyun }
1193*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_OFDM | WIRELESS_VHT)) {
1194*4882a593Smuzhiyun /*@AC mode*/
1195*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_160) {
1196*4882a593Smuzhiyun if (tx_stream_num == 1)
1197*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR1_AC_1SS;
1198*4882a593Smuzhiyun else if (tx_stream_num == 2)
1199*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR0_AC_2SS;
1200*4882a593Smuzhiyun else if (tx_stream_num == 3)
1201*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR0_AC_2SS;
1202*4882a593Smuzhiyun else if (tx_stream_num == 4)
1203*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR0_AC_2SS;
1204*4882a593Smuzhiyun } else {
1205*4882a593Smuzhiyun if (tx_stream_num == 1)
1206*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR1_AC_1SS;
1207*4882a593Smuzhiyun else if (tx_stream_num == 2)
1208*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR0_AC_2SS;
1209*4882a593Smuzhiyun else if (tx_stream_num == 3)
1210*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR4_AC_3SS;
1211*4882a593Smuzhiyun else if (tx_stream_num == 4)
1212*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR6_AC_4SS;
1213*4882a593Smuzhiyun }
1214*4882a593Smuzhiyun } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_VHT)) {
1215*4882a593Smuzhiyun /*@AC 2.4G mode*/
1216*4882a593Smuzhiyun if (bw >= CHANNEL_WIDTH_80) {
1217*4882a593Smuzhiyun if (tx_stream_num == 1)
1218*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR1_AC_1SS;
1219*4882a593Smuzhiyun else if (tx_stream_num == 2)
1220*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR0_AC_2SS;
1221*4882a593Smuzhiyun else if (tx_stream_num == 3)
1222*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR4_AC_3SS;
1223*4882a593Smuzhiyun else if (tx_stream_num == 4)
1224*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR6_AC_4SS;
1225*4882a593Smuzhiyun } else {
1226*4882a593Smuzhiyun if (tx_stream_num == 1) {
1227*4882a593Smuzhiyun if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2)
1228*4882a593Smuzhiyun rate_id_idx = PHYDM_TYPE2_ARFR5_AC_2G_1SS;
1229*4882a593Smuzhiyun else
1230*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR2_AC_2G_1SS;
1231*4882a593Smuzhiyun } else if (tx_stream_num == 2) {
1232*4882a593Smuzhiyun if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2)
1233*4882a593Smuzhiyun rate_id_idx = PHYDM_TYPE2_ARFR3_AC_2G_2SS;
1234*4882a593Smuzhiyun else
1235*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR3_AC_2G_2SS;
1236*4882a593Smuzhiyun } else if (tx_stream_num == 3) {
1237*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR4_AC_3SS;
1238*4882a593Smuzhiyun } else if (tx_stream_num == 4) {
1239*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR6_AC_4SS;
1240*4882a593Smuzhiyun }
1241*4882a593Smuzhiyun }
1242*4882a593Smuzhiyun } else {
1243*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[Warrning] No rate_id is found\n");
1244*4882a593Smuzhiyun rate_id_idx = 0;
1245*4882a593Smuzhiyun }
1246*4882a593Smuzhiyun
1247*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "Rate_ID=((0x%x))\n", rate_id_idx);
1248*4882a593Smuzhiyun
1249*4882a593Smuzhiyun return rate_id_idx;
1250*4882a593Smuzhiyun }
1251*4882a593Smuzhiyun
1252*4882a593Smuzhiyun #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT
phydm_ra_mode_selection(void * dm_void,u8 mode)1253*4882a593Smuzhiyun void phydm_ra_mode_selection(void *dm_void, u8 mode)
1254*4882a593Smuzhiyun {
1255*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1256*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
1257*4882a593Smuzhiyun u8 pre_mode = ra_tab->ra_trigger_mode; /* 0:pkt RA, 1:TBTT RA */
1258*4882a593Smuzhiyun
1259*4882a593Smuzhiyun if (mode >= 2) {
1260*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "RA mode selection Fail\n");
1261*4882a593Smuzhiyun } else {
1262*4882a593Smuzhiyun ra_tab->ra_trigger_mode = mode;
1263*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "RA mode, 0:pkt RA, 1:TBTT RA\n");
1264*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "PreMode=%d,CurMode=%d\n", pre_mode,
1265*4882a593Smuzhiyun mode);
1266*4882a593Smuzhiyun }
1267*4882a593Smuzhiyun }
1268*4882a593Smuzhiyun #endif
1269*4882a593Smuzhiyun
phydm_ra_h2c(void * dm_void,u8 sta_idx,u8 dis_ra,u8 dis_pt,u8 no_update_bw,u8 init_ra_lv,u64 ra_mask)1270*4882a593Smuzhiyun void phydm_ra_h2c(void *dm_void, u8 sta_idx, u8 dis_ra, u8 dis_pt,
1271*4882a593Smuzhiyun u8 no_update_bw, u8 init_ra_lv, u64 ra_mask)
1272*4882a593Smuzhiyun {
1273*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1274*4882a593Smuzhiyun struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx];
1275*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
1276*4882a593Smuzhiyun u8 h2c_val[H2C_MAX_LENGTH] = {0};
1277*4882a593Smuzhiyun u8 rate_id_idx = 0;
1278*4882a593Smuzhiyun
1279*4882a593Smuzhiyun if (is_sta_active(sta)) {
1280*4882a593Smuzhiyun ra = &sta->ra_info;
1281*4882a593Smuzhiyun } else {
1282*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid sta_info\n",
1283*4882a593Smuzhiyun __func__);
1284*4882a593Smuzhiyun return;
1285*4882a593Smuzhiyun }
1286*4882a593Smuzhiyun
1287*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "%s ======>\n", __func__);
1288*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "MACID=%d\n", sta->mac_id);
1289*4882a593Smuzhiyun
1290*4882a593Smuzhiyun
1291*4882a593Smuzhiyun #ifdef PHYDM_POWER_TRAINING_SUPPORT
1292*4882a593Smuzhiyun if ((dm->support_ability & ODM_BB_PWR_TRAIN) && !dm->is_disable_power_training)
1293*4882a593Smuzhiyun dis_pt = false;
1294*4882a593Smuzhiyun else
1295*4882a593Smuzhiyun dis_pt = true;
1296*4882a593Smuzhiyun
1297*4882a593Smuzhiyun #else
1298*4882a593Smuzhiyun dis_pt= true;
1299*4882a593Smuzhiyun #endif
1300*4882a593Smuzhiyun
1301*4882a593Smuzhiyun rate_id_idx = ra->rate_id;
1302*4882a593Smuzhiyun
1303*4882a593Smuzhiyun /*for compatibility issues with FW RA [PHYDM-405]*/
1304*4882a593Smuzhiyun if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2) {
1305*4882a593Smuzhiyun if (rate_id_idx == PHYDM_TYPE2_ARFR5_AC_2G_1SS)
1306*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR2_AC_2G_1SS;
1307*4882a593Smuzhiyun else if (rate_id_idx == PHYDM_TYPE2_ARFR3_AC_2G_2SS)
1308*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR3_AC_2G_2SS;
1309*4882a593Smuzhiyun }
1310*4882a593Smuzhiyun
1311*4882a593Smuzhiyun h2c_val[0] = sta->mac_id;
1312*4882a593Smuzhiyun h2c_val[1] = (rate_id_idx & 0x1f) | ((init_ra_lv & 0x3) << 5) |
1313*4882a593Smuzhiyun (ra->is_support_sgi << 7);
1314*4882a593Smuzhiyun h2c_val[2] = (u8)((ra->ra_bw_mode) | (((sta->ldpc_en) ? 1 : 0) << 2) |
1315*4882a593Smuzhiyun ((no_update_bw & 0x1) << 3) |
1316*4882a593Smuzhiyun (ra->is_vht_enable << 4) |
1317*4882a593Smuzhiyun ((dis_pt & 0x1) << 6) | ((dis_ra & 0x1) << 7));
1318*4882a593Smuzhiyun
1319*4882a593Smuzhiyun h2c_val[3] = (u8)(ra_mask & 0xff);
1320*4882a593Smuzhiyun h2c_val[4] = (u8)((ra_mask & 0xff00) >> 8);
1321*4882a593Smuzhiyun h2c_val[5] = (u8)((ra_mask & 0xff0000) >> 16);
1322*4882a593Smuzhiyun h2c_val[6] = (u8)((ra_mask & 0xff000000) >> 24);
1323*4882a593Smuzhiyun
1324*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "PHYDM h2c[0x40]=0x%x %x %x %x %x %x %x\n",
1325*4882a593Smuzhiyun h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2],
1326*4882a593Smuzhiyun h2c_val[1], h2c_val[0]);
1327*4882a593Smuzhiyun
1328*4882a593Smuzhiyun odm_fill_h2c_cmd(dm, PHYDM_H2C_RA_MASK, H2C_MAX_LENGTH, h2c_val);
1329*4882a593Smuzhiyun
1330*4882a593Smuzhiyun #if (defined(PHYDM_COMPILE_ABOVE_3SS))
1331*4882a593Smuzhiyun if (dm->support_ic_type & (PHYDM_IC_ABOVE_3SS)) {
1332*4882a593Smuzhiyun h2c_val[3] = (u8)((ra_mask >> 32) & 0x000000ff);
1333*4882a593Smuzhiyun h2c_val[4] = (u8)(((ra_mask >> 32) & 0x0000ff00) >> 8);
1334*4882a593Smuzhiyun h2c_val[5] = (u8)(((ra_mask >> 32) & 0x00ff0000) >> 16);
1335*4882a593Smuzhiyun h2c_val[6] = (u8)(((ra_mask >> 32) & 0xff000000) >> 24);
1336*4882a593Smuzhiyun
1337*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "h2c[0x46]=0x%x %x %x %x %x %x %x\n",
1338*4882a593Smuzhiyun h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3],
1339*4882a593Smuzhiyun h2c_val[2], h2c_val[1], h2c_val[0]);
1340*4882a593Smuzhiyun
1341*4882a593Smuzhiyun odm_fill_h2c_cmd(dm, PHYDM_RA_MASK_ABOVE_3SS,
1342*4882a593Smuzhiyun H2C_MAX_LENGTH, h2c_val);
1343*4882a593Smuzhiyun }
1344*4882a593Smuzhiyun #endif
1345*4882a593Smuzhiyun }
1346*4882a593Smuzhiyun
phydm_ra_registed(void * dm_void,u8 sta_idx,u8 rssi_from_assoc)1347*4882a593Smuzhiyun void phydm_ra_registed(void *dm_void, u8 sta_idx,
1348*4882a593Smuzhiyun /*@index of sta_info array, not MACID*/
1349*4882a593Smuzhiyun u8 rssi_from_assoc)
1350*4882a593Smuzhiyun {
1351*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1352*4882a593Smuzhiyun struct ra_table *ra_t = &dm->dm_ra_table;
1353*4882a593Smuzhiyun struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx];
1354*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
1355*4882a593Smuzhiyun u8 init_ra_lv = 0;
1356*4882a593Smuzhiyun u64 ra_mask = 0;
1357*4882a593Smuzhiyun /*@SD7 STA_idx != macid*/
1358*4882a593Smuzhiyun /*@SD4,8 STA_idx == macid, */
1359*4882a593Smuzhiyun
1360*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__);
1361*4882a593Smuzhiyun
1362*4882a593Smuzhiyun if (is_sta_active(sta)) {
1363*4882a593Smuzhiyun ra = &sta->ra_info;
1364*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d, macid=%d\n", sta_idx,
1365*4882a593Smuzhiyun sta->mac_id);
1366*4882a593Smuzhiyun } else {
1367*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "[Warning] %s invalid STA\n",
1368*4882a593Smuzhiyun __func__);
1369*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d\n", sta_idx);
1370*4882a593Smuzhiyun return;
1371*4882a593Smuzhiyun }
1372*4882a593Smuzhiyun
1373*4882a593Smuzhiyun #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1)
1374*4882a593Smuzhiyun if (dm->support_ic_type == ODM_RTL8188E)
1375*4882a593Smuzhiyun ra->rate_id = phydm_get_rate_id_88e(dm, sta_idx);
1376*4882a593Smuzhiyun else
1377*4882a593Smuzhiyun #endif
1378*4882a593Smuzhiyun {
1379*4882a593Smuzhiyun ra->rate_id = phydm_get_rate_id(dm, sta_idx);
1380*4882a593Smuzhiyun }
1381*4882a593Smuzhiyun
1382*4882a593Smuzhiyun ra_mask = phydm_get_bb_mod_ra_mask(dm, sta_idx);
1383*4882a593Smuzhiyun
1384*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "rssi_assoc=%d\n", rssi_from_assoc);
1385*4882a593Smuzhiyun
1386*4882a593Smuzhiyun if (rssi_from_assoc > 40)
1387*4882a593Smuzhiyun init_ra_lv = 1;
1388*4882a593Smuzhiyun else if (rssi_from_assoc > 20)
1389*4882a593Smuzhiyun init_ra_lv = 2;
1390*4882a593Smuzhiyun else if (rssi_from_assoc > 1)
1391*4882a593Smuzhiyun init_ra_lv = 3;
1392*4882a593Smuzhiyun else
1393*4882a593Smuzhiyun init_ra_lv = 0;
1394*4882a593Smuzhiyun
1395*4882a593Smuzhiyun if (ra_t->record_ra_info)
1396*4882a593Smuzhiyun ra_t->record_ra_info(dm, sta_idx, sta, ra_mask);
1397*4882a593Smuzhiyun
1398*4882a593Smuzhiyun #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1)
1399*4882a593Smuzhiyun if (dm->support_ic_type == ODM_RTL8188E)
1400*4882a593Smuzhiyun /*@Driver RA*/
1401*4882a593Smuzhiyun phydm_ra_update_8188e(dm, sta_idx, ra->rate_id,
1402*4882a593Smuzhiyun (u32)ra_mask, ra->is_support_sgi);
1403*4882a593Smuzhiyun else
1404*4882a593Smuzhiyun #endif
1405*4882a593Smuzhiyun {
1406*4882a593Smuzhiyun /*@FW RA*/
1407*4882a593Smuzhiyun phydm_ra_h2c(dm, sta_idx, ra->disable_ra, ra->disable_pt, 0,
1408*4882a593Smuzhiyun init_ra_lv, ra_mask);
1409*4882a593Smuzhiyun }
1410*4882a593Smuzhiyun }
1411*4882a593Smuzhiyun
phydm_ra_offline(void * dm_void,u8 sta_idx)1412*4882a593Smuzhiyun void phydm_ra_offline(void *dm_void, u8 sta_idx)
1413*4882a593Smuzhiyun {
1414*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1415*4882a593Smuzhiyun struct ra_table *ra_t = &dm->dm_ra_table;
1416*4882a593Smuzhiyun struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx];
1417*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
1418*4882a593Smuzhiyun
1419*4882a593Smuzhiyun if (is_sta_active(sta)) {
1420*4882a593Smuzhiyun ra = &sta->ra_info;
1421*4882a593Smuzhiyun } else {
1422*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid STA\n", __func__);
1423*4882a593Smuzhiyun return;
1424*4882a593Smuzhiyun }
1425*4882a593Smuzhiyun
1426*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "%s ======>\n", __func__);
1427*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "MACID=%d\n", sta->mac_id);
1428*4882a593Smuzhiyun
1429*4882a593Smuzhiyun odm_memory_set(dm, &ra->rate_id, 0, sizeof(struct ra_sta_info));
1430*4882a593Smuzhiyun ra->disable_ra = 1;
1431*4882a593Smuzhiyun ra->disable_pt = 1;
1432*4882a593Smuzhiyun
1433*4882a593Smuzhiyun if (ra_t->record_ra_info)
1434*4882a593Smuzhiyun ra_t->record_ra_info(dm, sta->mac_id, sta, 0);
1435*4882a593Smuzhiyun
1436*4882a593Smuzhiyun if (dm->support_ic_type != ODM_RTL8188E)
1437*4882a593Smuzhiyun phydm_ra_h2c(dm, sta->mac_id, 1, 1, 0, 0, 0);
1438*4882a593Smuzhiyun }
1439*4882a593Smuzhiyun
phydm_ra_mask_watchdog(void * dm_void)1440*4882a593Smuzhiyun void phydm_ra_mask_watchdog(void *dm_void)
1441*4882a593Smuzhiyun {
1442*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1443*4882a593Smuzhiyun struct ra_table *ra_t = &dm->dm_ra_table;
1444*4882a593Smuzhiyun struct cmn_sta_info *sta = NULL;
1445*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
1446*4882a593Smuzhiyun boolean force_ra_mask_en = false;
1447*4882a593Smuzhiyun u8 sta_idx;
1448*4882a593Smuzhiyun u64 ra_mask;
1449*4882a593Smuzhiyun u8 rssi_lv_new;
1450*4882a593Smuzhiyun u8 rssi = 0;
1451*4882a593Smuzhiyun
1452*4882a593Smuzhiyun if (!(dm->support_ability & ODM_BB_RA_MASK))
1453*4882a593Smuzhiyun return;
1454*4882a593Smuzhiyun
1455*4882a593Smuzhiyun if (!dm->is_linked || (dm->phydm_sys_up_time % 2) == 1)
1456*4882a593Smuzhiyun return;
1457*4882a593Smuzhiyun
1458*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__);
1459*4882a593Smuzhiyun
1460*4882a593Smuzhiyun ra_t->up_ramask_cnt++;
1461*4882a593Smuzhiyun
1462*4882a593Smuzhiyun if (ra_t->up_ramask_cnt >= FORCED_UPDATE_RAMASK_PERIOD) {
1463*4882a593Smuzhiyun ra_t->up_ramask_cnt = 0;
1464*4882a593Smuzhiyun force_ra_mask_en = true;
1465*4882a593Smuzhiyun }
1466*4882a593Smuzhiyun
1467*4882a593Smuzhiyun for (sta_idx = 0; sta_idx < ODM_ASSOCIATE_ENTRY_NUM; sta_idx++) {
1468*4882a593Smuzhiyun sta = dm->phydm_sta_info[sta_idx];
1469*4882a593Smuzhiyun
1470*4882a593Smuzhiyun if (!is_sta_active(sta))
1471*4882a593Smuzhiyun continue;
1472*4882a593Smuzhiyun
1473*4882a593Smuzhiyun ra = &sta->ra_info;
1474*4882a593Smuzhiyun
1475*4882a593Smuzhiyun if (ra->disable_ra)
1476*4882a593Smuzhiyun continue;
1477*4882a593Smuzhiyun
1478*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d, macid=%d\n", sta_idx,
1479*4882a593Smuzhiyun sta->mac_id);
1480*4882a593Smuzhiyun
1481*4882a593Smuzhiyun rssi = (u8)(sta->rssi_stat.rssi);
1482*4882a593Smuzhiyun
1483*4882a593Smuzhiyun /*@to be modified*/
1484*4882a593Smuzhiyun #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1))
1485*4882a593Smuzhiyun if (dm->support_ic_type == ODM_RTL8812 ||
1486*4882a593Smuzhiyun (dm->support_ic_type == ODM_RTL8821 &&
1487*4882a593Smuzhiyun dm->cut_version == ODM_CUT_A)
1488*4882a593Smuzhiyun ) {
1489*4882a593Smuzhiyun if (rssi < ra_t->ldpc_thres) {
1490*4882a593Smuzhiyun /*@LDPC TX enable*/
1491*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
1492*4882a593Smuzhiyun set_ra_ldpc_8812(sta, true);
1493*4882a593Smuzhiyun #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN)
1494*4882a593Smuzhiyun MgntSet_TX_LDPC(dm->adapter, sta->mac_id, true);
1495*4882a593Smuzhiyun #elif (DM_ODM_SUPPORT_TYPE == ODM_AP)
1496*4882a593Smuzhiyun /*to be added*/
1497*4882a593Smuzhiyun #endif
1498*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK,
1499*4882a593Smuzhiyun "RSSI=%d, ldpc_en =TRUE\n", rssi);
1500*4882a593Smuzhiyun
1501*4882a593Smuzhiyun } else if (rssi > (ra_t->ldpc_thres + 3)) {
1502*4882a593Smuzhiyun /*@LDPC TX disable*/
1503*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
1504*4882a593Smuzhiyun set_ra_ldpc_8812(sta, false);
1505*4882a593Smuzhiyun #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN)
1506*4882a593Smuzhiyun MgntSet_TX_LDPC(dm->adapter, sta->mac_id, false);
1507*4882a593Smuzhiyun #elif (DM_ODM_SUPPORT_TYPE == ODM_AP)
1508*4882a593Smuzhiyun /*to be added*/
1509*4882a593Smuzhiyun #endif
1510*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK,
1511*4882a593Smuzhiyun "RSSI=%d, ldpc_en =FALSE\n", rssi);
1512*4882a593Smuzhiyun }
1513*4882a593Smuzhiyun }
1514*4882a593Smuzhiyun #endif
1515*4882a593Smuzhiyun
1516*4882a593Smuzhiyun rssi_lv_new = phydm_rssi_lv_dec(dm, (u32)rssi, ra->rssi_level);
1517*4882a593Smuzhiyun
1518*4882a593Smuzhiyun if (ra->rssi_level != rssi_lv_new ||
1519*4882a593Smuzhiyun (force_ra_mask_en && dm->number_linked_client < 10)) {
1520*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK, "RSSI LV:((%d))->((%d))\n",
1521*4882a593Smuzhiyun ra->rssi_level, rssi_lv_new);
1522*4882a593Smuzhiyun
1523*4882a593Smuzhiyun ra->rssi_level = rssi_lv_new;
1524*4882a593Smuzhiyun
1525*4882a593Smuzhiyun ra_mask = phydm_get_bb_mod_ra_mask(dm, sta_idx);
1526*4882a593Smuzhiyun
1527*4882a593Smuzhiyun if (ra_t->record_ra_info)
1528*4882a593Smuzhiyun ra_t->record_ra_info(dm, sta_idx, sta, ra_mask);
1529*4882a593Smuzhiyun
1530*4882a593Smuzhiyun #if (RTL8188E_SUPPORT) && (RATE_ADAPTIVE_SUPPORT)
1531*4882a593Smuzhiyun if (dm->support_ic_type == ODM_RTL8188E)
1532*4882a593Smuzhiyun /*@Driver RA*/
1533*4882a593Smuzhiyun phydm_ra_update_8188e(dm, sta_idx, ra->rate_id,
1534*4882a593Smuzhiyun (u32)ra_mask,
1535*4882a593Smuzhiyun ra->is_support_sgi);
1536*4882a593Smuzhiyun else
1537*4882a593Smuzhiyun #endif
1538*4882a593Smuzhiyun {
1539*4882a593Smuzhiyun /*@FW RA*/
1540*4882a593Smuzhiyun phydm_ra_h2c(dm, sta_idx, ra->disable_ra,
1541*4882a593Smuzhiyun ra->disable_pt, 1, 0, ra_mask);
1542*4882a593Smuzhiyun }
1543*4882a593Smuzhiyun }
1544*4882a593Smuzhiyun }
1545*4882a593Smuzhiyun }
1546*4882a593Smuzhiyun
phydm_vht_en_mapping(void * dm_void,u32 wireless_mode)1547*4882a593Smuzhiyun u8 phydm_vht_en_mapping(void *dm_void, u32 wireless_mode)
1548*4882a593Smuzhiyun {
1549*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1550*4882a593Smuzhiyun u8 vht_en_out = 0;
1551*4882a593Smuzhiyun
1552*4882a593Smuzhiyun if (wireless_mode == PHYDM_WIRELESS_MODE_AC_5G ||
1553*4882a593Smuzhiyun wireless_mode == PHYDM_WIRELESS_MODE_AC_24G ||
1554*4882a593Smuzhiyun wireless_mode == PHYDM_WIRELESS_MODE_AC_ONLY)
1555*4882a593Smuzhiyun vht_en_out = 1;
1556*4882a593Smuzhiyun
1557*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "wireless_mode= (( 0x%x )), VHT_EN= (( %d ))\n",
1558*4882a593Smuzhiyun wireless_mode, vht_en_out);
1559*4882a593Smuzhiyun return vht_en_out;
1560*4882a593Smuzhiyun }
1561*4882a593Smuzhiyun
phydm_rftype2rateid_2g_n20(void * dm_void,u8 rf_type)1562*4882a593Smuzhiyun u8 phydm_rftype2rateid_2g_n20(void *dm_void, u8 rf_type)
1563*4882a593Smuzhiyun {
1564*4882a593Smuzhiyun u8 rate_id_idx = 0;
1565*4882a593Smuzhiyun
1566*4882a593Smuzhiyun if (rf_type == RF_1T1R)
1567*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_20M_1SS;
1568*4882a593Smuzhiyun else if (rf_type == RF_2T2R)
1569*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_20M_2SS;
1570*4882a593Smuzhiyun else if (rf_type == RF_3T3R)
1571*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR5_N_3SS;
1572*4882a593Smuzhiyun else
1573*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR7_N_4SS;
1574*4882a593Smuzhiyun return rate_id_idx;
1575*4882a593Smuzhiyun }
1576*4882a593Smuzhiyun
phydm_rftype2rateid_2g_n40(void * dm_void,u8 rf_type)1577*4882a593Smuzhiyun u8 phydm_rftype2rateid_2g_n40(void *dm_void, u8 rf_type)
1578*4882a593Smuzhiyun {
1579*4882a593Smuzhiyun u8 rate_id_idx = 0;
1580*4882a593Smuzhiyun
1581*4882a593Smuzhiyun if (rf_type == RF_1T1R)
1582*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_40M_1SS;
1583*4882a593Smuzhiyun else if (rf_type == RF_2T2R)
1584*4882a593Smuzhiyun rate_id_idx = PHYDM_BGN_40M_2SS;
1585*4882a593Smuzhiyun else if (rf_type == RF_3T3R)
1586*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR5_N_3SS;
1587*4882a593Smuzhiyun else
1588*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR7_N_4SS;
1589*4882a593Smuzhiyun return rate_id_idx;
1590*4882a593Smuzhiyun }
1591*4882a593Smuzhiyun
phydm_rftype2rateid_5g_n(void * dm_void,u8 rf_type)1592*4882a593Smuzhiyun u8 phydm_rftype2rateid_5g_n(void *dm_void, u8 rf_type)
1593*4882a593Smuzhiyun {
1594*4882a593Smuzhiyun u8 rate_id_idx = 0;
1595*4882a593Smuzhiyun
1596*4882a593Smuzhiyun if (rf_type == RF_1T1R)
1597*4882a593Smuzhiyun rate_id_idx = PHYDM_GN_N1SS;
1598*4882a593Smuzhiyun else if (rf_type == RF_2T2R)
1599*4882a593Smuzhiyun rate_id_idx = PHYDM_GN_N2SS;
1600*4882a593Smuzhiyun else if (rf_type == RF_3T3R)
1601*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR5_N_3SS;
1602*4882a593Smuzhiyun else
1603*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR7_N_4SS;
1604*4882a593Smuzhiyun return rate_id_idx;
1605*4882a593Smuzhiyun }
1606*4882a593Smuzhiyun
phydm_rftype2rateid_ac80(void * dm_void,u8 rf_type)1607*4882a593Smuzhiyun u8 phydm_rftype2rateid_ac80(void *dm_void, u8 rf_type)
1608*4882a593Smuzhiyun {
1609*4882a593Smuzhiyun u8 rate_id_idx = 0;
1610*4882a593Smuzhiyun
1611*4882a593Smuzhiyun if (rf_type == RF_1T1R)
1612*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR1_AC_1SS;
1613*4882a593Smuzhiyun else if (rf_type == RF_2T2R)
1614*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR0_AC_2SS;
1615*4882a593Smuzhiyun else if (rf_type == RF_3T3R)
1616*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR4_AC_3SS;
1617*4882a593Smuzhiyun else
1618*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR6_AC_4SS;
1619*4882a593Smuzhiyun return rate_id_idx;
1620*4882a593Smuzhiyun }
1621*4882a593Smuzhiyun
phydm_rftype2rateid_ac40(void * dm_void,u8 rf_type)1622*4882a593Smuzhiyun u8 phydm_rftype2rateid_ac40(void *dm_void, u8 rf_type)
1623*4882a593Smuzhiyun {
1624*4882a593Smuzhiyun u8 rate_id_idx = 0;
1625*4882a593Smuzhiyun
1626*4882a593Smuzhiyun if (rf_type == RF_1T1R)
1627*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR2_AC_2G_1SS;
1628*4882a593Smuzhiyun else if (rf_type == RF_2T2R)
1629*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR3_AC_2G_2SS;
1630*4882a593Smuzhiyun else if (rf_type == RF_3T3R)
1631*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR4_AC_3SS;
1632*4882a593Smuzhiyun else
1633*4882a593Smuzhiyun rate_id_idx = PHYDM_ARFR6_AC_4SS;
1634*4882a593Smuzhiyun return rate_id_idx;
1635*4882a593Smuzhiyun }
1636*4882a593Smuzhiyun
phydm_rate_id_mapping(void * dm_void,u32 wireless_mode,u8 rf_type,u8 bw)1637*4882a593Smuzhiyun u8 phydm_rate_id_mapping(void *dm_void, u32 wireless_mode, u8 rf_type, u8 bw)
1638*4882a593Smuzhiyun {
1639*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1640*4882a593Smuzhiyun u8 rate_id_idx = 0;
1641*4882a593Smuzhiyun
1642*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
1643*4882a593Smuzhiyun "wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x ))\n",
1644*4882a593Smuzhiyun wireless_mode, rf_type, bw);
1645*4882a593Smuzhiyun
1646*4882a593Smuzhiyun switch (wireless_mode) {
1647*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_N_24G:
1648*4882a593Smuzhiyun if (bw == CHANNEL_WIDTH_40)
1649*4882a593Smuzhiyun rate_id_idx = phydm_rftype2rateid_2g_n40(dm, rf_type);
1650*4882a593Smuzhiyun else
1651*4882a593Smuzhiyun rate_id_idx = phydm_rftype2rateid_2g_n20(dm, rf_type);
1652*4882a593Smuzhiyun break;
1653*4882a593Smuzhiyun
1654*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_N_5G:
1655*4882a593Smuzhiyun rate_id_idx = phydm_rftype2rateid_5g_n(dm, rf_type);
1656*4882a593Smuzhiyun break;
1657*4882a593Smuzhiyun
1658*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_G:
1659*4882a593Smuzhiyun rate_id_idx = PHYDM_BG;
1660*4882a593Smuzhiyun break;
1661*4882a593Smuzhiyun
1662*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_A:
1663*4882a593Smuzhiyun rate_id_idx = PHYDM_G;
1664*4882a593Smuzhiyun break;
1665*4882a593Smuzhiyun
1666*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_B:
1667*4882a593Smuzhiyun rate_id_idx = PHYDM_B_20M;
1668*4882a593Smuzhiyun break;
1669*4882a593Smuzhiyun
1670*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_AC_5G:
1671*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_AC_ONLY:
1672*4882a593Smuzhiyun rate_id_idx = phydm_rftype2rateid_ac80(dm, rf_type);
1673*4882a593Smuzhiyun break;
1674*4882a593Smuzhiyun
1675*4882a593Smuzhiyun case PHYDM_WIRELESS_MODE_AC_24G:
1676*4882a593Smuzhiyun /*@Becareful to set "Lowest rate" while using PHYDM_ARFR4_AC_3SS in 2.4G/5G*/
1677*4882a593Smuzhiyun if (bw >= CHANNEL_WIDTH_80)
1678*4882a593Smuzhiyun rate_id_idx = phydm_rftype2rateid_ac80(dm, rf_type);
1679*4882a593Smuzhiyun else
1680*4882a593Smuzhiyun rate_id_idx = phydm_rftype2rateid_ac40(dm, rf_type);
1681*4882a593Smuzhiyun break;
1682*4882a593Smuzhiyun
1683*4882a593Smuzhiyun default:
1684*4882a593Smuzhiyun rate_id_idx = 0;
1685*4882a593Smuzhiyun break;
1686*4882a593Smuzhiyun }
1687*4882a593Smuzhiyun
1688*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "RA rate ID = (( 0x%x ))\n", rate_id_idx);
1689*4882a593Smuzhiyun
1690*4882a593Smuzhiyun return rate_id_idx;
1691*4882a593Smuzhiyun }
1692*4882a593Smuzhiyun
phydm_rssi_lv_dec(void * dm_void,u32 rssi,u8 ratr_state)1693*4882a593Smuzhiyun u8 phydm_rssi_lv_dec(void *dm_void, u32 rssi, u8 ratr_state)
1694*4882a593Smuzhiyun {
1695*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1696*4882a593Smuzhiyun /*@MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/
1697*4882a593Smuzhiyun u8 rssi_lv_t[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100};
1698*4882a593Smuzhiyun u8 new_rssi_lv = 0;
1699*4882a593Smuzhiyun u8 i;
1700*4882a593Smuzhiyun
1701*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK,
1702*4882a593Smuzhiyun "curr RA level=(%d), Table_ori=[%d, %d, %d, %d, %d, %d]\n",
1703*4882a593Smuzhiyun ratr_state, rssi_lv_t[0], rssi_lv_t[1], rssi_lv_t[2],
1704*4882a593Smuzhiyun rssi_lv_t[3], rssi_lv_t[4], rssi_lv_t[5]);
1705*4882a593Smuzhiyun
1706*4882a593Smuzhiyun for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) {
1707*4882a593Smuzhiyun if (i >= (ratr_state))
1708*4882a593Smuzhiyun rssi_lv_t[i] += RA_FLOOR_UP_GAP;
1709*4882a593Smuzhiyun }
1710*4882a593Smuzhiyun
1711*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA_MASK,
1712*4882a593Smuzhiyun "RSSI=(%d), Table_mod=[%d, %d, %d, %d, %d, %d]\n", rssi,
1713*4882a593Smuzhiyun rssi_lv_t[0], rssi_lv_t[1], rssi_lv_t[2], rssi_lv_t[3],
1714*4882a593Smuzhiyun rssi_lv_t[4], rssi_lv_t[5]);
1715*4882a593Smuzhiyun
1716*4882a593Smuzhiyun for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) {
1717*4882a593Smuzhiyun if (rssi < rssi_lv_t[i]) {
1718*4882a593Smuzhiyun new_rssi_lv = i;
1719*4882a593Smuzhiyun break;
1720*4882a593Smuzhiyun }
1721*4882a593Smuzhiyun }
1722*4882a593Smuzhiyun return new_rssi_lv;
1723*4882a593Smuzhiyun }
1724*4882a593Smuzhiyun
phydm_get_ofdm_qam_order(void * dm_void,u8 rate_idx)1725*4882a593Smuzhiyun enum phydm_qam_order phydm_get_ofdm_qam_order(void *dm_void, u8 rate_idx)
1726*4882a593Smuzhiyun {
1727*4882a593Smuzhiyun u8 tmp_idx = rate_idx;
1728*4882a593Smuzhiyun enum phydm_qam_order qam_order = PHYDM_QAM_BPSK;
1729*4882a593Smuzhiyun enum phydm_qam_order qam[10] = {PHYDM_QAM_BPSK, PHYDM_QAM_QPSK,
1730*4882a593Smuzhiyun PHYDM_QAM_QPSK, PHYDM_QAM_16QAM,
1731*4882a593Smuzhiyun PHYDM_QAM_16QAM, PHYDM_QAM_64QAM,
1732*4882a593Smuzhiyun PHYDM_QAM_64QAM, PHYDM_QAM_64QAM,
1733*4882a593Smuzhiyun PHYDM_QAM_256QAM, PHYDM_QAM_256QAM};
1734*4882a593Smuzhiyun
1735*4882a593Smuzhiyun if (rate_idx <= ODM_RATE11M)
1736*4882a593Smuzhiyun return PHYDM_QAM_CCK;
1737*4882a593Smuzhiyun
1738*4882a593Smuzhiyun if (rate_idx >= ODM_RATEVHTSS1MCS0) {
1739*4882a593Smuzhiyun if (rate_idx >= ODM_RATEVHTSS4MCS0)
1740*4882a593Smuzhiyun tmp_idx -= ODM_RATEVHTSS4MCS0;
1741*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEVHTSS3MCS0)
1742*4882a593Smuzhiyun tmp_idx -= ODM_RATEVHTSS3MCS0;
1743*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEVHTSS2MCS0)
1744*4882a593Smuzhiyun tmp_idx -= ODM_RATEVHTSS2MCS0;
1745*4882a593Smuzhiyun else
1746*4882a593Smuzhiyun tmp_idx -= ODM_RATEVHTSS1MCS0;
1747*4882a593Smuzhiyun
1748*4882a593Smuzhiyun qam_order = qam[tmp_idx];
1749*4882a593Smuzhiyun } else if (rate_idx >= ODM_RATEMCS0) {
1750*4882a593Smuzhiyun if (rate_idx >= ODM_RATEMCS24)
1751*4882a593Smuzhiyun tmp_idx -= ODM_RATEMCS24;
1752*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEMCS16)
1753*4882a593Smuzhiyun tmp_idx -= ODM_RATEMCS16;
1754*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEMCS8)
1755*4882a593Smuzhiyun tmp_idx -= ODM_RATEMCS8;
1756*4882a593Smuzhiyun else
1757*4882a593Smuzhiyun tmp_idx -= ODM_RATEMCS0;
1758*4882a593Smuzhiyun
1759*4882a593Smuzhiyun qam_order = qam[tmp_idx];
1760*4882a593Smuzhiyun } else {
1761*4882a593Smuzhiyun if (rate_idx > ODM_RATE6M) {
1762*4882a593Smuzhiyun tmp_idx -= ODM_RATE6M;
1763*4882a593Smuzhiyun qam_order = qam[tmp_idx - 1];
1764*4882a593Smuzhiyun } else {
1765*4882a593Smuzhiyun qam_order = PHYDM_QAM_BPSK;
1766*4882a593Smuzhiyun }
1767*4882a593Smuzhiyun }
1768*4882a593Smuzhiyun
1769*4882a593Smuzhiyun return qam_order;
1770*4882a593Smuzhiyun }
1771*4882a593Smuzhiyun
phydm_rate_order_compute(void * dm_void,u8 rate_idx)1772*4882a593Smuzhiyun u8 phydm_rate_order_compute(void *dm_void, u8 rate_idx)
1773*4882a593Smuzhiyun {
1774*4882a593Smuzhiyun u8 rate_order = rate_idx & 0x7f;
1775*4882a593Smuzhiyun
1776*4882a593Smuzhiyun rate_idx &= 0x7f;
1777*4882a593Smuzhiyun
1778*4882a593Smuzhiyun if (rate_idx >= ODM_RATEVHTSS4MCS0)
1779*4882a593Smuzhiyun rate_order -= ODM_RATEVHTSS4MCS0;
1780*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEVHTSS3MCS0)
1781*4882a593Smuzhiyun rate_order -= ODM_RATEVHTSS3MCS0;
1782*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEVHTSS2MCS0)
1783*4882a593Smuzhiyun rate_order -= ODM_RATEVHTSS2MCS0;
1784*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEVHTSS1MCS0)
1785*4882a593Smuzhiyun rate_order -= ODM_RATEVHTSS1MCS0;
1786*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEMCS24)
1787*4882a593Smuzhiyun rate_order -= ODM_RATEMCS24;
1788*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEMCS16)
1789*4882a593Smuzhiyun rate_order -= ODM_RATEMCS16;
1790*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEMCS8)
1791*4882a593Smuzhiyun rate_order -= ODM_RATEMCS8;
1792*4882a593Smuzhiyun else if (rate_idx >= ODM_RATEMCS0)
1793*4882a593Smuzhiyun rate_order -= ODM_RATEMCS0;
1794*4882a593Smuzhiyun else if (rate_idx >= ODM_RATE6M)
1795*4882a593Smuzhiyun rate_order -= ODM_RATE6M;
1796*4882a593Smuzhiyun else
1797*4882a593Smuzhiyun rate_order -= ODM_RATE1M;
1798*4882a593Smuzhiyun
1799*4882a593Smuzhiyun if (rate_idx >= ODM_RATEMCS0)
1800*4882a593Smuzhiyun rate_order++;
1801*4882a593Smuzhiyun
1802*4882a593Smuzhiyun return rate_order;
1803*4882a593Smuzhiyun }
1804*4882a593Smuzhiyun
1805*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
phydm_rate2ss(void * dm_void,u8 rate_idx)1806*4882a593Smuzhiyun u8 phydm_rate2ss(void *dm_void, u8 rate_idx)
1807*4882a593Smuzhiyun {
1808*4882a593Smuzhiyun u8 ret = 0xff;
1809*4882a593Smuzhiyun u8 i, j;
1810*4882a593Smuzhiyun u8 search_idx;
1811*4882a593Smuzhiyun u32 ss_mapping_tab[4][3] = {{0x00000000, 0x003ff000, 0x000ff000},
1812*4882a593Smuzhiyun {0x00000000, 0xffc00000, 0x0ff00000},
1813*4882a593Smuzhiyun {0x000003ff, 0x0000000f, 0xf0000000},
1814*4882a593Smuzhiyun {0x000ffc00, 0x00000ff0, 0x00000000} };
1815*4882a593Smuzhiyun if (rate_idx < 32) {
1816*4882a593Smuzhiyun search_idx = rate_idx;
1817*4882a593Smuzhiyun j = 0;
1818*4882a593Smuzhiyun } else if (rate_idx < 64) {
1819*4882a593Smuzhiyun search_idx = rate_idx - 32;
1820*4882a593Smuzhiyun j = 1;
1821*4882a593Smuzhiyun } else {
1822*4882a593Smuzhiyun search_idx = rate_idx - 64;
1823*4882a593Smuzhiyun j = 2;
1824*4882a593Smuzhiyun }
1825*4882a593Smuzhiyun for (i = 0; i < 4; i++)
1826*4882a593Smuzhiyun if (ss_mapping_tab[i][j] & BIT(search_idx))
1827*4882a593Smuzhiyun ret = i;
1828*4882a593Smuzhiyun return ret;
1829*4882a593Smuzhiyun }
1830*4882a593Smuzhiyun
phydm_rate2plcp(void * dm_void,u8 rate_idx)1831*4882a593Smuzhiyun u8 phydm_rate2plcp(void *dm_void, u8 rate_idx)
1832*4882a593Smuzhiyun {
1833*4882a593Smuzhiyun u8 rate2ss = 0;
1834*4882a593Smuzhiyun u8 ltftime = 0;
1835*4882a593Smuzhiyun u8 plcptime = 0xff;
1836*4882a593Smuzhiyun
1837*4882a593Smuzhiyun if (rate_idx < ODM_RATE6M) {
1838*4882a593Smuzhiyun plcptime = 192;
1839*4882a593Smuzhiyun /* @CCK PLCP = 192us (long preamble) */
1840*4882a593Smuzhiyun } else if (rate_idx < ODM_RATEMCS0) {
1841*4882a593Smuzhiyun plcptime = 20;
1842*4882a593Smuzhiyun /* @LegOFDM PLCP = 20us */
1843*4882a593Smuzhiyun } else {
1844*4882a593Smuzhiyun if (rate_idx < ODM_RATEVHTSS1MCS0)
1845*4882a593Smuzhiyun plcptime = 32;
1846*4882a593Smuzhiyun /* @HT mode PLCP = 20us + 12us + 4us x Nss */
1847*4882a593Smuzhiyun else
1848*4882a593Smuzhiyun plcptime = 36;
1849*4882a593Smuzhiyun /* VHT mode PLCP = 20us + 16us + 4us x Nss */
1850*4882a593Smuzhiyun rate2ss = phydm_rate2ss(dm_void, rate_idx);
1851*4882a593Smuzhiyun if (rate2ss != 0xff)
1852*4882a593Smuzhiyun ltftime = (rate2ss + 1) * 4;
1853*4882a593Smuzhiyun else
1854*4882a593Smuzhiyun return 0xff;
1855*4882a593Smuzhiyun
1856*4882a593Smuzhiyun plcptime += ltftime;
1857*4882a593Smuzhiyun }
1858*4882a593Smuzhiyun return plcptime;
1859*4882a593Smuzhiyun }
1860*4882a593Smuzhiyun
phydm_get_plcp(void * dm_void,u16 macid)1861*4882a593Smuzhiyun u8 phydm_get_plcp(void *dm_void, u16 macid)
1862*4882a593Smuzhiyun {
1863*4882a593Smuzhiyun u8 plcp_time = 0;
1864*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1865*4882a593Smuzhiyun struct cmn_sta_info *sta = NULL;
1866*4882a593Smuzhiyun struct ra_sta_info *ra = NULL;
1867*4882a593Smuzhiyun
1868*4882a593Smuzhiyun sta = dm->phydm_sta_info[macid];
1869*4882a593Smuzhiyun ra = &sta->ra_info;
1870*4882a593Smuzhiyun plcp_time = phydm_rate2plcp(dm, ra->curr_tx_rate);
1871*4882a593Smuzhiyun return plcp_time;
1872*4882a593Smuzhiyun }
1873*4882a593Smuzhiyun #endif
1874*4882a593Smuzhiyun
phydm_ra_common_info_update(void * dm_void)1875*4882a593Smuzhiyun void phydm_ra_common_info_update(void *dm_void)
1876*4882a593Smuzhiyun {
1877*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1878*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
1879*4882a593Smuzhiyun struct cmn_sta_info *sta = NULL;
1880*4882a593Smuzhiyun u16 macid;
1881*4882a593Smuzhiyun u8 rate_order_tmp;
1882*4882a593Smuzhiyun u8 rate_idx = 0;
1883*4882a593Smuzhiyun u8 cnt = 0;
1884*4882a593Smuzhiyun
1885*4882a593Smuzhiyun ra_tab->highest_client_tx_order = 0;
1886*4882a593Smuzhiyun ra_tab->power_tracking_flag = 1;
1887*4882a593Smuzhiyun
1888*4882a593Smuzhiyun if (!dm->number_linked_client)
1889*4882a593Smuzhiyun return;
1890*4882a593Smuzhiyun
1891*4882a593Smuzhiyun for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) {
1892*4882a593Smuzhiyun sta = dm->phydm_sta_info[macid];
1893*4882a593Smuzhiyun
1894*4882a593Smuzhiyun if (!is_sta_active(sta))
1895*4882a593Smuzhiyun continue;
1896*4882a593Smuzhiyun
1897*4882a593Smuzhiyun rate_idx = sta->ra_info.curr_tx_rate & 0x7f;
1898*4882a593Smuzhiyun rate_order_tmp = phydm_rate_order_compute(dm, rate_idx);
1899*4882a593Smuzhiyun
1900*4882a593Smuzhiyun if (rate_order_tmp >= ra_tab->highest_client_tx_order) {
1901*4882a593Smuzhiyun ra_tab->highest_client_tx_order = rate_order_tmp;
1902*4882a593Smuzhiyun ra_tab->highest_client_tx_rate_order = macid;
1903*4882a593Smuzhiyun }
1904*4882a593Smuzhiyun
1905*4882a593Smuzhiyun cnt++;
1906*4882a593Smuzhiyun
1907*4882a593Smuzhiyun if (cnt == dm->number_linked_client)
1908*4882a593Smuzhiyun break;
1909*4882a593Smuzhiyun }
1910*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
1911*4882a593Smuzhiyun "MACID[%d], Highest Tx order Update for power traking: %d\n",
1912*4882a593Smuzhiyun ra_tab->highest_client_tx_rate_order,
1913*4882a593Smuzhiyun ra_tab->highest_client_tx_order);
1914*4882a593Smuzhiyun }
1915*4882a593Smuzhiyun
phydm_rrsr_set_register(void * dm_void,u32 rrsr_val)1916*4882a593Smuzhiyun void phydm_rrsr_set_register(void *dm_void, u32 rrsr_val)
1917*4882a593Smuzhiyun {
1918*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1919*4882a593Smuzhiyun
1920*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x440, 0xfffff, rrsr_val);
1921*4882a593Smuzhiyun }
1922*4882a593Smuzhiyun
phydm_masked_rrsr_set_register(void * dm_void,u32 rrsr_val)1923*4882a593Smuzhiyun void phydm_masked_rrsr_set_register(void *dm_void, u32 rrsr_val)
1924*4882a593Smuzhiyun {
1925*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1926*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
1927*4882a593Smuzhiyun
1928*4882a593Smuzhiyun if (ra_tab->rrsr_val_curr == rrsr_val)
1929*4882a593Smuzhiyun return;
1930*4882a593Smuzhiyun
1931*4882a593Smuzhiyun ra_tab->rrsr_val_curr = rrsr_val;
1932*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x440, 0xfffff, rrsr_val);
1933*4882a593Smuzhiyun }
1934*4882a593Smuzhiyun
phydm_rrsr_mask(void * dm_void)1935*4882a593Smuzhiyun void phydm_rrsr_mask(void *dm_void)
1936*4882a593Smuzhiyun {
1937*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
1938*4882a593Smuzhiyun struct ra_table *ra = &dm->dm_ra_table;
1939*4882a593Smuzhiyun struct cmn_sta_info *sta = NULL;
1940*4882a593Smuzhiyun u8 rate_order = 0;
1941*4882a593Smuzhiyun u8 rate_order_min = 0xff;
1942*4882a593Smuzhiyun u32 rrsr_mask = 0, rrsr_mask_ofdm = 0;
1943*4882a593Smuzhiyun u8 tx_rate_idx = 0;
1944*4882a593Smuzhiyun u8 i = 0, sta_cnt = 0;
1945*4882a593Smuzhiyun
1946*4882a593Smuzhiyun if (!ra->dynamic_rrsr_en)
1947*4882a593Smuzhiyun return;
1948*4882a593Smuzhiyun
1949*4882a593Smuzhiyun if (!dm->is_linked) {
1950*4882a593Smuzhiyun phydm_masked_rrsr_set_register(dm, ra->rrsr_val_init);
1951*4882a593Smuzhiyun return;
1952*4882a593Smuzhiyun }
1953*4882a593Smuzhiyun
1954*4882a593Smuzhiyun #if 1
1955*4882a593Smuzhiyun for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
1956*4882a593Smuzhiyun sta = dm->phydm_sta_info[i];
1957*4882a593Smuzhiyun if (!is_sta_active(sta))
1958*4882a593Smuzhiyun continue;
1959*4882a593Smuzhiyun
1960*4882a593Smuzhiyun sta_cnt++;
1961*4882a593Smuzhiyun tx_rate_idx = sta->ra_info.curr_tx_rate & 0x7f;
1962*4882a593Smuzhiyun rate_order = phydm_rate_order_compute(dm, tx_rate_idx);
1963*4882a593Smuzhiyun if (rate_order < rate_order_min)
1964*4882a593Smuzhiyun rate_order_min = rate_order;
1965*4882a593Smuzhiyun
1966*4882a593Smuzhiyun if (sta_cnt == dm->number_linked_client)
1967*4882a593Smuzhiyun break;
1968*4882a593Smuzhiyun }
1969*4882a593Smuzhiyun #else
1970*4882a593Smuzhiyun sta = dm->phydm_sta_info[dm->rssi_min_macid];
1971*4882a593Smuzhiyun
1972*4882a593Smuzhiyun if (!is_sta_active(sta)) {
1973*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_DYN_ARFR, "[Warning] %s invalid STA\n",
1974*4882a593Smuzhiyun __func__);
1975*4882a593Smuzhiyun return;
1976*4882a593Smuzhiyun }
1977*4882a593Smuzhiyun
1978*4882a593Smuzhiyun rate_order = phydm_rate_order_compute(dm, sta->ra_info.curr_tx_rate);
1979*4882a593Smuzhiyun #endif
1980*4882a593Smuzhiyun if (rate_order_min == 0) {
1981*4882a593Smuzhiyun rrsr_mask = 0x1f;
1982*4882a593Smuzhiyun } else {
1983*4882a593Smuzhiyun rrsr_mask_ofdm = (u32)phydm_gen_bitmask(rate_order_min);
1984*4882a593Smuzhiyun rrsr_mask = (rrsr_mask_ofdm << 4) | 0xf;
1985*4882a593Smuzhiyun }
1986*4882a593Smuzhiyun
1987*4882a593Smuzhiyun /*ra->rrsr_val_init = 0x15d;*/
1988*4882a593Smuzhiyun
1989*4882a593Smuzhiyun phydm_masked_rrsr_set_register(dm, ra->rrsr_val_init & rrsr_mask);
1990*4882a593Smuzhiyun
1991*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_DYN_ARFR,
1992*4882a593Smuzhiyun "tx{rate, rate_order_min}={0x%x, %d}, rrsr_init=0x%x, ofdm_rrsr_mask=0x%x, rrsr_val=0x%x\n",
1993*4882a593Smuzhiyun tx_rate_idx, rate_order_min, ra->rrsr_val_init,
1994*4882a593Smuzhiyun rrsr_mask, ra->rrsr_val_curr);
1995*4882a593Smuzhiyun }
1996*4882a593Smuzhiyun
phydm_ra_info_watchdog(void * dm_void)1997*4882a593Smuzhiyun void phydm_ra_info_watchdog(void *dm_void)
1998*4882a593Smuzhiyun {
1999*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2000*4882a593Smuzhiyun
2001*4882a593Smuzhiyun phydm_ra_common_info_update(dm);
2002*4882a593Smuzhiyun phydm_ra_dynamic_retry_count(dm);
2003*4882a593Smuzhiyun phydm_rrsr_mask(dm);
2004*4882a593Smuzhiyun phydm_ra_mask_watchdog(dm);
2005*4882a593Smuzhiyun
2006*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
2007*4882a593Smuzhiyun odm_refresh_basic_rate_mask(dm);
2008*4882a593Smuzhiyun #endif
2009*4882a593Smuzhiyun }
2010*4882a593Smuzhiyun
phydm_rrsr_en(void * dm_void,boolean en_rrsr)2011*4882a593Smuzhiyun void phydm_rrsr_en(void *dm_void, boolean en_rrsr)
2012*4882a593Smuzhiyun {
2013*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2014*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
2015*4882a593Smuzhiyun
2016*4882a593Smuzhiyun ra_tab->dynamic_rrsr_en = en_rrsr;
2017*4882a593Smuzhiyun }
2018*4882a593Smuzhiyun
phydm_arfr_table_init(void * dm_void)2019*4882a593Smuzhiyun void phydm_arfr_table_init(void *dm_void)
2020*4882a593Smuzhiyun {
2021*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2022*4882a593Smuzhiyun
2023*4882a593Smuzhiyun if (dm->support_ic_type & PHYDM_IC_RATEID_IDX_TYPE2) {
2024*4882a593Smuzhiyun /*ARFR table3(2.4g ac 2ss) for rate_id = 16*/
2025*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x494, MASKDWORD, 0xfe01f015);
2026*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x498, MASKDWORD, 0x40000000);
2027*4882a593Smuzhiyun
2028*4882a593Smuzhiyun /*ARFR table5(2.4g ac 1ss) for rate_id = 18*/
2029*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0x3ff015);
2030*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x40000000);
2031*4882a593Smuzhiyun }
2032*4882a593Smuzhiyun }
2033*4882a593Smuzhiyun
phydm_ra_info_init(void * dm_void)2034*4882a593Smuzhiyun void phydm_ra_info_init(void *dm_void)
2035*4882a593Smuzhiyun {
2036*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2037*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
2038*4882a593Smuzhiyun
2039*4882a593Smuzhiyun ra_tab->highest_client_tx_rate_order = 0;
2040*4882a593Smuzhiyun ra_tab->highest_client_tx_order = 0;
2041*4882a593Smuzhiyun ra_tab->ra_th_ofst = 0;
2042*4882a593Smuzhiyun ra_tab->ra_ofst_direc = 0;
2043*4882a593Smuzhiyun ra_tab->rrsr_val_init = odm_get_mac_reg(dm, R_0x440, MASKDWORD);
2044*4882a593Smuzhiyun ra_tab->dynamic_rrsr_en = false;
2045*4882a593Smuzhiyun ra_tab->ra_trigger_mode = 1; // default TBTT RA
2046*4882a593Smuzhiyun ra_tab->ra_tx_cls_th = 255;
2047*4882a593Smuzhiyun #if (RTL8822B_SUPPORT == 1)
2048*4882a593Smuzhiyun if (dm->support_ic_type == ODM_RTL8822B) {
2049*4882a593Smuzhiyun u32 ret_value;
2050*4882a593Smuzhiyun
2051*4882a593Smuzhiyun ret_value = odm_get_mac_reg(dm, R_0x4c8, MASKBYTE2);
2052*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4cc, MASKBYTE3, (ret_value - 1));
2053*4882a593Smuzhiyun }
2054*4882a593Smuzhiyun #endif
2055*4882a593Smuzhiyun
2056*4882a593Smuzhiyun #if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/
2057*4882a593Smuzhiyun phydm_ra_dynamic_retry_limit_init(dm);
2058*4882a593Smuzhiyun #endif
2059*4882a593Smuzhiyun
2060*4882a593Smuzhiyun #if 0 /*@CONFIG_RA_DYNAMIC_RATE_ID*/
2061*4882a593Smuzhiyun phydm_ra_dynamic_rate_id_init(dm);
2062*4882a593Smuzhiyun #endif
2063*4882a593Smuzhiyun
2064*4882a593Smuzhiyun phydm_arfr_table_init(dm);
2065*4882a593Smuzhiyun
2066*4882a593Smuzhiyun phydm_rate_adaptive_mask_init(dm);
2067*4882a593Smuzhiyun }
2068*4882a593Smuzhiyun
odm_find_rts_rate(void * dm_void,u8 tx_rate,boolean is_erp_protect)2069*4882a593Smuzhiyun u8 odm_find_rts_rate(void *dm_void, u8 tx_rate, boolean is_erp_protect)
2070*4882a593Smuzhiyun {
2071*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2072*4882a593Smuzhiyun u8 rts_ini_rate = ODM_RATE6M;
2073*4882a593Smuzhiyun
2074*4882a593Smuzhiyun if (is_erp_protect) { /* use CCK rate as RTS*/
2075*4882a593Smuzhiyun rts_ini_rate = ODM_RATE1M;
2076*4882a593Smuzhiyun } else {
2077*4882a593Smuzhiyun switch (tx_rate) {
2078*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS9:
2079*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS8:
2080*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS7:
2081*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS6:
2082*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS5:
2083*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS4:
2084*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS3:
2085*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS9:
2086*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS8:
2087*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS7:
2088*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS6:
2089*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS5:
2090*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS4:
2091*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS3:
2092*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS9:
2093*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS8:
2094*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS7:
2095*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS6:
2096*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS5:
2097*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS4:
2098*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS3:
2099*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS9:
2100*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS8:
2101*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS7:
2102*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS6:
2103*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS5:
2104*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS4:
2105*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS3:
2106*4882a593Smuzhiyun case ODM_RATEMCS31:
2107*4882a593Smuzhiyun case ODM_RATEMCS30:
2108*4882a593Smuzhiyun case ODM_RATEMCS29:
2109*4882a593Smuzhiyun case ODM_RATEMCS28:
2110*4882a593Smuzhiyun case ODM_RATEMCS27:
2111*4882a593Smuzhiyun case ODM_RATEMCS23:
2112*4882a593Smuzhiyun case ODM_RATEMCS22:
2113*4882a593Smuzhiyun case ODM_RATEMCS21:
2114*4882a593Smuzhiyun case ODM_RATEMCS20:
2115*4882a593Smuzhiyun case ODM_RATEMCS19:
2116*4882a593Smuzhiyun case ODM_RATEMCS15:
2117*4882a593Smuzhiyun case ODM_RATEMCS14:
2118*4882a593Smuzhiyun case ODM_RATEMCS13:
2119*4882a593Smuzhiyun case ODM_RATEMCS12:
2120*4882a593Smuzhiyun case ODM_RATEMCS11:
2121*4882a593Smuzhiyun case ODM_RATEMCS7:
2122*4882a593Smuzhiyun case ODM_RATEMCS6:
2123*4882a593Smuzhiyun case ODM_RATEMCS5:
2124*4882a593Smuzhiyun case ODM_RATEMCS4:
2125*4882a593Smuzhiyun case ODM_RATEMCS3:
2126*4882a593Smuzhiyun case ODM_RATE54M:
2127*4882a593Smuzhiyun case ODM_RATE48M:
2128*4882a593Smuzhiyun case ODM_RATE36M:
2129*4882a593Smuzhiyun case ODM_RATE24M:
2130*4882a593Smuzhiyun rts_ini_rate = ODM_RATE24M;
2131*4882a593Smuzhiyun break;
2132*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS2:
2133*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS1:
2134*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS2:
2135*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS1:
2136*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS2:
2137*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS1:
2138*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS2:
2139*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS1:
2140*4882a593Smuzhiyun case ODM_RATEMCS26:
2141*4882a593Smuzhiyun case ODM_RATEMCS25:
2142*4882a593Smuzhiyun case ODM_RATEMCS18:
2143*4882a593Smuzhiyun case ODM_RATEMCS17:
2144*4882a593Smuzhiyun case ODM_RATEMCS10:
2145*4882a593Smuzhiyun case ODM_RATEMCS9:
2146*4882a593Smuzhiyun case ODM_RATEMCS2:
2147*4882a593Smuzhiyun case ODM_RATEMCS1:
2148*4882a593Smuzhiyun case ODM_RATE18M:
2149*4882a593Smuzhiyun case ODM_RATE12M:
2150*4882a593Smuzhiyun rts_ini_rate = ODM_RATE12M;
2151*4882a593Smuzhiyun break;
2152*4882a593Smuzhiyun case ODM_RATEVHTSS4MCS0:
2153*4882a593Smuzhiyun case ODM_RATEVHTSS3MCS0:
2154*4882a593Smuzhiyun case ODM_RATEVHTSS2MCS0:
2155*4882a593Smuzhiyun case ODM_RATEVHTSS1MCS0:
2156*4882a593Smuzhiyun case ODM_RATEMCS24:
2157*4882a593Smuzhiyun case ODM_RATEMCS16:
2158*4882a593Smuzhiyun case ODM_RATEMCS8:
2159*4882a593Smuzhiyun case ODM_RATEMCS0:
2160*4882a593Smuzhiyun case ODM_RATE9M:
2161*4882a593Smuzhiyun case ODM_RATE6M:
2162*4882a593Smuzhiyun rts_ini_rate = ODM_RATE6M;
2163*4882a593Smuzhiyun break;
2164*4882a593Smuzhiyun case ODM_RATE11M:
2165*4882a593Smuzhiyun case ODM_RATE5_5M:
2166*4882a593Smuzhiyun case ODM_RATE2M:
2167*4882a593Smuzhiyun case ODM_RATE1M:
2168*4882a593Smuzhiyun rts_ini_rate = ODM_RATE1M;
2169*4882a593Smuzhiyun break;
2170*4882a593Smuzhiyun default:
2171*4882a593Smuzhiyun rts_ini_rate = ODM_RATE6M;
2172*4882a593Smuzhiyun break;
2173*4882a593Smuzhiyun }
2174*4882a593Smuzhiyun }
2175*4882a593Smuzhiyun
2176*4882a593Smuzhiyun if (*dm->band_type == ODM_BAND_5G) {
2177*4882a593Smuzhiyun if (rts_ini_rate < ODM_RATE6M)
2178*4882a593Smuzhiyun rts_ini_rate = ODM_RATE6M;
2179*4882a593Smuzhiyun }
2180*4882a593Smuzhiyun return rts_ini_rate;
2181*4882a593Smuzhiyun }
2182*4882a593Smuzhiyun
2183*4882a593Smuzhiyun #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
2184*4882a593Smuzhiyun
odm_refresh_basic_rate_mask(void * dm_void)2185*4882a593Smuzhiyun void odm_refresh_basic_rate_mask(
2186*4882a593Smuzhiyun void *dm_void)
2187*4882a593Smuzhiyun {
2188*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2189*4882a593Smuzhiyun void *adapter = dm->adapter;
2190*4882a593Smuzhiyun static u8 stage = 0;
2191*4882a593Smuzhiyun u8 cur_stage = 0;
2192*4882a593Smuzhiyun OCTET_STRING os_rate_set;
2193*4882a593Smuzhiyun PMGNT_INFO mgnt_info = GetDefaultMgntInfo(((PADAPTER)adapter));
2194*4882a593Smuzhiyun u8 rate_set[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M};
2195*4882a593Smuzhiyun
2196*4882a593Smuzhiyun if (dm->support_ic_type != ODM_RTL8812 && dm->support_ic_type != ODM_RTL8821)
2197*4882a593Smuzhiyun return;
2198*4882a593Smuzhiyun
2199*4882a593Smuzhiyun if (dm->is_linked == false) /* unlink Default port information */
2200*4882a593Smuzhiyun cur_stage = 0;
2201*4882a593Smuzhiyun else if (dm->rssi_min < 40) /* @link RSSI < 40% */
2202*4882a593Smuzhiyun cur_stage = 1;
2203*4882a593Smuzhiyun else if (dm->rssi_min > 45) /* @link RSSI > 45% */
2204*4882a593Smuzhiyun cur_stage = 3;
2205*4882a593Smuzhiyun else
2206*4882a593Smuzhiyun cur_stage = 2; /* @link 25% <= RSSI <= 30% */
2207*4882a593Smuzhiyun
2208*4882a593Smuzhiyun if (cur_stage != stage) {
2209*4882a593Smuzhiyun if (cur_stage == 1) {
2210*4882a593Smuzhiyun FillOctetString(os_rate_set, rate_set, 5);
2211*4882a593Smuzhiyun FilterSupportRate(mgnt_info->mBrates, &os_rate_set, false);
2212*4882a593Smuzhiyun phydm_set_hw_reg_handler_interface(dm, HW_VAR_BASIC_RATE, (u8 *)&os_rate_set);
2213*4882a593Smuzhiyun } else if (cur_stage == 3 && (stage == 1 || stage == 2))
2214*4882a593Smuzhiyun phydm_set_hw_reg_handler_interface(dm, HW_VAR_BASIC_RATE, (u8 *)(&mgnt_info->mBrates));
2215*4882a593Smuzhiyun }
2216*4882a593Smuzhiyun
2217*4882a593Smuzhiyun stage = cur_stage;
2218*4882a593Smuzhiyun }
2219*4882a593Smuzhiyun
2220*4882a593Smuzhiyun #endif
2221*4882a593Smuzhiyun
2222*4882a593Smuzhiyun #if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/
2223*4882a593Smuzhiyun
2224*4882a593Smuzhiyun void phydm_retry_limit_table_bound(
2225*4882a593Smuzhiyun void *dm_void,
2226*4882a593Smuzhiyun u8 *retry_limit,
2227*4882a593Smuzhiyun u8 offset)
2228*4882a593Smuzhiyun {
2229*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2230*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
2231*4882a593Smuzhiyun
2232*4882a593Smuzhiyun if (*retry_limit > offset) {
2233*4882a593Smuzhiyun *retry_limit -= offset;
2234*4882a593Smuzhiyun
2235*4882a593Smuzhiyun if (*retry_limit < ra_tab->retrylimit_low)
2236*4882a593Smuzhiyun *retry_limit = ra_tab->retrylimit_low;
2237*4882a593Smuzhiyun else if (*retry_limit > ra_tab->retrylimit_high)
2238*4882a593Smuzhiyun *retry_limit = ra_tab->retrylimit_high;
2239*4882a593Smuzhiyun } else
2240*4882a593Smuzhiyun *retry_limit = ra_tab->retrylimit_low;
2241*4882a593Smuzhiyun }
2242*4882a593Smuzhiyun
2243*4882a593Smuzhiyun void phydm_reset_retry_limit_table(
2244*4882a593Smuzhiyun void *dm_void)
2245*4882a593Smuzhiyun {
2246*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2247*4882a593Smuzhiyun struct ra_table *ra_t = &dm->dm_ra_table;
2248*4882a593Smuzhiyun u8 i;
2249*4882a593Smuzhiyun
2250*4882a593Smuzhiyun u8 per_rate_retrylimit_table_20M[ODM_RATEMCS15 + 1] = {
2251*4882a593Smuzhiyun 1, 1, 2, 4, /*@CCK*/
2252*4882a593Smuzhiyun 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/
2253*4882a593Smuzhiyun 2, 4, 6, 8, 12, 18, 20, 22, /*@20M HT-1SS*/
2254*4882a593Smuzhiyun 2, 4, 6, 8, 12, 18, 20, 22 /*@20M HT-2SS*/
2255*4882a593Smuzhiyun };
2256*4882a593Smuzhiyun u8 per_rate_retrylimit_table_40M[ODM_RATEMCS15 + 1] = {
2257*4882a593Smuzhiyun 1, 1, 2, 4, /*@CCK*/
2258*4882a593Smuzhiyun 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/
2259*4882a593Smuzhiyun 4, 8, 12, 16, 24, 32, 32, 32, /*@40M HT-1SS*/
2260*4882a593Smuzhiyun 4, 8, 12, 16, 24, 32, 32, 32 /*@40M HT-2SS*/
2261*4882a593Smuzhiyun };
2262*4882a593Smuzhiyun
2263*4882a593Smuzhiyun memcpy(&ra_t->per_rate_retrylimit_20M[0],
2264*4882a593Smuzhiyun &per_rate_retrylimit_table_20M[0], PHY_NUM_RATE_IDX);
2265*4882a593Smuzhiyun memcpy(&ra_t->per_rate_retrylimit_40M[0],
2266*4882a593Smuzhiyun &per_rate_retrylimit_table_40M[0], PHY_NUM_RATE_IDX);
2267*4882a593Smuzhiyun
2268*4882a593Smuzhiyun for (i = 0; i < PHY_NUM_RATE_IDX; i++) {
2269*4882a593Smuzhiyun phydm_retry_limit_table_bound(dm,
2270*4882a593Smuzhiyun &ra_t->per_rate_retrylimit_20M[i],
2271*4882a593Smuzhiyun 0);
2272*4882a593Smuzhiyun phydm_retry_limit_table_bound(dm,
2273*4882a593Smuzhiyun &ra_t->per_rate_retrylimit_40M[i],
2274*4882a593Smuzhiyun 0);
2275*4882a593Smuzhiyun }
2276*4882a593Smuzhiyun }
2277*4882a593Smuzhiyun
2278*4882a593Smuzhiyun void phydm_ra_dynamic_retry_limit_init(
2279*4882a593Smuzhiyun void *dm_void)
2280*4882a593Smuzhiyun {
2281*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2282*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
2283*4882a593Smuzhiyun
2284*4882a593Smuzhiyun ra_tab->retry_descend_num = RA_RETRY_DESCEND_NUM;
2285*4882a593Smuzhiyun ra_tab->retrylimit_low = RA_RETRY_LIMIT_LOW;
2286*4882a593Smuzhiyun ra_tab->retrylimit_high = RA_RETRY_LIMIT_HIGH;
2287*4882a593Smuzhiyun
2288*4882a593Smuzhiyun phydm_reset_retry_limit_table(dm);
2289*4882a593Smuzhiyun }
2290*4882a593Smuzhiyun
2291*4882a593Smuzhiyun void phydm_ra_dynamic_retry_limit(
2292*4882a593Smuzhiyun void *dm_void)
2293*4882a593Smuzhiyun {
2294*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2295*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
2296*4882a593Smuzhiyun u8 i, retry_offset;
2297*4882a593Smuzhiyun u32 ma_rx_tp;
2298*4882a593Smuzhiyun
2299*4882a593Smuzhiyun if (dm->pre_number_active_client == dm->number_active_client) {
2300*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
2301*4882a593Smuzhiyun "pre_number_active_client == number_active_client\n");
2302*4882a593Smuzhiyun return;
2303*4882a593Smuzhiyun
2304*4882a593Smuzhiyun } else {
2305*4882a593Smuzhiyun if (dm->number_active_client == 1) {
2306*4882a593Smuzhiyun phydm_reset_retry_limit_table(dm);
2307*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
2308*4882a593Smuzhiyun "one client only->reset to default value\n");
2309*4882a593Smuzhiyun } else {
2310*4882a593Smuzhiyun retry_offset = dm->number_active_client * ra_tab->retry_descend_num;
2311*4882a593Smuzhiyun
2312*4882a593Smuzhiyun for (i = 0; i < PHY_NUM_RATE_IDX; i++) {
2313*4882a593Smuzhiyun phydm_retry_limit_table_bound(dm,
2314*4882a593Smuzhiyun &ra_tab->per_rate_retrylimit_20M[i],
2315*4882a593Smuzhiyun retry_offset);
2316*4882a593Smuzhiyun phydm_retry_limit_table_bound(dm,
2317*4882a593Smuzhiyun &ra_tab->per_rate_retrylimit_40M[i],
2318*4882a593Smuzhiyun retry_offset);
2319*4882a593Smuzhiyun }
2320*4882a593Smuzhiyun }
2321*4882a593Smuzhiyun }
2322*4882a593Smuzhiyun }
2323*4882a593Smuzhiyun #endif
2324*4882a593Smuzhiyun
2325*4882a593Smuzhiyun #if 0 /*@CONFIG_RA_DYNAMIC_RATE_ID*/
2326*4882a593Smuzhiyun void phydm_ra_dynamic_rate_id_on_assoc(
2327*4882a593Smuzhiyun void *dm_void,
2328*4882a593Smuzhiyun u8 wireless_mode,
2329*4882a593Smuzhiyun u8 init_rate_id)
2330*4882a593Smuzhiyun {
2331*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2332*4882a593Smuzhiyun
2333*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
2334*4882a593Smuzhiyun "[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n",
2335*4882a593Smuzhiyun dm->rf_type, wireless_mode, init_rate_id);
2336*4882a593Smuzhiyun
2337*4882a593Smuzhiyun if (dm->rf_type == RF_2T2R || dm->rf_type == RF_2T3R || dm->rf_type == RF_2T4R) {
2338*4882a593Smuzhiyun if ((dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) &&
2339*4882a593Smuzhiyun (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G))) {
2340*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
2341*4882a593Smuzhiyun "[ON ASSOC] set N-2SS ARFR5 table\n");
2342*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/
2343*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/
2344*4882a593Smuzhiyun } else if ((dm->support_ic_type & (ODM_RTL8812)) &&
2345*4882a593Smuzhiyun (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY))) {
2346*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA,
2347*4882a593Smuzhiyun "[ON ASSOC] set AC-2SS ARFR0 table\n");
2348*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x444, MASKDWORD, 0x0fff); /*@AC-2SS, ARFR0, rate_id = 0x9*/
2349*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x448, MASKDWORD, 0xff01f000); /*@AC-2SS, ARFR0, rate_id = 0x9*/
2350*4882a593Smuzhiyun }
2351*4882a593Smuzhiyun }
2352*4882a593Smuzhiyun }
2353*4882a593Smuzhiyun
2354*4882a593Smuzhiyun void phydm_ra_dynamic_rate_id_init(
2355*4882a593Smuzhiyun void *dm_void)
2356*4882a593Smuzhiyun {
2357*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2358*4882a593Smuzhiyun
2359*4882a593Smuzhiyun if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) {
2360*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/
2361*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/
2362*4882a593Smuzhiyun
2363*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x444, MASKDWORD, 0x0fff); /*@AC-2SS, ARFR0, rate_id = 0x9*/
2364*4882a593Smuzhiyun odm_set_mac_reg(dm, R_0x448, MASKDWORD, 0xff01f000); /*@AC-2SS, ARFR0, rate_id = 0x9*/
2365*4882a593Smuzhiyun }
2366*4882a593Smuzhiyun }
2367*4882a593Smuzhiyun
2368*4882a593Smuzhiyun void phydm_update_rate_id(
2369*4882a593Smuzhiyun void *dm_void,
2370*4882a593Smuzhiyun u8 rate,
2371*4882a593Smuzhiyun u8 platform_macid)
2372*4882a593Smuzhiyun {
2373*4882a593Smuzhiyun #if 0
2374*4882a593Smuzhiyun
2375*4882a593Smuzhiyun struct dm_struct *dm = (struct dm_struct *)dm_void;
2376*4882a593Smuzhiyun struct ra_table *ra_tab = &dm->dm_ra_table;
2377*4882a593Smuzhiyun u8 current_tx_ss;
2378*4882a593Smuzhiyun u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/
2379*4882a593Smuzhiyun enum wireless_set wireless_set;
2380*4882a593Smuzhiyun u8 phydm_macid;
2381*4882a593Smuzhiyun struct cmn_sta_info *sta;
2382*4882a593Smuzhiyun
2383*4882a593Smuzhiyun #if 0
2384*4882a593Smuzhiyun if (rate_idx >= ODM_RATEVHTSS2MCS0) {
2385*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( VHT2SS-MCS%d ))\n",
2386*4882a593Smuzhiyun platform_macid, (rate_idx - ODM_RATEVHTSS2MCS0));
2387*4882a593Smuzhiyun /*@dummy for SD4 check patch*/
2388*4882a593Smuzhiyun } else if (rate_idx >= ODM_RATEVHTSS1MCS0) {
2389*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( VHT1SS-MCS%d ))\n",
2390*4882a593Smuzhiyun platform_macid, (rate_idx - ODM_RATEVHTSS1MCS0));
2391*4882a593Smuzhiyun /*@dummy for SD4 check patch*/
2392*4882a593Smuzhiyun } else if (rate_idx >= ODM_RATEMCS0) {
2393*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( HT-MCS%d ))\n",
2394*4882a593Smuzhiyun platform_macid, (rate_idx - ODM_RATEMCS0));
2395*4882a593Smuzhiyun /*@dummy for SD4 check patch*/
2396*4882a593Smuzhiyun } else {
2397*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( HT-MCS%d ))\n",
2398*4882a593Smuzhiyun platform_macid, rate_idx);
2399*4882a593Smuzhiyun /*@dummy for SD4 check patch*/
2400*4882a593Smuzhiyun }
2401*4882a593Smuzhiyun #endif
2402*4882a593Smuzhiyun
2403*4882a593Smuzhiyun phydm_macid = dm->phydm_macid_table[platform_macid];
2404*4882a593Smuzhiyun sta = dm->phydm_sta_info[phydm_macid];
2405*4882a593Smuzhiyun
2406*4882a593Smuzhiyun if (is_sta_active(sta)) {
2407*4882a593Smuzhiyun wireless_set = sta->support_wireless_set;
2408*4882a593Smuzhiyun
2409*4882a593Smuzhiyun if (dm->rf_type == RF_2T2R || dm->rf_type == RF_2T3R || dm->rf_type == RF_2T4R) {
2410*4882a593Smuzhiyun if (wireless_set & WIRELESS_HT) { /*N mode*/
2411*4882a593Smuzhiyun if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*@2SS mode*/
2412*4882a593Smuzhiyun
2413*4882a593Smuzhiyun sta->ra_info.rate_id = ARFR_5_RATE_ID;
2414*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "ARFR_5\n");
2415*4882a593Smuzhiyun }
2416*4882a593Smuzhiyun } else if (wireless_set & WIRELESS_VHT) {/*@AC mode*/
2417*4882a593Smuzhiyun if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*@2SS mode*/
2418*4882a593Smuzhiyun
2419*4882a593Smuzhiyun sta->ra_info.rate_id = ARFR_0_RATE_ID;
2420*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "ARFR_0\n");
2421*4882a593Smuzhiyun }
2422*4882a593Smuzhiyun } else
2423*4882a593Smuzhiyun sta->ra_info.rate_id = ARFR_0_RATE_ID;
2424*4882a593Smuzhiyun
2425*4882a593Smuzhiyun PHYDM_DBG(dm, DBG_RA, "UPdate_RateID[%d]: (( 0x%x ))\n",
2426*4882a593Smuzhiyun platform_macid, sta->ra_info.rate_id);
2427*4882a593Smuzhiyun }
2428*4882a593Smuzhiyun }
2429*4882a593Smuzhiyun #endif
2430*4882a593Smuzhiyun }
2431*4882a593Smuzhiyun
2432*4882a593Smuzhiyun #endif
2433