xref: /OK3568_Linux_fs/external/rkwifibt/drivers/rtl8821cs/hal/hal_intf.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
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 #define _HAL_INTF_C_
17 
18 #include <drv_types.h>
19 #include <hal_data.h>
20 
21 const u32 _chip_type_to_odm_ic_type[] = {
22 	0,
23 	ODM_RTL8188E,
24 	ODM_RTL8192E,
25 	ODM_RTL8812,
26 	ODM_RTL8821,
27 	ODM_RTL8723B,
28 	ODM_RTL8814A,
29 	ODM_RTL8703B,
30 	ODM_RTL8188F,
31 	ODM_RTL8188F,
32 	ODM_RTL8822B,
33 	ODM_RTL8723D,
34 	ODM_RTL8821C,
35 	ODM_RTL8710B,
36 	ODM_RTL8192F,
37 	ODM_RTL8822C,
38 	ODM_RTL8814B,
39 	ODM_RTL8723F,
40 	0,
41 };
42 
rtw_hal_chip_configure(_adapter * padapter)43 void rtw_hal_chip_configure(_adapter *padapter)
44 {
45 	padapter->hal_func.intf_chip_configure(padapter);
46 }
47 
48 /*
49  * Description:
50  *	Read chip internal ROM data
51  *
52  * Return:
53  *	_SUCCESS success
54  *	_FAIL	 fail
55  */
rtw_hal_read_chip_info(_adapter * padapter)56 u8 rtw_hal_read_chip_info(_adapter *padapter)
57 {
58 	u8 rtn = _SUCCESS;
59 	u8 hci_type = rtw_get_intf_type(padapter);
60 	systime start = rtw_get_current_time();
61 
62 	/*  before access eFuse, make sure card enable has been called */
63 	if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI)
64 	    && !rtw_is_hw_init_completed(padapter))
65 		rtw_hal_power_on(padapter);
66 
67 	rtn = padapter->hal_func.read_adapter_info(padapter);
68 
69 	if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI)
70 	    && !rtw_is_hw_init_completed(padapter))
71 		rtw_hal_power_off(padapter);
72 
73 	RTW_INFO("%s in %d ms\n", __func__, rtw_get_passing_time_ms(start));
74 
75 	return rtn;
76 }
77 
rtw_hal_read_chip_version(_adapter * padapter)78 void rtw_hal_read_chip_version(_adapter *padapter)
79 {
80 	padapter->hal_func.read_chip_version(padapter);
81 	rtw_odm_init_ic_type(padapter);
82 }
83 
rtw_init_wireless_mode(_adapter * padapter)84 static void rtw_init_wireless_mode(_adapter *padapter)
85 {
86 	u8 proto_wireless_mode = 0;
87 	struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter);
88 	if(hal_spec->proto_cap & PROTO_CAP_11B)
89 		proto_wireless_mode |= WIRELESS_11B;
90 
91 	if(hal_spec->proto_cap & PROTO_CAP_11G)
92 		proto_wireless_mode |= WIRELESS_11G;
93 
94 	if(hal_spec->band_cap & BAND_CAP_5G)
95 		proto_wireless_mode |= WIRELESS_11A;
96 
97 #ifdef CONFIG_80211N_HT
98 	if(hal_spec->proto_cap & PROTO_CAP_11N) {
99 
100 		if(hal_spec->band_cap & BAND_CAP_2G)
101 			proto_wireless_mode |= WIRELESS_11_24N;
102 		if(hal_spec->band_cap & BAND_CAP_5G)
103 			proto_wireless_mode |= WIRELESS_11_5N;
104 	}
105 #endif
106 
107 #ifdef CONFIG_80211AC_VHT
108 	if(hal_spec->proto_cap & PROTO_CAP_11AC)
109 		proto_wireless_mode |= WIRELESS_11AC;
110 #endif
111 	padapter->registrypriv.wireless_mode &= proto_wireless_mode;
112 }
113 
rtw_hal_def_value_init(_adapter * padapter)114 void rtw_hal_def_value_init(_adapter *padapter)
115 {
116 	if (is_primary_adapter(padapter)) {
117 		/*init fw_psmode_iface_id*/
118 		adapter_to_pwrctl(padapter)->fw_psmode_iface_id = 0xff;
119 		/*wireless_mode*/
120 		rtw_init_wireless_mode(padapter);
121 		padapter->hal_func.init_default_value(padapter);
122 
123 		rtw_init_hal_com_default_value(padapter);
124 
125 		#ifdef CONFIG_FW_MULTI_PORT_SUPPORT
126 		adapter_to_dvobj(padapter)->dft.port_id = 0xFF;
127 		adapter_to_dvobj(padapter)->dft.mac_id = 0xFF;
128 		#endif
129 		#ifdef CONFIG_HW_P0_TSF_SYNC
130 		adapter_to_dvobj(padapter)->p0_tsf.sync_port = MAX_HW_PORT;
131 		adapter_to_dvobj(padapter)->p0_tsf.offset = 0;
132 		#endif
133 
134 		GET_HAL_DATA(padapter)->rx_tsf_addr_filter_config = 0;
135 	}
136 }
137 
rtw_hal_data_init(_adapter * padapter)138 u8 rtw_hal_data_init(_adapter *padapter)
139 {
140 	if (is_primary_adapter(padapter)) {
141 		padapter->hal_data_sz = sizeof(HAL_DATA_TYPE);
142 		padapter->HalData = rtw_zvmalloc(padapter->hal_data_sz);
143 		if (padapter->HalData == NULL) {
144 			RTW_INFO("cant not alloc memory for HAL DATA\n");
145 			return _FAIL;
146 		}
147 		rtw_phydm_priv_init(padapter);
148 	}
149 	return _SUCCESS;
150 }
151 
rtw_hal_data_deinit(_adapter * padapter)152 void rtw_hal_data_deinit(_adapter *padapter)
153 {
154 	if (is_primary_adapter(padapter)) {
155 		if (padapter->HalData) {
156 #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
157 			phy_free_filebuf(padapter);
158 #endif
159 			rtw_vmfree(padapter->HalData, padapter->hal_data_sz);
160 			padapter->HalData = NULL;
161 			padapter->hal_data_sz = 0;
162 		}
163 	}
164 }
165 
rtw_hal_free_data(_adapter * padapter)166 void	rtw_hal_free_data(_adapter *padapter)
167 {
168 	/* free HAL Data	 */
169 	rtw_hal_data_deinit(padapter);
170 }
rtw_hal_dm_init(_adapter * padapter)171 void rtw_hal_dm_init(_adapter *padapter)
172 {
173 	if (is_primary_adapter(padapter)) {
174 		PHAL_DATA_TYPE	pHalData = GET_HAL_DATA(padapter);
175 
176 		padapter->hal_func.dm_init(padapter);
177 
178 		_rtw_spinlock_init(&pHalData->IQKSpinLock);
179 
180 		#ifdef CONFIG_TXPWR_PG_WITH_PWR_IDX
181 		if (pHalData->txpwr_pg_mode == TXPWR_PG_WITH_PWR_IDX)
182 			hal_load_txpwr_info(padapter);
183 		#endif
184 		phy_load_tx_power_ext_info(padapter, 1);
185 	}
186 }
rtw_hal_dm_deinit(_adapter * padapter)187 void rtw_hal_dm_deinit(_adapter *padapter)
188 {
189 	if (is_primary_adapter(padapter)) {
190 		PHAL_DATA_TYPE	pHalData = GET_HAL_DATA(padapter);
191 
192 		padapter->hal_func.dm_deinit(padapter);
193 
194 		_rtw_spinlock_free(&pHalData->IQKSpinLock);
195 	}
196 }
197 
rtw_chip_rftype_to_hal_rftype(_adapter * adapter,u8 limit)198 enum rf_type rtw_chip_rftype_to_hal_rftype(_adapter *adapter, u8 limit)
199 {
200 	PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter);
201 	u8 tx_num = 0, rx_num = 0;
202 
203 	/*get RF PATH from version_id.RF_TYPE */
204 	if (IS_1T1R(hal_data->version_id)) {
205 		tx_num = 1;
206 		rx_num = 1;
207 	} else if (IS_1T2R(hal_data->version_id)) {
208 		tx_num = 1;
209 		rx_num = 2;
210 	} else if (IS_2T2R(hal_data->version_id)) {
211 		tx_num = 2;
212 		rx_num = 2;
213 	} else if (IS_2T3R(hal_data->version_id)) {
214 		tx_num = 2;
215 		rx_num = 3;
216 	} else if (IS_2T4R(hal_data->version_id)) {
217 		tx_num = 2;
218 		rx_num = 4;
219 	} else if (IS_3T3R(hal_data->version_id)) {
220 		tx_num = 3;
221 		rx_num = 3;
222 	} else if (IS_3T4R(hal_data->version_id)) {
223 		tx_num = 3;
224 		rx_num = 4;
225 	} else if (IS_4T4R(hal_data->version_id)) {
226 		tx_num = 4;
227 		rx_num = 4;
228 	}
229 
230 	if (limit) {
231 		tx_num = rtw_min(tx_num, limit);
232 		rx_num = rtw_min(rx_num, limit);
233 	}
234 
235 	return trx_num_to_rf_type(tx_num, rx_num);
236 }
237 
dump_hal_runtime_trx_mode(void * sel,_adapter * adapter)238 void dump_hal_runtime_trx_mode(void *sel, _adapter *adapter)
239 {
240 	struct registry_priv *regpriv = &adapter->registrypriv;
241 	PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter);
242 	int i;
243 
244 	RTW_PRINT_SEL(sel, "txpath=0x%x, rxpath=0x%x\n", hal_data->txpath, hal_data->rxpath);
245 	for (i = 0; i < hal_data->tx_nss; i++)
246 		RTW_PRINT_SEL(sel, "txpath_%uss:0x%x, num:%u\n"
247 			, i + 1, hal_data->txpath_nss[i]
248 			, hal_data->txpath_num_nss[i]);
249 }
250 
dump_hal_trx_mode(void * sel,_adapter * adapter)251 void dump_hal_trx_mode(void *sel, _adapter *adapter)
252 {
253 	struct registry_priv *regpriv = &adapter->registrypriv;
254 	PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter);
255 	int i;
256 
257 	RTW_PRINT_SEL(sel, "trx_path_bmp:0x%02x(%s), NumTotalRFPath:%u, max_tx_cnt:%u\n"
258 		, hal_data->trx_path_bmp
259 		, rf_type_to_rfpath_str(hal_data->rf_type)
260 		, hal_data->NumTotalRFPath
261 		, hal_data->max_tx_cnt
262 	);
263 	RTW_PRINT_SEL(sel, "tx_nss:%u, rx_nss:%u\n"
264 		, hal_data->tx_nss, hal_data->rx_nss);
265 	for (i = 0; i < hal_data->tx_nss; i++)
266 		RTW_PRINT_SEL(sel, "txpath_cap_num_%uss:%u\n"
267 			, i + 1, hal_data->txpath_cap_num_nss[i]);
268 	RTW_PRINT_SEL(sel, "\n");
269 
270 	dump_hal_runtime_trx_mode(sel, adapter);
271 }
272 
_dump_rf_path(void * sel,_adapter * adapter)273 void _dump_rf_path(void *sel, _adapter *adapter)
274 {
275 	PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter);
276 	struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);
277 	struct registry_priv *regsty = adapter_to_regsty(adapter);
278 
279 	RTW_PRINT_SEL(sel, "[RF_PATH] ver_id.RF_TYPE:%s\n"
280 		, rf_type_to_rfpath_str(rtw_chip_rftype_to_hal_rftype(adapter, 0)));
281 	RTW_PRINT_SEL(sel, "[RF_PATH] HALSPEC's rf_reg_trx_path_bmp:0x%02x, rf_reg_path_avail_num:%u, max_tx_cnt:%u\n"
282 		, hal_spec->rf_reg_trx_path_bmp, hal_spec->rf_reg_path_avail_num, hal_spec->max_tx_cnt);
283 	RTW_PRINT_SEL(sel, "[RF_PATH] PG's trx_path_bmp:0x%02x, max_tx_cnt:%u\n"
284 		, hal_data->eeprom_trx_path_bmp, hal_data->eeprom_max_tx_cnt);
285 	RTW_PRINT_SEL(sel, "[RF_PATH] Registry's trx_path_bmp:0x%02x, tx_path_lmt:%u, rx_path_lmt:%u\n"
286 		, regsty->trx_path_bmp, regsty->tx_path_lmt, regsty->rx_path_lmt);
287 	RTW_PRINT_SEL(sel, "[RF_PATH] HALDATA's trx_path_bmp:0x%02x, max_tx_cnt:%u\n"
288 		, hal_data->trx_path_bmp, hal_data->max_tx_cnt);
289 	RTW_PRINT_SEL(sel, "[RF_PATH] HALDATA's rf_type:%s, NumTotalRFPath:%d\n"
290 		, rf_type_to_rfpath_str(hal_data->rf_type), hal_data->NumTotalRFPath);
291 }
292 
293 #ifdef CONFIG_RTL8814A
294 extern enum rf_type rtl8814a_rfpath_decision(_adapter *adapter);
295 #endif
296 
rtw_hal_rfpath_init(_adapter * adapter)297 u8 rtw_hal_rfpath_init(_adapter *adapter)
298 {
299 	HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
300 	struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);
301 
302 #ifdef CONFIG_RTL8814A
303 if (IS_HARDWARE_TYPE_8814A(adapter)) {
304 	enum bb_path tx_bmp, rx_bmp;
305 	hal_data->rf_type = rtl8814a_rfpath_decision(adapter);
306 	rf_type_to_default_trx_bmp(hal_data->rf_type, &tx_bmp, &rx_bmp);
307 	hal_data->trx_path_bmp = (tx_bmp << 4) | rx_bmp;
308 	hal_data->NumTotalRFPath = 4;
309 	hal_data->max_tx_cnt = hal_spec->max_tx_cnt;
310 	hal_data->max_tx_cnt = rtw_min(hal_data->max_tx_cnt, rf_type_to_rf_tx_cnt(hal_data->rf_type));
311 } else
312 #endif
313 {
314 	struct registry_priv *regsty = adapter_to_regsty(adapter);
315 	u8 trx_path_bmp;
316 	u8 tx_path_num;
317 	u8 rx_path_num;
318 	int i;
319 
320 	trx_path_bmp = hal_spec->rf_reg_trx_path_bmp;
321 
322 	if (regsty->trx_path_bmp != 0x00) {
323 		/* restrict trx_path_bmp with regsty.trx_path_bmp */
324 		trx_path_bmp &= regsty->trx_path_bmp;
325 		if (!trx_path_bmp) {
326 			RTW_ERR("%s hal_spec.rf_reg_trx_path_bmp:0x%02x, regsty->trx_path_bmp:0x%02x no intersection\n"
327 				, __func__, hal_spec->rf_reg_trx_path_bmp, regsty->trx_path_bmp);
328 			return _FAIL;
329 		}
330 	} else if (hal_data->eeprom_trx_path_bmp != 0x00) {
331 		/* restrict trx_path_bmp with eeprom_trx_path_bmp */
332 		trx_path_bmp &= hal_data->eeprom_trx_path_bmp;
333 		if (!trx_path_bmp) {
334 			RTW_ERR("%s hal_spec.rf_reg_trx_path_bmp:0x%02x, hal_data->eeprom_trx_path_bmp:0x%02x no intersection\n"
335 				, __func__, hal_spec->rf_reg_trx_path_bmp, hal_data->eeprom_trx_path_bmp);
336 			return _FAIL;
337 		}
338 	}
339 
340 	/* restrict trx_path_bmp with TX and RX num limit */
341 	trx_path_bmp = rtw_restrict_trx_path_bmp_by_trx_num_lmt(trx_path_bmp
342 		, regsty->tx_path_lmt, regsty->rx_path_lmt, &tx_path_num, &rx_path_num);
343 	if (!trx_path_bmp) {
344 		RTW_ERR("%s rtw_restrict_trx_path_bmp_by_trx_num_lmt(0x%02x, %u, %u) failed\n"
345 			, __func__, trx_path_bmp, regsty->tx_path_lmt, regsty->rx_path_lmt);
346 		return _FAIL;
347 	}
348 	hal_data->trx_path_bmp = trx_path_bmp;
349 	hal_data->rf_type = trx_bmp_to_rf_type((trx_path_bmp & 0xF0) >> 4, trx_path_bmp & 0x0F);
350 	hal_data->NumTotalRFPath = rtw_max(tx_path_num, rx_path_num);
351 
352 	hal_data->max_tx_cnt = hal_spec->max_tx_cnt;
353 	hal_data->max_tx_cnt = rtw_min(hal_data->max_tx_cnt, tx_path_num);
354 	if (hal_data->eeprom_max_tx_cnt)
355 		hal_data->max_tx_cnt = rtw_min(hal_data->max_tx_cnt, hal_data->eeprom_max_tx_cnt);
356 
357 	if (1)
358 		_dump_rf_path(RTW_DBGDUMP, adapter);
359 }
360 
361 	RTW_INFO("%s trx_path_bmp:0x%02x(%s), NumTotalRFPath:%u, max_tx_cnt:%u\n"
362 		, __func__
363 		, hal_data->trx_path_bmp
364 		, rf_type_to_rfpath_str(hal_data->rf_type)
365 		, hal_data->NumTotalRFPath
366 		, hal_data->max_tx_cnt);
367 
368 	return _SUCCESS;
369 }
370 
_dump_trx_nss(void * sel,_adapter * adapter)371 void _dump_trx_nss(void *sel, _adapter *adapter)
372 {
373 	struct registry_priv *regpriv = &adapter->registrypriv;
374 	struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);
375 
376 	RTW_PRINT_SEL(sel, "[TRX_Nss] HALSPEC - tx_nss:%d, rx_nss:%d\n", hal_spec->tx_nss_num, hal_spec->rx_nss_num);
377 	RTW_PRINT_SEL(sel, "[TRX_Nss] Registry - tx_nss:%d, rx_nss:%d\n", regpriv->tx_nss, regpriv->rx_nss);
378 	RTW_PRINT_SEL(sel, "[TRX_Nss] HALDATA - tx_nss:%d, rx_nss:%d\n", GET_HAL_TX_NSS(adapter), GET_HAL_RX_NSS(adapter));
379 
380 }
381 #define NSS_VALID(nss) (nss > 0)
382 
rtw_hal_trxnss_init(_adapter * adapter)383 u8 rtw_hal_trxnss_init(_adapter *adapter)
384 {
385 	struct registry_priv *regpriv = &adapter->registrypriv;
386 	struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter);
387 	PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter);
388 	enum rf_type rf_path = GET_HAL_RFPATH(adapter);
389 	int i;
390 
391 	hal_data->tx_nss = hal_spec->tx_nss_num;
392 	hal_data->rx_nss = hal_spec->rx_nss_num;
393 
394 	if (NSS_VALID(regpriv->tx_nss))
395 		hal_data->tx_nss = rtw_min(hal_data->tx_nss, regpriv->tx_nss);
396 	hal_data->tx_nss = rtw_min(hal_data->tx_nss, hal_data->max_tx_cnt);
397 	if (NSS_VALID(regpriv->rx_nss))
398 		hal_data->rx_nss = rtw_min(hal_data->rx_nss, regpriv->rx_nss);
399 	hal_data->rx_nss = rtw_min(hal_data->rx_nss, rf_type_to_rf_rx_cnt(rf_path));
400 
401 	for (i = 0; i < 4; i++) {
402 		if (hal_data->tx_nss < i + 1)
403 			break;
404 
405 		if (IS_HARDWARE_TYPE_8814B(adapter) /* 8814B is always full-TX */
406 			#ifdef CONFIG_RTW_TX_NPATH_EN
407 			/* these IC is capable of full-TX when macro defined */
408 			|| IS_HARDWARE_TYPE_8192E(adapter) || IS_HARDWARE_TYPE_8192F(adapter)
409 			|| IS_HARDWARE_TYPE_8812(adapter) || IS_HARDWARE_TYPE_8822B(adapter)
410 			|| IS_HARDWARE_TYPE_8822C(adapter)
411 			#endif
412 		)
413 			hal_data->txpath_cap_num_nss[i] = hal_data->max_tx_cnt;
414 		else
415 			hal_data->txpath_cap_num_nss[i] = i + 1;
416 	}
417 
418 	if (1)
419 		_dump_trx_nss(RTW_DBGDUMP, adapter);
420 
421 	RTW_INFO("%s tx_nss:%u, rx_nss:%u\n", __func__
422 		, hal_data->tx_nss, hal_data->rx_nss);
423 
424 	return _SUCCESS;
425 }
426 
427 #ifdef CONFIG_RTW_SW_LED
rtw_hal_sw_led_init(_adapter * padapter)428 void rtw_hal_sw_led_init(_adapter *padapter)
429 {
430 	struct led_priv *ledpriv = adapter_to_led(padapter);
431 
432 	if (ledpriv->bRegUseLed == _FALSE)
433 		return;
434 
435 	if (!is_primary_adapter(padapter))
436 		return;
437 
438 	if (padapter->hal_func.InitSwLeds) {
439 		padapter->hal_func.InitSwLeds(padapter);
440 		rtw_led_set_ctl_en_mask_primary(padapter);
441 		rtw_led_set_iface_en(padapter, 1);
442 	}
443 }
444 
rtw_hal_sw_led_deinit(_adapter * padapter)445 void rtw_hal_sw_led_deinit(_adapter *padapter)
446 {
447 	struct led_priv *ledpriv = adapter_to_led(padapter);
448 
449 	if (ledpriv->bRegUseLed == _FALSE)
450 		return;
451 
452 	if (!is_primary_adapter(padapter))
453 		return;
454 
455 	if (padapter->hal_func.DeInitSwLeds)
456 		padapter->hal_func.DeInitSwLeds(padapter);
457 }
458 #endif
459 
rtw_hal_power_on(_adapter * padapter)460 u32 rtw_hal_power_on(_adapter *padapter)
461 {
462 	u32 ret = 0;
463 	PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter);
464 
465 	ret = padapter->hal_func.hal_power_on(padapter);
466 
467 #ifdef CONFIG_BT_COEXIST
468 	if ((ret == _SUCCESS) && (pHalData->EEPROMBluetoothCoexist == _TRUE))
469 		rtw_btcoex_PowerOnSetting(padapter);
470 #endif
471 
472 	return ret;
473 }
rtw_hal_power_off(_adapter * padapter)474 void rtw_hal_power_off(_adapter *padapter)
475 {
476 	struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl;
477 
478 	_rtw_memset(macid_ctl->h2c_msr, 0, MACID_NUM_SW_LIMIT);
479 	_rtw_memset(macid_ctl->op_num, 0, H2C_MSR_ROLE_MAX);
480 
481 #ifdef CONFIG_LPS_1T1R
482 	GET_HAL_DATA(padapter)->lps_1t1r = 0;
483 #endif
484 
485 #ifdef CONFIG_BT_COEXIST
486 	rtw_btcoex_PowerOffSetting(padapter);
487 #endif
488 
489 	padapter->hal_func.hal_power_off(padapter);
490 }
491 
492 
rtw_hal_init_opmode(_adapter * padapter)493 void rtw_hal_init_opmode(_adapter *padapter)
494 {
495 	NDIS_802_11_NETWORK_INFRASTRUCTURE networkType = Ndis802_11InfrastructureMax;
496 	struct  mlme_priv *pmlmepriv = &(padapter->mlmepriv);
497 	sint fw_state;
498 
499 	fw_state = get_fwstate(pmlmepriv);
500 
501 	if (fw_state & WIFI_ADHOC_STATE)
502 		networkType = Ndis802_11IBSS;
503 	else if (fw_state & WIFI_STATION_STATE)
504 		networkType = Ndis802_11Infrastructure;
505 #ifdef CONFIG_AP_MODE
506 	else if (fw_state & WIFI_AP_STATE)
507 		networkType = Ndis802_11APMode;
508 #endif
509 #ifdef CONFIG_RTW_MESH
510 	else if (fw_state & WIFI_MESH_STATE)
511 		networkType = Ndis802_11_mesh;
512 #endif
513 	else
514 		return;
515 
516 	rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_DIRECTLY);
517 }
518 
519 #ifdef CONFIG_NEW_NETDEV_HDL
rtw_hal_iface_init(_adapter * adapter)520 uint rtw_hal_iface_init(_adapter *adapter)
521 {
522 	uint status = _SUCCESS;
523 
524 	rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter_mac_addr(adapter));
525 	#ifdef RTW_HALMAC
526 	rtw_hal_hw_port_enable(adapter);
527 	#endif
528 	rtw_sec_restore_wep_key(adapter);
529 	rtw_hal_init_opmode(adapter);
530 	rtw_hal_start_thread(adapter);
531 	return status;
532 }
rtw_hal_init(_adapter * padapter)533 uint rtw_hal_init(_adapter *padapter)
534 {
535 	uint status = _SUCCESS;
536 	PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter);
537 
538 	halrf_set_rfsupportability(adapter_to_phydm(padapter));
539 
540 	status = padapter->hal_func.hal_init(padapter);
541 
542 	if(pHalData ->phydm_init_result) {
543 
544 		status = _FAIL;
545 		RTW_ERR("%s phydm init fail reason=%u \n",
546 			__func__,
547 			pHalData ->phydm_init_result);
548 	}
549 
550 	if (status == _SUCCESS) {
551 		rtw_set_hw_init_completed(padapter, _TRUE);
552 		if (padapter->registrypriv.notch_filter == 1)
553 			rtw_hal_notch_filter(padapter, 1);
554 		rtw_led_control(padapter, LED_CTL_POWER_ON);
555 		init_hw_mlme_ext(padapter);
556 		#ifdef CONFIG_RF_POWER_TRIM
557 		rtw_bb_rf_gain_offset(padapter);
558 		#endif /*CONFIG_RF_POWER_TRIM*/
559 		GET_PRIMARY_ADAPTER(padapter)->bup = _TRUE; /*temporary*/
560 		#ifdef CONFIG_MI_WITH_MBSSID_CAM
561 		rtw_mi_set_mbid_cam(padapter);
562 		#endif
563 		#ifdef CONFIG_SUPPORT_MULTI_BCN
564 		rtw_ap_multi_bcn_cfg(padapter);
565 		#endif
566 		#if (RTL8822B_SUPPORT == 1) || (RTL8192F_SUPPORT == 1)
567 		#ifdef CONFIG_DYNAMIC_SOML
568 		rtw_dyn_soml_config(padapter);
569 		#endif
570 		#endif
571 		#ifdef CONFIG_TDMADIG
572 		rtw_phydm_tdmadig(padapter, TDMADIG_INIT);
573 		#endif/*CONFIG_TDMADIG*/
574 		rtw_phydm_dyn_rrsr_en(padapter,padapter->registrypriv.en_dyn_rrsr);
575 		#ifdef RTW_HALMAC
576 		RTW_INFO("%s: padapter->registrypriv.set_rrsr_value=0x%x\n", __func__,padapter->registrypriv.set_rrsr_value);
577 		if(padapter->registrypriv.set_rrsr_value != 0xFFFFFFFF)
578 			rtw_phydm_set_rrsr(padapter, padapter->registrypriv.set_rrsr_value, TRUE);
579 		#endif
580 	} else {
581 		rtw_set_hw_init_completed(padapter, _FALSE);
582 		RTW_ERR("%s: hal_init fail\n", __func__);
583 	}
584 	return status;
585 }
586 #else
rtw_hal_init(_adapter * padapter)587 uint	 rtw_hal_init(_adapter *padapter)
588 {
589 	uint	status = _SUCCESS;
590 	struct dvobj_priv *dvobj = adapter_to_dvobj(padapter);
591 	PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter);
592 	int i;
593 
594 	halrf_set_rfsupportability(adapter_to_phydm(padapter));
595 
596 	status = padapter->hal_func.hal_init(padapter);
597 
598 	if(pHalData ->phydm_init_result) {
599 
600 		status = _FAIL;
601 		RTW_ERR("%s phydm init fail reason=%u \n",
602 				__func__,
603 				pHalData->phydm_init_result);
604 	}
605 
606 	if (status == _SUCCESS) {
607 		rtw_set_hw_init_completed(padapter, _TRUE);
608 		rtw_mi_set_mac_addr(padapter);/*set mac addr of all ifaces*/
609 		#ifdef RTW_HALMAC
610 		rtw_restore_hw_port_cfg(padapter);
611 		#endif
612 		if (padapter->registrypriv.notch_filter == 1)
613 			rtw_hal_notch_filter(padapter, 1);
614 
615 		for (i = 0; i < dvobj->iface_nums; i++)
616 			rtw_sec_restore_wep_key(dvobj->padapters[i]);
617 
618 		rtw_led_control(padapter, LED_CTL_POWER_ON);
619 
620 		init_hw_mlme_ext(padapter);
621 
622 		rtw_hal_init_opmode(padapter);
623 
624 		#ifdef CONFIG_RF_POWER_TRIM
625 		rtw_bb_rf_gain_offset(padapter);
626 		#endif /*CONFIG_RF_POWER_TRIM*/
627 
628 		#ifdef CONFIG_SUPPORT_MULTI_BCN
629 		rtw_ap_multi_bcn_cfg(padapter);
630 		#endif
631 
632 #if (RTL8822B_SUPPORT == 1) || (RTL8192F_SUPPORT == 1)
633 #ifdef CONFIG_DYNAMIC_SOML
634 		rtw_dyn_soml_config(padapter);
635 #endif
636 #endif
637 		#ifdef CONFIG_TDMADIG
638 		rtw_phydm_tdmadig(padapter, TDMADIG_INIT);
639 		#endif/*CONFIG_TDMADIG*/
640 
641 		rtw_phydm_dyn_rrsr_en(padapter,padapter->registrypriv.en_dyn_rrsr);
642 		#ifdef RTW_HALMAC
643 		RTW_INFO("%s: padapter->registrypriv.set_rrsr_value=0x%x\n", __func__,padapter->registrypriv.set_rrsr_value);
644 		if(padapter->registrypriv.set_rrsr_value != 0xFFFFFFFF)
645 			rtw_phydm_set_rrsr(padapter, padapter->registrypriv.set_rrsr_value, TRUE);
646 		#endif
647 
648 	} else {
649 		rtw_set_hw_init_completed(padapter, _FALSE);
650 		RTW_ERR("%s: fail\n", __func__);
651 	}
652 
653 
654 	return status;
655 
656 }
657 #endif
658 
rtw_hal_deinit(_adapter * padapter)659 uint rtw_hal_deinit(_adapter *padapter)
660 {
661 	uint	status = _SUCCESS;
662 
663 	status = padapter->hal_func.hal_deinit(padapter);
664 
665 	if (status == _SUCCESS) {
666 		rtw_led_control(padapter, LED_CTL_POWER_OFF);
667 		rtw_set_hw_init_completed(padapter, _FALSE);
668 	} else
669 		RTW_INFO("\n rtw_hal_deinit: hal_init fail\n");
670 
671 
672 	return status;
673 }
674 
rtw_hal_set_hwreg(_adapter * padapter,u8 variable,u8 * val)675 u8 rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val)
676 {
677 	return padapter->hal_func.set_hw_reg_handler(padapter, variable, val);
678 }
679 
rtw_hal_get_hwreg(_adapter * padapter,u8 variable,u8 * val)680 void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val)
681 {
682 	padapter->hal_func.GetHwRegHandler(padapter, variable, val);
683 }
684 
rtw_hal_set_def_var(_adapter * padapter,HAL_DEF_VARIABLE eVariable,void * pValue)685 u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue)
686 {
687 	return padapter->hal_func.SetHalDefVarHandler(padapter, eVariable, pValue);
688 }
rtw_hal_get_def_var(_adapter * padapter,HAL_DEF_VARIABLE eVariable,void * pValue)689 u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue)
690 {
691 	return padapter->hal_func.get_hal_def_var_handler(padapter, eVariable, pValue);
692 }
693 
rtw_hal_set_odm_var(_adapter * padapter,HAL_ODM_VARIABLE eVariable,void * pValue1,BOOLEAN bSet)694 void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, BOOLEAN bSet)
695 {
696 	padapter->hal_func.SetHalODMVarHandler(padapter, eVariable, pValue1, bSet);
697 }
rtw_hal_get_odm_var(_adapter * padapter,HAL_ODM_VARIABLE eVariable,void * pValue1,void * pValue2)698 void	rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2)
699 {
700 	padapter->hal_func.GetHalODMVarHandler(padapter, eVariable, pValue1, pValue2);
701 }
702 
703 /* FOR SDIO & PCIE */
rtw_hal_enable_interrupt(_adapter * padapter)704 void rtw_hal_enable_interrupt(_adapter *padapter)
705 {
706 #if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI)
707 	padapter->hal_func.enable_interrupt(padapter);
708 #endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */
709 }
710 
711 /* FOR SDIO & PCIE */
rtw_hal_disable_interrupt(_adapter * padapter)712 void rtw_hal_disable_interrupt(_adapter *padapter)
713 {
714 #if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI)
715 	padapter->hal_func.disable_interrupt(padapter);
716 #endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */
717 }
718 
719 
rtw_hal_check_ips_status(_adapter * padapter)720 u8 rtw_hal_check_ips_status(_adapter *padapter)
721 {
722 	u8 val = _FALSE;
723 	if (padapter->hal_func.check_ips_status)
724 		val = padapter->hal_func.check_ips_status(padapter);
725 	else
726 		RTW_INFO("%s: hal_func.check_ips_status is NULL!\n", __FUNCTION__);
727 
728 	return val;
729 }
730 
rtw_hal_fw_dl(_adapter * padapter,u8 wowlan)731 s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan)
732 {
733 	s32 ret;
734 
735 	ret = padapter->hal_func.fw_dl(padapter, wowlan);
736 
737 #ifdef CONFIG_LPS_1T1R
738 	GET_HAL_DATA(padapter)->lps_1t1r = 0;
739 #endif
740 
741 	return ret;
742 }
743 
744 #ifdef RTW_HALMAC
rtw_hal_fw_mem_dl(_adapter * padapter,enum fw_mem mem)745 s32 rtw_hal_fw_mem_dl(_adapter *padapter, enum fw_mem mem)
746 {
747 	systime dlfw_start_time = rtw_get_current_time();
748 	struct dvobj_priv *dvobj = adapter_to_dvobj(padapter);
749 	struct debug_priv *pdbgpriv = &dvobj->drv_dbg;
750 	s32 rst = _FALSE;
751 
752 	rst = padapter->hal_func.fw_mem_dl(padapter, mem);
753 	RTW_INFO("%s in %dms\n", __func__, rtw_get_passing_time_ms(dlfw_start_time));
754 
755 	if (rst == _FALSE)
756 		pdbgpriv->dbg_fw_mem_dl_error_cnt++;
757 	if (1)
758 		RTW_INFO("%s dbg_fw_mem_dl_error_cnt:%d\n", __func__, pdbgpriv->dbg_fw_mem_dl_error_cnt);
759 	return rst;
760 }
761 #endif
762 
763 #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)
rtw_hal_clear_interrupt(_adapter * padapter)764 void rtw_hal_clear_interrupt(_adapter *padapter)
765 {
766 #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
767 	padapter->hal_func.clear_interrupt(padapter);
768 #endif
769 }
770 #endif
771 
772 #if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI)
rtw_hal_inirp_init(_adapter * padapter)773 u32	rtw_hal_inirp_init(_adapter *padapter)
774 {
775 	if (is_primary_adapter(padapter))
776 		return padapter->hal_func.inirp_init(padapter);
777 	return _SUCCESS;
778 }
rtw_hal_inirp_deinit(_adapter * padapter)779 u32	rtw_hal_inirp_deinit(_adapter *padapter)
780 {
781 
782 	if (is_primary_adapter(padapter))
783 		return padapter->hal_func.inirp_deinit(padapter);
784 
785 	return _SUCCESS;
786 }
787 #endif /* #if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) */
788 
789 #if defined(CONFIG_PCI_HCI)
rtw_hal_irp_reset(_adapter * padapter)790 void	rtw_hal_irp_reset(_adapter *padapter)
791 {
792 	padapter->hal_func.irp_reset(GET_PRIMARY_ADAPTER(padapter));
793 }
794 
rtw_hal_pci_dbi_write(_adapter * padapter,u16 addr,u8 data)795 void rtw_hal_pci_dbi_write(_adapter *padapter, u16 addr, u8 data)
796 {
797 	u16 cmd[2];
798 
799 	cmd[0] = addr;
800 	cmd[1] = data;
801 
802 	padapter->hal_func.set_hw_reg_handler(padapter, HW_VAR_DBI, (u8 *) cmd);
803 }
804 
rtw_hal_pci_dbi_read(_adapter * padapter,u16 addr)805 u8 rtw_hal_pci_dbi_read(_adapter *padapter, u16 addr)
806 {
807 	padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_DBI, (u8 *)(&addr));
808 
809 	return (u8)addr;
810 }
811 
rtw_hal_pci_mdio_write(_adapter * padapter,u8 addr,u16 data)812 void rtw_hal_pci_mdio_write(_adapter *padapter, u8 addr, u16 data)
813 {
814 	u16 cmd[2];
815 
816 	cmd[0] = (u16)addr;
817 	cmd[1] = data;
818 
819 	padapter->hal_func.set_hw_reg_handler(padapter, HW_VAR_MDIO, (u8 *) cmd);
820 }
821 
rtw_hal_pci_mdio_read(_adapter * padapter,u8 addr)822 u16 rtw_hal_pci_mdio_read(_adapter *padapter, u8 addr)
823 {
824 	padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_MDIO, &addr);
825 
826 	return (u8)addr;
827 }
828 
rtw_hal_pci_l1off_nic_support(_adapter * padapter)829 u8 rtw_hal_pci_l1off_nic_support(_adapter *padapter)
830 {
831 	u8 l1off;
832 
833 	padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_L1OFF_NIC_SUPPORT, &l1off);
834 	return l1off;
835 }
836 
rtw_hal_pci_l1off_capability(_adapter * padapter)837 u8 rtw_hal_pci_l1off_capability(_adapter *padapter)
838 {
839 	u8 l1off;
840 
841 	padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_L1OFF_CAPABILITY, &l1off);
842 	return l1off;
843 }
844 
845 
846 #endif /* #if defined(CONFIG_PCI_HCI) */
847 
848 /* for USB Auto-suspend */
rtw_hal_intf_ps_func(_adapter * padapter,HAL_INTF_PS_FUNC efunc_id,u8 * val)849 u8	rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val)
850 {
851 	if (padapter->hal_func.interface_ps_func)
852 		return padapter->hal_func.interface_ps_func(padapter, efunc_id, val);
853 	return _FAIL;
854 }
855 
856 #ifdef CONFIG_RTW_MGMT_QUEUE
rtw_hal_mgmt_xmitframe_enqueue(_adapter * padapter,struct xmit_frame * pxmitframe)857 s32	rtw_hal_mgmt_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe)
858 {
859 	return padapter->hal_func.hal_mgmt_xmitframe_enqueue(padapter, pxmitframe);
860 }
861 #endif
862 
rtw_hal_xmitframe_enqueue(_adapter * padapter,struct xmit_frame * pxmitframe)863 s32	rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe)
864 {
865 	return padapter->hal_func.hal_xmitframe_enqueue(padapter, pxmitframe);
866 }
867 
rtw_hal_xmit(_adapter * padapter,struct xmit_frame * pxmitframe)868 s32	rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe)
869 {
870 	return padapter->hal_func.hal_xmit(padapter, pxmitframe);
871 }
872 
873 /*
874  * [IMPORTANT] This function would be run in interrupt context.
875  */
rtw_hal_mgnt_xmit(_adapter * padapter,struct xmit_frame * pmgntframe)876 s32	rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe)
877 {
878 #ifdef CONFIG_RTW_MGMT_QUEUE
879 	_irqL irqL;
880 	struct xmit_priv *pxmitpriv = &(padapter->xmitpriv);
881 #endif
882 	s32 ret = _FAIL;
883 
884 	update_mgntframe_attrib_addr(padapter, pmgntframe);
885 #ifdef CONFIG_RTW_MGMT_QUEUE
886 	update_mgntframe_subtype(padapter, pmgntframe);
887 #endif
888 
889 #if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH)
890 	if ((!MLME_IS_MESH(padapter) && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _TRUE)
891 		#ifdef CONFIG_RTW_MESH
892 		|| (MLME_IS_MESH(padapter) && padapter->mesh_info.mesh_auth_id)
893 		#endif
894 	)
895 		rtw_mgmt_xmitframe_coalesce(padapter, pmgntframe->pkt, pmgntframe);
896 #endif
897 
898 #if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS)
899 #ifdef CONFIG_RTW_MGMT_QUEUE
900 	if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) {
901 		_enter_critical_bh(&pxmitpriv->lock, &irqL);
902 		ret = mgmt_xmitframe_enqueue_for_sleeping_sta(padapter, pmgntframe);
903 		_exit_critical_bh(&pxmitpriv->lock, &irqL);
904 
905 		#ifdef DBG_MGMT_QUEUE
906 		if (ret == _TRUE)
907 			RTW_INFO("%s doesn't be queued, dattrib->ra:"MAC_FMT" seq_num = %u, subtype = 0x%x\n",
908 			__func__, MAC_ARG(pmgntframe->attrib.ra), pmgntframe->attrib.seqnum, pmgntframe->attrib.subtype);
909 		#endif
910 
911 		if (ret == RTW_QUEUE_MGMT)
912 			return ret;
913 	}
914 #endif
915 #endif
916 
917 	ret = padapter->hal_func.mgnt_xmit(padapter, pmgntframe);
918 	return ret;
919 }
920 
rtw_hal_init_xmit_priv(_adapter * padapter)921 s32	rtw_hal_init_xmit_priv(_adapter *padapter)
922 {
923 	return padapter->hal_func.init_xmit_priv(padapter);
924 }
rtw_hal_free_xmit_priv(_adapter * padapter)925 void	rtw_hal_free_xmit_priv(_adapter *padapter)
926 {
927 	padapter->hal_func.free_xmit_priv(padapter);
928 }
929 
rtw_hal_init_recv_priv(_adapter * padapter)930 s32	rtw_hal_init_recv_priv(_adapter *padapter)
931 {
932 	return padapter->hal_func.init_recv_priv(padapter);
933 }
rtw_hal_free_recv_priv(_adapter * padapter)934 void	rtw_hal_free_recv_priv(_adapter *padapter)
935 {
936 	padapter->hal_func.free_recv_priv(padapter);
937 }
938 
rtw_sta_ra_registed(_adapter * padapter,struct sta_info * psta)939 void rtw_sta_ra_registed(_adapter *padapter, struct sta_info *psta)
940 {
941 	HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter);
942 
943 	if (psta == NULL) {
944 		RTW_ERR(FUNC_ADPT_FMT" sta is NULL\n", FUNC_ADPT_ARG(padapter));
945 		rtw_warn_on(1);
946 		return;
947 	}
948 
949 #ifdef CONFIG_AP_MODE
950 	if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) {
951 		if (psta->cmn.aid > padapter->stapriv.max_aid) {
952 			RTW_ERR("station aid %d exceed the max number\n", psta->cmn.aid);
953 			rtw_warn_on(1);
954 			return;
955 		}
956 		rtw_ap_update_sta_ra_info(padapter, psta);
957 	}
958 #endif
959 
960 	psta->cmn.ra_info.ra_bw_mode = rtw_get_tx_bw_mode(padapter, psta);
961 	/*set correct initial date rate for each mac_id */
962 	hal_data->INIDATA_RATE[psta->cmn.mac_id] = psta->init_rate;
963 
964 	rtw_phydm_ra_registed(padapter, psta);
965 }
966 
rtw_hal_update_ra_mask(struct sta_info * psta)967 void rtw_hal_update_ra_mask(struct sta_info *psta)
968 {
969 	_adapter *padapter;
970 
971 	if (!psta)
972 		return;
973 
974 	padapter = psta->padapter;
975 	rtw_sta_ra_registed(padapter, psta);
976 }
977 
978 /*	Start specifical interface thread		*/
rtw_hal_start_thread(_adapter * padapter)979 void	rtw_hal_start_thread(_adapter *padapter)
980 {
981 #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
982 #ifndef CONFIG_SDIO_TX_TASKLET
983 	padapter->hal_func.run_thread(padapter);
984 #endif
985 #endif
986 }
987 /*	Start specifical interface thread		*/
rtw_hal_stop_thread(_adapter * padapter)988 void	rtw_hal_stop_thread(_adapter *padapter)
989 {
990 #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
991 #ifndef CONFIG_SDIO_TX_TASKLET
992 
993 	padapter->hal_func.cancel_thread(padapter);
994 
995 #endif
996 #endif
997 }
998 
rtw_hal_read_bbreg(_adapter * padapter,u32 RegAddr,u32 BitMask)999 u32	rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask)
1000 {
1001 	u32 data = 0;
1002 	if (padapter->hal_func.read_bbreg)
1003 		data = padapter->hal_func.read_bbreg(padapter, RegAddr, BitMask);
1004 	return data;
1005 }
rtw_hal_write_bbreg(_adapter * padapter,u32 RegAddr,u32 BitMask,u32 Data)1006 void	rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data)
1007 {
1008 	if (padapter->hal_func.write_bbreg)
1009 		padapter->hal_func.write_bbreg(padapter, RegAddr, BitMask, Data);
1010 }
1011 
rtw_hal_read_rfreg(_adapter * padapter,enum rf_path eRFPath,u32 RegAddr,u32 BitMask)1012 u32 rtw_hal_read_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask)
1013 {
1014 	u32 data = 0;
1015 
1016 	if (padapter->hal_func.read_rfreg) {
1017 		data = padapter->hal_func.read_rfreg(padapter, eRFPath, RegAddr, BitMask);
1018 
1019 		#ifdef DBG_IO
1020 		if (match_rf_read_sniff_ranges(padapter, eRFPath, RegAddr, BitMask)) {
1021 			RTW_INFO("DBG_IO rtw_hal_read_rfreg(%u, 0x%04x, 0x%08x) read:0x%08x(0x%08x)\n"
1022 				, eRFPath, RegAddr, BitMask, (data << PHY_CalculateBitShift(BitMask)), data);
1023 		}
1024 		#endif
1025 	}
1026 
1027 	return data;
1028 }
1029 
rtw_hal_write_rfreg(_adapter * padapter,enum rf_path eRFPath,u32 RegAddr,u32 BitMask,u32 Data)1030 void rtw_hal_write_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data)
1031 {
1032 	if (padapter->hal_func.write_rfreg) {
1033 
1034 		#ifdef DBG_IO
1035 		if (match_rf_write_sniff_ranges(padapter, eRFPath, RegAddr, BitMask)) {
1036 			RTW_INFO("DBG_IO rtw_hal_write_rfreg(%u, 0x%04x, 0x%08x) write:0x%08x(0x%08x)\n"
1037 				, eRFPath, RegAddr, BitMask, (Data << PHY_CalculateBitShift(BitMask)), Data);
1038 		}
1039 		#endif
1040 
1041 		padapter->hal_func.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data);
1042 
1043 #ifdef CONFIG_PCI_HCI
1044 		if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(padapter)) /*For N-Series IC, suggest by Jenyu*/
1045 			rtw_udelay_os(2);
1046 #endif
1047 	}
1048 }
1049 
1050 #ifdef CONFIG_SYSON_INDIRECT_ACCESS
rtw_hal_read_syson_reg(PADAPTER padapter,u32 RegAddr,u32 BitMask)1051 u32 rtw_hal_read_syson_reg(PADAPTER padapter, u32 RegAddr, u32 BitMask)
1052 {
1053 	u32 data = 0;
1054 	if (padapter->hal_func.read_syson_reg)
1055 		data = padapter->hal_func.read_syson_reg(padapter, RegAddr, BitMask);
1056 
1057 	return data;
1058 }
1059 
rtw_hal_write_syson_reg(_adapter * padapter,u32 RegAddr,u32 BitMask,u32 Data)1060 void rtw_hal_write_syson_reg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data)
1061 {
1062 	if (padapter->hal_func.write_syson_reg)
1063 		padapter->hal_func.write_syson_reg(padapter, RegAddr, BitMask, Data);
1064 }
1065 #endif
1066 
1067 #if defined(CONFIG_PCI_HCI)
rtw_hal_interrupt_handler(_adapter * padapter)1068 s32	rtw_hal_interrupt_handler(_adapter *padapter)
1069 {
1070 	s32 ret = _FAIL;
1071 	ret = padapter->hal_func.interrupt_handler(padapter);
1072 	return ret;
1073 }
1074 
rtw_hal_unmap_beacon_icf(_adapter * padapter)1075 void	rtw_hal_unmap_beacon_icf(_adapter *padapter)
1076 {
1077 	padapter->hal_func.unmap_beacon_icf(padapter);
1078 }
1079 #endif
1080 #if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT)
rtw_hal_interrupt_handler(_adapter * padapter,u16 pkt_len,u8 * pbuf)1081 void	rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf)
1082 {
1083 	padapter->hal_func.interrupt_handler(padapter, pkt_len, pbuf);
1084 }
1085 #endif
1086 
rtw_hal_set_chnl_bw(_adapter * padapter,u8 channel,enum channel_width Bandwidth,u8 Offset40,u8 Offset80)1087 void	rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, enum channel_width Bandwidth, u8 Offset40, u8 Offset80)
1088 {
1089 	PHAL_DATA_TYPE	pHalData = GET_HAL_DATA(padapter);
1090 	/*u8 cch_160 = Bandwidth == CHANNEL_WIDTH_160 ? channel : 0;*/
1091 	u8 cch_80 = Bandwidth == CHANNEL_WIDTH_80 ? channel : 0;
1092 	u8 cch_40 = Bandwidth == CHANNEL_WIDTH_40 ? channel : 0;
1093 	u8 cch_20 = Bandwidth == CHANNEL_WIDTH_20 ? channel : 0;
1094 
1095 	if (rtw_phydm_is_iqk_in_progress(padapter))
1096 		RTW_ERR("%s, %d, IQK may race condition\n", __func__, __LINE__);
1097 
1098 #ifdef CONFIG_MP_INCLUDED
1099 	/* MP mode channel don't use secondary channel */
1100 	if (rtw_mp_mode_check(padapter) == _FALSE)
1101 #endif
1102 	{
1103 		#if 0
1104 		if (cch_160 != 0)
1105 			cch_80 = rtw_get_scch_by_cch_offset(cch_160, CHANNEL_WIDTH_160, Offset80);
1106 		#endif
1107 		if (cch_80 != 0)
1108 			cch_40 = rtw_get_scch_by_cch_offset(cch_80, CHANNEL_WIDTH_80, Offset80);
1109 		if (cch_40 != 0)
1110 			cch_20 = rtw_get_scch_by_cch_offset(cch_40, CHANNEL_WIDTH_40, Offset40);
1111 	}
1112 
1113 	pHalData->cch_80 = cch_80;
1114 	pHalData->cch_40 = cch_40;
1115 	pHalData->cch_20 = cch_20;
1116 
1117 	if (0)
1118 		RTW_INFO("%s cch:%u, %s, offset40:%u, offset80:%u (%u, %u, %u)\n", __func__
1119 			, channel, ch_width_str(Bandwidth), Offset40, Offset80
1120 			, pHalData->cch_80, pHalData->cch_40, pHalData->cch_20);
1121 
1122 	padapter->hal_func.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80);
1123 }
1124 
rtw_hal_dm_watchdog(_adapter * padapter)1125 void	rtw_hal_dm_watchdog(_adapter *padapter)
1126 {
1127 
1128 	rtw_hal_turbo_edca(padapter);
1129 	padapter->hal_func.hal_dm_watchdog(padapter);
1130 }
1131 
1132 #ifdef CONFIG_LPS_LCLK_WD_TIMER
rtw_hal_dm_watchdog_in_lps(_adapter * padapter)1133 void	rtw_hal_dm_watchdog_in_lps(_adapter *padapter)
1134 {
1135 #if defined(CONFIG_CONCURRENT_MODE)
1136 #ifndef CONFIG_FW_MULTI_PORT_SUPPORT
1137 	if (padapter->hw_port != HW_PORT0)
1138 		return;
1139 #endif
1140 #endif
1141 
1142 	if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE)
1143 		rtw_phydm_watchdog_in_lps_lclk(padapter);/* this function caller is in interrupt context */
1144 }
1145 #endif /*CONFIG_LPS_LCLK_WD_TIMER*/
1146 
rtw_hal_bcn_related_reg_setting(_adapter * padapter)1147 void rtw_hal_bcn_related_reg_setting(_adapter *padapter)
1148 {
1149 	padapter->hal_func.SetBeaconRelatedRegistersHandler(padapter);
1150 }
1151 
1152 #ifdef CONFIG_HOSTAPD_MLME
rtw_hal_hostap_mgnt_xmit_entry(_adapter * padapter,_pkt * pkt)1153 s32	rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt)
1154 {
1155 	if (padapter->hal_func.hostap_mgnt_xmit_entry)
1156 		return padapter->hal_func.hostap_mgnt_xmit_entry(padapter, pkt);
1157 	return _FAIL;
1158 }
1159 #endif /* CONFIG_HOSTAPD_MLME */
1160 
1161 #ifdef DBG_CONFIG_ERROR_DETECT
rtw_hal_sreset_init(_adapter * padapter)1162 void	rtw_hal_sreset_init(_adapter *padapter)
1163 {
1164 	padapter->hal_func.sreset_init_value(padapter);
1165 }
rtw_hal_sreset_reset(_adapter * padapter)1166 void rtw_hal_sreset_reset(_adapter *padapter)
1167 {
1168 	padapter = GET_PRIMARY_ADAPTER(padapter);
1169 	padapter->hal_func.silentreset(padapter);
1170 }
1171 
rtw_hal_sreset_reset_value(_adapter * padapter)1172 void rtw_hal_sreset_reset_value(_adapter *padapter)
1173 {
1174 	padapter->hal_func.sreset_reset_value(padapter);
1175 }
1176 
rtw_hal_sreset_xmit_status_check(_adapter * padapter)1177 void rtw_hal_sreset_xmit_status_check(_adapter *padapter)
1178 {
1179 	padapter->hal_func.sreset_xmit_status_check(padapter);
1180 }
rtw_hal_sreset_linked_status_check(_adapter * padapter)1181 void rtw_hal_sreset_linked_status_check(_adapter *padapter)
1182 {
1183 	padapter->hal_func.sreset_linked_status_check(padapter);
1184 }
rtw_hal_sreset_get_wifi_status(_adapter * padapter)1185 u8   rtw_hal_sreset_get_wifi_status(_adapter *padapter)
1186 {
1187 	return padapter->hal_func.sreset_get_wifi_status(padapter);
1188 }
1189 
rtw_hal_sreset_inprogress(_adapter * padapter)1190 bool rtw_hal_sreset_inprogress(_adapter *padapter)
1191 {
1192 	padapter = GET_PRIMARY_ADAPTER(padapter);
1193 	return padapter->hal_func.sreset_inprogress(padapter);
1194 }
1195 #endif /* DBG_CONFIG_ERROR_DETECT */
1196 
1197 #ifdef CONFIG_IOL
rtw_hal_iol_cmd(ADAPTER * adapter,struct xmit_frame * xmit_frame,u32 max_waiting_ms,u32 bndy_cnt)1198 int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_waiting_ms, u32 bndy_cnt)
1199 {
1200 	if (adapter->hal_func.IOL_exec_cmds_sync)
1201 		return adapter->hal_func.IOL_exec_cmds_sync(adapter, xmit_frame, max_waiting_ms, bndy_cnt);
1202 	return _FAIL;
1203 }
1204 #endif
1205 
1206 #ifdef CONFIG_XMIT_THREAD_MODE
rtw_hal_xmit_thread_handler(_adapter * padapter)1207 s32 rtw_hal_xmit_thread_handler(_adapter *padapter)
1208 {
1209 	return padapter->hal_func.xmit_thread_handler(padapter);
1210 }
1211 #endif
1212 
1213 #ifdef CONFIG_RECV_THREAD_MODE
rtw_hal_recv_hdl(_adapter * adapter)1214 s32 rtw_hal_recv_hdl(_adapter *adapter)
1215 {
1216 	return adapter->hal_func.recv_hdl(adapter);
1217 }
1218 #endif
1219 
rtw_hal_notch_filter(_adapter * adapter,bool enable)1220 void rtw_hal_notch_filter(_adapter *adapter, bool enable)
1221 {
1222 	if (adapter->hal_func.hal_notch_filter)
1223 		adapter->hal_func.hal_notch_filter(adapter, enable);
1224 }
1225 
1226 #ifdef CONFIG_FW_C2H_REG
rtw_hal_c2h_valid(_adapter * adapter,u8 * buf)1227 inline bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf)
1228 {
1229 	HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter);
1230 	bool ret = _FAIL;
1231 
1232 	ret = C2H_ID_88XX(buf) || C2H_PLEN_88XX(buf);
1233 
1234 	return ret;
1235 }
1236 
rtw_hal_c2h_evt_read(_adapter * adapter,u8 * buf)1237 inline s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf)
1238 {
1239 	HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter);
1240 	s32 ret = _FAIL;
1241 
1242 	ret = c2h_evt_read_88xx(adapter, buf);
1243 
1244 	return ret;
1245 }
1246 
rtw_hal_c2h_reg_hdr_parse(_adapter * adapter,u8 * buf,u8 * id,u8 * seq,u8 * plen,u8 ** payload)1247 bool rtw_hal_c2h_reg_hdr_parse(_adapter *adapter, u8 *buf, u8 *id, u8 *seq, u8 *plen, u8 **payload)
1248 {
1249 	HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter);
1250 	bool ret = _FAIL;
1251 
1252 	*id = C2H_ID_88XX(buf);
1253 	*seq = C2H_SEQ_88XX(buf);
1254 	*plen = C2H_PLEN_88XX(buf);
1255 	*payload = C2H_PAYLOAD_88XX(buf);
1256 	ret = _SUCCESS;
1257 
1258 	return ret;
1259 }
1260 #endif /* CONFIG_FW_C2H_REG */
1261 
1262 #ifdef CONFIG_FW_C2H_PKT
rtw_hal_c2h_pkt_hdr_parse(_adapter * adapter,u8 * buf,u16 len,u8 * id,u8 * seq,u8 * plen,u8 ** payload)1263 bool rtw_hal_c2h_pkt_hdr_parse(_adapter *adapter, u8 *buf, u16 len, u8 *id, u8 *seq, u8 *plen, u8 **payload)
1264 {
1265 	HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter);
1266 	bool ret = _FAIL;
1267 
1268 	if (!buf || len > 256 || len < 3)
1269 		goto exit;
1270 
1271 	*id = C2H_ID_88XX(buf);
1272 	*seq = C2H_SEQ_88XX(buf);
1273 	*plen = len - 2;
1274 	*payload = C2H_PAYLOAD_88XX(buf);
1275 	ret = _SUCCESS;
1276 
1277 exit:
1278 	return ret;
1279 }
1280 #endif /* CONFIG_FW_C2H_PKT */
1281 
1282 #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTL8723B)
1283 #include <rtw_bt_mp.h> /* for MPTBT_FwC2hBtMpCtrl */
1284 #endif
c2h_handler(_adapter * adapter,u8 id,u8 seq,u8 plen,u8 * payload)1285 s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload)
1286 {
1287 	u8 sub_id = 0;
1288 	s32 ret = _SUCCESS;
1289 
1290 	switch (id) {
1291 	case C2H_FW_SCAN_COMPLETE:
1292 		RTW_INFO("[C2H], FW Scan Complete\n");
1293 		break;
1294 
1295 #ifdef CONFIG_BT_COEXIST
1296 	case C2H_BT_INFO:
1297 		rtw_btcoex_BtInfoNotify(adapter, plen, payload);
1298 		break;
1299 	case C2H_BT_MP_INFO:
1300 		#if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTL8723B)
1301 		MPTBT_FwC2hBtMpCtrl(adapter, payload, plen);
1302 		#endif
1303 		rtw_btcoex_BtMpRptNotify(adapter, plen, payload);
1304 		break;
1305 	case C2H_MAILBOX_STATUS:
1306 		RTW_DBG_DUMP("C2H_MAILBOX_STATUS: ", payload, plen);
1307 		break;
1308 	case C2H_WLAN_INFO:
1309 		rtw_btcoex_WlFwDbgInfoNotify(adapter, payload, plen);
1310 		break;
1311 #endif /* CONFIG_BT_COEXIST */
1312 
1313 	case C2H_IQK_FINISH:
1314 		c2h_iqk_offload(adapter, payload, plen);
1315 		break;
1316 
1317 #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)
1318 	case C2H_FW_CHNL_SWITCH_COMPLETE:
1319 #ifndef CONFIG_TDLS_CH_SW_V2
1320 		rtw_tdls_chsw_oper_done(adapter);
1321 #endif
1322 		break;
1323 #endif
1324 
1325 	case C2H_BCN_EARLY_RPT:
1326 		rtw_hal_bcn_early_rpt_c2h_handler(adapter);
1327 		break;
1328 
1329 #ifdef CONFIG_MCC_MODE
1330 	case C2H_MCC:
1331 		rtw_hal_mcc_c2h_handler(adapter, plen, payload);
1332 		break;
1333 #endif
1334 
1335 #ifdef CONFIG_RTW_MAC_HIDDEN_RPT
1336 	case C2H_MAC_HIDDEN_RPT:
1337 		c2h_mac_hidden_rpt_hdl(adapter, payload, plen);
1338 		break;
1339 	case C2H_MAC_HIDDEN_RPT_2:
1340 		c2h_mac_hidden_rpt_2_hdl(adapter, payload, plen);
1341 		break;
1342 #endif
1343 
1344 	case C2H_DEFEATURE_DBG:
1345 		c2h_defeature_dbg_hdl(adapter, payload, plen);
1346 		break;
1347 
1348 #ifdef CONFIG_RTW_CUSTOMER_STR
1349 	case C2H_CUSTOMER_STR_RPT:
1350 		c2h_customer_str_rpt_hdl(adapter, payload, plen);
1351 		break;
1352 	case C2H_CUSTOMER_STR_RPT_2:
1353 		c2h_customer_str_rpt_2_hdl(adapter, payload, plen);
1354 		break;
1355 #endif
1356 #ifdef RTW_PER_CMD_SUPPORT_FW
1357 	case C2H_PER_RATE_RPT:
1358 		c2h_per_rate_rpt_hdl(adapter, payload, plen);
1359 		break;
1360 #endif
1361 #ifdef CONFIG_LPS_ACK
1362 	case C2H_LPS_STATUS_RPT:
1363 		c2h_lps_status_rpt(adapter, payload, plen);
1364 		break;
1365 #endif
1366 #ifdef CONFIG_FW_OFFLOAD_SET_TXPWR_IDX
1367 	case C2H_SET_TXPWR_FINISH:
1368 		c2h_txpwr_idx_offload_done(adapter, payload, plen);
1369 		break;
1370 #endif
1371 	case C2H_EXTEND:
1372 		sub_id = payload[0];
1373 		/* no handle, goto default */
1374 		fallthrough;
1375 	default:
1376 		if (phydm_c2H_content_parsing(adapter_to_phydm(adapter), id, plen, payload) != TRUE)
1377 			ret = _FAIL;
1378 		break;
1379 	}
1380 
1381 	if (ret != _SUCCESS) {
1382 		if (id == C2H_EXTEND)
1383 			RTW_WARN("%s: unknown C2H(0x%02x, 0x%02x)\n", __func__, id, sub_id);
1384 		else
1385 			RTW_WARN("%s: unknown C2H(0x%02x)\n", __func__, id);
1386 	}
1387 
1388 	return ret;
1389 }
1390 
1391 #ifndef RTW_HALMAC
rtw_hal_c2h_handler(_adapter * adapter,u8 id,u8 seq,u8 plen,u8 * payload)1392 s32 rtw_hal_c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload)
1393 {
1394 	s32 ret = _FAIL;
1395 
1396 	ret = adapter->hal_func.c2h_handler(adapter, id, seq, plen, payload);
1397 	if (ret != _SUCCESS)
1398 		ret = c2h_handler(adapter, id, seq, plen, payload);
1399 
1400 	return ret;
1401 }
1402 
rtw_hal_c2h_id_handle_directly(_adapter * adapter,u8 id,u8 seq,u8 plen,u8 * payload)1403 s32 rtw_hal_c2h_id_handle_directly(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload)
1404 {
1405 	switch (id) {
1406 	case C2H_CCX_TX_RPT:
1407 	case C2H_BT_MP_INFO:
1408 	case C2H_FW_CHNL_SWITCH_COMPLETE:
1409 	case C2H_IQK_FINISH:
1410 	case C2H_MCC:
1411 	case C2H_BCN_EARLY_RPT:
1412 	case C2H_AP_REQ_TXRPT:
1413 	case C2H_SPC_STAT:
1414 	case C2H_SET_TXPWR_FINISH:
1415 		return _TRUE;
1416 	default:
1417 		return _FALSE;
1418 	}
1419 }
1420 #endif /* !RTW_HALMAC */
1421 
1422 #ifdef CONFIG_PROTSEL_MACSLEEP
_rtw_hal_macid_sleep(_adapter * adapter,u8 macid,u8 sleep)1423 static s32 _rtw_hal_macid_sleep(_adapter *adapter, u8 macid, u8 sleep)
1424 {
1425 	struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter);
1426 	u16 reg_sleep_info = macid_ctl->reg_sleep_info;
1427 	u16 reg_sleep_ctrl = macid_ctl->reg_sleep_ctrl;
1428 	const u32 sel_mask_sel = BIT(0) | BIT(1) | BIT(2);
1429 	u8 bit_shift;
1430 	u32 val32;
1431 	s32 ret = _FAIL;
1432 
1433 	if (macid >= macid_ctl->num) {
1434 		RTW_ERR(ADPT_FMT" %s invalid macid(%u)\n"
1435 			, ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" , macid);
1436 		goto exit;
1437 	}
1438 
1439 	if (macid < 32) {
1440 		bit_shift = macid;
1441 	#if (MACID_NUM_SW_LIMIT > 32)
1442 	} else if (macid < 64) {
1443 		bit_shift = macid - 32;
1444 	#endif
1445 	#if (MACID_NUM_SW_LIMIT > 64)
1446 	} else if (macid < 96) {
1447 		bit_shift = macid - 64;
1448 	#endif
1449 	#if (MACID_NUM_SW_LIMIT > 96)
1450 	} else if (macid < 128) {
1451 		bit_shift = macid - 96;
1452 	#endif
1453 	} else {
1454 		rtw_warn_on(1);
1455 		goto exit;
1456 	}
1457 
1458 	if (!reg_sleep_ctrl || !reg_sleep_info) {
1459 		rtw_warn_on(1);
1460 		goto exit;
1461 	}
1462 
1463 	val32 = rtw_read32(adapter, reg_sleep_ctrl);
1464 	val32 = (val32 &~sel_mask_sel) | ((macid / 32) & sel_mask_sel);
1465 	rtw_write32(adapter, reg_sleep_ctrl, val32);
1466 
1467 	val32 = rtw_read32(adapter, reg_sleep_info);
1468 	RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n"
1469 		, ADPT_ARG(adapter), sleep ? "sleep" : "wakeup"
1470 		, macid, reg_sleep_info, val32);
1471 
1472 	ret = _SUCCESS;
1473 
1474 	if (sleep) {
1475 		if (val32 & BIT(bit_shift))
1476 			goto exit;
1477 		val32 |= BIT(bit_shift);
1478 	} else {
1479 		if (!(val32 & BIT(bit_shift)))
1480 			goto exit;
1481 		val32 &= ~BIT(bit_shift);
1482 	}
1483 
1484 	rtw_write32(adapter, reg_sleep_info, val32);
1485 
1486 exit:
1487 	return ret;
1488 }
1489 #else
_rtw_hal_macid_sleep(_adapter * adapter,u8 macid,u8 sleep)1490 static s32 _rtw_hal_macid_sleep(_adapter *adapter, u8 macid, u8 sleep)
1491 {
1492 	struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter);
1493 	u16 reg_sleep;
1494 	u8 bit_shift;
1495 	u32 val32;
1496 	s32 ret = _FAIL;
1497 
1498 	if (macid >= macid_ctl->num) {
1499 		RTW_ERR(ADPT_FMT" %s invalid macid(%u)\n"
1500 			, ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" , macid);
1501 		goto exit;
1502 	}
1503 
1504 	if (macid < 32) {
1505 		reg_sleep = macid_ctl->reg_sleep_m0;
1506 		bit_shift = macid;
1507 	#if (MACID_NUM_SW_LIMIT > 32)
1508 	} else if (macid < 64) {
1509 		reg_sleep = macid_ctl->reg_sleep_m1;
1510 		bit_shift = macid - 32;
1511 	#endif
1512 	#if (MACID_NUM_SW_LIMIT > 64)
1513 	} else if (macid < 96) {
1514 		reg_sleep = macid_ctl->reg_sleep_m2;
1515 		bit_shift = macid - 64;
1516 	#endif
1517 	#if (MACID_NUM_SW_LIMIT > 96)
1518 	} else if (macid < 128) {
1519 		reg_sleep = macid_ctl->reg_sleep_m3;
1520 		bit_shift = macid - 96;
1521 	#endif
1522 	} else {
1523 		rtw_warn_on(1);
1524 		goto exit;
1525 	}
1526 
1527 	if (!reg_sleep) {
1528 		rtw_warn_on(1);
1529 		goto exit;
1530 	}
1531 
1532 	val32 = rtw_read32(adapter, reg_sleep);
1533 	RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n"
1534 		, ADPT_ARG(adapter), sleep ? "sleep" : "wakeup"
1535 		, macid, reg_sleep, val32);
1536 
1537 	ret = _SUCCESS;
1538 
1539 	if (sleep) {
1540 		if (val32 & BIT(bit_shift))
1541 			goto exit;
1542 		val32 |= BIT(bit_shift);
1543 	} else {
1544 		if (!(val32 & BIT(bit_shift)))
1545 			goto exit;
1546 		val32 &= ~BIT(bit_shift);
1547 	}
1548 
1549 	rtw_write32(adapter, reg_sleep, val32);
1550 
1551 exit:
1552 	return ret;
1553 }
1554 #endif
1555 
rtw_hal_macid_sleep(_adapter * adapter,u8 macid)1556 inline s32 rtw_hal_macid_sleep(_adapter *adapter, u8 macid)
1557 {
1558 	return _rtw_hal_macid_sleep(adapter, macid, 1);
1559 }
1560 
rtw_hal_macid_wakeup(_adapter * adapter,u8 macid)1561 inline s32 rtw_hal_macid_wakeup(_adapter *adapter, u8 macid)
1562 {
1563 	return _rtw_hal_macid_sleep(adapter, macid, 0);
1564 }
1565 
1566 #ifdef CONFIG_PROTSEL_MACSLEEP
_rtw_hal_macid_bmp_sleep(_adapter * adapter,struct macid_bmp * bmp,u8 sleep)1567 static s32 _rtw_hal_macid_bmp_sleep(_adapter *adapter, struct macid_bmp *bmp, u8 sleep)
1568 {
1569 	struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter);
1570 	u16 reg_sleep_info = macid_ctl->reg_sleep_info;
1571 	u16 reg_sleep_ctrl = macid_ctl->reg_sleep_ctrl;
1572 	const u32 sel_mask_sel = BIT(0) | BIT(1) | BIT(2);
1573 	u32 m;
1574 	u8 mid = 0;
1575 	u32 val32;
1576 
1577 	do {
1578 		if (mid == 0) {
1579 			m = bmp->m0;
1580 		#if (MACID_NUM_SW_LIMIT > 32)
1581 		} else if (mid == 1) {
1582 			m = bmp->m1;
1583 		#endif
1584 		#if (MACID_NUM_SW_LIMIT > 64)
1585 		} else if (mid == 2) {
1586 			m = bmp->m2;
1587 		#endif
1588 		#if (MACID_NUM_SW_LIMIT > 96)
1589 		} else if (mid == 3) {
1590 			m = bmp->m3;
1591 		#endif
1592 		} else {
1593 			rtw_warn_on(1);
1594 			break;
1595 		}
1596 
1597 		if (m == 0)
1598 			goto move_next;
1599 
1600 		if (!reg_sleep_ctrl || !reg_sleep_info) {
1601 			rtw_warn_on(1);
1602 			break;
1603 		}
1604 
1605 		val32 = rtw_read32(adapter, reg_sleep_ctrl);
1606 		val32 = (val32 &~sel_mask_sel) | (mid & sel_mask_sel);
1607 		rtw_write32(adapter, reg_sleep_ctrl, val32);
1608 
1609 		val32 = rtw_read32(adapter, reg_sleep_info);
1610 		RTW_INFO(ADPT_FMT" %s m%u=0x%08x, ori reg_0x%03x=0x%08x\n"
1611 			, ADPT_ARG(adapter), sleep ? "sleep" : "wakeup"
1612 			, mid, m, reg_sleep_info, val32);
1613 
1614 		if (sleep) {
1615 			if ((val32 & m) == m)
1616 				goto move_next;
1617 			val32 |= m;
1618 		} else {
1619 			if ((val32 & m) == 0)
1620 				goto move_next;
1621 			val32 &= ~m;
1622 		}
1623 
1624 		rtw_write32(adapter, reg_sleep_info, val32);
1625 
1626 move_next:
1627 		mid++;
1628 	} while (mid * 32 < MACID_NUM_SW_LIMIT);
1629 
1630 	return _SUCCESS;
1631 }
1632 #else
_rtw_hal_macid_bmp_sleep(_adapter * adapter,struct macid_bmp * bmp,u8 sleep)1633 static s32 _rtw_hal_macid_bmp_sleep(_adapter *adapter, struct macid_bmp *bmp, u8 sleep)
1634 {
1635 	struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter);
1636 	u16 reg_sleep;
1637 	u32 m;
1638 	u8 mid = 0;
1639 	u32 val32;
1640 
1641 	do {
1642 		if (mid == 0) {
1643 			m = bmp->m0;
1644 			reg_sleep = macid_ctl->reg_sleep_m0;
1645 		#if (MACID_NUM_SW_LIMIT > 32)
1646 		} else if (mid == 1) {
1647 			m = bmp->m1;
1648 			reg_sleep = macid_ctl->reg_sleep_m1;
1649 		#endif
1650 		#if (MACID_NUM_SW_LIMIT > 64)
1651 		} else if (mid == 2) {
1652 			m = bmp->m2;
1653 			reg_sleep = macid_ctl->reg_sleep_m2;
1654 		#endif
1655 		#if (MACID_NUM_SW_LIMIT > 96)
1656 		} else if (mid == 3) {
1657 			m = bmp->m3;
1658 			reg_sleep = macid_ctl->reg_sleep_m3;
1659 		#endif
1660 		} else {
1661 			rtw_warn_on(1);
1662 			break;
1663 		}
1664 
1665 		if (m == 0)
1666 			goto move_next;
1667 
1668 		if (!reg_sleep) {
1669 			rtw_warn_on(1);
1670 			break;
1671 		}
1672 
1673 		val32 = rtw_read32(adapter, reg_sleep);
1674 		RTW_INFO(ADPT_FMT" %s m%u=0x%08x, ori reg_0x%03x=0x%08x\n"
1675 			, ADPT_ARG(adapter), sleep ? "sleep" : "wakeup"
1676 			, mid, m, reg_sleep, val32);
1677 
1678 		if (sleep) {
1679 			if ((val32 & m) == m)
1680 				goto move_next;
1681 			val32 |= m;
1682 		} else {
1683 			if ((val32 & m) == 0)
1684 				goto move_next;
1685 			val32 &= ~m;
1686 		}
1687 
1688 		rtw_write32(adapter, reg_sleep, val32);
1689 
1690 move_next:
1691 		mid++;
1692 	} while (mid * 32 < MACID_NUM_SW_LIMIT);
1693 
1694 	return _SUCCESS;
1695 }
1696 #endif
1697 
rtw_hal_macid_sleep_all_used(_adapter * adapter)1698 inline s32 rtw_hal_macid_sleep_all_used(_adapter *adapter)
1699 {
1700 	struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter);
1701 
1702 	return _rtw_hal_macid_bmp_sleep(adapter, &macid_ctl->used, 1);
1703 }
1704 
rtw_hal_macid_wakeup_all_used(_adapter * adapter)1705 inline s32 rtw_hal_macid_wakeup_all_used(_adapter *adapter)
1706 {
1707 	struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter);
1708 
1709 	return _rtw_hal_macid_bmp_sleep(adapter, &macid_ctl->used, 0);
1710 }
1711 
_rtw_hal_macid_drop(_adapter * adapter,u8 macid,u8 drop)1712 static s32 _rtw_hal_macid_drop(_adapter *adapter, u8 macid, u8 drop)
1713 {
1714 	struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter);
1715 #ifndef CONFIG_PROTSEL_MACSLEEP
1716 	u16 reg_drop = 0;
1717 #else
1718 	u16 reg_drop_info = macid_ctl->reg_drop_info;
1719 	u16 reg_drop_ctrl = macid_ctl->reg_drop_ctrl;
1720 	const u32 sel_mask_sel = BIT(0) | BIT(1) | BIT(2);
1721 #endif /* CONFIG_PROTSEL_MACSLEEP */
1722 	u8 bit_shift;
1723 	u32 val32;
1724 	s32 ret = _FAIL;
1725 /* some IC doesn't have this register */
1726 #ifndef REG_PKT_BUFF_ACCESS_CTRL
1727 #define REG_PKT_BUFF_ACCESS_CTRL 0
1728 #endif
1729 
1730 	if (macid >= macid_ctl->num) {
1731 		RTW_ERR(ADPT_FMT" %s invalid macid(%u)\n"
1732 			, ADPT_ARG(adapter), drop ? "drop" : "undrop" , macid);
1733 		goto exit;
1734 	}
1735 
1736 	if(_rtw_macid_ctl_chk_cap(adapter, MACID_DROP)) {
1737 		if (macid < 32) {
1738 #ifndef CONFIG_PROTSEL_MACSLEEP
1739 			reg_drop = macid_ctl->reg_drop_m0;
1740 #endif /* CONFIG_PROTSEL_MACSLEEP */
1741 			bit_shift = macid;
1742 		#if (MACID_NUM_SW_LIMIT > 32)
1743 		} else if (macid < 64) {
1744 #ifndef CONFIG_PROTSEL_MACSLEEP
1745 			reg_drop = macid_ctl->reg_drop_m1;
1746 #endif /* CONFIG_PROTSEL_MACSLEEP */
1747 			bit_shift = macid - 32;
1748 		#endif
1749 		#if (MACID_NUM_SW_LIMIT > 64)
1750 		} else if (macid < 96) {
1751 #ifndef CONFIG_PROTSEL_MACSLEEP
1752 			reg_drop = macid_ctl->reg_drop_m2;
1753 #endif /* CONFIG_PROTSEL_MACSLEEP */
1754 			bit_shift = macid - 64;
1755 		#endif
1756 		#if (MACID_NUM_SW_LIMIT > 96)
1757 		} else if (macid < 128) {
1758 #ifndef CONFIG_PROTSEL_MACSLEEP
1759 			reg_drop = macid_ctl->reg_drop_m3;
1760 #endif /* CONFIG_PROTSEL_MACSLEEP */
1761 			bit_shift = macid - 96;
1762 		#endif
1763 		} else {
1764 			rtw_warn_on(1);
1765 			goto exit;
1766 		}
1767 
1768 #ifndef CONFIG_PROTSEL_MACSLEEP
1769 		if (!reg_drop) {
1770 			rtw_warn_on(1);
1771 			goto exit;
1772 		}
1773 		val32 = rtw_read32(adapter, reg_drop);
1774 		/*RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x \n"
1775 			, ADPT_ARG(adapter), drop ? "drop" : "undrop"
1776 			, macid, reg_drop, val32);*/
1777 #else
1778 		if (!reg_drop_ctrl || !reg_drop_info) {
1779 			rtw_warn_on(1);
1780 			goto exit;
1781 		}
1782 
1783 		val32 = rtw_read32(adapter, reg_drop_ctrl);
1784 		val32 = (val32 &~sel_mask_sel) | ((macid / 32) & sel_mask_sel);
1785 		rtw_write32(adapter, reg_drop_ctrl, val32);
1786 
1787 		val32 = rtw_read32(adapter, reg_drop_info);
1788 		/*RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n"
1789 			, ADPT_ARG(adapter), drop ? "drop" : "undrop"
1790 			, macid, reg_drop_info, val32);*/
1791 #endif /* CONFIG_PROTSEL_MACSLEEP */
1792 		ret = _SUCCESS;
1793 
1794 		if (drop) {
1795 			if (val32 & BIT(bit_shift))
1796 				goto exit;
1797 			val32 |= BIT(bit_shift);
1798 		} else {
1799 			if (!(val32 & BIT(bit_shift)))
1800 				goto exit;
1801 			val32 &= ~BIT(bit_shift);
1802 		}
1803 
1804 #ifndef CONFIG_PROTSEL_MACSLEEP
1805 		rtw_write32(adapter, reg_drop, val32);
1806 		RTW_INFO(ADPT_FMT" %s macid=%d, done reg_0x%03x=0x%08x\n"
1807 			, ADPT_ARG(adapter), drop ? "drop" : "undrop"
1808 			, macid, reg_drop, val32);
1809 #else
1810 		rtw_write32(adapter, reg_drop_info, val32);
1811 		RTW_INFO(ADPT_FMT" %s macid=%d, done reg_0x%03x=0x%08x\n"
1812 			, ADPT_ARG(adapter), drop ? "drop" : "undrop"
1813 			, macid, reg_drop_info, val32);
1814 #endif /* CONFIG_PROTSEL_MACSLEEP */
1815 
1816 
1817 	} else if(_rtw_macid_ctl_chk_cap(adapter, MACID_DROP_INDIRECT)) {
1818 		u16 start_addr = macid_ctl->macid_txrpt/8;
1819 		u32 txrpt_h4b = 0;
1820 		u8 i;
1821 
1822 		/* each address means 1 byte */
1823 		start_addr += macid*(macid_ctl->macid_txrpt_pgsz/8);
1824 		/* select tx report buffer */
1825 		rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, TXREPORT_BUF_SELECT);
1826 		/* set tx report buffer start address for reading */
1827 		rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, start_addr);
1828 		txrpt_h4b = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H);
1829 		/* OFFSET5 BIT2 is BIT10 of high 4 bytes */
1830 		if (drop) {
1831 			if (txrpt_h4b & BIT(10))
1832 				goto exit;
1833 			txrpt_h4b |= BIT(10);
1834 		} else {
1835 			if (!(txrpt_h4b & BIT(10)))
1836 				goto exit;
1837 			txrpt_h4b &= ~BIT(10);
1838 		}
1839 		/* set to macid drop field */
1840 		rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, txrpt_h4b);
1841 		/* 0x20800000 only write BIT10 of tx report buf */
1842 		rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, 0x20800000 | start_addr);
1843 #if 0 /* some ICs doesn't clear the write done bit */
1844 		/* checking TX queue status */
1845 		for (i = 0 ; i < 50 ; i++) {
1846 			txrpt_h4b = rtw_read32(adapter, REG_PKTBUF_DBG_CTRL);
1847 			if (txrpt_h4b & BIT(23)) {
1848 				RTW_INFO("%s: wait to write TX RTP buf (%d)!\n", __func__, i);
1849 				rtw_mdelay_os(10);
1850 			} else {
1851 				RTW_INFO("%s: wait to write TX RTP buf done (%d)!\n", __func__, i);
1852 				break;
1853 			}
1854 		}
1855 #endif
1856 		rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, start_addr);
1857 		RTW_INFO("start_addr=%x, data_H:%08x, data_L:%08x, macid=%d, txrpt_h4b=%x\n", start_addr
1858 		,rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H), rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L), macid, txrpt_h4b);
1859 	} else {
1860 		RTW_INFO("There is no definition for camctl cap , please correct it\n");
1861 	}
1862 exit:
1863 	return ret;
1864 }
1865 
rtw_hal_macid_drop(_adapter * adapter,u8 macid)1866 inline s32 rtw_hal_macid_drop(_adapter *adapter, u8 macid)
1867 {
1868 	return _rtw_hal_macid_drop(adapter, macid, 1);
1869 }
1870 
rtw_hal_macid_undrop(_adapter * adapter,u8 macid)1871 inline s32 rtw_hal_macid_undrop(_adapter *adapter, u8 macid)
1872 {
1873 	return _rtw_hal_macid_drop(adapter, macid, 0);
1874 }
1875 
rtw_hal_fill_h2c_cmd(PADAPTER padapter,u8 ElementID,u32 CmdLen,u8 * pCmdBuffer)1876 s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer)
1877 {
1878 	_adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter);
1879 
1880 	if (GET_HAL_DATA(pri_adapter)->bFWReady == _TRUE)
1881 		return padapter->hal_func.fill_h2c_cmd(padapter, ElementID, CmdLen, pCmdBuffer);
1882 	else if (padapter->registrypriv.mp_mode == 0)
1883 		RTW_PRINT(FUNC_ADPT_FMT" FW doesn't exit when no MP mode, by pass H2C id:0x%02x\n"
1884 			  , FUNC_ADPT_ARG(padapter), ElementID);
1885 	return _FAIL;
1886 }
1887 
rtw_hal_fill_fake_txdesc(_adapter * padapter,u8 * pDesc,u32 BufferLen,u8 IsPsPoll,u8 IsBTQosNull,u8 bDataFrame)1888 void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen,
1889 			      u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame)
1890 {
1891 	padapter->hal_func.fill_fake_txdesc(padapter, pDesc, BufferLen, IsPsPoll, IsBTQosNull, bDataFrame);
1892 
1893 }
1894 
rtw_hal_get_txbuff_rsvd_page_num(_adapter * adapter,bool wowlan)1895 u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan)
1896 {
1897 	u8 num = 0;
1898 
1899 
1900 	if (adapter->hal_func.hal_get_tx_buff_rsvd_page_num) {
1901 		num = adapter->hal_func.hal_get_tx_buff_rsvd_page_num(adapter, wowlan);
1902 	} else {
1903 #ifdef RTW_HALMAC
1904 		num = GET_HAL_DATA(adapter)->drv_rsvd_page_number;
1905 #endif /* RTW_HALMAC */
1906 	}
1907 
1908 	return num;
1909 }
1910 
1911 #ifdef CONFIG_GPIO_API
rtw_hal_update_hisr_hsisr_ind(_adapter * padapter,u32 flag)1912 void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag)
1913 {
1914 	if (padapter->hal_func.update_hisr_hsisr_ind)
1915 		padapter->hal_func.update_hisr_hsisr_ind(padapter, flag);
1916 }
1917 
rtw_hal_gpio_func_check(_adapter * padapter,u8 gpio_num)1918 int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num)
1919 {
1920 	int ret = _SUCCESS;
1921 
1922 	if (padapter->hal_func.hal_gpio_func_check)
1923 		ret = padapter->hal_func.hal_gpio_func_check(padapter, gpio_num);
1924 
1925 	return ret;
1926 }
1927 
rtw_hal_gpio_multi_func_reset(_adapter * padapter,u8 gpio_num)1928 void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num)
1929 {
1930 	if (padapter->hal_func.hal_gpio_multi_func_reset)
1931 		padapter->hal_func.hal_gpio_multi_func_reset(padapter, gpio_num);
1932 }
1933 #endif
1934 
1935 #ifdef CONFIG_FW_CORRECT_BCN
rtw_hal_fw_correct_bcn(_adapter * padapter)1936 void rtw_hal_fw_correct_bcn(_adapter *padapter)
1937 {
1938 	if (padapter->hal_func.fw_correct_bcn)
1939 		padapter->hal_func.fw_correct_bcn(padapter);
1940 }
1941 #endif
1942 
rtw_hal_set_tx_power_level(_adapter * adapter,u8 channel)1943 void rtw_hal_set_tx_power_level(_adapter *adapter, u8 channel)
1944 {
1945 	HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
1946 
1947 	if (phy_chk_ch_setting_consistency(adapter, channel) != _SUCCESS)
1948 		return;
1949 
1950 	hal_data->set_entire_txpwr = 1;
1951 
1952 	adapter->hal_func.set_tx_power_level_handler(adapter, channel);
1953 	rtw_hal_set_txpwr_done(adapter);
1954 
1955 	hal_data->set_entire_txpwr = 0;
1956 }
1957 
rtw_hal_update_txpwr_level(_adapter * adapter)1958 void rtw_hal_update_txpwr_level(_adapter *adapter)
1959 {
1960 	HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter);
1961 #ifdef CONFIG_ACTIVE_TPC_REPORT
1962 	struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
1963 	int i;
1964 #endif
1965 
1966 	rtw_hal_set_tx_power_level(adapter, hal_data->current_channel);
1967 	rtw_rfctl_update_op_mode(adapter_to_rfctl(adapter), 0, 0);
1968 
1969 #ifdef CONFIG_ACTIVE_TPC_REPORT
1970 	for (i = 0; i < dvobj->iface_nums; i++) {
1971 		struct mlme_priv *mlme;
1972 
1973 		if (!dvobj->padapters[i])
1974 			continue;
1975 		if (!CHK_MLME_STATE(dvobj->padapters[i], WIFI_AP_STATE | WIFI_MESH_STATE)
1976 			|| !MLME_IS_ASOC(dvobj->padapters[i]) || MLME_IS_OPCH_SW(dvobj->padapters[i]))
1977 			continue;
1978 		if (dvobj->padapters[i]->mlmeextpriv.bstart_bss != _TRUE)
1979 			continue;
1980 
1981 		mlme = &(dvobj->padapters[i]->mlmepriv);
1982 		if (MLME_ACTIVE_TPC_REPORT(mlme))
1983 			update_beacon(dvobj->padapters[i], WLAN_EID_TPC_REPORT, NULL, 1, 0);
1984 	}
1985 #endif
1986 }
1987 
rtw_hal_set_txpwr_done(_adapter * adapter)1988 void rtw_hal_set_txpwr_done(_adapter *adapter)
1989 {
1990 	if (adapter->hal_func.set_txpwr_done)
1991 		adapter->hal_func.set_txpwr_done(adapter);
1992 }
1993 
rtw_hal_set_tx_power_index(_adapter * adapter,u32 powerindex,enum rf_path rfpath,u8 rate)1994 void rtw_hal_set_tx_power_index(_adapter *adapter, u32 powerindex
1995 	, enum rf_path rfpath, u8 rate)
1996 {
1997 	adapter->hal_func.set_tx_power_index_handler(adapter, powerindex, rfpath, rate);
1998 }
1999 
rtw_hal_get_tx_power_index(_adapter * adapter,enum rf_path rfpath,RATE_SECTION rs,enum MGN_RATE rate,enum channel_width bw,BAND_TYPE band,u8 cch,u8 opch,struct txpwr_idx_comp * tic)2000 u8 rtw_hal_get_tx_power_index(_adapter *adapter, enum rf_path rfpath
2001 	, RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch, u8 opch
2002 	, struct txpwr_idx_comp *tic)
2003 {
2004 	return adapter->hal_func.get_tx_power_index_handler(adapter, rfpath
2005 		, rs, rate, bw, band, cch, opch, tic);
2006 }
2007 
rtw_hal_get_txpwr_target_extra_bias(_adapter * adapter,enum rf_path rfpath,RATE_SECTION rs,enum MGN_RATE rate,enum channel_width bw,BAND_TYPE band,u8 cch)2008 s8 rtw_hal_get_txpwr_target_extra_bias(_adapter *adapter, enum rf_path rfpath
2009 	, RATE_SECTION rs, enum MGN_RATE rate, enum channel_width bw, BAND_TYPE band, u8 cch)
2010 {
2011 	s8 val = 0;
2012 
2013 	if (adapter->hal_func.get_txpwr_target_extra_bias) {
2014 		val = adapter->hal_func.get_txpwr_target_extra_bias(adapter
2015 				, rfpath, rs, rate, bw, band, cch);
2016 	}
2017 
2018 	return val;
2019 }
2020 
2021 #ifdef RTW_HALMAC
2022 /*
2023  * Description:
2024  *	Initialize MAC registers
2025  *
2026  * Return:
2027  *	_TRUE	success
2028  *	_FALSE	fail
2029  */
rtw_hal_init_mac_register(PADAPTER adapter)2030 u8 rtw_hal_init_mac_register(PADAPTER adapter)
2031 {
2032 	return adapter->hal_func.init_mac_register(adapter);
2033 }
2034 
2035 /*
2036  * Description:
2037  *	Initialize PHY(BB/RF) related functions
2038  *
2039  * Return:
2040  *	_TRUE	success
2041  *	_FALSE	fail
2042  */
rtw_hal_init_phy(PADAPTER adapter)2043 u8 rtw_hal_init_phy(PADAPTER adapter)
2044 {
2045 	return adapter->hal_func.init_phy(adapter);
2046 }
2047 #endif /* RTW_HALMAC */
2048 
2049 #ifdef CONFIG_RFKILL_POLL
rtw_hal_rfkill_poll(_adapter * adapter,u8 * valid)2050 bool rtw_hal_rfkill_poll(_adapter *adapter, u8 *valid)
2051 {
2052 	bool ret;
2053 
2054 	if (adapter->hal_func.hal_radio_onoff_check)
2055 		ret = adapter->hal_func.hal_radio_onoff_check(adapter, valid);
2056 	else {
2057 		*valid = 0;
2058 		ret = _FALSE;
2059 	}
2060 	return ret;
2061 }
2062 #endif
2063 
2064 #define rtw_hal_error_msg(ops_fun)		\
2065 	RTW_PRINT("### %s - Error : Please hook hal_func.%s ###\n", __FUNCTION__, ops_fun)
2066 
rtw_hal_ops_check(_adapter * padapter)2067 u8 rtw_hal_ops_check(_adapter *padapter)
2068 {
2069 	u8 ret = _SUCCESS;
2070 #if 1
2071 	/*** initialize section ***/
2072 	if (NULL == padapter->hal_func.read_chip_version) {
2073 		rtw_hal_error_msg("read_chip_version");
2074 		ret = _FAIL;
2075 	}
2076 	if (NULL == padapter->hal_func.init_default_value) {
2077 		rtw_hal_error_msg("init_default_value");
2078 		ret = _FAIL;
2079 	}
2080 	if (NULL == padapter->hal_func.intf_chip_configure) {
2081 		rtw_hal_error_msg("intf_chip_configure");
2082 		ret = _FAIL;
2083 	}
2084 	if (NULL == padapter->hal_func.read_adapter_info) {
2085 		rtw_hal_error_msg("read_adapter_info");
2086 		ret = _FAIL;
2087 	}
2088 
2089 	if (NULL == padapter->hal_func.hal_power_on) {
2090 		rtw_hal_error_msg("hal_power_on");
2091 		ret = _FAIL;
2092 	}
2093 	if (NULL == padapter->hal_func.hal_power_off) {
2094 		rtw_hal_error_msg("hal_power_off");
2095 		ret = _FAIL;
2096 	}
2097 
2098 	if (NULL == padapter->hal_func.hal_init) {
2099 		rtw_hal_error_msg("hal_init");
2100 		ret = _FAIL;
2101 	}
2102 	if (NULL == padapter->hal_func.hal_deinit) {
2103 		rtw_hal_error_msg("hal_deinit");
2104 		ret = _FAIL;
2105 	}
2106 
2107 	/*** xmit section ***/
2108 	if (NULL == padapter->hal_func.init_xmit_priv) {
2109 		rtw_hal_error_msg("init_xmit_priv");
2110 		ret = _FAIL;
2111 	}
2112 	if (NULL == padapter->hal_func.free_xmit_priv) {
2113 		rtw_hal_error_msg("free_xmit_priv");
2114 		ret = _FAIL;
2115 	}
2116 	if (NULL == padapter->hal_func.hal_xmit) {
2117 		rtw_hal_error_msg("hal_xmit");
2118 		ret = _FAIL;
2119 	}
2120 	if (NULL == padapter->hal_func.mgnt_xmit) {
2121 		rtw_hal_error_msg("mgnt_xmit");
2122 		ret = _FAIL;
2123 	}
2124 #ifdef CONFIG_XMIT_THREAD_MODE
2125 	if (NULL == padapter->hal_func.xmit_thread_handler) {
2126 		rtw_hal_error_msg("xmit_thread_handler");
2127 		ret = _FAIL;
2128 	}
2129 #endif
2130 	if (NULL == padapter->hal_func.hal_xmitframe_enqueue) {
2131 		rtw_hal_error_msg("hal_xmitframe_enqueue");
2132 		ret = _FAIL;
2133 	}
2134 #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
2135 #ifndef CONFIG_SDIO_TX_TASKLET
2136 	if (NULL == padapter->hal_func.run_thread) {
2137 		rtw_hal_error_msg("run_thread");
2138 		ret = _FAIL;
2139 	}
2140 	if (NULL == padapter->hal_func.cancel_thread) {
2141 		rtw_hal_error_msg("cancel_thread");
2142 		ret = _FAIL;
2143 	}
2144 #endif
2145 #endif
2146 
2147 	/*** recv section ***/
2148 	if (NULL == padapter->hal_func.init_recv_priv) {
2149 		rtw_hal_error_msg("init_recv_priv");
2150 		ret = _FAIL;
2151 	}
2152 	if (NULL == padapter->hal_func.free_recv_priv) {
2153 		rtw_hal_error_msg("free_recv_priv");
2154 		ret = _FAIL;
2155 	}
2156 #ifdef CONFIG_RECV_THREAD_MODE
2157 	if (NULL == padapter->hal_func.recv_hdl) {
2158 		rtw_hal_error_msg("recv_hdl");
2159 		ret = _FAIL;
2160 	}
2161 #endif
2162 #if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI)
2163 	if (NULL == padapter->hal_func.inirp_init) {
2164 		rtw_hal_error_msg("inirp_init");
2165 		ret = _FAIL;
2166 	}
2167 	if (NULL == padapter->hal_func.inirp_deinit) {
2168 		rtw_hal_error_msg("inirp_deinit");
2169 		ret = _FAIL;
2170 	}
2171 #endif /* #if defined(CONFIG_USB_HCI) || defined (CONFIG_PCI_HCI) */
2172 
2173 
2174 	/*** interrupt hdl section ***/
2175 #if defined(CONFIG_PCI_HCI)
2176 	if (NULL == padapter->hal_func.irp_reset) {
2177 		rtw_hal_error_msg("irp_reset");
2178 		ret = _FAIL;
2179 	}
2180 #endif/*#if defined(CONFIG_PCI_HCI)*/
2181 #if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT))
2182 	if (NULL == padapter->hal_func.interrupt_handler) {
2183 		rtw_hal_error_msg("interrupt_handler");
2184 		ret = _FAIL;
2185 	}
2186 #endif /*#if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT))*/
2187 
2188 #if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI)
2189 	if (NULL == padapter->hal_func.enable_interrupt) {
2190 		rtw_hal_error_msg("enable_interrupt");
2191 		ret = _FAIL;
2192 	}
2193 	if (NULL == padapter->hal_func.disable_interrupt) {
2194 		rtw_hal_error_msg("disable_interrupt");
2195 		ret = _FAIL;
2196 	}
2197 #endif /* defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */
2198 
2199 
2200 	/*** DM section ***/
2201 	if (NULL == padapter->hal_func.dm_init) {
2202 		rtw_hal_error_msg("dm_init");
2203 		ret = _FAIL;
2204 	}
2205 	if (NULL == padapter->hal_func.dm_deinit) {
2206 		rtw_hal_error_msg("dm_deinit");
2207 		ret = _FAIL;
2208 	}
2209 	if (NULL == padapter->hal_func.hal_dm_watchdog) {
2210 		rtw_hal_error_msg("hal_dm_watchdog");
2211 		ret = _FAIL;
2212 	}
2213 
2214 	/*** xxx section ***/
2215 	if (NULL == padapter->hal_func.set_chnl_bw_handler) {
2216 		rtw_hal_error_msg("set_chnl_bw_handler");
2217 		ret = _FAIL;
2218 	}
2219 
2220 	if (NULL == padapter->hal_func.set_hw_reg_handler) {
2221 		rtw_hal_error_msg("set_hw_reg_handler");
2222 		ret = _FAIL;
2223 	}
2224 	if (NULL == padapter->hal_func.GetHwRegHandler) {
2225 		rtw_hal_error_msg("GetHwRegHandler");
2226 		ret = _FAIL;
2227 	}
2228 	if (NULL == padapter->hal_func.get_hal_def_var_handler) {
2229 		rtw_hal_error_msg("get_hal_def_var_handler");
2230 		ret = _FAIL;
2231 	}
2232 	if (NULL == padapter->hal_func.SetHalDefVarHandler) {
2233 		rtw_hal_error_msg("SetHalDefVarHandler");
2234 		ret = _FAIL;
2235 	}
2236 	if (NULL == padapter->hal_func.GetHalODMVarHandler) {
2237 		rtw_hal_error_msg("GetHalODMVarHandler");
2238 		ret = _FAIL;
2239 	}
2240 	if (NULL == padapter->hal_func.SetHalODMVarHandler) {
2241 		rtw_hal_error_msg("SetHalODMVarHandler");
2242 		ret = _FAIL;
2243 	}
2244 
2245 	if (NULL == padapter->hal_func.SetBeaconRelatedRegistersHandler) {
2246 		rtw_hal_error_msg("SetBeaconRelatedRegistersHandler");
2247 		ret = _FAIL;
2248 	}
2249 
2250 	if (NULL == padapter->hal_func.fill_h2c_cmd) {
2251 		rtw_hal_error_msg("fill_h2c_cmd");
2252 		ret = _FAIL;
2253 	}
2254 
2255 #ifdef RTW_HALMAC
2256 	if (NULL == padapter->hal_func.hal_mac_c2h_handler) {
2257 		rtw_hal_error_msg("hal_mac_c2h_handler");
2258 		ret = _FAIL;
2259 	}
2260 #elif !defined(CONFIG_RTL8188E)
2261 	if (NULL == padapter->hal_func.c2h_handler) {
2262 		rtw_hal_error_msg("c2h_handler");
2263 		ret = _FAIL;
2264 	}
2265 #endif
2266 
2267 #if defined(CONFIG_LPS) || defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)
2268 	if (NULL == padapter->hal_func.fill_fake_txdesc) {
2269 		rtw_hal_error_msg("fill_fake_txdesc");
2270 		ret = _FAIL;
2271 	}
2272 #endif
2273 
2274 #ifndef RTW_HALMAC
2275 	if (NULL == padapter->hal_func.hal_get_tx_buff_rsvd_page_num) {
2276 		rtw_hal_error_msg("hal_get_tx_buff_rsvd_page_num");
2277 		ret = _FAIL;
2278 	}
2279 #endif /* !RTW_HALMAC */
2280 
2281 #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)
2282 #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)
2283 	if (NULL == padapter->hal_func.clear_interrupt) {
2284 		rtw_hal_error_msg("clear_interrupt");
2285 		ret = _FAIL;
2286 	}
2287 #endif
2288 #endif /* CONFIG_WOWLAN */
2289 
2290 	if (NULL == padapter->hal_func.fw_dl) {
2291 		rtw_hal_error_msg("fw_dl");
2292 		ret = _FAIL;
2293 	}
2294 
2295 	#ifdef CONFIG_FW_CORRECT_BCN
2296 	if (IS_HARDWARE_TYPE_8814A(padapter)
2297 	    && NULL == padapter->hal_func.fw_correct_bcn) {
2298 		rtw_hal_error_msg("fw_correct_bcn");
2299 		ret = _FAIL;
2300 	}
2301 	#endif
2302 
2303 	if (!padapter->hal_func.set_tx_power_level_handler) {
2304 		rtw_hal_error_msg("set_tx_power_level_handler");
2305 		ret = _FAIL;
2306 	}
2307 	if (!padapter->hal_func.set_tx_power_index_handler) {
2308 		rtw_hal_error_msg("set_tx_power_index_handler");
2309 		ret = _FAIL;
2310 	}
2311 	if (!padapter->hal_func.get_tx_power_index_handler) {
2312 		rtw_hal_error_msg("get_tx_power_index_handler");
2313 		ret = _FAIL;
2314 	}
2315 
2316 	/*** SReset section ***/
2317 #ifdef DBG_CONFIG_ERROR_DETECT
2318 	if (NULL == padapter->hal_func.sreset_init_value) {
2319 		rtw_hal_error_msg("sreset_init_value");
2320 		ret = _FAIL;
2321 	}
2322 	if (NULL == padapter->hal_func.sreset_reset_value) {
2323 		rtw_hal_error_msg("sreset_reset_value");
2324 		ret = _FAIL;
2325 	}
2326 	if (NULL == padapter->hal_func.silentreset) {
2327 		rtw_hal_error_msg("silentreset");
2328 		ret = _FAIL;
2329 	}
2330 	if (NULL == padapter->hal_func.sreset_xmit_status_check) {
2331 		rtw_hal_error_msg("sreset_xmit_status_check");
2332 		ret = _FAIL;
2333 	}
2334 	if (NULL == padapter->hal_func.sreset_linked_status_check) {
2335 		rtw_hal_error_msg("sreset_linked_status_check");
2336 		ret = _FAIL;
2337 	}
2338 	if (NULL == padapter->hal_func.sreset_get_wifi_status) {
2339 		rtw_hal_error_msg("sreset_get_wifi_status");
2340 		ret = _FAIL;
2341 	}
2342 	if (NULL == padapter->hal_func.sreset_inprogress) {
2343 		rtw_hal_error_msg("sreset_inprogress");
2344 		ret = _FAIL;
2345 	}
2346 #endif  /* #ifdef DBG_CONFIG_ERROR_DETECT */
2347 
2348 #ifdef RTW_HALMAC
2349 	if (NULL == padapter->hal_func.init_mac_register) {
2350 		rtw_hal_error_msg("init_mac_register");
2351 		ret = _FAIL;
2352 	}
2353 	if (NULL == padapter->hal_func.init_phy) {
2354 		rtw_hal_error_msg("init_phy");
2355 		ret = _FAIL;
2356 	}
2357 #endif /* RTW_HALMAC */
2358 
2359 #ifdef CONFIG_RFKILL_POLL
2360 	if (padapter->hal_func.hal_radio_onoff_check == NULL) {
2361 		rtw_hal_error_msg("hal_radio_onoff_check");
2362 		ret = _FAIL;
2363 	}
2364 #endif
2365 #endif
2366 	return  ret;
2367 }
2368