1 /******************************************************************************
2 *
3 * Copyright(c) 2007 - 2017 Realtek Corporation.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 *****************************************************************************/
15
16 /* ************************************************************
17 * include files
18 * ************************************************************ */
19
20 #include "mp_precomp.h"
21 #include "phydm_precomp.h"
22
23 #ifdef PHYDM_SUPPORT_RSSI_MONITOR
24
25 #ifdef PHYDM_3RD_REFORM_RSSI_MONOTOR
26 void
phydm_rssi_monitor_h2c(void * p_dm_void,u8 macid)27 phydm_rssi_monitor_h2c(
28 void *p_dm_void,
29 u8 macid
30 )
31 {
32 struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void;
33 struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table;
34 struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid];
35 struct ra_sta_info *p_ra = NULL;
36 u8 h2c_val[H2C_MAX_LENGTH] = {0};
37 u8 stbc_en, ldpc_en;
38 u8 bf_en = 0;
39 u8 is_rx, is_tx;
40
41 if (is_sta_active(p_sta)) {
42 p_ra = &(p_sta->ra_info);
43 } else {
44 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("[Warning] %s invalid sta_info\n", __func__));
45 return;
46 }
47
48 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("%s ======>\n", __func__));
49 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("MACID=%d\n", p_sta->mac_id));
50
51 is_rx = (p_ra->txrx_state == RX_STATE) ? 1 : 0;
52 is_tx = (p_ra->txrx_state == TX_STATE) ? 1 : 0;
53 stbc_en = (p_sta->stbc_en) ? 1 : 0;
54 ldpc_en = (p_sta->ldpc_en) ? 1 : 0;
55
56 #ifdef CONFIG_BEAMFORMING
57 if ((p_sta->bf_info.ht_beamform_cap & BEAMFORMING_HT_BEAMFORMEE_ENABLE) ||
58 (p_sta->bf_info.vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) {
59 bf_en = 1;
60 }
61 #endif
62
63 if (p_ra_t->RA_threshold_offset != 0) {
64 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RA_th_ofst = (( %s%d ))\n",
65 ((p_ra_t->RA_offset_direction) ? "+" : "-"), p_ra_t->RA_threshold_offset));
66 }
67
68 h2c_val[0] = p_sta->mac_id;
69 h2c_val[1] = 0;
70 h2c_val[2] = p_sta->rssi_stat.rssi;
71 h2c_val[3] = is_rx | (stbc_en << 1) | ((p_dm->noisy_decision & 0x1) << 2) | (bf_en << 6);
72 h2c_val[4] = (p_ra_t->RA_threshold_offset & 0x7f) | ((p_ra_t->RA_offset_direction & 0x1) << 7);
73 h2c_val[5] = 0;
74 h2c_val[6] = 0;
75
76 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("PHYDM h2c[0x42]=0x%x %x %x %x %x %x %x\n",
77 h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2], h2c_val[1], h2c_val[0]));
78
79 #if (RTL8188E_SUPPORT == 1)
80 if (p_dm->support_ic_type == ODM_RTL8188E)
81 odm_ra_set_rssi_8188e(p_dm, (u8)(p_sta->mac_id & 0xFF), p_sta->rssi_stat.rssi & 0x7F);
82 else
83 #endif
84 {
85 odm_fill_h2c_cmd(p_dm, ODM_H2C_RSSI_REPORT, H2C_MAX_LENGTH, h2c_val);
86 }
87 }
88
89 void
phydm_calculate_rssi_min_max(void * p_dm_void)90 phydm_calculate_rssi_min_max(
91 void *p_dm_void
92 )
93 {
94 struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void;
95 struct cmn_sta_info *p_sta;
96 s8 rssi_max_tmp = 0, rssi_min_tmp = 100;
97 u8 i;
98 u8 sta_cnt = 0;
99
100 if (!p_dm->is_linked)
101 return;
102
103 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("%s ======>\n", __func__));
104
105 for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
106 p_sta = p_dm->p_phydm_sta_info[i];
107 if (is_sta_active(p_sta)) {
108
109 sta_cnt++;
110
111 if (p_sta->rssi_stat.rssi < rssi_min_tmp)
112 rssi_min_tmp = p_sta->rssi_stat.rssi;
113
114 if (p_sta->rssi_stat.rssi > rssi_max_tmp)
115 rssi_max_tmp = p_sta->rssi_stat.rssi;
116
117 /*[Send RSSI to FW]*/
118 if (p_sta->ra_info.disable_ra == false)
119 phydm_rssi_monitor_h2c(p_dm, i);
120
121 if (sta_cnt == p_dm->number_linked_client)
122 break;
123 }
124 }
125
126 p_dm->rssi_max = (u8)rssi_max_tmp;
127 p_dm->rssi_min = (u8)rssi_min_tmp;
128
129 }
130 #endif
131
132
133 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
134
135 s32
phydm_find_minimum_rssi(struct PHY_DM_STRUCT * p_dm,struct _ADAPTER * p_adapter,boolean * p_is_link_temp)136 phydm_find_minimum_rssi(
137 struct PHY_DM_STRUCT *p_dm,
138 struct _ADAPTER *p_adapter,
139 boolean *p_is_link_temp
140
141 )
142 {
143 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter);
144 PMGNT_INFO p_mgnt_info = &(p_adapter->MgntInfo);
145 boolean act_as_ap = ACTING_AS_AP(p_adapter);
146
147 /* 1.Determine the minimum RSSI */
148 if ((!p_mgnt_info->bMediaConnect) ||
149 (act_as_ap && (p_hal_data->EntryMinUndecoratedSmoothedPWDB == 0))) {/* We should check AP mode and Entry info.into consideration, revised by Roger, 2013.10.18*/
150
151 p_hal_data->MinUndecoratedPWDBForDM = 0;
152 *p_is_link_temp = false;
153
154 } else
155 *p_is_link_temp = true;
156
157
158 if (p_mgnt_info->bMediaConnect) { /* Default port*/
159
160 if (act_as_ap || p_mgnt_info->mIbss) {
161 p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->EntryMinUndecoratedSmoothedPWDB;
162 /**/
163 } else {
164 p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->UndecoratedSmoothedPWDB;
165 /**/
166 }
167 } else { /* associated entry pwdb*/
168 p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->EntryMinUndecoratedSmoothedPWDB;
169 /**/
170 }
171
172 return p_hal_data->MinUndecoratedPWDBForDM;
173 }
174
175 void
odm_rssi_monitor_check_mp(void * p_dm_void)176 odm_rssi_monitor_check_mp(
177 void *p_dm_void
178 )
179 {
180 struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void;
181 struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table;
182 u8 h2c_parameter[H2C_0X42_LENGTH] = {0};
183 u32 i;
184 boolean is_ext_ra_info = true;
185 u8 cmdlen = H2C_0X42_LENGTH;
186 u8 tx_bf_en = 0, stbc_en = 0;
187
188 struct _ADAPTER *adapter = p_dm->adapter;
189 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
190 struct sta_info *p_entry = NULL;
191 s32 tmp_entry_max_pwdb = 0, tmp_entry_min_pwdb = 0xff;
192 PMGNT_INFO p_mgnt_info = &adapter->MgntInfo;
193 PMGNT_INFO p_default_mgnt_info = &adapter->MgntInfo;
194 u64 cur_tx_ok_cnt = 0, cur_rx_ok_cnt = 0;
195 #if (BEAMFORMING_SUPPORT == 1)
196 #ifndef BEAMFORMING_VERSION_1
197 enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE;
198 #endif
199 #endif
200 struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(adapter);
201
202 if (p_dm->support_ic_type == ODM_RTL8188E) {
203 is_ext_ra_info = false;
204 cmdlen = 3;
205 }
206
207 while (p_loop_adapter) {
208
209 if (p_loop_adapter != NULL) {
210 p_mgnt_info = &p_loop_adapter->MgntInfo;
211 cur_tx_ok_cnt = p_loop_adapter->TxStats.NumTxBytesUnicast - p_mgnt_info->lastTxOkCnt;
212 cur_rx_ok_cnt = p_loop_adapter->RxStats.NumRxBytesUnicast - p_mgnt_info->lastRxOkCnt;
213 p_mgnt_info->lastTxOkCnt = cur_tx_ok_cnt;
214 p_mgnt_info->lastRxOkCnt = cur_rx_ok_cnt;
215 }
216
217 for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) {
218
219 if (IsAPModeExist(p_loop_adapter)) {
220 if (GetFirstExtAdapter(p_loop_adapter) != NULL &&
221 GetFirstExtAdapter(p_loop_adapter) == p_loop_adapter)
222 p_entry = AsocEntry_EnumStation(p_loop_adapter, i);
223 else if (GetFirstGOPort(p_loop_adapter) != NULL &&
224 IsFirstGoAdapter(p_loop_adapter))
225 p_entry = AsocEntry_EnumStation(p_loop_adapter, i);
226 } else {
227 if (GetDefaultAdapter(p_loop_adapter) == p_loop_adapter)
228 p_entry = AsocEntry_EnumStation(p_loop_adapter, i);
229 }
230
231 if (p_entry != NULL) {
232 if (p_entry->bAssociated) {
233
234 RT_DISP_ADDR(FDM, DM_PWDB, ("p_entry->mac_addr ="), GET_STA_INFO(p_entry).mac_addr);
235 RT_DISP(FDM, DM_PWDB, ("p_entry->rssi = 0x%x(%d)\n",
236 GET_STA_INFO(p_entry).rssi_stat.rssi, GET_STA_INFO(p_entry).rssi_stat.rssi));
237
238 /* 2 BF_en */
239 #if (BEAMFORMING_SUPPORT == 1)
240 #ifndef BEAMFORMING_VERSION_1
241 beamform_cap = phydm_beamforming_get_entry_beam_cap_by_mac_id(p_dm, GET_STA_INFO(p_entry).mac_id);
242 if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU))
243 tx_bf_en = 1;
244 #else
245 if (Beamform_GetSupportBeamformerCap(GetDefaultAdapter(adapter), p_entry))
246 tx_bf_en = 1;
247 #endif
248 #endif
249 /* 2 STBC_en */
250 if ((IS_WIRELESS_MODE_AC(adapter) && TEST_FLAG(p_entry->VHTInfo.STBC, STBC_VHT_ENABLE_TX)) ||
251 TEST_FLAG(p_entry->HTInfo.STBC, STBC_HT_ENABLE_TX))
252 stbc_en = 1;
253
254 if (GET_STA_INFO(p_entry).rssi_stat.rssi < tmp_entry_min_pwdb)
255 tmp_entry_min_pwdb = GET_STA_INFO(p_entry).rssi_stat.rssi;
256 if (GET_STA_INFO(p_entry).rssi_stat.rssi > tmp_entry_max_pwdb)
257 tmp_entry_max_pwdb = GET_STA_INFO(p_entry).rssi_stat.rssi;
258
259 h2c_parameter[4] = (p_ra_table->RA_threshold_offset & 0x7f) | (p_ra_table->RA_offset_direction << 7);
260 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RA_threshold_offset = (( %s%d ))\n", ((p_ra_table->RA_threshold_offset == 0) ? " " : ((p_ra_table->RA_offset_direction) ? "+" : "-")), p_ra_table->RA_threshold_offset));
261
262 if (is_ext_ra_info) {
263 if (cur_rx_ok_cnt > (cur_tx_ok_cnt * 6))
264 h2c_parameter[3] |= RAINFO_BE_RX_STATE;
265
266 if (tx_bf_en)
267 h2c_parameter[3] |= RAINFO_BF_STATE;
268 else {
269 if (stbc_en)
270 h2c_parameter[3] |= RAINFO_STBC_STATE;
271 }
272
273 if (p_dm->noisy_decision)
274 h2c_parameter[3] |= RAINFO_NOISY_STATE;
275 else
276 h2c_parameter[3] &= (~RAINFO_NOISY_STATE);
277
278 if (p_dm->h2c_rarpt_connect) {
279 h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE;
280 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("h2c_rarpt_connect = (( %d ))\n", p_dm->h2c_rarpt_connect));
281 }
282
283 }
284
285 h2c_parameter[2] = (u8)(GET_STA_INFO(p_entry).rssi_stat.rssi & 0xFF);
286 /* h2c_parameter[1] = 0x20;*/ /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 */
287 h2c_parameter[0] = (GET_STA_INFO(p_entry).mac_id);
288
289 odm_fill_h2c_cmd(p_dm, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter);
290 }
291 } else
292 break;
293 }
294
295 p_loop_adapter = GetNextExtAdapter(p_loop_adapter);
296 }
297
298
299 /*Default port*/
300 if (tmp_entry_max_pwdb != 0) { /* If associated entry is found */
301 p_hal_data->EntryMaxUndecoratedSmoothedPWDB = tmp_entry_max_pwdb;
302 RT_DISP(FDM, DM_PWDB, ("EntryMaxPWDB = 0x%x(%d)\n", tmp_entry_max_pwdb, tmp_entry_max_pwdb));
303 } else
304 p_hal_data->EntryMaxUndecoratedSmoothedPWDB = 0;
305
306 if (tmp_entry_min_pwdb != 0xff) { /* If associated entry is found */
307 p_hal_data->EntryMinUndecoratedSmoothedPWDB = tmp_entry_min_pwdb;
308 RT_DISP(FDM, DM_PWDB, ("EntryMinPWDB = 0x%x(%d)\n", tmp_entry_min_pwdb, tmp_entry_min_pwdb));
309
310 } else
311 p_hal_data->EntryMinUndecoratedSmoothedPWDB = 0;
312
313 /* Default porti sent RSSI to FW */
314 if (p_hal_data->bUseRAMask) {
315 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("1 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n",
316 WIN_DEFAULT_PORT_MACID, p_hal_data->UndecoratedSmoothedPWDB, p_hal_data->ra_rpt_linked));
317 if (p_hal_data->UndecoratedSmoothedPWDB > 0) {
318
319 PRT_HIGH_THROUGHPUT p_ht_info = GET_HT_INFO(p_default_mgnt_info);
320 PRT_VERY_HIGH_THROUGHPUT p_vht_info = GET_VHT_INFO(p_default_mgnt_info);
321
322 /* BF_en*/
323 #if (BEAMFORMING_SUPPORT == 1)
324 #ifndef BEAMFORMING_VERSION_1
325 beamform_cap = phydm_beamforming_get_entry_beam_cap_by_mac_id(p_dm, p_default_mgnt_info->m_mac_id);
326
327 if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU))
328 tx_bf_en = 1;
329 #else
330 if (Beamform_GetSupportBeamformerCap(GetDefaultAdapter(adapter), NULL))
331 tx_bf_en = 1;
332 #endif
333 #endif
334
335 /* STBC_en*/
336 if ((IS_WIRELESS_MODE_AC(adapter) && TEST_FLAG(p_vht_info->VhtCurStbc, STBC_VHT_ENABLE_TX)) ||
337 TEST_FLAG(p_ht_info->HtCurStbc, STBC_HT_ENABLE_TX))
338 stbc_en = 1;
339
340 h2c_parameter[4] = (p_ra_table->RA_threshold_offset & 0x7f) | (p_ra_table->RA_offset_direction << 7);
341 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RA_threshold_offset = (( %s%d ))\n", ((p_ra_table->RA_threshold_offset == 0) ? " " : ((p_ra_table->RA_offset_direction) ? "+" : "-")), p_ra_table->RA_threshold_offset));
342
343 if (is_ext_ra_info) {
344 if (tx_bf_en)
345 h2c_parameter[3] |= RAINFO_BF_STATE;
346 else {
347 if (stbc_en)
348 h2c_parameter[3] |= RAINFO_STBC_STATE;
349 }
350
351 if (p_dm->h2c_rarpt_connect) {
352 h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE;
353 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("h2c_rarpt_connect = (( %d ))\n", p_dm->h2c_rarpt_connect));
354 }
355
356
357 if (p_dm->noisy_decision == 1) {
358 h2c_parameter[3] |= RAINFO_NOISY_STATE;
359 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("[RSSIMonitorCheckMP] Send H2C to FW\n"));
360 } else
361 h2c_parameter[3] &= (~RAINFO_NOISY_STATE);
362
363 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("[RSSIMonitorCheckMP] h2c_parameter=%x\n", h2c_parameter[3]));
364 }
365
366 h2c_parameter[2] = (u8)(p_hal_data->UndecoratedSmoothedPWDB & 0xFF);
367 /*h2c_parameter[1] = 0x20;*/ /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/
368 h2c_parameter[0] = WIN_DEFAULT_PORT_MACID; /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/
369
370 odm_fill_h2c_cmd(p_dm, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter);
371 }
372
373 } else
374 PlatformEFIOWrite1Byte(adapter, 0x4fe, (u8)p_hal_data->UndecoratedSmoothedPWDB);
375
376 {
377 struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(adapter);
378 boolean default_pointer_value, *p_is_link_temp = &default_pointer_value;
379 s32 global_rssi_min = 0xFF, local_rssi_min;
380 boolean is_link = false;
381
382 while (p_loop_adapter) {
383 local_rssi_min = phydm_find_minimum_rssi(p_dm, p_loop_adapter, p_is_link_temp);
384 /* dbg_print("p_hal_data->is_linked=%d, local_rssi_min=%d\n", p_hal_data->is_linked, local_rssi_min); */
385
386 if (*p_is_link_temp)
387 is_link = true;
388
389 if ((local_rssi_min < global_rssi_min) && (*p_is_link_temp))
390 global_rssi_min = local_rssi_min;
391
392 p_loop_adapter = GetNextExtAdapter(p_loop_adapter);
393 }
394
395 p_hal_data->bLinked = is_link;
396
397 p_dm->is_linked = is_link;
398 p_dm->rssi_min = (u8)((is_link) ? global_rssi_min : 0);
399
400 }
401
402
403 }
404
405 #endif
406
407 void
phydm_rssi_monitor_check(void * p_dm_void)408 phydm_rssi_monitor_check(
409 void *p_dm_void
410 )
411 {
412 struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void;
413
414 if (!(p_dm->support_ability & ODM_BB_RSSI_MONITOR))
415 return;
416
417 if ((p_dm->phydm_sys_up_time % 2) == 1) /*for AP watchdog period = 1 sec*/
418 return;
419
420 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("%s ======>\n", __func__));
421
422 #ifdef PHYDM_3RD_REFORM_RSSI_MONOTOR
423 phydm_calculate_rssi_min_max(p_dm);
424 #else
425 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
426 odm_rssi_monitor_check_mp(p_dm);
427 #endif
428 #endif
429
430 PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RSSI {max, min} = {%d, %d}\n",
431 p_dm->rssi_max, p_dm->rssi_min));
432
433 }
434
435 void
phydm_rssi_monitor_init(void * p_dm_void)436 phydm_rssi_monitor_init(
437 void *p_dm_void
438 )
439 {
440
441 struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void;
442 struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table;
443 #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN))
444 struct _ADAPTER *adapter = p_dm->adapter;
445 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
446
447 p_ra_table->PT_collision_pre = true; /*used in odm_dynamic_arfb_select(WIN only)*/
448
449 p_hal_data->UndecoratedSmoothedPWDB = -1;
450 p_hal_data->ra_rpt_linked = false;
451 #endif
452
453 p_ra_table->firstconnect = false;
454 p_dm->rssi_max = 0;
455 p_dm->rssi_min = 0;
456
457 }
458
459 #endif
460