xref: /OK3568_Linux_fs/external/rkwifibt/drivers/rtl8852be/phl/phl_init.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /******************************************************************************
2*4882a593Smuzhiyun  *
3*4882a593Smuzhiyun  * Copyright(c) 2019 Realtek Corporation.
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * This program is free software; you can redistribute it and/or modify it
6*4882a593Smuzhiyun  * under the terms of version 2 of the GNU General Public License as
7*4882a593Smuzhiyun  * published by the Free Software Foundation.
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * This program is distributed in the hope that it will be useful, but WITHOUT
10*4882a593Smuzhiyun  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11*4882a593Smuzhiyun  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12*4882a593Smuzhiyun  * more details.
13*4882a593Smuzhiyun  *
14*4882a593Smuzhiyun  *****************************************************************************/
15*4882a593Smuzhiyun #define _PHL_INIT_C_
16*4882a593Smuzhiyun #include "phl_headers.h"
17*4882a593Smuzhiyun 
_phl_com_init_rssi_stat(struct rtw_phl_com_t * phl_com)18*4882a593Smuzhiyun void _phl_com_init_rssi_stat(struct rtw_phl_com_t *phl_com)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun 	u8 i = 0, j = 0;
21*4882a593Smuzhiyun 	for (i = 0; i < RTW_RSSI_TYPE_MAX; i++) {
22*4882a593Smuzhiyun 		phl_com->rssi_stat.ma_rssi_ele_idx[i] = 0;
23*4882a593Smuzhiyun 		phl_com->rssi_stat.ma_rssi_ele_cnt[i] = 0;
24*4882a593Smuzhiyun 		phl_com->rssi_stat.ma_rssi_ele_sum[i] = 0;
25*4882a593Smuzhiyun 		phl_com->rssi_stat.ma_rssi[i] = 0;
26*4882a593Smuzhiyun 		for (j = 0; j < PHL_RSSI_MAVG_NUM; j++)
27*4882a593Smuzhiyun 			phl_com->rssi_stat.ma_rssi_ele[i][j] = 0;
28*4882a593Smuzhiyun 	}
29*4882a593Smuzhiyun 	_os_spinlock_init(phl_com->drv_priv, &(phl_com->rssi_stat.lock));
30*4882a593Smuzhiyun }
31*4882a593Smuzhiyun 
_phl_com_deinit_rssi_stat(struct rtw_phl_com_t * phl_com)32*4882a593Smuzhiyun void _phl_com_deinit_rssi_stat(struct rtw_phl_com_t *phl_com)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun 	_os_spinlock_free(phl_com->drv_priv, &(phl_com->rssi_stat.lock));
35*4882a593Smuzhiyun }
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun /**
38*4882a593Smuzhiyun  * rtw_phl_init_ppdu_sts_para(...)
39*4882a593Smuzhiyun  * Description:
40*4882a593Smuzhiyun  * 	1. Do not call this api after rx started.
41*4882a593Smuzhiyun  * 	2. PPDU Status per PKT settings
42*4882a593Smuzhiyun  **/
rtw_phl_init_ppdu_sts_para(struct rtw_phl_com_t * phl_com,bool en_psts_per_pkt,bool psts_ampdu,u8 rx_fltr)43*4882a593Smuzhiyun void rtw_phl_init_ppdu_sts_para(struct rtw_phl_com_t *phl_com,
44*4882a593Smuzhiyun 				bool en_psts_per_pkt, bool psts_ampdu,
45*4882a593Smuzhiyun 				u8 rx_fltr)
46*4882a593Smuzhiyun {
47*4882a593Smuzhiyun #ifdef CONFIG_PHL_RX_PSTS_PER_PKT
48*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.en_psts_per_pkt = en_psts_per_pkt;
49*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.psts_ampdu = psts_ampdu;
50*4882a593Smuzhiyun #ifdef RTW_WKARD_DISABLE_PSTS_PER_PKT_DATA
51*4882a593Smuzhiyun 	/* Forced disable PSTS for DATA frame, to avoid unknown performance issue */
52*4882a593Smuzhiyun 	rx_fltr &= (~RTW_PHL_PSTS_FLTR_DATA);
53*4882a593Smuzhiyun #endif
54*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.ppdu_sts_filter = rx_fltr;
55*4882a593Smuzhiyun #else
56*4882a593Smuzhiyun 	return;
57*4882a593Smuzhiyun #endif
58*4882a593Smuzhiyun }
59*4882a593Smuzhiyun 
_phl_com_deinit_ppdu_sts(struct rtw_phl_com_t * phl_com)60*4882a593Smuzhiyun void _phl_com_deinit_ppdu_sts(struct rtw_phl_com_t *phl_com)
61*4882a593Smuzhiyun {
62*4882a593Smuzhiyun #ifdef CONFIG_PHL_RX_PSTS_PER_PKT
63*4882a593Smuzhiyun 	u8 i = 0;
64*4882a593Smuzhiyun 	u8 j = 0;
65*4882a593Smuzhiyun 	for (j = 0; j < HW_BAND_MAX; j++) {
66*4882a593Smuzhiyun 		for (i = 0; i < PHL_MAX_PPDU_CNT; i++) {
67*4882a593Smuzhiyun 			if (phl_com->ppdu_sts_info.sts_ent[j][i].frames.cnt != 0) {
68*4882a593Smuzhiyun 				PHL_INFO("[Error] deinit_ppdu_sts : frame queue is not empty\n");
69*4882a593Smuzhiyun 			}
70*4882a593Smuzhiyun 			pq_deinit(phl_com->drv_priv,
71*4882a593Smuzhiyun 				  &(phl_com->ppdu_sts_info.sts_ent[j][i].frames));
72*4882a593Smuzhiyun 		}
73*4882a593Smuzhiyun 	}
74*4882a593Smuzhiyun #else
75*4882a593Smuzhiyun 	return;
76*4882a593Smuzhiyun #endif
77*4882a593Smuzhiyun }
78*4882a593Smuzhiyun 
_phl_com_init_ppdu_sts(struct rtw_phl_com_t * phl_com)79*4882a593Smuzhiyun void _phl_com_init_ppdu_sts(struct rtw_phl_com_t *phl_com)
80*4882a593Smuzhiyun {
81*4882a593Smuzhiyun #ifdef CONFIG_PHL_RX_PSTS_PER_PKT
82*4882a593Smuzhiyun 	u8 i = 0;
83*4882a593Smuzhiyun #endif
84*4882a593Smuzhiyun 	u8 j = 0;
85*4882a593Smuzhiyun 	for (j = 0; j < HW_BAND_MAX; j++) {
86*4882a593Smuzhiyun 		phl_com->ppdu_sts_info.cur_rx_ppdu_cnt[j] = 0xFF;
87*4882a593Smuzhiyun 	}
88*4882a593Smuzhiyun #ifdef CONFIG_PHL_RX_PSTS_PER_PKT
89*4882a593Smuzhiyun 	/* Default enable when compile flag is set. */
90*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.en_psts_per_pkt = true;
91*4882a593Smuzhiyun 	/**
92*4882a593Smuzhiyun 	 * Filter of buffer pkt for phy status:
93*4882a593Smuzhiyun 	 *	if the correspond bit is set to 1,
94*4882a593Smuzhiyun 	 *	the pkt will be buffer till ppdu sts or next ppdu is processed.
95*4882a593Smuzhiyun 	 **/
96*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.ppdu_sts_filter =
97*4882a593Smuzhiyun 			RTW_PHL_PSTS_FLTR_MGNT | RTW_PHL_PSTS_FLTR_CTRL |
98*4882a593Smuzhiyun 			RTW_PHL_PSTS_FLTR_EXT_RSVD;
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 	/* if set to false, only the first mpdu in ppdu has phy status */
101*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.psts_ampdu = false;
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.en_fake_psts = false;
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	for (j = 0; j < HW_BAND_MAX; j++) {
106*4882a593Smuzhiyun 		for (i = 0; i < PHL_MAX_PPDU_CNT; i++) {
107*4882a593Smuzhiyun 			pq_init(phl_com->drv_priv,
108*4882a593Smuzhiyun 				&(phl_com->ppdu_sts_info.sts_ent[j][i].frames));
109*4882a593Smuzhiyun 		}
110*4882a593Smuzhiyun 	}
111*4882a593Smuzhiyun #endif
112*4882a593Smuzhiyun #ifdef CONFIG_PHY_INFO_NTFY
113*4882a593Smuzhiyun 	phl_com->ppdu_sts_info.msg_aggr_cnt = 0;
114*4882a593Smuzhiyun #endif
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun 
phl_msg_entry(void * priv,struct phl_msg * msg)117*4882a593Smuzhiyun static void phl_msg_entry(void* priv, struct phl_msg *msg)
118*4882a593Smuzhiyun {
119*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)priv;
120*4882a593Smuzhiyun 	u8 mdl_id = MSG_MDL_ID_FIELD(msg->msg_id);
121*4882a593Smuzhiyun 	u16 evt_id = MSG_EVT_ID_FIELD(msg->msg_id);
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun 	PHL_DBG("[PHL]%s, mdl_id(%d)\n", __FUNCTION__, mdl_id);
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun 	/* dispatch received PHY msg here */
126*4882a593Smuzhiyun 	switch(mdl_id) {
127*4882a593Smuzhiyun 		case PHL_MDL_PHY_MGNT:
128*4882a593Smuzhiyun 			phl_msg_hub_phy_mgnt_evt_hdlr(phl_info, evt_id);
129*4882a593Smuzhiyun 			break;
130*4882a593Smuzhiyun 		case PHL_MDL_TX:
131*4882a593Smuzhiyun 			phl_msg_hub_tx_evt_hdlr(phl_info, evt_id, msg->inbuf, msg->inlen);
132*4882a593Smuzhiyun 			break;
133*4882a593Smuzhiyun 		case PHL_MDL_RX:
134*4882a593Smuzhiyun 			phl_msg_hub_rx_evt_hdlr(phl_info, evt_id, msg->inbuf, msg->inlen);
135*4882a593Smuzhiyun 			break;
136*4882a593Smuzhiyun 		case PHL_MDL_BTC:
137*4882a593Smuzhiyun 			rtw_phl_btc_hub_msg_hdl(phl_info, msg);
138*4882a593Smuzhiyun 			break;
139*4882a593Smuzhiyun 		default:
140*4882a593Smuzhiyun 			break;
141*4882a593Smuzhiyun 	}
142*4882a593Smuzhiyun }
143*4882a593Smuzhiyun 
phl_register_msg_entry(struct phl_info_t * phl_info)144*4882a593Smuzhiyun static enum rtw_phl_status phl_register_msg_entry(struct phl_info_t *phl_info)
145*4882a593Smuzhiyun {
146*4882a593Smuzhiyun 	struct phl_msg_receiver ctx;
147*4882a593Smuzhiyun 	void *d = phl_to_drvpriv(phl_info);
148*4882a593Smuzhiyun 	u8 imr[] = {PHL_MDL_PHY_MGNT, PHL_MDL_RX, PHL_MDL_MRC, PHL_MDL_POWER_MGNT
149*4882a593Smuzhiyun 			, PHL_MDL_BTC, PHL_MDL_TX};
150*4882a593Smuzhiyun 	_os_mem_set(d, &ctx, 0, sizeof(struct phl_msg_receiver));
151*4882a593Smuzhiyun 	ctx.incoming_evt_notify = phl_msg_entry;
152*4882a593Smuzhiyun 	ctx.priv = (void*)phl_info;
153*4882a593Smuzhiyun 	if( phl_msg_hub_register_recver((void*)phl_info,
154*4882a593Smuzhiyun 				&ctx, MSG_RECV_PHL) == RTW_PHL_STATUS_SUCCESS) {
155*4882a593Smuzhiyun 		/* PHL layer module should set IMR for receiving
156*4882a593Smuzhiyun 		desired PHY msg  and handle it in phl_phy_evt_entry*/
157*4882a593Smuzhiyun 		phl_msg_hub_update_recver_mask((void*)phl_info, MSG_RECV_PHL,
158*4882a593Smuzhiyun 						imr, sizeof(imr), false);
159*4882a593Smuzhiyun 		return RTW_PHL_STATUS_SUCCESS;
160*4882a593Smuzhiyun 	}
161*4882a593Smuzhiyun 	else
162*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun }
165*4882a593Smuzhiyun 
phl_deregister_msg_entry(struct phl_info_t * phl_info)166*4882a593Smuzhiyun static enum rtw_phl_status phl_deregister_msg_entry(
167*4882a593Smuzhiyun 					struct phl_info_t *phl_info)
168*4882a593Smuzhiyun {
169*4882a593Smuzhiyun 	return phl_msg_hub_deregister_recver((void*)phl_info, MSG_RECV_PHL);
170*4882a593Smuzhiyun }
171*4882a593Smuzhiyun 
phl_fw_init(struct phl_info_t * phl_info)172*4882a593Smuzhiyun static enum rtw_phl_status phl_fw_init(struct phl_info_t *phl_info)
173*4882a593Smuzhiyun {
174*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_RESOURCE;
175*4882a593Smuzhiyun 	struct rtw_phl_com_t *phl_com = phl_info->phl_com;
176*4882a593Smuzhiyun 	struct rtw_fw_info_t *fw_info = &phl_com->fw_info;
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 	FUNCIN_WSTS(phl_status);
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 	fw_info->rom_buff = _os_mem_alloc(phl_to_drvpriv(phl_info), RTW_MAX_FW_SIZE);
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 	if (!fw_info->rom_buff) {
183*4882a593Smuzhiyun 		PHL_ERR("%s : rom buff allocate fail!!\n", __func__);
184*4882a593Smuzhiyun 		goto mem_alloc_fail;
185*4882a593Smuzhiyun 	}
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun 	fw_info->ram_buff = _os_mem_alloc(phl_to_drvpriv(phl_info), RTW_MAX_FW_SIZE);
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 	if (!fw_info->ram_buff) {
190*4882a593Smuzhiyun 		PHL_ERR("%s : ram buff allocate fail!!\n", __func__);
191*4882a593Smuzhiyun 		goto mem_alloc_fail;
192*4882a593Smuzhiyun 	}
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun #ifdef CONFIG_PHL_REUSED_FWDL_BUF
195*4882a593Smuzhiyun 	fw_info->buf = _os_mem_alloc(phl_to_drvpriv(phl_info), RTW_MAX_FW_SIZE);
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun 	/* if allocating failed, fw bin files will be reading every time */
198*4882a593Smuzhiyun 	if (!fw_info->buf)
199*4882a593Smuzhiyun 		PHL_WARN("%s : buf for fw storage allocate fail!!\n", __func__);
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun 	fw_info->wow_buf = _os_mem_alloc(phl_to_drvpriv(phl_info), RTW_MAX_FW_SIZE);
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun 	/* if allocating failed, fw bin files will be reading every time */
204*4882a593Smuzhiyun 	if (!fw_info->wow_buf)
205*4882a593Smuzhiyun 		PHL_WARN("%s : wow buf for wowlan fw storage allocate fail!!\n", __func__);
206*4882a593Smuzhiyun #endif
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	phl_status = RTW_PHL_STATUS_SUCCESS;
209*4882a593Smuzhiyun 
210*4882a593Smuzhiyun 	FUNCOUT_WSTS(phl_status);
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun mem_alloc_fail:
213*4882a593Smuzhiyun 	return phl_status;
214*4882a593Smuzhiyun }
215*4882a593Smuzhiyun 
phl_fw_deinit(struct phl_info_t * phl_info)216*4882a593Smuzhiyun static void phl_fw_deinit(struct phl_info_t *phl_info)
217*4882a593Smuzhiyun {
218*4882a593Smuzhiyun 	struct rtw_fw_info_t *fw_info = &phl_info->phl_com->fw_info;
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun 	if (fw_info->rom_buff)
221*4882a593Smuzhiyun 		_os_mem_free(phl_to_drvpriv(phl_info), fw_info->rom_buff,
222*4882a593Smuzhiyun 			RTW_MAX_FW_SIZE);
223*4882a593Smuzhiyun 	if (fw_info->ram_buff)
224*4882a593Smuzhiyun 		_os_mem_free(phl_to_drvpriv(phl_info), fw_info->ram_buff,
225*4882a593Smuzhiyun 			RTW_MAX_FW_SIZE);
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun #ifdef CONFIG_REUSED_FWDL_BUF
228*4882a593Smuzhiyun 	if (fw_info->buf)
229*4882a593Smuzhiyun 		_os_mem_free(phl_to_drvpriv(phl_info), fw_info->buf,
230*4882a593Smuzhiyun 			RTW_MAX_FW_SIZE);
231*4882a593Smuzhiyun 	if (fw_info->wow_buf)
232*4882a593Smuzhiyun 		_os_mem_free(phl_to_drvpriv(phl_info), fw_info->wow_buf,
233*4882a593Smuzhiyun 			RTW_MAX_FW_SIZE);
234*4882a593Smuzhiyun #endif
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	/* allocate in rtw_hal_ld_fw_symbol */
237*4882a593Smuzhiyun 	if (fw_info->sym_buf)
238*4882a593Smuzhiyun 		_os_mem_free(phl_to_drvpriv(phl_info), fw_info->sym_buf,
239*4882a593Smuzhiyun 			RTW_MAX_FW_SIZE);
240*4882a593Smuzhiyun }
241*4882a593Smuzhiyun static enum rtw_phl_status
phl_register_background_module_entry(struct phl_info_t * phl_info)242*4882a593Smuzhiyun phl_register_background_module_entry(struct phl_info_t *phl_info)
243*4882a593Smuzhiyun {
244*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
245*4882a593Smuzhiyun #ifdef CONFIG_CMD_DISP
246*4882a593Smuzhiyun 	/*
247*4882a593Smuzhiyun 	 * setup struct phl_module_ops & call dispr_register_module
248*4882a593Smuzhiyun 	 * to register background module instance.
249*4882a593Smuzhiyun 	 * call dispr_deregister_module if you need to dynamically
250*4882a593Smuzhiyun 	 * deregister the instance of background module.
251*4882a593Smuzhiyun 	*/
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 	/* 1,2,3 cmd controller section */
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	/* 41 ~ 70 mandatory background module section*/
257*4882a593Smuzhiyun #ifdef CONFIG_PHL_CMD_SER
258*4882a593Smuzhiyun 	phl_status = phl_register_ser_module(phl_info);
259*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
260*4882a593Smuzhiyun 		return phl_status;
261*4882a593Smuzhiyun #endif
262*4882a593Smuzhiyun #ifdef CONFIG_POWER_SAVE
263*4882a593Smuzhiyun 	phl_status = phl_register_ps_module(phl_info);
264*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
265*4882a593Smuzhiyun 		return phl_status;
266*4882a593Smuzhiyun #endif
267*4882a593Smuzhiyun 	/* 70 ~ 127 optional background module section*/
268*4882a593Smuzhiyun #ifdef CONFIG_PHL_CMD_BTC
269*4882a593Smuzhiyun 	phl_status = phl_register_btc_module(phl_info);
270*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
271*4882a593Smuzhiyun 		return phl_status;
272*4882a593Smuzhiyun #endif
273*4882a593Smuzhiyun 	phl_status = phl_register_custom_module(phl_info, HW_BAND_0);
274*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
275*4882a593Smuzhiyun 		return phl_status;
276*4882a593Smuzhiyun 
277*4882a593Smuzhiyun 	phl_status = phl_register_led_module(phl_info);
278*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
279*4882a593Smuzhiyun 		return phl_status;
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	phl_status = phl_register_cmd_general(phl_info);
282*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
283*4882a593Smuzhiyun 		return phl_status;
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun 	/* 10 ~ 40 protocol, wifi role section*/
286*4882a593Smuzhiyun 	phl_status = phl_register_mrc_module(phl_info);
287*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
288*4882a593Smuzhiyun 		return phl_status;
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 	phl_status = phl_snd_cmd_register_module(phl_info);
291*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
292*4882a593Smuzhiyun 		return phl_status;
293*4882a593Smuzhiyun #else
294*4882a593Smuzhiyun 	phl_status = RTW_PHL_STATUS_SUCCESS;
295*4882a593Smuzhiyun #endif
296*4882a593Smuzhiyun 	return phl_status;
297*4882a593Smuzhiyun }
298*4882a593Smuzhiyun 
phl_com_init(void * drv_priv,struct phl_info_t * phl_info,struct rtw_ic_info * ic_info)299*4882a593Smuzhiyun static enum rtw_phl_status phl_com_init(void *drv_priv,
300*4882a593Smuzhiyun 					struct phl_info_t *phl_info,
301*4882a593Smuzhiyun 					struct rtw_ic_info *ic_info)
302*4882a593Smuzhiyun {
303*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	phl_info->phl_com = _os_mem_alloc(drv_priv,
306*4882a593Smuzhiyun 						sizeof(struct rtw_phl_com_t));
307*4882a593Smuzhiyun 	if (phl_info->phl_com == NULL) {
308*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_RESOURCE;
309*4882a593Smuzhiyun 		PHL_ERR("alloc phl_com failed\n");
310*4882a593Smuzhiyun 		goto error_phl_com_mem;
311*4882a593Smuzhiyun 	}
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	phl_info->phl_com->phl_priv = phl_info;
314*4882a593Smuzhiyun 	phl_info->phl_com->drv_priv = drv_priv;
315*4882a593Smuzhiyun 	phl_info->phl_com->hci_type = ic_info->hci_type;
316*4882a593Smuzhiyun 	phl_info->phl_com->edcca_mode = RTW_EDCCA_NORMAL;
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	phl_sw_cap_init(phl_info->phl_com);
319*4882a593Smuzhiyun 
320*4882a593Smuzhiyun 	_os_spinlock_init(drv_priv, &phl_info->phl_com->evt_info.evt_lock);
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	phl_fw_init(phl_info);
323*4882a593Smuzhiyun 	#ifdef CONFIG_PHL_CHANNEL_INFO
324*4882a593Smuzhiyun 	phl_status = phl_chaninfo_init(phl_info);
325*4882a593Smuzhiyun 	if (phl_status)
326*4882a593Smuzhiyun 		goto error_phl_com_mem;
327*4882a593Smuzhiyun 	#endif /* CONFIG_PHL_CHANNEL_INFO */
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 	_phl_com_init_rssi_stat(phl_info->phl_com);
330*4882a593Smuzhiyun 	_phl_com_init_ppdu_sts(phl_info->phl_com);
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 	phl_status = RTW_PHL_STATUS_SUCCESS;
333*4882a593Smuzhiyun 	return phl_status;
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun error_phl_com_mem:
336*4882a593Smuzhiyun 	return phl_status;
337*4882a593Smuzhiyun }
338*4882a593Smuzhiyun 
phl_hci_init(struct phl_info_t * phl_info,struct rtw_ic_info * ic_info)339*4882a593Smuzhiyun static enum rtw_phl_status phl_hci_init(struct phl_info_t *phl_info,
340*4882a593Smuzhiyun 									struct rtw_ic_info *ic_info)
341*4882a593Smuzhiyun {
342*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	phl_info->hci = _os_mem_alloc(phl_to_drvpriv(phl_info),
345*4882a593Smuzhiyun 					sizeof(struct hci_info_t));
346*4882a593Smuzhiyun 	if (phl_info->hci == NULL) {
347*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_RESOURCE;
348*4882a593Smuzhiyun 		goto error_hci_mem;
349*4882a593Smuzhiyun 	}
350*4882a593Smuzhiyun #ifdef CONFIG_USB_HCI
351*4882a593Smuzhiyun 	phl_info->hci->usb_bulkout_size = ic_info->usb_info.usb_bulkout_size;
352*4882a593Smuzhiyun #endif
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	/* init variable of hci_info_t struct */
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	phl_status = RTW_PHL_STATUS_SUCCESS;
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun error_hci_mem:
359*4882a593Smuzhiyun 	return phl_status;
360*4882a593Smuzhiyun }
361*4882a593Smuzhiyun 
phl_com_deinit(struct phl_info_t * phl_info,struct rtw_phl_com_t * phl_com)362*4882a593Smuzhiyun static void phl_com_deinit(struct phl_info_t *phl_info,
363*4882a593Smuzhiyun 				struct rtw_phl_com_t *phl_com)
364*4882a593Smuzhiyun {
365*4882a593Smuzhiyun 	void *drv_priv = phl_to_drvpriv(phl_info);
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	/* deinit variable or stop mechanism. */
368*4882a593Smuzhiyun 	if (phl_com) {
369*4882a593Smuzhiyun 		phl_sw_cap_deinit(phl_info->phl_com);
370*4882a593Smuzhiyun 		_os_spinlock_free(drv_priv, &phl_com->evt_info.evt_lock);
371*4882a593Smuzhiyun 		_phl_com_deinit_rssi_stat(phl_info->phl_com);
372*4882a593Smuzhiyun 		_phl_com_deinit_ppdu_sts(phl_info->phl_com);
373*4882a593Smuzhiyun 		phl_fw_deinit(phl_info);
374*4882a593Smuzhiyun 		#ifdef CONFIG_PHL_CHANNEL_INFO
375*4882a593Smuzhiyun 		phl_chaninfo_deinit(phl_info);
376*4882a593Smuzhiyun 		#endif /* CONFIG_PHL_CHANNEL_INFO */
377*4882a593Smuzhiyun 		_os_mem_free(drv_priv, phl_com, sizeof(struct rtw_phl_com_t));
378*4882a593Smuzhiyun 	}
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun 
phl_hci_deinit(struct phl_info_t * phl_info,struct hci_info_t * hci)381*4882a593Smuzhiyun static void phl_hci_deinit(struct phl_info_t *phl_info, struct hci_info_t *hci)
382*4882a593Smuzhiyun {
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	/* deinit variable or stop mechanism. */
385*4882a593Smuzhiyun 	if (hci)
386*4882a593Smuzhiyun 		_os_mem_free(phl_to_drvpriv(phl_info), hci,
387*4882a593Smuzhiyun 						sizeof(struct hci_info_t));
388*4882a593Smuzhiyun }
389*4882a593Smuzhiyun 
_phl_hci_ops_check(struct phl_info_t * phl_info)390*4882a593Smuzhiyun static enum rtw_phl_status _phl_hci_ops_check(struct phl_info_t *phl_info)
391*4882a593Smuzhiyun {
392*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_SUCCESS;
393*4882a593Smuzhiyun 	struct phl_hci_trx_ops *trx_ops = phl_info->hci_trx_ops;
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun 	if (!trx_ops->hci_trx_init) {
396*4882a593Smuzhiyun 		phl_ops_error_msg("hci_trx_init");
397*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
398*4882a593Smuzhiyun 	}
399*4882a593Smuzhiyun 	if (!trx_ops->hci_trx_deinit) {
400*4882a593Smuzhiyun 		phl_ops_error_msg("hci_trx_deinit");
401*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
402*4882a593Smuzhiyun 	}
403*4882a593Smuzhiyun 	if (!trx_ops->prepare_tx) {
404*4882a593Smuzhiyun 		phl_ops_error_msg("prepare_tx");
405*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
406*4882a593Smuzhiyun 	}
407*4882a593Smuzhiyun 	if (!trx_ops->recycle_rx_buf) {
408*4882a593Smuzhiyun 		phl_ops_error_msg("recycle_rx_buf");
409*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
410*4882a593Smuzhiyun 	}
411*4882a593Smuzhiyun 	if (!trx_ops->tx) {
412*4882a593Smuzhiyun 		phl_ops_error_msg("tx");
413*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
414*4882a593Smuzhiyun 	}
415*4882a593Smuzhiyun 	if (!trx_ops->rx) {
416*4882a593Smuzhiyun 		phl_ops_error_msg("rx");
417*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
418*4882a593Smuzhiyun 	}
419*4882a593Smuzhiyun 	if (!trx_ops->trx_cfg) {
420*4882a593Smuzhiyun 		phl_ops_error_msg("trx_cfg");
421*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
422*4882a593Smuzhiyun 	}
423*4882a593Smuzhiyun 	if (!trx_ops->pltfm_tx) {
424*4882a593Smuzhiyun 		phl_ops_error_msg("pltfm_tx");
425*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
426*4882a593Smuzhiyun 	}
427*4882a593Smuzhiyun 	if (!trx_ops->alloc_h2c_pkt_buf) {
428*4882a593Smuzhiyun 		phl_ops_error_msg("alloc_h2c_pkt_buf");
429*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
430*4882a593Smuzhiyun 	}
431*4882a593Smuzhiyun 	if (!trx_ops->free_h2c_pkt_buf) {
432*4882a593Smuzhiyun 		phl_ops_error_msg("free_h2c_pkt_buf");
433*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
434*4882a593Smuzhiyun 	}
435*4882a593Smuzhiyun 	if (!trx_ops->trx_reset) {
436*4882a593Smuzhiyun 		phl_ops_error_msg("trx_reset");
437*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
438*4882a593Smuzhiyun 	}
439*4882a593Smuzhiyun 	if (!trx_ops->trx_resume) {
440*4882a593Smuzhiyun 		phl_ops_error_msg("trx_resume");
441*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
442*4882a593Smuzhiyun 	}
443*4882a593Smuzhiyun 	if (!trx_ops->req_tx_stop) {
444*4882a593Smuzhiyun 		phl_ops_error_msg("req_tx_stop");
445*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
446*4882a593Smuzhiyun 	}
447*4882a593Smuzhiyun 	if (!trx_ops->req_rx_stop) {
448*4882a593Smuzhiyun 		phl_ops_error_msg("req_rx_stop");
449*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
450*4882a593Smuzhiyun 	}
451*4882a593Smuzhiyun 	if (!trx_ops->is_tx_pause) {
452*4882a593Smuzhiyun 		phl_ops_error_msg("is_tx_pause");
453*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
454*4882a593Smuzhiyun 	}
455*4882a593Smuzhiyun 	if (!trx_ops->is_rx_pause) {
456*4882a593Smuzhiyun 		phl_ops_error_msg("is_rx_pause");
457*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
458*4882a593Smuzhiyun 	}
459*4882a593Smuzhiyun 	if (!trx_ops->get_txbd_buf) {
460*4882a593Smuzhiyun 		phl_ops_error_msg("get_txbd_buf");
461*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
462*4882a593Smuzhiyun 	}
463*4882a593Smuzhiyun 	if (!trx_ops->get_rxbd_buf) {
464*4882a593Smuzhiyun 		phl_ops_error_msg("get_rxbd_buf");
465*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
466*4882a593Smuzhiyun 	}
467*4882a593Smuzhiyun 	if (!trx_ops->recycle_rx_pkt) {
468*4882a593Smuzhiyun 		phl_ops_error_msg("recycle_rx_pkt");
469*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
470*4882a593Smuzhiyun 	}
471*4882a593Smuzhiyun 	if (!trx_ops->register_trx_hdlr) {
472*4882a593Smuzhiyun 		phl_ops_error_msg("register_trx_hdlr");
473*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
474*4882a593Smuzhiyun 	}
475*4882a593Smuzhiyun 	if (!trx_ops->rx_handle_normal) {
476*4882a593Smuzhiyun 		phl_ops_error_msg("rx_handle_normal");
477*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
478*4882a593Smuzhiyun 	}
479*4882a593Smuzhiyun 	if (!trx_ops->tx_watchdog) {
480*4882a593Smuzhiyun 		phl_ops_error_msg("tx_watchdog");
481*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
482*4882a593Smuzhiyun 	}
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun #ifdef CONFIG_PCI_HCI
485*4882a593Smuzhiyun 	if (!trx_ops->recycle_busy_wd) {
486*4882a593Smuzhiyun 		phl_ops_error_msg("recycle_busy_wd");
487*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
488*4882a593Smuzhiyun 	}
489*4882a593Smuzhiyun 	if (!trx_ops->recycle_busy_h2c) {
490*4882a593Smuzhiyun 		phl_ops_error_msg("recycle_busy_h2c");
491*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
492*4882a593Smuzhiyun 	}
493*4882a593Smuzhiyun 	if (!trx_ops->read_hw_rx) {
494*4882a593Smuzhiyun 		phl_ops_error_msg("read_hw_rx");
495*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
496*4882a593Smuzhiyun 	}
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun #endif
499*4882a593Smuzhiyun 
500*4882a593Smuzhiyun #ifdef CONFIG_USB_HCI
501*4882a593Smuzhiyun 	if (!trx_ops->pend_rxbuf) {
502*4882a593Smuzhiyun 		phl_ops_error_msg("pend_rxbuf");
503*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
504*4882a593Smuzhiyun 	}
505*4882a593Smuzhiyun 	if (!trx_ops->recycle_tx_buf) {
506*4882a593Smuzhiyun 		phl_ops_error_msg("recycle_tx_buf");
507*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
508*4882a593Smuzhiyun 	}
509*4882a593Smuzhiyun #endif
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	return status;
512*4882a593Smuzhiyun }
513*4882a593Smuzhiyun 
phl_set_hci_ops(struct phl_info_t * phl_info)514*4882a593Smuzhiyun static enum rtw_phl_status phl_set_hci_ops(struct phl_info_t *phl_info)
515*4882a593Smuzhiyun {
516*4882a593Smuzhiyun 	#ifdef CONFIG_PCI_HCI
517*4882a593Smuzhiyun 	if (phl_get_hci_type(phl_info->phl_com) == RTW_HCI_PCIE)
518*4882a593Smuzhiyun 		phl_hook_trx_ops_pci(phl_info);
519*4882a593Smuzhiyun 	#endif
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	#ifdef CONFIG_USB_HCI
522*4882a593Smuzhiyun 	if (phl_get_hci_type(phl_info->phl_com) == RTW_HCI_USB)
523*4882a593Smuzhiyun 		phl_hook_trx_ops_usb(phl_info);
524*4882a593Smuzhiyun 	#endif
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 	#ifdef CONFIG_SDIO_HCI
527*4882a593Smuzhiyun 	if (phl_get_hci_type(phl_info->phl_com) == RTW_HCI_SDIO)
528*4882a593Smuzhiyun 		phl_hook_trx_ops_sdio(phl_info);
529*4882a593Smuzhiyun 	#endif
530*4882a593Smuzhiyun 
531*4882a593Smuzhiyun 	return _phl_hci_ops_check(phl_info);
532*4882a593Smuzhiyun }
533*4882a593Smuzhiyun 
534*4882a593Smuzhiyun #ifdef CONFIG_FSM
phl_cmd_init(struct phl_info_t * phl_info)535*4882a593Smuzhiyun static enum rtw_phl_status phl_cmd_init(struct phl_info_t *phl_info)
536*4882a593Smuzhiyun {
537*4882a593Smuzhiyun 	if (phl_info->cmd_fsm != NULL)
538*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
539*4882a593Smuzhiyun 
540*4882a593Smuzhiyun 	phl_info->cmd_fsm = phl_cmd_new_fsm(phl_info->fsm_root, phl_info);
541*4882a593Smuzhiyun 	if (phl_info->cmd_fsm == NULL)
542*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
543*4882a593Smuzhiyun 
544*4882a593Smuzhiyun 	if (phl_info->cmd_obj != NULL)
545*4882a593Smuzhiyun 		goto obj_fail;
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	phl_info->cmd_obj = phl_cmd_new_obj(phl_info->cmd_fsm, phl_info);
548*4882a593Smuzhiyun 	if (phl_info->cmd_obj == NULL)
549*4882a593Smuzhiyun 		goto obj_fail;
550*4882a593Smuzhiyun 
551*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun obj_fail:
554*4882a593Smuzhiyun 	phl_fsm_deinit_fsm(phl_info->cmd_fsm);
555*4882a593Smuzhiyun 	phl_info->cmd_fsm = NULL;
556*4882a593Smuzhiyun 	return RTW_PHL_STATUS_FAILURE;
557*4882a593Smuzhiyun }
558*4882a593Smuzhiyun 
phl_cmd_deinit(struct phl_info_t * phl_info)559*4882a593Smuzhiyun static void phl_cmd_deinit(struct phl_info_t *phl_info)
560*4882a593Smuzhiyun {
561*4882a593Smuzhiyun 	phl_cmd_destory_obj(phl_info->cmd_obj);
562*4882a593Smuzhiyun 	phl_info->cmd_obj = NULL;
563*4882a593Smuzhiyun 	phl_cmd_destory_fsm(phl_info->cmd_fsm);
564*4882a593Smuzhiyun 	phl_info->cmd_fsm = NULL;
565*4882a593Smuzhiyun }
566*4882a593Smuzhiyun 
phl_ser_init(struct phl_info_t * phl_info)567*4882a593Smuzhiyun static enum rtw_phl_status phl_ser_init(struct phl_info_t *phl_info)
568*4882a593Smuzhiyun {
569*4882a593Smuzhiyun 	if (phl_info->ser_fsm != NULL)
570*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
571*4882a593Smuzhiyun 
572*4882a593Smuzhiyun 	phl_info->ser_fsm = phl_ser_new_fsm(phl_info->fsm_root, phl_info);
573*4882a593Smuzhiyun 	if (phl_info->ser_fsm == NULL)
574*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	if (phl_info->ser_obj != NULL)
577*4882a593Smuzhiyun 		goto obj_fail;
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	phl_info->ser_obj = phl_ser_new_obj(phl_info->ser_fsm, phl_info);
580*4882a593Smuzhiyun 	if (phl_info->ser_obj == NULL)
581*4882a593Smuzhiyun 		goto obj_fail;
582*4882a593Smuzhiyun 
583*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun obj_fail:
586*4882a593Smuzhiyun 	phl_ser_destory_fsm(phl_info->ser_fsm);
587*4882a593Smuzhiyun 	phl_info->ser_fsm = NULL;
588*4882a593Smuzhiyun 	return RTW_PHL_STATUS_FAILURE;
589*4882a593Smuzhiyun }
590*4882a593Smuzhiyun 
phl_ser_deinit(struct phl_info_t * phl_info)591*4882a593Smuzhiyun static void phl_ser_deinit(struct phl_info_t *phl_info)
592*4882a593Smuzhiyun {
593*4882a593Smuzhiyun 	phl_ser_destory_obj(phl_info->ser_obj);
594*4882a593Smuzhiyun 	phl_info->ser_obj = NULL;
595*4882a593Smuzhiyun 
596*4882a593Smuzhiyun 	phl_ser_destory_fsm(phl_info->ser_fsm);
597*4882a593Smuzhiyun 	phl_info->ser_fsm = NULL;
598*4882a593Smuzhiyun }
599*4882a593Smuzhiyun 
phl_btc_init(struct phl_info_t * phl_info)600*4882a593Smuzhiyun static enum rtw_phl_status phl_btc_init(struct phl_info_t *phl_info)
601*4882a593Smuzhiyun {
602*4882a593Smuzhiyun 	if (phl_info->btc_fsm != NULL)
603*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
604*4882a593Smuzhiyun 
605*4882a593Smuzhiyun 	phl_info->btc_fsm = phl_btc_new_fsm(phl_info->fsm_root, phl_info);
606*4882a593Smuzhiyun 	if (phl_info->btc_fsm == NULL)
607*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
608*4882a593Smuzhiyun 
609*4882a593Smuzhiyun 	phl_info->btc_obj = phl_btc_new_obj(phl_info->btc_fsm, phl_info);
610*4882a593Smuzhiyun 	if (phl_info->btc_obj == NULL)
611*4882a593Smuzhiyun 		goto obj_fail;
612*4882a593Smuzhiyun 
613*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun obj_fail:
616*4882a593Smuzhiyun 	phl_fsm_deinit_fsm(phl_info->btc_fsm);
617*4882a593Smuzhiyun 	phl_info->btc_fsm = NULL;
618*4882a593Smuzhiyun 	return RTW_PHL_STATUS_FAILURE;
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun }
621*4882a593Smuzhiyun 
phl_btc_deinit(struct phl_info_t * phl_info)622*4882a593Smuzhiyun static void phl_btc_deinit(struct phl_info_t *phl_info)
623*4882a593Smuzhiyun {
624*4882a593Smuzhiyun 	phl_btc_destory_obj(phl_info->btc_obj);
625*4882a593Smuzhiyun 	phl_info->btc_obj = NULL;
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 	phl_btc_destory_fsm(phl_info->btc_fsm);
628*4882a593Smuzhiyun 	phl_info->btc_fsm = NULL;
629*4882a593Smuzhiyun }
630*4882a593Smuzhiyun 
phl_scan_init(struct phl_info_t * phl_info)631*4882a593Smuzhiyun static enum rtw_phl_status phl_scan_init(struct phl_info_t *phl_info)
632*4882a593Smuzhiyun {
633*4882a593Smuzhiyun 	if (phl_info->scan_fsm != NULL)
634*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
635*4882a593Smuzhiyun 
636*4882a593Smuzhiyun 	phl_info->scan_fsm = phl_scan_new_fsm(phl_info->fsm_root, phl_info);
637*4882a593Smuzhiyun 	if (phl_info->scan_fsm == NULL)
638*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun 	if (phl_info->scan_obj != NULL)
641*4882a593Smuzhiyun 		goto obj_fail;
642*4882a593Smuzhiyun 
643*4882a593Smuzhiyun 	phl_info->scan_obj = phl_scan_new_obj(phl_info->scan_fsm, phl_info);
644*4882a593Smuzhiyun 	if (phl_info->scan_obj == NULL)
645*4882a593Smuzhiyun 		goto obj_fail;
646*4882a593Smuzhiyun 
647*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun obj_fail:
650*4882a593Smuzhiyun 	phl_fsm_deinit_fsm(phl_info->scan_fsm);
651*4882a593Smuzhiyun 	phl_info->scan_fsm = NULL;
652*4882a593Smuzhiyun 	return RTW_PHL_STATUS_FAILURE;
653*4882a593Smuzhiyun }
654*4882a593Smuzhiyun 
phl_scan_deinit(struct phl_info_t * phl_info)655*4882a593Smuzhiyun static void phl_scan_deinit(struct phl_info_t *phl_info)
656*4882a593Smuzhiyun {
657*4882a593Smuzhiyun 	phl_scan_destory_obj(phl_info->scan_obj);
658*4882a593Smuzhiyun 	phl_info->scan_obj = NULL;
659*4882a593Smuzhiyun 	phl_scan_destory_fsm(phl_info->scan_fsm);
660*4882a593Smuzhiyun 	phl_info->scan_fsm = NULL;
661*4882a593Smuzhiyun }
662*4882a593Smuzhiyun 
phl_sound_init(struct phl_info_t * phl_info)663*4882a593Smuzhiyun static enum rtw_phl_status phl_sound_init(struct phl_info_t *phl_info)
664*4882a593Smuzhiyun {
665*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_SUCCESS;
666*4882a593Smuzhiyun 
667*4882a593Smuzhiyun 	if (phl_info->snd_fsm!= NULL)
668*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
669*4882a593Smuzhiyun 
670*4882a593Smuzhiyun 	phl_info->snd_fsm = phl_sound_new_fsm(phl_info->fsm_root, phl_info);
671*4882a593Smuzhiyun 	if (phl_info->snd_fsm == NULL)
672*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
673*4882a593Smuzhiyun 
674*4882a593Smuzhiyun 	pstatus = phl_snd_new_obj(phl_info->snd_fsm, phl_info);
675*4882a593Smuzhiyun 	if (pstatus != RTW_PHL_STATUS_SUCCESS)
676*4882a593Smuzhiyun 		goto obj_fail;
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 	return pstatus;
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun obj_fail:
681*4882a593Smuzhiyun 	phl_fsm_deinit_fsm(phl_info->snd_fsm);
682*4882a593Smuzhiyun 	phl_info->snd_fsm = NULL;
683*4882a593Smuzhiyun 	return RTW_PHL_STATUS_FAILURE;
684*4882a593Smuzhiyun }
685*4882a593Smuzhiyun 
phl_sound_deinit(struct phl_info_t * phl_info)686*4882a593Smuzhiyun static void phl_sound_deinit(struct phl_info_t *phl_info)
687*4882a593Smuzhiyun {
688*4882a593Smuzhiyun 	phl_snd_destory_obj(phl_info->snd_obj);
689*4882a593Smuzhiyun 	phl_info->snd_obj = NULL;
690*4882a593Smuzhiyun 	phl_snd_destory_fsm(phl_info->snd_fsm);
691*4882a593Smuzhiyun 	phl_info->snd_fsm = NULL;
692*4882a593Smuzhiyun }
693*4882a593Smuzhiyun 
phl_fsm_init(struct phl_info_t * phl_info)694*4882a593Smuzhiyun static enum rtw_phl_status phl_fsm_init(struct phl_info_t *phl_info)
695*4882a593Smuzhiyun {
696*4882a593Smuzhiyun 	if (phl_info->fsm_root != NULL)
697*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
698*4882a593Smuzhiyun 
699*4882a593Smuzhiyun 	/* allocate memory for fsm to do version control */
700*4882a593Smuzhiyun 	phl_info->fsm_root = phl_fsm_init_root(phl_info);
701*4882a593Smuzhiyun 	if (phl_info->fsm_root == NULL)
702*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
703*4882a593Smuzhiyun 
704*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
705*4882a593Smuzhiyun }
706*4882a593Smuzhiyun 
phl_fsm_deinit(struct phl_info_t * phl_info)707*4882a593Smuzhiyun static void phl_fsm_deinit(struct phl_info_t *phl_info)
708*4882a593Smuzhiyun {
709*4882a593Smuzhiyun 	/* free memory for fsm */
710*4882a593Smuzhiyun 	phl_fsm_deinit_root(phl_info->fsm_root);
711*4882a593Smuzhiyun 	phl_info->fsm_root = NULL;
712*4882a593Smuzhiyun }
713*4882a593Smuzhiyun 
phl_fsm_module_init(struct phl_info_t * phl_info)714*4882a593Smuzhiyun static enum rtw_phl_status phl_fsm_module_init(struct phl_info_t *phl_info)
715*4882a593Smuzhiyun {
716*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	phl_status = phl_cmd_init(phl_info);
719*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
720*4882a593Smuzhiyun 		PHL_ERR("phl_cmd_init failed\n");
721*4882a593Smuzhiyun 		goto cmd_fail;
722*4882a593Smuzhiyun 	}
723*4882a593Smuzhiyun 
724*4882a593Smuzhiyun 	phl_status = phl_ser_init(phl_info);
725*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
726*4882a593Smuzhiyun 		PHL_ERR("phl_ser_init failed\n");
727*4882a593Smuzhiyun 		goto ser_fail;
728*4882a593Smuzhiyun 	}
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 	phl_status = phl_btc_init(phl_info);
731*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
732*4882a593Smuzhiyun 		PHL_ERR("phl_btc_init failed\n");
733*4882a593Smuzhiyun 		goto btc_fail;
734*4882a593Smuzhiyun 	}
735*4882a593Smuzhiyun 
736*4882a593Smuzhiyun 	phl_status = phl_scan_init(phl_info);
737*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
738*4882a593Smuzhiyun 		PHL_ERR("phl_scan_init failed\n");
739*4882a593Smuzhiyun 		goto scan_fail;
740*4882a593Smuzhiyun 	}
741*4882a593Smuzhiyun 
742*4882a593Smuzhiyun 	phl_status = phl_sound_init(phl_info);
743*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
744*4882a593Smuzhiyun 		PHL_ERR("phl_sound_init failed\n");
745*4882a593Smuzhiyun 		goto sound_fail;
746*4882a593Smuzhiyun 	}
747*4882a593Smuzhiyun 
748*4882a593Smuzhiyun 	return phl_status;
749*4882a593Smuzhiyun 
750*4882a593Smuzhiyun sound_fail:
751*4882a593Smuzhiyun 	phl_scan_deinit(phl_info);
752*4882a593Smuzhiyun scan_fail:
753*4882a593Smuzhiyun 	phl_btc_deinit(phl_info);
754*4882a593Smuzhiyun btc_fail:
755*4882a593Smuzhiyun 	phl_ser_deinit(phl_info);
756*4882a593Smuzhiyun ser_fail:
757*4882a593Smuzhiyun 	phl_cmd_deinit(phl_info);
758*4882a593Smuzhiyun cmd_fail:
759*4882a593Smuzhiyun 	return phl_status;
760*4882a593Smuzhiyun }
761*4882a593Smuzhiyun 
phl_fsm_module_deinit(struct phl_info_t * phl_info)762*4882a593Smuzhiyun static void phl_fsm_module_deinit(struct phl_info_t *phl_info)
763*4882a593Smuzhiyun {
764*4882a593Smuzhiyun 	phl_sound_deinit(phl_info);
765*4882a593Smuzhiyun 	phl_scan_deinit(phl_info);
766*4882a593Smuzhiyun 	phl_btc_deinit(phl_info);
767*4882a593Smuzhiyun 	phl_ser_deinit(phl_info);
768*4882a593Smuzhiyun 	phl_cmd_deinit(phl_info);
769*4882a593Smuzhiyun }
770*4882a593Smuzhiyun 
phl_fsm_start(struct phl_info_t * phl_info)771*4882a593Smuzhiyun static enum rtw_phl_status phl_fsm_start(struct phl_info_t *phl_info)
772*4882a593Smuzhiyun {
773*4882a593Smuzhiyun 	return phl_fsm_start_root(phl_info->fsm_root);
774*4882a593Smuzhiyun }
775*4882a593Smuzhiyun 
phl_fsm_stop(struct phl_info_t * phl_info)776*4882a593Smuzhiyun static enum rtw_phl_status phl_fsm_stop(struct phl_info_t *phl_info)
777*4882a593Smuzhiyun {
778*4882a593Smuzhiyun 	return phl_fsm_stop_root(phl_info->fsm_root);
779*4882a593Smuzhiyun }
780*4882a593Smuzhiyun 
phl_fsm_module_start(struct phl_info_t * phl_info)781*4882a593Smuzhiyun static enum rtw_phl_status phl_fsm_module_start(struct phl_info_t *phl_info)
782*4882a593Smuzhiyun {
783*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
784*4882a593Smuzhiyun 
785*4882a593Smuzhiyun 	phl_status = phl_fsm_start_fsm(phl_info->ser_fsm);
786*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
787*4882a593Smuzhiyun 		goto ser_fail;
788*4882a593Smuzhiyun 
789*4882a593Smuzhiyun 	phl_status = phl_btc_start(phl_info->btc_obj);
790*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
791*4882a593Smuzhiyun 		goto btc_fail;
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	phl_status = phl_fsm_start_fsm(phl_info->scan_fsm);
794*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
795*4882a593Smuzhiyun 		goto scan_fail;
796*4882a593Smuzhiyun 
797*4882a593Smuzhiyun 	phl_status = phl_cmd_start(phl_info->cmd_obj);
798*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
799*4882a593Smuzhiyun 		goto cmd_fail;
800*4882a593Smuzhiyun 
801*4882a593Smuzhiyun 	phl_status = phl_fsm_start_fsm(phl_info->snd_fsm);
802*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
803*4882a593Smuzhiyun 		goto snd_fail;
804*4882a593Smuzhiyun 
805*4882a593Smuzhiyun 	return phl_status;
806*4882a593Smuzhiyun 
807*4882a593Smuzhiyun snd_fail:
808*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->cmd_fsm);
809*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->scan_fsm);
810*4882a593Smuzhiyun scan_fail:
811*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->btc_fsm);
812*4882a593Smuzhiyun btc_fail:
813*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->ser_fsm);
814*4882a593Smuzhiyun ser_fail:
815*4882a593Smuzhiyun 	phl_fsm_cmd_stop(phl_info);
816*4882a593Smuzhiyun cmd_fail:
817*4882a593Smuzhiyun 	return phl_status;
818*4882a593Smuzhiyun }
819*4882a593Smuzhiyun 
phl_fsm_module_stop(struct phl_info_t * phl_info)820*4882a593Smuzhiyun static enum rtw_phl_status phl_fsm_module_stop(struct phl_info_t *phl_info)
821*4882a593Smuzhiyun {
822*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
823*4882a593Smuzhiyun 
824*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->snd_fsm);
825*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->scan_fsm);
826*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->btc_fsm);
827*4882a593Smuzhiyun 	phl_fsm_stop_fsm(phl_info->ser_fsm);
828*4882a593Smuzhiyun 	phl_fsm_cmd_stop(phl_info);
829*4882a593Smuzhiyun 
830*4882a593Smuzhiyun 	return phl_status;
831*4882a593Smuzhiyun }
832*4882a593Smuzhiyun 
833*4882a593Smuzhiyun #endif /*CONFIG_FSM*/
phl_module_init(struct phl_info_t * phl_info)834*4882a593Smuzhiyun static enum rtw_phl_status phl_module_init(struct phl_info_t *phl_info)
835*4882a593Smuzhiyun {
836*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
837*4882a593Smuzhiyun 
838*4882a593Smuzhiyun 	phl_status = phl_msg_hub_init(phl_info);
839*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
840*4882a593Smuzhiyun 		PHL_ERR("phl_msg_hub_init failed\n");
841*4882a593Smuzhiyun 		goto msg_hub_fail;
842*4882a593Smuzhiyun 	}
843*4882a593Smuzhiyun 
844*4882a593Smuzhiyun 	phl_status = phl_wow_mdl_init(phl_info);
845*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
846*4882a593Smuzhiyun 		PHL_ERR("phl_wow_mdl_init failed\n");
847*4882a593Smuzhiyun 		goto wow_init_fail;
848*4882a593Smuzhiyun 	}
849*4882a593Smuzhiyun 
850*4882a593Smuzhiyun 	phl_status = phl_pkt_ofld_init(phl_info);
851*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
852*4882a593Smuzhiyun 		PHL_ERR("phl_pkt_ofld_init failed\n");
853*4882a593Smuzhiyun 		goto pkt_ofld_init_fail;
854*4882a593Smuzhiyun 	}
855*4882a593Smuzhiyun 
856*4882a593Smuzhiyun 	if (!phl_test_module_init(phl_info)) {
857*4882a593Smuzhiyun 		PHL_ERR("phl_test_module_init failed\n");
858*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_FAILURE;
859*4882a593Smuzhiyun 		goto error_test_module_init;
860*4882a593Smuzhiyun 	}
861*4882a593Smuzhiyun 
862*4882a593Smuzhiyun 	phl_status = phl_p2pps_init(phl_info);
863*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
864*4882a593Smuzhiyun 		PHL_ERR("phl_p2pps_init failed\n");
865*4882a593Smuzhiyun 		goto error_p2pps_init;
866*4882a593Smuzhiyun 	}
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun 	phl_status = phl_disp_eng_init(phl_info, HW_BAND_MAX);
869*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
870*4882a593Smuzhiyun 		PHL_ERR("phl_disp_eng_init failed\n");
871*4882a593Smuzhiyun 		goto error_disp_eng_init;
872*4882a593Smuzhiyun 	}
873*4882a593Smuzhiyun 
874*4882a593Smuzhiyun 	phl_status = phl_register_background_module_entry(phl_info);
875*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
876*4882a593Smuzhiyun 		PHL_ERR("phl_register_disp_eng_module_entry failed\n");
877*4882a593Smuzhiyun 		goto error_disp_eng_reg_init;
878*4882a593Smuzhiyun 	}
879*4882a593Smuzhiyun 
880*4882a593Smuzhiyun 	phl_status = phl_ecsa_ctrl_init(phl_info);
881*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
882*4882a593Smuzhiyun 		PHL_ERR("phl_ecsa_ctrl_init failed\n");
883*4882a593Smuzhiyun 		goto error_ecsa_ctrl_init;
884*4882a593Smuzhiyun 	}
885*4882a593Smuzhiyun 	return phl_status;
886*4882a593Smuzhiyun 
887*4882a593Smuzhiyun error_ecsa_ctrl_init:
888*4882a593Smuzhiyun error_disp_eng_reg_init:
889*4882a593Smuzhiyun 	phl_disp_eng_deinit(phl_info);
890*4882a593Smuzhiyun error_disp_eng_init:
891*4882a593Smuzhiyun 	phl_p2pps_deinit(phl_info);
892*4882a593Smuzhiyun error_p2pps_init:
893*4882a593Smuzhiyun 	phl_test_module_deinit(phl_info->phl_com);
894*4882a593Smuzhiyun error_test_module_init:
895*4882a593Smuzhiyun 	phl_pkt_ofld_deinit(phl_info);
896*4882a593Smuzhiyun pkt_ofld_init_fail:
897*4882a593Smuzhiyun 	phl_wow_mdl_deinit(phl_info);
898*4882a593Smuzhiyun wow_init_fail:
899*4882a593Smuzhiyun 	phl_msg_hub_deinit(phl_info);
900*4882a593Smuzhiyun msg_hub_fail:
901*4882a593Smuzhiyun 	return phl_status;
902*4882a593Smuzhiyun }
903*4882a593Smuzhiyun 
phl_module_deinit(struct phl_info_t * phl_info)904*4882a593Smuzhiyun static void phl_module_deinit(struct phl_info_t *phl_info)
905*4882a593Smuzhiyun {
906*4882a593Smuzhiyun 	phl_ecsa_ctrl_deinit(phl_info);
907*4882a593Smuzhiyun 	phl_disp_eng_deinit(phl_info);
908*4882a593Smuzhiyun 	phl_test_module_deinit(phl_info->phl_com);
909*4882a593Smuzhiyun 	phl_pkt_ofld_deinit(phl_info);
910*4882a593Smuzhiyun 	phl_wow_mdl_deinit(phl_info);
911*4882a593Smuzhiyun 	phl_msg_hub_deinit(phl_info);
912*4882a593Smuzhiyun 	phl_p2pps_deinit(phl_info);
913*4882a593Smuzhiyun }
914*4882a593Smuzhiyun 
phl_module_start(struct phl_info_t * phl_info)915*4882a593Smuzhiyun static enum rtw_phl_status phl_module_start(struct phl_info_t *phl_info)
916*4882a593Smuzhiyun {
917*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	if (!phl_test_module_start(phl_info->phl_com)) {
920*4882a593Smuzhiyun 		PHL_ERR("phl_test_module_start failed\n");
921*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_FAILURE;
922*4882a593Smuzhiyun 		goto error_test_mdl_start;
923*4882a593Smuzhiyun 	}
924*4882a593Smuzhiyun 
925*4882a593Smuzhiyun 	phl_status = phl_disp_eng_start(phl_info);
926*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
927*4882a593Smuzhiyun 		PHL_ERR("phl_disp_eng_start failed\n");
928*4882a593Smuzhiyun 		goto error_disp_eng_start;
929*4882a593Smuzhiyun 	}
930*4882a593Smuzhiyun 
931*4882a593Smuzhiyun 	if(phl_info->msg_hub) {
932*4882a593Smuzhiyun 		phl_msg_hub_start(phl_info);
933*4882a593Smuzhiyun 		phl_register_msg_entry(phl_info);
934*4882a593Smuzhiyun 	}
935*4882a593Smuzhiyun 
936*4882a593Smuzhiyun 	return phl_status;
937*4882a593Smuzhiyun 
938*4882a593Smuzhiyun error_disp_eng_start:
939*4882a593Smuzhiyun 	phl_test_module_stop(phl_info->phl_com);
940*4882a593Smuzhiyun error_test_mdl_start:
941*4882a593Smuzhiyun 	return phl_status;
942*4882a593Smuzhiyun }
943*4882a593Smuzhiyun 
phl_module_stop(struct phl_info_t * phl_info)944*4882a593Smuzhiyun static enum rtw_phl_status phl_module_stop(struct phl_info_t *phl_info)
945*4882a593Smuzhiyun {
946*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
947*4882a593Smuzhiyun 
948*4882a593Smuzhiyun 	phl_status = phl_cmd_enqueue(phl_info, HW_BAND_0, MSG_EVT_MDL_CHECK_STOP,
949*4882a593Smuzhiyun 		NULL, 0, NULL, PHL_CMD_WAIT, 500);
950*4882a593Smuzhiyun 
951*4882a593Smuzhiyun 	phl_disp_eng_stop(phl_info);
952*4882a593Smuzhiyun 	phl_test_module_stop(phl_info->phl_com);
953*4882a593Smuzhiyun 
954*4882a593Smuzhiyun 	if(phl_info->msg_hub) {
955*4882a593Smuzhiyun 		phl_deregister_msg_entry(phl_info);
956*4882a593Smuzhiyun 		phl_msg_hub_stop(phl_info);
957*4882a593Smuzhiyun 	}
958*4882a593Smuzhiyun 
959*4882a593Smuzhiyun 	return phl_status;
960*4882a593Smuzhiyun }
961*4882a593Smuzhiyun 
phl_var_init(struct phl_info_t * phl_info)962*4882a593Smuzhiyun static enum rtw_phl_status phl_var_init(struct phl_info_t *phl_info)
963*4882a593Smuzhiyun {
964*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
965*4882a593Smuzhiyun }
966*4882a593Smuzhiyun 
phl_var_deinit(struct phl_info_t * phl_info)967*4882a593Smuzhiyun static void phl_var_deinit(struct phl_info_t *phl_info)
968*4882a593Smuzhiyun {
969*4882a593Smuzhiyun 
970*4882a593Smuzhiyun }
971*4882a593Smuzhiyun 
rtw_phl_get_com(void * phl)972*4882a593Smuzhiyun struct rtw_phl_com_t *rtw_phl_get_com(void *phl)
973*4882a593Smuzhiyun {
974*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
975*4882a593Smuzhiyun 
976*4882a593Smuzhiyun 	return phl_info->phl_com;
977*4882a593Smuzhiyun }
978*4882a593Smuzhiyun 
phl_regulation_init(void * drv_priv,void * phl)979*4882a593Smuzhiyun static void phl_regulation_init(void *drv_priv, void *phl)
980*4882a593Smuzhiyun {
981*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
982*4882a593Smuzhiyun 	struct rtw_regulation *rg = NULL;
983*4882a593Smuzhiyun 
984*4882a593Smuzhiyun 	if (!drv_priv || !phl)
985*4882a593Smuzhiyun 		return;
986*4882a593Smuzhiyun 
987*4882a593Smuzhiyun 	rg = &phl_info->regulation;
988*4882a593Smuzhiyun 
989*4882a593Smuzhiyun 	_os_spinlock_init(drv_priv, &rg->lock);
990*4882a593Smuzhiyun 	rg->init = 1;
991*4882a593Smuzhiyun 	rg->domain.code = INVALID_DOMAIN_CODE;
992*4882a593Smuzhiyun 	rg->domain_6g.code = INVALID_DOMAIN_CODE;
993*4882a593Smuzhiyun 	rg->tpo = TPO_NA;
994*4882a593Smuzhiyun }
995*4882a593Smuzhiyun 
phl_regulation_deinit(void * drv_priv,void * phl)996*4882a593Smuzhiyun static void phl_regulation_deinit(void *drv_priv, void *phl)
997*4882a593Smuzhiyun {
998*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
999*4882a593Smuzhiyun 	struct rtw_regulation *rg = NULL;
1000*4882a593Smuzhiyun 
1001*4882a593Smuzhiyun 	if (!drv_priv || !phl)
1002*4882a593Smuzhiyun 		return;
1003*4882a593Smuzhiyun 
1004*4882a593Smuzhiyun 	rg = &phl_info->regulation;
1005*4882a593Smuzhiyun 
1006*4882a593Smuzhiyun 	_os_spinlock_free(drv_priv, &rg->lock);
1007*4882a593Smuzhiyun }
1008*4882a593Smuzhiyun 
rtw_phl_init(void * drv_priv,void ** phl,struct rtw_ic_info * ic_info)1009*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_init(void *drv_priv, void **phl,
1010*4882a593Smuzhiyun 					struct rtw_ic_info *ic_info)
1011*4882a593Smuzhiyun {
1012*4882a593Smuzhiyun 	struct phl_info_t *phl_info = NULL;
1013*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
1014*4882a593Smuzhiyun 	enum rtw_hal_status hal_status = RTW_HAL_STATUS_FAILURE;
1015*4882a593Smuzhiyun 
1016*4882a593Smuzhiyun 	FUNCIN();
1017*4882a593Smuzhiyun 	phl_info = _os_mem_alloc(drv_priv, sizeof(struct phl_info_t));
1018*4882a593Smuzhiyun 	if (phl_info == NULL) {
1019*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_RESOURCE;
1020*4882a593Smuzhiyun 		PHL_ERR("alloc phl_info failed\n");
1021*4882a593Smuzhiyun 		goto error_phl_mem;
1022*4882a593Smuzhiyun 	}
1023*4882a593Smuzhiyun 	_os_mem_set(drv_priv, phl_info, 0, sizeof(struct phl_info_t));
1024*4882a593Smuzhiyun 	*phl = phl_info;
1025*4882a593Smuzhiyun 
1026*4882a593Smuzhiyun 	phl_regulation_init(drv_priv, phl_info);
1027*4882a593Smuzhiyun 
1028*4882a593Smuzhiyun 	phl_status = phl_com_init(drv_priv, phl_info, ic_info);
1029*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1030*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_RESOURCE;
1031*4882a593Smuzhiyun 		PHL_ERR("alloc phl_com failed\n");
1032*4882a593Smuzhiyun 		goto error_phl_com_mem;
1033*4882a593Smuzhiyun 	}
1034*4882a593Smuzhiyun 
1035*4882a593Smuzhiyun 	phl_status = phl_hci_init(phl_info, ic_info);
1036*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1037*4882a593Smuzhiyun 		PHL_ERR("phl_hci_init failed\n");
1038*4882a593Smuzhiyun 		goto error_hci_init;
1039*4882a593Smuzhiyun 	}
1040*4882a593Smuzhiyun 
1041*4882a593Smuzhiyun 	phl_status = phl_set_hci_ops(phl_info);
1042*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1043*4882a593Smuzhiyun 		PHL_ERR("phl_set_hci_ops failed\n");
1044*4882a593Smuzhiyun 		goto error_set_hci_ops;
1045*4882a593Smuzhiyun 	}
1046*4882a593Smuzhiyun #ifdef CONFIG_FSM
1047*4882a593Smuzhiyun 	phl_status = phl_fsm_init(phl_info);
1048*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1049*4882a593Smuzhiyun 		PHL_ERR("phl_fsm_init failed\n");
1050*4882a593Smuzhiyun 		goto error_fsm_init;
1051*4882a593Smuzhiyun 	}
1052*4882a593Smuzhiyun 
1053*4882a593Smuzhiyun 	/* init FSM modules */
1054*4882a593Smuzhiyun 	phl_status = phl_fsm_module_init(phl_info);
1055*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1056*4882a593Smuzhiyun 		PHL_ERR("phl_fsm_module_init failed\n");
1057*4882a593Smuzhiyun 		goto error_fsm_module_init;
1058*4882a593Smuzhiyun 	}
1059*4882a593Smuzhiyun #endif
1060*4882a593Smuzhiyun 	phl_status = phl_twt_init(*phl);
1061*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1062*4882a593Smuzhiyun 		PHL_ERR("phl_twt_init failed\n");
1063*4882a593Smuzhiyun 		goto error_phl_twt_init;
1064*4882a593Smuzhiyun 	}
1065*4882a593Smuzhiyun 	hal_status = rtw_hal_init(drv_priv, phl_info->phl_com,
1066*4882a593Smuzhiyun 					&(phl_info->hal), ic_info->ic_id);
1067*4882a593Smuzhiyun 	if ((hal_status != RTW_HAL_STATUS_SUCCESS) || (phl_info->hal == NULL)) {
1068*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1069*4882a593Smuzhiyun 		PHL_ERR("rtw_hal_init failed status(%d),phl_info->hal(%p)\n",
1070*4882a593Smuzhiyun 			hal_status, phl_info->hal);
1071*4882a593Smuzhiyun 		goto error_hal_init;
1072*4882a593Smuzhiyun 	}
1073*4882a593Smuzhiyun 
1074*4882a593Smuzhiyun 	/*send bus info to hal*/
1075*4882a593Smuzhiyun 	rtw_hal_hci_cfg(phl_info->phl_com, phl_info->hal, ic_info);
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun 	/*get hw capability from mac/bb/rf/btc/efuse/fw-defeature-rpt*/
1078*4882a593Smuzhiyun 	hal_status = rtw_hal_read_chip_info(phl_info->phl_com, phl_info->hal);
1079*4882a593Smuzhiyun 	if (hal_status != RTW_HAL_STATUS_SUCCESS) {
1080*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1081*4882a593Smuzhiyun 		PHL_ERR("rtw_hal_read_chip_info failed\n");
1082*4882a593Smuzhiyun 		goto error_hal_read_chip_info;
1083*4882a593Smuzhiyun 	}
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	hal_status = rtw_hal_var_init(phl_info->phl_com, phl_info->hal);
1086*4882a593Smuzhiyun 	if (hal_status != RTW_HAL_STATUS_SUCCESS) {
1087*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1088*4882a593Smuzhiyun 		PHL_ERR("rtw_hal_var_init failed\n");
1089*4882a593Smuzhiyun 		goto error_hal_var_init;
1090*4882a593Smuzhiyun 	}
1091*4882a593Smuzhiyun 
1092*4882a593Smuzhiyun 	phl_status = phl_var_init(phl_info);
1093*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1094*4882a593Smuzhiyun 		PHL_ERR("phl_var_init failed\n");
1095*4882a593Smuzhiyun 		goto error_phl_var_init;
1096*4882a593Smuzhiyun 	}
1097*4882a593Smuzhiyun 
1098*4882a593Smuzhiyun 	/* init mr_ctrl, wifi_role[] */
1099*4882a593Smuzhiyun 	phl_status = phl_mr_ctrl_init(phl_info);
1100*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1101*4882a593Smuzhiyun 		PHL_ERR("phl_mr_ctrl_init failed\n");
1102*4882a593Smuzhiyun 		goto error_wifi_role_ctrl_init;
1103*4882a593Smuzhiyun 	}
1104*4882a593Smuzhiyun 
1105*4882a593Smuzhiyun 	/* init modules */
1106*4882a593Smuzhiyun 	phl_status = phl_module_init(phl_info);
1107*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1108*4882a593Smuzhiyun 		PHL_ERR("phl_module_init failed\n");
1109*4882a593Smuzhiyun 		goto error_module_init;
1110*4882a593Smuzhiyun 	}
1111*4882a593Smuzhiyun 
1112*4882a593Smuzhiyun 	/* init macid_ctrl , stainfo_ctrl*/
1113*4882a593Smuzhiyun 	/* init after get hw cap - macid number*/
1114*4882a593Smuzhiyun 	phl_status = phl_macid_ctrl_init(phl_info);
1115*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1116*4882a593Smuzhiyun 		PHL_ERR("phl_macid_ctrl_init failed\n");
1117*4882a593Smuzhiyun 		goto error_macid_ctrl_init;
1118*4882a593Smuzhiyun 	}
1119*4882a593Smuzhiyun 
1120*4882a593Smuzhiyun 	/*init after hal_init - hal_sta_info*/
1121*4882a593Smuzhiyun 	phl_status = phl_stainfo_ctrl_init(phl_info);
1122*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1123*4882a593Smuzhiyun 		PHL_ERR("phl_stainfo_ctrl_init failed\n");
1124*4882a593Smuzhiyun 		goto error_stainfo_ctrl_init;
1125*4882a593Smuzhiyun 	}
1126*4882a593Smuzhiyun 	FUNCOUT();
1127*4882a593Smuzhiyun 
1128*4882a593Smuzhiyun 	return phl_status;
1129*4882a593Smuzhiyun 
1130*4882a593Smuzhiyun error_stainfo_ctrl_init:
1131*4882a593Smuzhiyun 	phl_macid_ctrl_deinit(phl_info);
1132*4882a593Smuzhiyun error_macid_ctrl_init:
1133*4882a593Smuzhiyun 	phl_module_deinit(phl_info);
1134*4882a593Smuzhiyun error_module_init:
1135*4882a593Smuzhiyun 	phl_mr_ctrl_deinit(phl_info);
1136*4882a593Smuzhiyun error_wifi_role_ctrl_init:
1137*4882a593Smuzhiyun 	phl_var_deinit(phl_info);
1138*4882a593Smuzhiyun error_phl_var_init:
1139*4882a593Smuzhiyun error_hal_var_init:
1140*4882a593Smuzhiyun error_hal_read_chip_info:
1141*4882a593Smuzhiyun 	rtw_hal_deinit(phl_info->phl_com, phl_info->hal);
1142*4882a593Smuzhiyun error_hal_init:
1143*4882a593Smuzhiyun error_phl_twt_init:
1144*4882a593Smuzhiyun 	phl_twt_deinit(phl);
1145*4882a593Smuzhiyun #ifdef CONFIG_FSM
1146*4882a593Smuzhiyun 	phl_fsm_module_deinit(phl_info);
1147*4882a593Smuzhiyun error_fsm_module_init:
1148*4882a593Smuzhiyun 	phl_fsm_deinit(phl_info);
1149*4882a593Smuzhiyun error_fsm_init:
1150*4882a593Smuzhiyun 	/* Do nothing */
1151*4882a593Smuzhiyun #endif
1152*4882a593Smuzhiyun error_set_hci_ops:
1153*4882a593Smuzhiyun 	phl_hci_deinit(phl_info, phl_info->hci);
1154*4882a593Smuzhiyun error_hci_init:
1155*4882a593Smuzhiyun 	phl_com_deinit(phl_info, phl_info->phl_com);
1156*4882a593Smuzhiyun error_phl_com_mem:
1157*4882a593Smuzhiyun 	if (phl_info) {
1158*4882a593Smuzhiyun 		phl_regulation_deinit(drv_priv, phl_info);
1159*4882a593Smuzhiyun 		_os_mem_free(drv_priv, phl_info, sizeof(struct phl_info_t));
1160*4882a593Smuzhiyun 		*phl = phl_info = NULL;
1161*4882a593Smuzhiyun 	}
1162*4882a593Smuzhiyun error_phl_mem:
1163*4882a593Smuzhiyun 	return phl_status;
1164*4882a593Smuzhiyun }
1165*4882a593Smuzhiyun 
rtw_phl_deinit(void * phl)1166*4882a593Smuzhiyun void rtw_phl_deinit(void *phl)
1167*4882a593Smuzhiyun {
1168*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1169*4882a593Smuzhiyun 	void *drv_priv = phl_to_drvpriv(phl_info);
1170*4882a593Smuzhiyun 
1171*4882a593Smuzhiyun 	if (phl_info) {
1172*4882a593Smuzhiyun 		phl_twt_deinit(phl);
1173*4882a593Smuzhiyun 		phl_stainfo_ctrl_deinie(phl_info);
1174*4882a593Smuzhiyun 		phl_macid_ctrl_deinit(phl_info);
1175*4882a593Smuzhiyun 		/*deinit mr_ctrl, wifi_role[]*/
1176*4882a593Smuzhiyun 		phl_module_deinit(phl_info);
1177*4882a593Smuzhiyun 		phl_mr_ctrl_deinit(phl_info);
1178*4882a593Smuzhiyun 		rtw_hal_deinit(phl_info->phl_com, phl_info->hal);
1179*4882a593Smuzhiyun 		phl_var_deinit(phl_info);
1180*4882a593Smuzhiyun 		#ifdef CONFIG_FSM
1181*4882a593Smuzhiyun 		phl_fsm_module_deinit(phl_info);
1182*4882a593Smuzhiyun 		phl_fsm_deinit(phl_info);
1183*4882a593Smuzhiyun 		#endif
1184*4882a593Smuzhiyun 		phl_hci_deinit(phl_info, phl_info->hci);
1185*4882a593Smuzhiyun 		phl_com_deinit(phl_info, phl_info->phl_com);
1186*4882a593Smuzhiyun 		phl_regulation_deinit(drv_priv, phl_info);
1187*4882a593Smuzhiyun 		_os_mem_free(drv_priv, phl_info,
1188*4882a593Smuzhiyun 					sizeof(struct phl_info_t));
1189*4882a593Smuzhiyun 	}
1190*4882a593Smuzhiyun }
1191*4882a593Smuzhiyun 
1192*4882a593Smuzhiyun enum rtw_phl_status
rtw_phl_trx_alloc(void * phl)1193*4882a593Smuzhiyun rtw_phl_trx_alloc(void *phl)
1194*4882a593Smuzhiyun {
1195*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1196*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
1197*4882a593Smuzhiyun 
1198*4882a593Smuzhiyun 	phl_status = phl_datapath_init(phl_info);
1199*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1200*4882a593Smuzhiyun 		PHL_ERR("phl_datapath_init failed\n");
1201*4882a593Smuzhiyun 		goto error_datapath;
1202*4882a593Smuzhiyun 	}
1203*4882a593Smuzhiyun 
1204*4882a593Smuzhiyun 	phl_status = phl_trx_test_init(phl);
1205*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS) {
1206*4882a593Smuzhiyun 		PHL_ERR("phl_trx_test_init failed\n");
1207*4882a593Smuzhiyun 		goto error_trx_test;
1208*4882a593Smuzhiyun 	}
1209*4882a593Smuzhiyun 
1210*4882a593Smuzhiyun 	return phl_status;
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun error_trx_test:
1213*4882a593Smuzhiyun 	phl_datapath_deinit(phl_info);
1214*4882a593Smuzhiyun error_datapath:
1215*4882a593Smuzhiyun 	return phl_status;
1216*4882a593Smuzhiyun }
1217*4882a593Smuzhiyun 
1218*4882a593Smuzhiyun void
rtw_phl_trx_free_handler(void * phl)1219*4882a593Smuzhiyun rtw_phl_trx_free_handler(void *phl)
1220*4882a593Smuzhiyun {
1221*4882a593Smuzhiyun 	phl_trx_free_handler(phl);
1222*4882a593Smuzhiyun }
1223*4882a593Smuzhiyun 
1224*4882a593Smuzhiyun void
rtw_phl_trx_free_sw_rsc(void * phl)1225*4882a593Smuzhiyun rtw_phl_trx_free_sw_rsc(void *phl)
1226*4882a593Smuzhiyun {
1227*4882a593Smuzhiyun 	phl_trx_free_sw_rsc(phl);
1228*4882a593Smuzhiyun 	phl_trx_test_deinit(phl);
1229*4882a593Smuzhiyun }
1230*4882a593Smuzhiyun 
1231*4882a593Smuzhiyun void
rtw_phl_trx_free(void * phl)1232*4882a593Smuzhiyun rtw_phl_trx_free(void *phl)
1233*4882a593Smuzhiyun {
1234*4882a593Smuzhiyun 	rtw_phl_trx_free_handler(phl);
1235*4882a593Smuzhiyun 	rtw_phl_trx_free_sw_rsc(phl);
1236*4882a593Smuzhiyun }
1237*4882a593Smuzhiyun 
1238*4882a593Smuzhiyun 
rtw_phl_is_init_completed(void * phl)1239*4882a593Smuzhiyun bool rtw_phl_is_init_completed(void *phl)
1240*4882a593Smuzhiyun {
1241*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1242*4882a593Smuzhiyun 
1243*4882a593Smuzhiyun 	return rtw_hal_is_inited(phl_info->phl_com, phl_info->hal);
1244*4882a593Smuzhiyun }
1245*4882a593Smuzhiyun 
1246*4882a593Smuzhiyun #ifdef RTW_PHL_BCN
1247*4882a593Smuzhiyun 
1248*4882a593Smuzhiyun enum rtw_phl_status
phl_add_beacon(struct phl_info_t * phl_info,struct rtw_bcn_info_cmn * bcn_cmn)1249*4882a593Smuzhiyun phl_add_beacon(struct phl_info_t *phl_info, struct rtw_bcn_info_cmn *bcn_cmn)
1250*4882a593Smuzhiyun {
1251*4882a593Smuzhiyun 	struct rtw_phl_com_t *phl_com = phl_info->phl_com;
1252*4882a593Smuzhiyun 	void *hal = phl_info->hal;
1253*4882a593Smuzhiyun 
1254*4882a593Smuzhiyun 	if(rtw_hal_add_beacon(phl_com, hal, bcn_cmn) == RTW_HAL_STATUS_SUCCESS)
1255*4882a593Smuzhiyun 		return RTW_PHL_STATUS_SUCCESS;
1256*4882a593Smuzhiyun 	else
1257*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
1258*4882a593Smuzhiyun }
1259*4882a593Smuzhiyun 
phl_update_beacon(struct phl_info_t * phl_info,u8 bcn_id)1260*4882a593Smuzhiyun enum rtw_phl_status phl_update_beacon(struct phl_info_t *phl_info, u8 bcn_id)
1261*4882a593Smuzhiyun {
1262*4882a593Smuzhiyun 	struct rtw_phl_com_t *phl_com = phl_info->phl_com;
1263*4882a593Smuzhiyun 	void *hal = phl_info->hal;
1264*4882a593Smuzhiyun 
1265*4882a593Smuzhiyun 	if(rtw_hal_update_beacon(phl_com, hal, bcn_id) == RTW_HAL_STATUS_SUCCESS)
1266*4882a593Smuzhiyun 		return RTW_PHL_STATUS_SUCCESS;
1267*4882a593Smuzhiyun 	else
1268*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
1269*4882a593Smuzhiyun }
1270*4882a593Smuzhiyun 
rtw_phl_free_bcn_entry(void * phl,struct rtw_wifi_role_t * wrole)1271*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_free_bcn_entry(void *phl, struct rtw_wifi_role_t *wrole)
1272*4882a593Smuzhiyun {
1273*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1274*4882a593Smuzhiyun 	struct rtw_phl_com_t *phl_com = phl_info->phl_com;
1275*4882a593Smuzhiyun 	struct rtw_bcn_info_cmn *bcn_cmn = &wrole->bcn_cmn;
1276*4882a593Smuzhiyun 	void *hal = phl_info->hal;
1277*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
1278*4882a593Smuzhiyun 
1279*4882a593Smuzhiyun 	if (bcn_cmn->bcn_added == 1) {
1280*4882a593Smuzhiyun 		if (rtw_hal_free_beacon(phl_com, hal, bcn_cmn->bcn_id) == RTW_HAL_STATUS_SUCCESS) {
1281*4882a593Smuzhiyun 			bcn_cmn->bcn_added = 0;
1282*4882a593Smuzhiyun 			phl_status = RTW_PHL_STATUS_SUCCESS;
1283*4882a593Smuzhiyun 		} else {
1284*4882a593Smuzhiyun 			phl_status = RTW_PHL_STATUS_FAILURE;
1285*4882a593Smuzhiyun 		}
1286*4882a593Smuzhiyun 	}
1287*4882a593Smuzhiyun 
1288*4882a593Smuzhiyun 	return phl_status;
1289*4882a593Smuzhiyun }
1290*4882a593Smuzhiyun 
1291*4882a593Smuzhiyun enum rtw_phl_status
phl_beacon_stop(struct phl_info_t * phl_info,struct rtw_wifi_role_t * wrole,u8 stop)1292*4882a593Smuzhiyun phl_beacon_stop(struct phl_info_t *phl_info, struct rtw_wifi_role_t *wrole, u8 stop)
1293*4882a593Smuzhiyun {
1294*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_SUCCESS;
1295*4882a593Smuzhiyun 	enum rtw_hal_status hstatus = RTW_HAL_STATUS_SUCCESS;
1296*4882a593Smuzhiyun 
1297*4882a593Smuzhiyun 	hstatus = rtw_hal_beacon_stop(phl_info->hal, wrole, stop);
1298*4882a593Smuzhiyun 	if (hstatus != RTW_HAL_STATUS_SUCCESS)
1299*4882a593Smuzhiyun 		pstatus = RTW_PHL_STATUS_FAILURE;
1300*4882a593Smuzhiyun 
1301*4882a593Smuzhiyun 	return pstatus;
1302*4882a593Smuzhiyun }
1303*4882a593Smuzhiyun 
1304*4882a593Smuzhiyun enum rtw_phl_status
phl_issue_beacon(struct phl_info_t * phl_info,struct rtw_bcn_info_cmn * bcn_cmn)1305*4882a593Smuzhiyun phl_issue_beacon(struct phl_info_t *phl_info, struct rtw_bcn_info_cmn *bcn_cmn)
1306*4882a593Smuzhiyun {
1307*4882a593Smuzhiyun 	struct rtw_phl_com_t *phl_com = phl_info->phl_com;
1308*4882a593Smuzhiyun 	struct rtw_bcn_info_cmn *wrole_bcn_cmn;
1309*4882a593Smuzhiyun 	struct rtw_wifi_role_t *wifi_role;
1310*4882a593Smuzhiyun 	void *drv = phl_com->drv_priv;
1311*4882a593Smuzhiyun 	u8 bcn_id, role_idx, bcn_added;
1312*4882a593Smuzhiyun 
1313*4882a593Smuzhiyun 	role_idx = bcn_cmn->role_idx;
1314*4882a593Smuzhiyun 	if (role_idx > MAX_WIFI_ROLE_NUMBER) {
1315*4882a593Smuzhiyun 		PHL_ERR("%s: role idx err(%d)\n", __func__, role_idx);
1316*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
1317*4882a593Smuzhiyun 	}
1318*4882a593Smuzhiyun 
1319*4882a593Smuzhiyun 	wifi_role = &phl_com->wifi_roles[role_idx];
1320*4882a593Smuzhiyun 	wrole_bcn_cmn = &wifi_role->bcn_cmn;
1321*4882a593Smuzhiyun 	bcn_added = wrole_bcn_cmn->bcn_added;
1322*4882a593Smuzhiyun 	_os_mem_cpy(drv, wrole_bcn_cmn, bcn_cmn, sizeof(struct rtw_bcn_info_cmn));
1323*4882a593Smuzhiyun 
1324*4882a593Smuzhiyun 	/* BCN add */
1325*4882a593Smuzhiyun 	if (!bcn_added) {
1326*4882a593Smuzhiyun 		if(phl_add_beacon(phl_info, wrole_bcn_cmn) == RTW_PHL_STATUS_SUCCESS) {
1327*4882a593Smuzhiyun 			wrole_bcn_cmn->bcn_added = true;
1328*4882a593Smuzhiyun 			return RTW_PHL_STATUS_SUCCESS;
1329*4882a593Smuzhiyun 		} else {
1330*4882a593Smuzhiyun 			return RTW_PHL_STATUS_FAILURE;
1331*4882a593Smuzhiyun 		}
1332*4882a593Smuzhiyun 	} else {
1333*4882a593Smuzhiyun 		/* BCN update */
1334*4882a593Smuzhiyun 		bcn_id = wrole_bcn_cmn->bcn_id;
1335*4882a593Smuzhiyun 		if(phl_update_beacon(phl_info, bcn_id) == RTW_PHL_STATUS_SUCCESS)
1336*4882a593Smuzhiyun 			return RTW_PHL_STATUS_SUCCESS;
1337*4882a593Smuzhiyun 		else
1338*4882a593Smuzhiyun 			return RTW_PHL_STATUS_FAILURE;
1339*4882a593Smuzhiyun 	}
1340*4882a593Smuzhiyun }
1341*4882a593Smuzhiyun #ifdef CONFIG_CMD_DISP
1342*4882a593Smuzhiyun enum rtw_phl_status
phl_cmd_issue_bcn_hdl(struct phl_info_t * phl_info,u8 * param)1343*4882a593Smuzhiyun phl_cmd_issue_bcn_hdl(struct phl_info_t *phl_info, u8 *param)
1344*4882a593Smuzhiyun {
1345*4882a593Smuzhiyun 	struct rtw_bcn_info_cmn *bcn_cmn = (struct rtw_bcn_info_cmn *)param;
1346*4882a593Smuzhiyun 
1347*4882a593Smuzhiyun 	return phl_issue_beacon(phl_info, bcn_cmn);
1348*4882a593Smuzhiyun }
1349*4882a593Smuzhiyun 
_phl_issue_bcn_done(void * drv_priv,u8 * buf,u32 buf_len,enum rtw_phl_status status)1350*4882a593Smuzhiyun static void _phl_issue_bcn_done(void *drv_priv, u8 *buf, u32 buf_len,
1351*4882a593Smuzhiyun 						enum rtw_phl_status status)
1352*4882a593Smuzhiyun {
1353*4882a593Smuzhiyun 	if (buf) {
1354*4882a593Smuzhiyun 		_os_kmem_free(drv_priv, buf, buf_len);
1355*4882a593Smuzhiyun 		buf = NULL;
1356*4882a593Smuzhiyun 		PHL_INFO("%s.....\n", __func__);
1357*4882a593Smuzhiyun 	}
1358*4882a593Smuzhiyun }
1359*4882a593Smuzhiyun 
1360*4882a593Smuzhiyun enum rtw_phl_status
rtw_phl_cmd_issue_beacon(void * phl,struct rtw_wifi_role_t * wifi_role,struct rtw_bcn_info_cmn * bcn_cmn,enum phl_cmd_type cmd_type,u32 cmd_timeout)1361*4882a593Smuzhiyun rtw_phl_cmd_issue_beacon(void *phl,
1362*4882a593Smuzhiyun                          struct rtw_wifi_role_t *wifi_role,
1363*4882a593Smuzhiyun                          struct rtw_bcn_info_cmn *bcn_cmn,
1364*4882a593Smuzhiyun                          enum phl_cmd_type cmd_type,
1365*4882a593Smuzhiyun                          u32 cmd_timeout)
1366*4882a593Smuzhiyun {
1367*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1368*4882a593Smuzhiyun 	void *drv = wifi_role->phl_com->drv_priv;
1369*4882a593Smuzhiyun 	enum rtw_phl_status psts = RTW_PHL_STATUS_FAILURE;
1370*4882a593Smuzhiyun 	struct rtw_bcn_info_cmn *param = NULL;
1371*4882a593Smuzhiyun 	u32 param_len;
1372*4882a593Smuzhiyun 
1373*4882a593Smuzhiyun 	if (cmd_type == PHL_CMD_DIRECTLY) {
1374*4882a593Smuzhiyun 		psts = phl_issue_beacon(phl_info, bcn_cmn);
1375*4882a593Smuzhiyun 		goto _exit;
1376*4882a593Smuzhiyun 	}
1377*4882a593Smuzhiyun 
1378*4882a593Smuzhiyun 	param_len = sizeof(struct rtw_bcn_info_cmn);
1379*4882a593Smuzhiyun 	param = _os_kmem_alloc(drv, param_len);
1380*4882a593Smuzhiyun 	if (param == NULL) {
1381*4882a593Smuzhiyun 		PHL_ERR("%s: alloc param failed!\n", __func__);
1382*4882a593Smuzhiyun 		goto _exit;
1383*4882a593Smuzhiyun 	}
1384*4882a593Smuzhiyun 
1385*4882a593Smuzhiyun 	_os_mem_cpy(drv, param, bcn_cmn, param_len);
1386*4882a593Smuzhiyun 
1387*4882a593Smuzhiyun 	psts = phl_cmd_enqueue(phl_info,
1388*4882a593Smuzhiyun 			wifi_role->hw_band,
1389*4882a593Smuzhiyun 			MSG_EVT_ISSUE_BCN,
1390*4882a593Smuzhiyun 			(u8 *)param, param_len,
1391*4882a593Smuzhiyun 			_phl_issue_bcn_done,
1392*4882a593Smuzhiyun 			cmd_type, cmd_timeout);
1393*4882a593Smuzhiyun 
1394*4882a593Smuzhiyun 	if (is_cmd_failure(psts)) {
1395*4882a593Smuzhiyun 		/* Send cmd success, but wait cmd fail*/
1396*4882a593Smuzhiyun 		psts = RTW_PHL_STATUS_FAILURE;
1397*4882a593Smuzhiyun 	} else if (psts != RTW_PHL_STATUS_SUCCESS) {
1398*4882a593Smuzhiyun 		/* Send cmd fail */
1399*4882a593Smuzhiyun 		_os_kmem_free(phl_to_drvpriv(phl_info), param, param_len);
1400*4882a593Smuzhiyun 		psts = RTW_PHL_STATUS_FAILURE;
1401*4882a593Smuzhiyun 	}
1402*4882a593Smuzhiyun 
1403*4882a593Smuzhiyun _exit:
1404*4882a593Smuzhiyun 	return psts;
1405*4882a593Smuzhiyun }
1406*4882a593Smuzhiyun 
1407*4882a593Smuzhiyun struct stop_bcn_param {
1408*4882a593Smuzhiyun 	struct rtw_wifi_role_t *wrole;
1409*4882a593Smuzhiyun 	u8 stop;
1410*4882a593Smuzhiyun };
1411*4882a593Smuzhiyun 
1412*4882a593Smuzhiyun enum rtw_phl_status
phl_cmd_stop_bcn_hdl(struct phl_info_t * phl_info,u8 * param)1413*4882a593Smuzhiyun phl_cmd_stop_bcn_hdl(struct phl_info_t *phl_info, u8 *param)
1414*4882a593Smuzhiyun {
1415*4882a593Smuzhiyun 	struct stop_bcn_param *bcn_param = (struct stop_bcn_param *)param;
1416*4882a593Smuzhiyun 
1417*4882a593Smuzhiyun 	return phl_beacon_stop(phl_info, bcn_param->wrole, bcn_param->stop);
1418*4882a593Smuzhiyun }
1419*4882a593Smuzhiyun 
1420*4882a593Smuzhiyun 
_phl_stop_bcn_done(void * drv_priv,u8 * buf,u32 buf_len,enum rtw_phl_status status)1421*4882a593Smuzhiyun static void _phl_stop_bcn_done(void *drv_priv, u8 *buf, u32 buf_len,
1422*4882a593Smuzhiyun 						enum rtw_phl_status status)
1423*4882a593Smuzhiyun {
1424*4882a593Smuzhiyun 	if (buf) {
1425*4882a593Smuzhiyun 		_os_kmem_free(drv_priv, buf, buf_len);
1426*4882a593Smuzhiyun 		buf = NULL;
1427*4882a593Smuzhiyun 		PHL_INFO("%s.....\n", __func__);
1428*4882a593Smuzhiyun 	}
1429*4882a593Smuzhiyun }
1430*4882a593Smuzhiyun 
1431*4882a593Smuzhiyun 
1432*4882a593Smuzhiyun enum rtw_phl_status
rtw_phl_cmd_stop_beacon(void * phl,struct rtw_wifi_role_t * wifi_role,u8 stop,enum phl_cmd_type cmd_type,u32 cmd_timeout)1433*4882a593Smuzhiyun rtw_phl_cmd_stop_beacon(void *phl,
1434*4882a593Smuzhiyun                         struct rtw_wifi_role_t *wifi_role,
1435*4882a593Smuzhiyun                         u8 stop,
1436*4882a593Smuzhiyun                         enum phl_cmd_type cmd_type,
1437*4882a593Smuzhiyun                         u32 cmd_timeout)
1438*4882a593Smuzhiyun {
1439*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1440*4882a593Smuzhiyun 	void *drv = wifi_role->phl_com->drv_priv;
1441*4882a593Smuzhiyun 	enum rtw_phl_status psts = RTW_PHL_STATUS_FAILURE;
1442*4882a593Smuzhiyun 	struct stop_bcn_param *param = NULL;
1443*4882a593Smuzhiyun 	u32 param_len;
1444*4882a593Smuzhiyun 
1445*4882a593Smuzhiyun 	if (cmd_type == PHL_CMD_DIRECTLY) {
1446*4882a593Smuzhiyun 		psts = phl_beacon_stop(phl_info, wifi_role, stop);
1447*4882a593Smuzhiyun 		goto _exit;
1448*4882a593Smuzhiyun 	}
1449*4882a593Smuzhiyun 
1450*4882a593Smuzhiyun 	param_len = sizeof(struct stop_bcn_param);
1451*4882a593Smuzhiyun 	param = _os_kmem_alloc(drv, param_len);
1452*4882a593Smuzhiyun 	if (param == NULL) {
1453*4882a593Smuzhiyun 		PHL_ERR("%s: alloc param failed!\n", __func__);
1454*4882a593Smuzhiyun 		goto _exit;
1455*4882a593Smuzhiyun 	}
1456*4882a593Smuzhiyun 
1457*4882a593Smuzhiyun 	param->wrole = wifi_role;
1458*4882a593Smuzhiyun 	param->stop = stop;
1459*4882a593Smuzhiyun 
1460*4882a593Smuzhiyun 	psts = phl_cmd_enqueue(phl_info,
1461*4882a593Smuzhiyun 			wifi_role->hw_band,
1462*4882a593Smuzhiyun 			MSG_EVT_STOP_BCN,
1463*4882a593Smuzhiyun 			(u8 *)param, param_len,
1464*4882a593Smuzhiyun 			_phl_stop_bcn_done,
1465*4882a593Smuzhiyun 			cmd_type, cmd_timeout);
1466*4882a593Smuzhiyun 
1467*4882a593Smuzhiyun 	if (is_cmd_failure(psts)) {
1468*4882a593Smuzhiyun 		/* Send cmd success, but wait cmd fail*/
1469*4882a593Smuzhiyun 		psts = RTW_PHL_STATUS_FAILURE;
1470*4882a593Smuzhiyun 	} else if (psts != RTW_PHL_STATUS_SUCCESS) {
1471*4882a593Smuzhiyun 		/* Send cmd fail */
1472*4882a593Smuzhiyun 		_os_kmem_free(phl_to_drvpriv(phl_info), param, param_len);
1473*4882a593Smuzhiyun 		psts = RTW_PHL_STATUS_FAILURE;
1474*4882a593Smuzhiyun 	}
1475*4882a593Smuzhiyun _exit:
1476*4882a593Smuzhiyun 	return psts;
1477*4882a593Smuzhiyun }
1478*4882a593Smuzhiyun #else /*for FSM*/
1479*4882a593Smuzhiyun enum rtw_phl_status
rtw_phl_cmd_stop_beacon(void * phl,struct rtw_wifi_role_t * wifi_role,u8 stop,enum phl_cmd_type cmd_type,u32 cmd_timeout)1480*4882a593Smuzhiyun rtw_phl_cmd_stop_beacon(void *phl,
1481*4882a593Smuzhiyun 				struct rtw_wifi_role_t *wifi_role,
1482*4882a593Smuzhiyun 				u8 stop,
1483*4882a593Smuzhiyun 				enum phl_cmd_type cmd_type,
1484*4882a593Smuzhiyun 				u32 cmd_timeout)
1485*4882a593Smuzhiyun {
1486*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1487*4882a593Smuzhiyun 
1488*4882a593Smuzhiyun 	return phl_beacon_stop(phl_info, wifi_role, stop);
1489*4882a593Smuzhiyun }
1490*4882a593Smuzhiyun 
1491*4882a593Smuzhiyun enum rtw_phl_status
rtw_phl_cmd_issue_beacon(void * phl,struct rtw_wifi_role_t * wifi_role,struct rtw_bcn_info_cmn * bcn_cmn,enum phl_cmd_type cmd_type,u32 cmd_timeout)1492*4882a593Smuzhiyun rtw_phl_cmd_issue_beacon(void *phl,
1493*4882a593Smuzhiyun 				struct rtw_wifi_role_t *wifi_role,
1494*4882a593Smuzhiyun 				struct rtw_bcn_info_cmn *bcn_cmn,
1495*4882a593Smuzhiyun 				enum phl_cmd_type cmd_type,
1496*4882a593Smuzhiyun 				u32 cmd_timeout)
1497*4882a593Smuzhiyun {
1498*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1499*4882a593Smuzhiyun 
1500*4882a593Smuzhiyun 	return phl_issue_beacon(phl_info, bcn_cmn);
1501*4882a593Smuzhiyun }
1502*4882a593Smuzhiyun #endif /*CONFIG_CMD_DISP*/
1503*4882a593Smuzhiyun #endif /*RTW_PHL_BCN*/
1504*4882a593Smuzhiyun 
rtw_phl_cap_pre_config(void * phl)1505*4882a593Smuzhiyun void rtw_phl_cap_pre_config(void *phl)
1506*4882a593Smuzhiyun {
1507*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1508*4882a593Smuzhiyun 	/* FW Pre-config */
1509*4882a593Smuzhiyun 	rtw_hal_fw_cap_pre_config(phl_info->phl_com,phl_info->hal);
1510*4882a593Smuzhiyun 	/* Bus Pre-config */
1511*4882a593Smuzhiyun 	rtw_hal_bus_cap_pre_config(phl_info->phl_com,phl_info->hal);
1512*4882a593Smuzhiyun }
1513*4882a593Smuzhiyun 
rtw_phl_preload(void * phl)1514*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_preload(void *phl)
1515*4882a593Smuzhiyun {
1516*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1517*4882a593Smuzhiyun 	enum rtw_hal_status hal_status = RTW_HAL_STATUS_SUCCESS;
1518*4882a593Smuzhiyun 
1519*4882a593Smuzhiyun #ifdef RTW_WKARD_PRELOAD_TRX_RESET
1520*4882a593Smuzhiyun 	struct phl_hci_trx_ops *ops = phl_info->hci_trx_ops;
1521*4882a593Smuzhiyun #endif
1522*4882a593Smuzhiyun 	FUNCIN();
1523*4882a593Smuzhiyun 
1524*4882a593Smuzhiyun 	hal_status = rtw_hal_preload(phl_info->phl_com, phl_info->hal);
1525*4882a593Smuzhiyun 
1526*4882a593Smuzhiyun #ifdef RTW_WKARD_PRELOAD_TRX_RESET
1527*4882a593Smuzhiyun 	ops->trx_reset(phl_info, PHL_CTRL_TX|PHL_CTRL_RX);
1528*4882a593Smuzhiyun #endif
1529*4882a593Smuzhiyun 	if (hal_status != RTW_HAL_STATUS_SUCCESS)
1530*4882a593Smuzhiyun 		return RTW_PHL_STATUS_FAILURE;
1531*4882a593Smuzhiyun 
1532*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
1533*4882a593Smuzhiyun }
1534*4882a593Smuzhiyun 
rtw_phl_start(void * phl)1535*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_start(void *phl)
1536*4882a593Smuzhiyun {
1537*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1538*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
1539*4882a593Smuzhiyun 	enum rtw_hal_status hal_status = RTW_HAL_STATUS_SUCCESS;
1540*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1541*4882a593Smuzhiyun 	struct rtw_phl_evt_ops *evt_ops = &phl_info->phl_com->evt_ops;
1542*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1543*4882a593Smuzhiyun 
1544*4882a593Smuzhiyun 	hal_status = rtw_hal_start(phl_info->phl_com, phl_info->hal);
1545*4882a593Smuzhiyun 	if (hal_status == RTW_HAL_STATUS_MAC_INIT_FAILURE) {
1546*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1547*4882a593Smuzhiyun 		goto error_hal_start;
1548*4882a593Smuzhiyun 	} else if (hal_status == RTW_HAL_STATUS_BB_INIT_FAILURE) {
1549*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1550*4882a593Smuzhiyun 		goto error_hal_start;
1551*4882a593Smuzhiyun 	} else if (hal_status == RTW_HAL_STATUS_RF_INIT_FAILURE) {
1552*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1553*4882a593Smuzhiyun 		goto error_hal_start;
1554*4882a593Smuzhiyun 	} else if (hal_status == RTW_HAL_STATUS_BTC_INIT_FAILURE) {
1555*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1556*4882a593Smuzhiyun 		goto error_hal_start;
1557*4882a593Smuzhiyun 	} else if (hal_status != RTW_HAL_STATUS_SUCCESS) {
1558*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1559*4882a593Smuzhiyun 		goto error_hal_start;
1560*4882a593Smuzhiyun 	}
1561*4882a593Smuzhiyun 
1562*4882a593Smuzhiyun #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE
1563*4882a593Smuzhiyun 	/* if no need keep para buf, phl_com->dev_sw_cap->keep_para_info = false*/
1564*4882a593Smuzhiyun 	rtw_phl_init_free_para_buf(phl_info->phl_com);
1565*4882a593Smuzhiyun #endif
1566*4882a593Smuzhiyun 
1567*4882a593Smuzhiyun #ifdef CONFIG_FSM
1568*4882a593Smuzhiyun 	/* start FSM framework */
1569*4882a593Smuzhiyun 	phl_status = phl_fsm_start(phl_info);
1570*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
1571*4882a593Smuzhiyun 		goto error_phl_fsm_start;
1572*4882a593Smuzhiyun 
1573*4882a593Smuzhiyun 	/* start FSM modules */
1574*4882a593Smuzhiyun 	phl_status = phl_fsm_module_start(phl_info);
1575*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
1576*4882a593Smuzhiyun 		goto error_phl_fsm_module_start;
1577*4882a593Smuzhiyun #endif
1578*4882a593Smuzhiyun 	/* start modules */
1579*4882a593Smuzhiyun 	phl_status = phl_module_start(phl_info);
1580*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
1581*4882a593Smuzhiyun 		goto error_phl_module_start;
1582*4882a593Smuzhiyun 
1583*4882a593Smuzhiyun 	phl_status = phl_datapath_start(phl_info);
1584*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
1585*4882a593Smuzhiyun 		goto error_phl_datapath_start;
1586*4882a593Smuzhiyun 
1587*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1588*4882a593Smuzhiyun 	evt_ops->set_interrupt_caps(phl_to_drvpriv(phl_info), true);
1589*4882a593Smuzhiyun #else
1590*4882a593Smuzhiyun 	rtw_hal_enable_interrupt(phl_info->phl_com, phl_info->hal);
1591*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1592*4882a593Smuzhiyun 
1593*4882a593Smuzhiyun 	phl_info->phl_com->dev_state = RTW_DEV_WORKING;
1594*4882a593Smuzhiyun 	phl_status = RTW_PHL_STATUS_SUCCESS;
1595*4882a593Smuzhiyun 
1596*4882a593Smuzhiyun 	return phl_status;
1597*4882a593Smuzhiyun 
1598*4882a593Smuzhiyun error_phl_datapath_start:
1599*4882a593Smuzhiyun 	phl_module_stop(phl_info);
1600*4882a593Smuzhiyun error_phl_module_start:
1601*4882a593Smuzhiyun #ifdef CONFIG_FSM
1602*4882a593Smuzhiyun 	phl_fsm_module_stop(phl_info);
1603*4882a593Smuzhiyun error_phl_fsm_module_start:
1604*4882a593Smuzhiyun 	phl_fsm_stop(phl_info);
1605*4882a593Smuzhiyun error_phl_fsm_start:
1606*4882a593Smuzhiyun #endif
1607*4882a593Smuzhiyun 	rtw_hal_stop(phl_info->phl_com, phl_info->hal);
1608*4882a593Smuzhiyun error_hal_start:
1609*4882a593Smuzhiyun 	return phl_status;
1610*4882a593Smuzhiyun }
1611*4882a593Smuzhiyun 
_phl_interrupt_stop(struct phl_info_t * phl_info)1612*4882a593Smuzhiyun static void _phl_interrupt_stop(struct phl_info_t *phl_info)
1613*4882a593Smuzhiyun {
1614*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1615*4882a593Smuzhiyun 	struct rtw_phl_evt_ops *evt_ops = &phl_info->phl_com->evt_ops;
1616*4882a593Smuzhiyun 
1617*4882a593Smuzhiyun 	do {
1618*4882a593Smuzhiyun 		if (false == TEST_STATUS_FLAG(phl_info->phl_com->dev_state,
1619*4882a593Smuzhiyun 		                              RTW_DEV_SURPRISE_REMOVAL))
1620*4882a593Smuzhiyun 			evt_ops->set_interrupt_caps(phl_to_drvpriv(phl_info), false);
1621*4882a593Smuzhiyun 	} while (false);
1622*4882a593Smuzhiyun #else
1623*4882a593Smuzhiyun 	do {
1624*4882a593Smuzhiyun 		if (false == TEST_STATUS_FLAG(phl_info->phl_com->dev_state,
1625*4882a593Smuzhiyun 		                              RTW_DEV_SURPRISE_REMOVAL))
1626*4882a593Smuzhiyun 			rtw_hal_disable_interrupt(phl_info->phl_com, phl_info->hal);
1627*4882a593Smuzhiyun 	} while (false);
1628*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1629*4882a593Smuzhiyun }
1630*4882a593Smuzhiyun 
_phl_cmd_send_msg_phy_on(struct phl_info_t * phl_info)1631*4882a593Smuzhiyun static enum rtw_phl_status _phl_cmd_send_msg_phy_on(struct phl_info_t *phl_info)
1632*4882a593Smuzhiyun {
1633*4882a593Smuzhiyun 	enum rtw_phl_status sts = RTW_PHL_STATUS_FAILURE;
1634*4882a593Smuzhiyun #ifdef DBG_PHY_ON_TIME
1635*4882a593Smuzhiyun 	u32 phyon_start = 0, phyon_t = 0;
1636*4882a593Smuzhiyun #endif /* DBG_PHY_ON_TIME */
1637*4882a593Smuzhiyun 
1638*4882a593Smuzhiyun #ifdef DBG_PHY_ON_TIME
1639*4882a593Smuzhiyun 	phyon_start = _os_get_cur_time_ms();
1640*4882a593Smuzhiyun #endif /* DBG_PHY_ON_TIME */
1641*4882a593Smuzhiyun 
1642*4882a593Smuzhiyun 	sts = phl_cmd_enqueue(phl_info, HW_BAND_0, MSG_EVT_PHY_ON, NULL, 0, NULL,
1643*4882a593Smuzhiyun 			PHL_CMD_WAIT, 3000);
1644*4882a593Smuzhiyun 
1645*4882a593Smuzhiyun #ifdef DBG_PHY_ON_TIME
1646*4882a593Smuzhiyun 	phyon_t = phl_get_passing_time_ms(phyon_start);
1647*4882a593Smuzhiyun 	if (phyon_t > 1000) {
1648*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_DBG, _PHL_WARNING_, "%s : phy on takes %u (ms).\n"
1649*4882a593Smuzhiyun 			  	, __func__, phyon_t);
1650*4882a593Smuzhiyun 	}
1651*4882a593Smuzhiyun #endif /* DBG_PHY_ON_TIME */
1652*4882a593Smuzhiyun 
1653*4882a593Smuzhiyun 	if (is_cmd_failure(sts)) {
1654*4882a593Smuzhiyun 		/* send cmd success, but wait cmd fail */
1655*4882a593Smuzhiyun 		sts = RTW_PHL_STATUS_FAILURE;
1656*4882a593Smuzhiyun 	} else if (sts != RTW_PHL_STATUS_SUCCESS) {
1657*4882a593Smuzhiyun 		/* send cmd fail */
1658*4882a593Smuzhiyun 		sts = RTW_PHL_STATUS_FAILURE;
1659*4882a593Smuzhiyun 	}
1660*4882a593Smuzhiyun 	return sts;
1661*4882a593Smuzhiyun }
1662*4882a593Smuzhiyun 
rtw_phl_stop(void * phl)1663*4882a593Smuzhiyun void rtw_phl_stop(void *phl)
1664*4882a593Smuzhiyun {
1665*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1666*4882a593Smuzhiyun 
1667*4882a593Smuzhiyun 	_phl_cmd_send_msg_phy_on(phl_info);
1668*4882a593Smuzhiyun 
1669*4882a593Smuzhiyun 	_phl_interrupt_stop(phl_info);
1670*4882a593Smuzhiyun 	phl_module_stop(phl_info);
1671*4882a593Smuzhiyun 
1672*4882a593Smuzhiyun #ifdef DBG_PHL_MR
1673*4882a593Smuzhiyun 	phl_mr_info_dbg(phl_info);
1674*4882a593Smuzhiyun #endif
1675*4882a593Smuzhiyun 
1676*4882a593Smuzhiyun #ifdef CONFIG_FSM
1677*4882a593Smuzhiyun 	phl_fsm_module_stop(phl_info);
1678*4882a593Smuzhiyun 	phl_fsm_stop(phl_info);
1679*4882a593Smuzhiyun #endif
1680*4882a593Smuzhiyun 
1681*4882a593Smuzhiyun 	rtw_hal_stop(phl_info->phl_com, phl_info->hal);
1682*4882a593Smuzhiyun 	phl_datapath_stop(phl_info);
1683*4882a593Smuzhiyun 
1684*4882a593Smuzhiyun 	phl_info->phl_com->dev_state = 0;
1685*4882a593Smuzhiyun }
1686*4882a593Smuzhiyun 
phl_wow_start(struct phl_info_t * phl_info,struct rtw_phl_stainfo_t * sta)1687*4882a593Smuzhiyun enum rtw_phl_status phl_wow_start(struct phl_info_t *phl_info, struct rtw_phl_stainfo_t *sta)
1688*4882a593Smuzhiyun {
1689*4882a593Smuzhiyun #ifdef CONFIG_WOWLAN
1690*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_FAILURE;
1691*4882a593Smuzhiyun 	enum rtw_hal_status hstatus = RTW_HAL_STATUS_FAILURE;
1692*4882a593Smuzhiyun 	struct phl_wow_info *wow_info = phl_to_wow_info(phl_info);
1693*4882a593Smuzhiyun 
1694*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1695*4882a593Smuzhiyun 	struct rtw_phl_evt_ops *evt_ops = &phl_info->phl_com->evt_ops;
1696*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1697*4882a593Smuzhiyun 
1698*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_WOW, _PHL_INFO_, "[wow] %s enter with sta state(%d)\n.", __func__, sta->wrole->mstate);
1699*4882a593Smuzhiyun 
1700*4882a593Smuzhiyun 	phl_wow_decide_op_mode(wow_info, sta);
1701*4882a593Smuzhiyun 
1702*4882a593Smuzhiyun 	if (wow_info->op_mode == RTW_WOW_OP_PWR_DOWN) {
1703*4882a593Smuzhiyun 		phl_cmd_role_suspend(phl_info);
1704*4882a593Smuzhiyun 		rtw_phl_stop(phl_info);
1705*4882a593Smuzhiyun 		/* since control path stopped after rtw_phl_stop,
1706*4882a593Smuzhiyun 		   below action don't have to migrate to general module */
1707*4882a593Smuzhiyun 		hstatus = rtw_hal_set_wowlan(phl_info->phl_com, phl_info->hal, true);
1708*4882a593Smuzhiyun 		if (RTW_HAL_STATUS_SUCCESS != hstatus)
1709*4882a593Smuzhiyun 			PHL_WARN("[wow] rtw_hal_set_wowlan failed, status(%u)\n", hstatus);
1710*4882a593Smuzhiyun 		pstatus = RTW_PHL_STATUS_SUCCESS;
1711*4882a593Smuzhiyun 	} else {
1712*4882a593Smuzhiyun 		/* stop all active features */
1713*4882a593Smuzhiyun 		#ifdef CONFIG_WOW_WITH_SER
1714*4882a593Smuzhiyun 		rtw_hal_ser_ctrl(phl_info->hal, false);
1715*4882a593Smuzhiyun 		#endif
1716*4882a593Smuzhiyun 
1717*4882a593Smuzhiyun 		pstatus = phl_module_stop(phl_info);
1718*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1719*4882a593Smuzhiyun 			PHL_ERR("[wow] phl_module_stop failed.\n");
1720*4882a593Smuzhiyun 			goto end;
1721*4882a593Smuzhiyun 		}
1722*4882a593Smuzhiyun 		/* since control path stopped after phl_module_stop,
1723*4882a593Smuzhiyun 		   below action don't have to migrate to general module */
1724*4882a593Smuzhiyun #ifdef CONFIG_FSM
1725*4882a593Smuzhiyun 		pstatus = phl_fsm_module_stop(phl_info);
1726*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1727*4882a593Smuzhiyun 			PHL_ERR("[wow] phl_fsm_module_stop failed.\n");
1728*4882a593Smuzhiyun 			goto end;
1729*4882a593Smuzhiyun 		}
1730*4882a593Smuzhiyun 
1731*4882a593Smuzhiyun 		pstatus = phl_fsm_stop(phl_info);
1732*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1733*4882a593Smuzhiyun 			PHL_ERR("[wow] phl_fsm_stop failed.\n");
1734*4882a593Smuzhiyun 			goto end;
1735*4882a593Smuzhiyun 		}
1736*4882a593Smuzhiyun #endif
1737*4882a593Smuzhiyun 		hstatus = rtw_hal_set_wowlan(phl_info->phl_com, phl_info->hal, true);
1738*4882a593Smuzhiyun 		if (RTW_HAL_STATUS_SUCCESS != hstatus)
1739*4882a593Smuzhiyun 			PHL_WARN("[wow] rtw_hal_set_wowlan failed, status(%u)\n", hstatus);
1740*4882a593Smuzhiyun 		pstatus = phl_wow_init_precfg(wow_info);
1741*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1742*4882a593Smuzhiyun 			PHL_ERR("[wow] phl_wow_init_precfg failed.\n");
1743*4882a593Smuzhiyun 			goto end;
1744*4882a593Smuzhiyun 		}
1745*4882a593Smuzhiyun 
1746*4882a593Smuzhiyun 		hstatus = rtw_hal_wow_init(phl_info->phl_com, phl_info->hal, sta);
1747*4882a593Smuzhiyun 		if (RTW_HAL_STATUS_SUCCESS != hstatus) {
1748*4882a593Smuzhiyun 			pstatus = RTW_PHL_STATUS_FAILURE;
1749*4882a593Smuzhiyun 			goto end;
1750*4882a593Smuzhiyun 		}
1751*4882a593Smuzhiyun 
1752*4882a593Smuzhiyun 		pstatus = phl_wow_func_en(wow_info);
1753*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != pstatus)
1754*4882a593Smuzhiyun 			goto end;
1755*4882a593Smuzhiyun #ifdef CONFIG_POWER_SAVE
1756*4882a593Smuzhiyun 		/* power saving */
1757*4882a593Smuzhiyun 		phl_wow_ps_proto_cfg(wow_info, true);
1758*4882a593Smuzhiyun 
1759*4882a593Smuzhiyun 		phl_wow_ps_pwr_ntfy(wow_info, true);
1760*4882a593Smuzhiyun #endif
1761*4882a593Smuzhiyun 		pstatus = phl_wow_init_postcfg(wow_info);
1762*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1763*4882a593Smuzhiyun 			PHL_ERR("[wow] phl_wow_init_postcfg failed.\n");
1764*4882a593Smuzhiyun 			goto end;
1765*4882a593Smuzhiyun 		}
1766*4882a593Smuzhiyun 		#ifdef CONFIG_WOW_WITH_SER
1767*4882a593Smuzhiyun 		rtw_hal_ser_ctrl(phl_info->hal, true);
1768*4882a593Smuzhiyun 		#endif
1769*4882a593Smuzhiyun #ifdef CONFIG_POWER_SAVE
1770*4882a593Smuzhiyun 		/* power saving */
1771*4882a593Smuzhiyun 		phl_wow_ps_pwr_cfg(wow_info, true);
1772*4882a593Smuzhiyun #endif
1773*4882a593Smuzhiyun 		pstatus = RTW_PHL_STATUS_SUCCESS;
1774*4882a593Smuzhiyun 	}
1775*4882a593Smuzhiyun 
1776*4882a593Smuzhiyun end:
1777*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1778*4882a593Smuzhiyun 		#ifdef CONFIG_SYNC_INTERRUPT
1779*4882a593Smuzhiyun 		evt_ops->set_interrupt_caps(phl_to_drvpriv(phl_info), false);
1780*4882a593Smuzhiyun 		#else
1781*4882a593Smuzhiyun 		rtw_hal_disable_interrupt(phl_info->phl_com, phl_info->hal);
1782*4882a593Smuzhiyun 		#endif /* CONFIG_SYNC_INTERRUPT */
1783*4882a593Smuzhiyun 		phl_role_suspend(phl_info);
1784*4882a593Smuzhiyun 		rtw_hal_stop(phl_info->phl_com, phl_info->hal);
1785*4882a593Smuzhiyun 		phl_datapath_stop(phl_info);
1786*4882a593Smuzhiyun 		wow_info->op_mode = RTW_WOW_OP_PWR_DOWN;
1787*4882a593Smuzhiyun 		PHL_ERR("[wow] %s fail, set op_mode %d!\n", __func__, wow_info->op_mode);
1788*4882a593Smuzhiyun 	} else {
1789*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_WOW, _PHL_INFO_,
1790*4882a593Smuzhiyun 			"[wow] %s success, with func_en %d, op_mode %d.\n",
1791*4882a593Smuzhiyun 			__func__, wow_info->func_en, wow_info->op_mode);
1792*4882a593Smuzhiyun 	}
1793*4882a593Smuzhiyun 
1794*4882a593Smuzhiyun 	return pstatus;
1795*4882a593Smuzhiyun #else
1796*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
1797*4882a593Smuzhiyun #endif /* CONFIG_WOWLAN */
1798*4882a593Smuzhiyun }
1799*4882a593Smuzhiyun 
_wow_stop_reinit(struct phl_info_t * phl_info)1800*4882a593Smuzhiyun static void _wow_stop_reinit(struct phl_info_t *phl_info)
1801*4882a593Smuzhiyun {
1802*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_FAILURE;
1803*4882a593Smuzhiyun 
1804*4882a593Smuzhiyun 	PHL_WARN("%s : reset hw!\n", __func__);
1805*4882a593Smuzhiyun 	phl_role_suspend(phl_info);
1806*4882a593Smuzhiyun 	rtw_hal_stop(phl_info->phl_com, phl_info->hal);
1807*4882a593Smuzhiyun 	phl_datapath_stop(phl_info);
1808*4882a593Smuzhiyun 	pstatus = rtw_phl_start(phl_info);
1809*4882a593Smuzhiyun 	if (pstatus)
1810*4882a593Smuzhiyun 		PHL_ERR("%s : rtw_phl_start fail!\n", __func__);
1811*4882a593Smuzhiyun 	phl_cmd_role_recover(phl_info);
1812*4882a593Smuzhiyun 
1813*4882a593Smuzhiyun }
1814*4882a593Smuzhiyun 
phl_wow_stop(struct phl_info_t * phl_info,struct rtw_phl_stainfo_t * sta,u8 * hw_reinit)1815*4882a593Smuzhiyun void phl_wow_stop(struct phl_info_t *phl_info, struct rtw_phl_stainfo_t *sta, u8 *hw_reinit)
1816*4882a593Smuzhiyun {
1817*4882a593Smuzhiyun #ifdef CONFIG_WOWLAN
1818*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_FAILURE;
1819*4882a593Smuzhiyun 	enum rtw_hal_status hstatus = RTW_HAL_STATUS_FAILURE;
1820*4882a593Smuzhiyun 	struct phl_wow_info *wow_info = phl_to_wow_info(phl_info);
1821*4882a593Smuzhiyun 	u8 reset = 0;
1822*4882a593Smuzhiyun 
1823*4882a593Smuzhiyun 	if (rtw_hal_get_pwr_state(phl_info->hal, &wow_info->mac_pwr)
1824*4882a593Smuzhiyun 		!= RTW_HAL_STATUS_SUCCESS)
1825*4882a593Smuzhiyun 		return;
1826*4882a593Smuzhiyun 
1827*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_WOW, _PHL_INFO_, "%s enter with mac power %d\n.",
1828*4882a593Smuzhiyun 			  __func__, wow_info->mac_pwr);
1829*4882a593Smuzhiyun 
1830*4882a593Smuzhiyun 	if (wow_info->mac_pwr != RTW_MAC_PWR_OFF) {
1831*4882a593Smuzhiyun 		#ifdef CONFIG_WOW_WITH_SER
1832*4882a593Smuzhiyun 		rtw_hal_ser_ctrl(phl_info->hal, false);
1833*4882a593Smuzhiyun 		#endif
1834*4882a593Smuzhiyun 		#ifdef CONFIG_POWER_SAVE
1835*4882a593Smuzhiyun 		/* leave clock/power gating */
1836*4882a593Smuzhiyun 		pstatus = phl_wow_ps_pwr_cfg(wow_info, false);
1837*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1838*4882a593Smuzhiyun 			PHL_ERR("[wow] HW leave power saving failed.\n");
1839*4882a593Smuzhiyun 			_wow_stop_reinit(phl_info);
1840*4882a593Smuzhiyun 			*hw_reinit = true;
1841*4882a593Smuzhiyun 			return;
1842*4882a593Smuzhiyun 		}
1843*4882a593Smuzhiyun 		#endif
1844*4882a593Smuzhiyun 	}
1845*4882a593Smuzhiyun 
1846*4882a593Smuzhiyun 	hstatus = rtw_hal_set_wowlan(phl_info->phl_com, phl_info->hal, false);
1847*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != hstatus) {
1848*4882a593Smuzhiyun 		PHL_WARN("[wow] rtw_hal_set_wowlan failed, status(%u)\n", hstatus);
1849*4882a593Smuzhiyun 	}
1850*4882a593Smuzhiyun 
1851*4882a593Smuzhiyun 	if (wow_info->mac_pwr == RTW_MAC_PWR_OFF) {
1852*4882a593Smuzhiyun 		if (wow_info->op_mode == RTW_WOW_OP_PWR_DOWN) {
1853*4882a593Smuzhiyun 			pstatus = rtw_phl_start(phl_info);
1854*4882a593Smuzhiyun 			phl_role_recover(phl_info);
1855*4882a593Smuzhiyun 			*hw_reinit = true;
1856*4882a593Smuzhiyun 		} else {
1857*4882a593Smuzhiyun 			PHL_WARN("[wow] enter suspend with wow enabled but mac is power down\n");
1858*4882a593Smuzhiyun 			_wow_stop_reinit(phl_info);
1859*4882a593Smuzhiyun 			*hw_reinit = true;
1860*4882a593Smuzhiyun 		}
1861*4882a593Smuzhiyun 	} else if (wow_info->mac_pwr == RTW_MAC_PWR_ON ||
1862*4882a593Smuzhiyun 			   wow_info->mac_pwr == RTW_MAC_PWR_LPS) {
1863*4882a593Smuzhiyun 
1864*4882a593Smuzhiyun 		phl_wow_handle_wake_rsn(wow_info, &reset);
1865*4882a593Smuzhiyun 		if (reset) {
1866*4882a593Smuzhiyun 			_wow_stop_reinit(phl_info);
1867*4882a593Smuzhiyun 			*hw_reinit = true;
1868*4882a593Smuzhiyun 			return;
1869*4882a593Smuzhiyun 		}
1870*4882a593Smuzhiyun 
1871*4882a593Smuzhiyun 		phl_wow_deinit_precfg(wow_info);
1872*4882a593Smuzhiyun 
1873*4882a593Smuzhiyun 		rtw_hal_fw_dbg_dump(phl_info->hal);
1874*4882a593Smuzhiyun #ifdef CONFIG_POWER_SAVE
1875*4882a593Smuzhiyun 		phl_wow_ps_pwr_ntfy(wow_info, false);
1876*4882a593Smuzhiyun 		/* leave power saving */
1877*4882a593Smuzhiyun 		phl_wow_ps_proto_cfg(wow_info, false);
1878*4882a593Smuzhiyun #endif
1879*4882a593Smuzhiyun 		phl_wow_func_dis(wow_info);
1880*4882a593Smuzhiyun 
1881*4882a593Smuzhiyun 		hstatus = rtw_hal_wow_deinit(phl_info->phl_com, phl_info->hal, sta);
1882*4882a593Smuzhiyun 		if (hstatus)
1883*4882a593Smuzhiyun 			PHL_ERR("%s : rtw_hal_wow_deinit failed.\n", __func__);
1884*4882a593Smuzhiyun 
1885*4882a593Smuzhiyun 		phl_module_start(phl_info);
1886*4882a593Smuzhiyun #ifdef CONFIG_FSM
1887*4882a593Smuzhiyun 		phl_fsm_start(phl_info);
1888*4882a593Smuzhiyun 		phl_fsm_module_start(phl_info);
1889*4882a593Smuzhiyun #endif
1890*4882a593Smuzhiyun 		phl_wow_deinit_postcfg(wow_info);
1891*4882a593Smuzhiyun 		#ifdef CONFIG_WOW_WITH_SER
1892*4882a593Smuzhiyun 		rtw_hal_ser_ctrl(phl_info->hal, true);
1893*4882a593Smuzhiyun 		#endif
1894*4882a593Smuzhiyun 		*hw_reinit = false;
1895*4882a593Smuzhiyun 	} else {
1896*4882a593Smuzhiyun 		PHL_ERR("%s : unexpected mac pwr state %d.\n", __func__, wow_info->mac_pwr);
1897*4882a593Smuzhiyun 	}
1898*4882a593Smuzhiyun 
1899*4882a593Smuzhiyun #endif /* CONFIG_WOWLAN */
1900*4882a593Smuzhiyun }
1901*4882a593Smuzhiyun 
rtw_phl_rf_on(void * phl)1902*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_rf_on(void *phl)
1903*4882a593Smuzhiyun {
1904*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1905*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
1906*4882a593Smuzhiyun 	enum rtw_hal_status hal_status = RTW_HAL_STATUS_SUCCESS;
1907*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1908*4882a593Smuzhiyun 	struct rtw_phl_evt_ops *evt_ops = &phl_info->phl_com->evt_ops;
1909*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1910*4882a593Smuzhiyun 	struct phl_data_ctl_t ctl = {0};
1911*4882a593Smuzhiyun 
1912*4882a593Smuzhiyun 	hal_status = rtw_hal_start(phl_info->phl_com, phl_info->hal);
1913*4882a593Smuzhiyun 	if (hal_status == RTW_HAL_STATUS_MAC_INIT_FAILURE) {
1914*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1915*4882a593Smuzhiyun 		goto error_hal_start;
1916*4882a593Smuzhiyun 	} else if (hal_status == RTW_HAL_STATUS_BB_INIT_FAILURE) {
1917*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1918*4882a593Smuzhiyun 		goto error_hal_start;
1919*4882a593Smuzhiyun 	} else if (hal_status == RTW_HAL_STATUS_RF_INIT_FAILURE) {
1920*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1921*4882a593Smuzhiyun 		goto error_hal_start;
1922*4882a593Smuzhiyun 	} else if (hal_status == RTW_HAL_STATUS_BTC_INIT_FAILURE) {
1923*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_HAL_INIT_FAILURE;
1924*4882a593Smuzhiyun 		goto error_hal_start;
1925*4882a593Smuzhiyun 	}
1926*4882a593Smuzhiyun 
1927*4882a593Smuzhiyun 	phl_role_recover(phl_info);
1928*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1929*4882a593Smuzhiyun 	evt_ops->set_interrupt_caps(phl_to_drvpriv(phl_info), true);
1930*4882a593Smuzhiyun #else
1931*4882a593Smuzhiyun 	rtw_hal_enable_interrupt(phl_info->phl_com, phl_info->hal);
1932*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1933*4882a593Smuzhiyun 
1934*4882a593Smuzhiyun 	ctl.id = PHL_MDL_POWER_MGNT;
1935*4882a593Smuzhiyun 	ctl.cmd = PHL_DATA_CTL_SW_TX_RESUME;
1936*4882a593Smuzhiyun 	if (phl_data_ctrler(phl_info, &ctl, NULL) != RTW_PHL_STATUS_SUCCESS)
1937*4882a593Smuzhiyun 		PHL_WARN("%s: tx resume fail!\n", __func__);
1938*4882a593Smuzhiyun 	ctl.cmd = PHL_DATA_CTL_SW_RX_RESUME;
1939*4882a593Smuzhiyun 	if (phl_data_ctrler(phl_info, &ctl, NULL) != RTW_PHL_STATUS_SUCCESS)
1940*4882a593Smuzhiyun 		PHL_WARN("%s: rx resume fail!\n", __func__);
1941*4882a593Smuzhiyun 
1942*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
1943*4882a593Smuzhiyun error_hal_start:
1944*4882a593Smuzhiyun 	PHL_ERR("error_hal_start\n");
1945*4882a593Smuzhiyun 	return phl_status;
1946*4882a593Smuzhiyun }
1947*4882a593Smuzhiyun 
1948*4882a593Smuzhiyun #define MAX_RF_OFF_STOP_TRX_TIME 100 /* ms */
rtw_phl_rf_off(void * phl)1949*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_rf_off(void *phl)
1950*4882a593Smuzhiyun {
1951*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1952*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1953*4882a593Smuzhiyun 	struct rtw_phl_evt_ops *evt_ops = &phl_info->phl_com->evt_ops;
1954*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1955*4882a593Smuzhiyun 	struct phl_data_ctl_t ctl = {0};
1956*4882a593Smuzhiyun 
1957*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
1958*4882a593Smuzhiyun 	evt_ops->set_interrupt_caps(phl_to_drvpriv(phl_info), false);
1959*4882a593Smuzhiyun #else
1960*4882a593Smuzhiyun 	rtw_hal_disable_interrupt(phl_info->phl_com, phl_info->hal);
1961*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
1962*4882a593Smuzhiyun 
1963*4882a593Smuzhiyun 	ctl.id = PHL_MDL_POWER_MGNT;
1964*4882a593Smuzhiyun 	ctl.cmd = PHL_DATA_CTL_SW_TX_PAUSE;
1965*4882a593Smuzhiyun 	if (phl_data_ctrler(phl_info, &ctl, NULL) != RTW_PHL_STATUS_SUCCESS)
1966*4882a593Smuzhiyun 		PHL_WARN("%s: tx pause fail!\n", __func__);
1967*4882a593Smuzhiyun 	ctl.cmd = PHL_DATA_CTL_SW_RX_PAUSE;
1968*4882a593Smuzhiyun 	if (phl_data_ctrler(phl_info, &ctl, NULL) != RTW_PHL_STATUS_SUCCESS)
1969*4882a593Smuzhiyun 		PHL_WARN("%s: rx pause fail!\n", __func__);
1970*4882a593Smuzhiyun 
1971*4882a593Smuzhiyun 	phl_role_suspend(phl_info);
1972*4882a593Smuzhiyun 	rtw_hal_stop(phl_info->phl_com, phl_info->hal);
1973*4882a593Smuzhiyun 
1974*4882a593Smuzhiyun 	ctl.cmd = PHL_DATA_CTL_SW_TX_RESET;
1975*4882a593Smuzhiyun 	if (phl_data_ctrler(phl_info, &ctl, NULL) != RTW_PHL_STATUS_SUCCESS)
1976*4882a593Smuzhiyun 		PHL_WARN("%s: tx reset fail!\n", __func__);
1977*4882a593Smuzhiyun 	ctl.cmd = PHL_DATA_CTL_SW_RX_RESET;
1978*4882a593Smuzhiyun 	if (phl_data_ctrler(phl_info, &ctl, NULL) != RTW_PHL_STATUS_SUCCESS)
1979*4882a593Smuzhiyun 		PHL_WARN("%s: rx reset fail!\n", __func__);
1980*4882a593Smuzhiyun 
1981*4882a593Smuzhiyun 	return RTW_PHL_STATUS_SUCCESS;
1982*4882a593Smuzhiyun }
1983*4882a593Smuzhiyun 
rtw_phl_suspend(void * phl,struct rtw_phl_stainfo_t * sta,u8 wow_en)1984*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_suspend(void *phl, struct rtw_phl_stainfo_t *sta, u8 wow_en)
1985*4882a593Smuzhiyun {
1986*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
1987*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_SUCCESS;
1988*4882a593Smuzhiyun 
1989*4882a593Smuzhiyun 	PHL_INFO("%s enter with wow_en(%d)\n.", __func__, wow_en);
1990*4882a593Smuzhiyun #ifdef CONFIG_WOWLAN
1991*4882a593Smuzhiyun 	pstatus = _phl_cmd_send_msg_phy_on(phl_info);
1992*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != pstatus) {
1993*4882a593Smuzhiyun 		PHL_ERR("[wow] _phl_cmd_send_msg_phy_on fail!\n");
1994*4882a593Smuzhiyun 		wow_en = false;
1995*4882a593Smuzhiyun 	}
1996*4882a593Smuzhiyun 
1997*4882a593Smuzhiyun 	if (wow_en) {
1998*4882a593Smuzhiyun 		pstatus = phl_wow_start(phl_info, sta);
1999*4882a593Smuzhiyun 	} else {
2000*4882a593Smuzhiyun 		phl_cmd_role_suspend(phl_info);
2001*4882a593Smuzhiyun 		rtw_phl_stop(phl);
2002*4882a593Smuzhiyun 	}
2003*4882a593Smuzhiyun #else
2004*4882a593Smuzhiyun 	PHL_INFO("%s enter with wow_en(%d)\n.", __func__, wow_en);
2005*4882a593Smuzhiyun 
2006*4882a593Smuzhiyun 	phl_cmd_role_suspend(phl_info);
2007*4882a593Smuzhiyun 	rtw_phl_stop(phl);
2008*4882a593Smuzhiyun #endif
2009*4882a593Smuzhiyun 
2010*4882a593Smuzhiyun 	FUNCOUT_WSTS(pstatus);
2011*4882a593Smuzhiyun 
2012*4882a593Smuzhiyun 	return pstatus;
2013*4882a593Smuzhiyun }
2014*4882a593Smuzhiyun 
rtw_phl_resume(void * phl,struct rtw_phl_stainfo_t * sta,u8 * hw_reinit)2015*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_resume(void *phl, struct rtw_phl_stainfo_t *sta, u8 *hw_reinit)
2016*4882a593Smuzhiyun {
2017*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2018*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_SUCCESS;
2019*4882a593Smuzhiyun #ifdef CONFIG_WOWLAN
2020*4882a593Smuzhiyun 	struct phl_wow_info *wow_info = phl_to_wow_info(phl_info);
2021*4882a593Smuzhiyun #endif
2022*4882a593Smuzhiyun 
2023*4882a593Smuzhiyun 	/**
2024*4882a593Smuzhiyun 	 * Since some platforms require performance when device resuming, we need
2025*4882a593Smuzhiyun 	 * to finish "rtw_phl_resume" as fast as possible. In this situation, we
2026*4882a593Smuzhiyun 	 * prevent ps module entering any power saving mechanisms and try to do I/O
2027*4882a593Smuzhiyun 	 * operations directly without issue commands to cmd dispatcher. Therefore,
2028*4882a593Smuzhiyun 	 * ps module will not enter power saving if device state "RTW_DEV_RESUMING"
2029*4882a593Smuzhiyun 	 * is set. If device state "RTW_DEV_RESUMING" is set, operations of I/O
2030*4882a593Smuzhiyun 	 * should check whether the current power state can perform I/O or not and
2031*4882a593Smuzhiyun 	 * perform I/O directly without issuing commands to cmd dispatcher if device
2032*4882a593Smuzhiyun 	 * power state is I/O allowable. This kind of flow is only suitable for
2033*4882a593Smuzhiyun 	 * "rtw_phl_resume" because core layer will not perform any other tasks when
2034*4882a593Smuzhiyun 	 * calling rtw_phl_resume which is relatively simple enough.
2035*4882a593Smuzhiyun 	 */
2036*4882a593Smuzhiyun 	PHL_INFO("%s enter...\n.", __func__);
2037*4882a593Smuzhiyun 	SET_STATUS_FLAG(phl_info->phl_com->dev_state, RTW_DEV_RESUMING);
2038*4882a593Smuzhiyun 
2039*4882a593Smuzhiyun #ifdef CONFIG_WOWLAN
2040*4882a593Smuzhiyun 	if (wow_info->op_mode != RTW_WOW_OP_NONE) {
2041*4882a593Smuzhiyun 		phl_wow_stop(phl_info, sta, hw_reinit);
2042*4882a593Smuzhiyun 	} else {
2043*4882a593Smuzhiyun 		pstatus = rtw_phl_start(phl);
2044*4882a593Smuzhiyun 		#ifdef CONFIG_POWER_SAVE
2045*4882a593Smuzhiyun 		if (phl_ps_get_cur_pwr_lvl(phl_info) == PS_PWR_LVL_PWRON)
2046*4882a593Smuzhiyun 		#endif
2047*4882a593Smuzhiyun 			phl_role_recover(phl_info);
2048*4882a593Smuzhiyun 		*hw_reinit = true;
2049*4882a593Smuzhiyun 	}
2050*4882a593Smuzhiyun 	#if defined(RTW_WKARD_WOW_L2_PWR) && defined(CONFIG_PCI_HCI)
2051*4882a593Smuzhiyun 	rtw_hal_set_l2_leave(phl_info->hal);
2052*4882a593Smuzhiyun 	#endif
2053*4882a593Smuzhiyun 	phl_record_wow_stat(wow_info);
2054*4882a593Smuzhiyun 	phl_reset_wow_info(wow_info);
2055*4882a593Smuzhiyun #else
2056*4882a593Smuzhiyun 	pstatus = rtw_phl_start(phl);
2057*4882a593Smuzhiyun 	#ifdef CONFIG_POWER_SAVE
2058*4882a593Smuzhiyun 	if (phl_ps_get_cur_pwr_lvl(phl_info) == PS_PWR_LVL_PWRON)
2059*4882a593Smuzhiyun 	#endif
2060*4882a593Smuzhiyun 		phl_role_recover(phl_info);
2061*4882a593Smuzhiyun 	*hw_reinit = true;
2062*4882a593Smuzhiyun #endif
2063*4882a593Smuzhiyun 
2064*4882a593Smuzhiyun 	CLEAR_STATUS_FLAG(phl_info->phl_com->dev_state, RTW_DEV_RESUMING);
2065*4882a593Smuzhiyun 
2066*4882a593Smuzhiyun 	PHL_INFO("%s exit with hw_reinit %d.\n.", __func__, *hw_reinit);
2067*4882a593Smuzhiyun 
2068*4882a593Smuzhiyun 	return pstatus;
2069*4882a593Smuzhiyun }
2070*4882a593Smuzhiyun 
rtw_phl_reset(void * phl)2071*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_reset(void *phl)
2072*4882a593Smuzhiyun {
2073*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2074*4882a593Smuzhiyun 	struct phl_hci_trx_ops *ops = phl_info->hci_trx_ops;
2075*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
2076*4882a593Smuzhiyun 
2077*4882a593Smuzhiyun 	if(rtw_phl_is_init_completed(phl_info))
2078*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_SUCCESS;
2079*4882a593Smuzhiyun 
2080*4882a593Smuzhiyun 	rtw_hal_stop(phl_info->phl_com, phl_info->hal);
2081*4882a593Smuzhiyun 
2082*4882a593Smuzhiyun 	ops->trx_reset(phl_info, PHL_CTRL_TX|PHL_CTRL_RX);
2083*4882a593Smuzhiyun 	ops->trx_resume(phl_info, PHL_CTRL_TX|PHL_CTRL_RX);
2084*4882a593Smuzhiyun 
2085*4882a593Smuzhiyun 	rtw_hal_start(phl_info->phl_com, phl_info->hal);
2086*4882a593Smuzhiyun 	/* Leave power save */
2087*4882a593Smuzhiyun 	/* scan abort */
2088*4882a593Smuzhiyun 	/* STA disconnect/stop AP/Stop p2p function */
2089*4882a593Smuzhiyun 
2090*4882a593Smuzhiyun 	return phl_status;
2091*4882a593Smuzhiyun }
2092*4882a593Smuzhiyun 
rtw_phl_restart(void * phl)2093*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_restart(void *phl)
2094*4882a593Smuzhiyun {
2095*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;
2096*4882a593Smuzhiyun 
2097*4882a593Smuzhiyun 	phl_status = RTW_PHL_STATUS_SUCCESS;
2098*4882a593Smuzhiyun 
2099*4882a593Smuzhiyun 	return phl_status;
2100*4882a593Smuzhiyun }
2101*4882a593Smuzhiyun 
2102*4882a593Smuzhiyun 
2103*4882a593Smuzhiyun /******************* IO  APIs *******************/
rtw_phl_read8(void * phl,u32 addr)2104*4882a593Smuzhiyun u8 rtw_phl_read8(void *phl, u32 addr)
2105*4882a593Smuzhiyun {
2106*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2107*4882a593Smuzhiyun 
2108*4882a593Smuzhiyun 	return rtw_hal_read8(phl_info->hal, addr);
2109*4882a593Smuzhiyun }
rtw_phl_read16(void * phl,u32 addr)2110*4882a593Smuzhiyun u16 rtw_phl_read16(void *phl, u32 addr)
2111*4882a593Smuzhiyun {
2112*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2113*4882a593Smuzhiyun 
2114*4882a593Smuzhiyun 	return rtw_hal_read16(phl_info->hal, addr);
2115*4882a593Smuzhiyun }
rtw_phl_read32(void * phl,u32 addr)2116*4882a593Smuzhiyun u32 rtw_phl_read32(void *phl, u32 addr)
2117*4882a593Smuzhiyun {
2118*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2119*4882a593Smuzhiyun 
2120*4882a593Smuzhiyun 	return rtw_hal_read32(phl_info->hal, addr);
2121*4882a593Smuzhiyun }
rtw_phl_write8(void * phl,u32 addr,u8 val)2122*4882a593Smuzhiyun void rtw_phl_write8(void *phl, u32 addr, u8 val)
2123*4882a593Smuzhiyun {
2124*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2125*4882a593Smuzhiyun 
2126*4882a593Smuzhiyun 	rtw_hal_write8(phl_info->hal, addr, val);
2127*4882a593Smuzhiyun }
rtw_phl_write16(void * phl,u32 addr,u16 val)2128*4882a593Smuzhiyun void rtw_phl_write16(void *phl, u32 addr, u16 val)
2129*4882a593Smuzhiyun {
2130*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2131*4882a593Smuzhiyun 
2132*4882a593Smuzhiyun 	rtw_hal_write16(phl_info->hal, addr, val);
2133*4882a593Smuzhiyun }
rtw_phl_write32(void * phl,u32 addr,u32 val)2134*4882a593Smuzhiyun void rtw_phl_write32(void *phl, u32 addr, u32 val)
2135*4882a593Smuzhiyun {
2136*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2137*4882a593Smuzhiyun 
2138*4882a593Smuzhiyun 	rtw_hal_write32(phl_info->hal, addr, val);
2139*4882a593Smuzhiyun }
rtw_phl_read_macreg(void * phl,u32 offset,u32 bit_mask)2140*4882a593Smuzhiyun u32 rtw_phl_read_macreg(void *phl, u32 offset, u32 bit_mask)
2141*4882a593Smuzhiyun {
2142*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2143*4882a593Smuzhiyun 
2144*4882a593Smuzhiyun 	return rtw_hal_read_macreg(phl_info->hal, offset, bit_mask);
2145*4882a593Smuzhiyun }
rtw_phl_write_macreg(void * phl,u32 offset,u32 bit_mask,u32 data)2146*4882a593Smuzhiyun void rtw_phl_write_macreg(void *phl,
2147*4882a593Smuzhiyun 			u32 offset, u32 bit_mask, u32 data)
2148*4882a593Smuzhiyun {
2149*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2150*4882a593Smuzhiyun 
2151*4882a593Smuzhiyun 	rtw_hal_write_macreg(phl_info->hal, offset, bit_mask, data);
2152*4882a593Smuzhiyun 
2153*4882a593Smuzhiyun }
rtw_phl_read_bbreg(void * phl,u32 offset,u32 bit_mask)2154*4882a593Smuzhiyun u32 rtw_phl_read_bbreg(void *phl, u32 offset, u32 bit_mask)
2155*4882a593Smuzhiyun {
2156*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2157*4882a593Smuzhiyun 
2158*4882a593Smuzhiyun 	return rtw_hal_read_bbreg(phl_info->hal, offset, bit_mask);
2159*4882a593Smuzhiyun }
rtw_phl_write_bbreg(void * phl,u32 offset,u32 bit_mask,u32 data)2160*4882a593Smuzhiyun void rtw_phl_write_bbreg(void *phl,
2161*4882a593Smuzhiyun 			u32 offset, u32 bit_mask, u32 data)
2162*4882a593Smuzhiyun {
2163*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2164*4882a593Smuzhiyun 
2165*4882a593Smuzhiyun 	rtw_hal_write_bbreg(phl_info->hal, offset, bit_mask, data);
2166*4882a593Smuzhiyun 
2167*4882a593Smuzhiyun }
rtw_phl_read_rfreg(void * phl,enum rf_path path,u32 offset,u32 bit_mask)2168*4882a593Smuzhiyun u32 rtw_phl_read_rfreg(void *phl,
2169*4882a593Smuzhiyun 			enum rf_path path, u32 offset, u32 bit_mask)
2170*4882a593Smuzhiyun {
2171*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2172*4882a593Smuzhiyun 
2173*4882a593Smuzhiyun 	return rtw_hal_read_rfreg(phl_info->hal, path, offset, bit_mask);
2174*4882a593Smuzhiyun }
rtw_phl_write_rfreg(void * phl,enum rf_path path,u32 offset,u32 bit_mask,u32 data)2175*4882a593Smuzhiyun void rtw_phl_write_rfreg(void *phl,
2176*4882a593Smuzhiyun 			enum rf_path path, u32 offset, u32 bit_mask, u32 data)
2177*4882a593Smuzhiyun {
2178*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2179*4882a593Smuzhiyun 
2180*4882a593Smuzhiyun 	rtw_hal_write_rfreg(phl_info->hal, path, offset, bit_mask, data);
2181*4882a593Smuzhiyun 
2182*4882a593Smuzhiyun }
2183*4882a593Smuzhiyun 
rtw_phl_restore_interrupt(void * phl)2184*4882a593Smuzhiyun void rtw_phl_restore_interrupt(void *phl)
2185*4882a593Smuzhiyun {
2186*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2187*4882a593Smuzhiyun 	rtw_hal_restore_interrupt(phl_info->phl_com, phl_info->hal);
2188*4882a593Smuzhiyun }
2189*4882a593Smuzhiyun 
rtw_phl_interrupt_handler(void * phl)2190*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_interrupt_handler(void *phl)
2191*4882a593Smuzhiyun {
2192*4882a593Smuzhiyun 	enum rtw_phl_status phl_status = RTW_PHL_STATUS_SUCCESS;
2193*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2194*4882a593Smuzhiyun 	u32 int_hdler_msk = 0x0;
2195*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
2196*4882a593Smuzhiyun 	struct rtw_phl_evt_ops *ops = &phl_info->phl_com->evt_ops;
2197*4882a593Smuzhiyun #endif /* CONFIG_SYNC_INTERRUPT */
2198*4882a593Smuzhiyun 	int_hdler_msk = rtw_hal_interrupt_handler(phl_info->hal);
2199*4882a593Smuzhiyun 
2200*4882a593Smuzhiyun 	if (!int_hdler_msk) {
2201*4882a593Smuzhiyun 		PHL_WARN("%s : 0x%x\n", __func__, int_hdler_msk);
2202*4882a593Smuzhiyun 		phl_status = RTW_PHL_STATUS_FAILURE;
2203*4882a593Smuzhiyun 		goto end;
2204*4882a593Smuzhiyun 	}
2205*4882a593Smuzhiyun 
2206*4882a593Smuzhiyun 	PHL_DBG("%s : 0x%x\n", __func__, int_hdler_msk);
2207*4882a593Smuzhiyun 	/* beacon interrupt */
2208*4882a593Smuzhiyun 	if (int_hdler_msk & BIT0)
2209*4882a593Smuzhiyun 		;/* todo */
2210*4882a593Smuzhiyun 
2211*4882a593Smuzhiyun 	/* rx interrupt */
2212*4882a593Smuzhiyun 	if (int_hdler_msk & BIT1) {
2213*4882a593Smuzhiyun #if defined(CONFIG_SDIO_HCI) && defined(CONFIG_PHL_SDIO_READ_RXFF_IN_INT)
2214*4882a593Smuzhiyun 		phl_info->hci_trx_ops->recv_rxfifo(phl);
2215*4882a593Smuzhiyun #else
2216*4882a593Smuzhiyun 
2217*4882a593Smuzhiyun #if defined(CONFIG_PCI_HCI)
2218*4882a593Smuzhiyun 		phl_info->hci_trx_ops->read_hw_rx(phl, RX_CH);
2219*4882a593Smuzhiyun #endif
2220*4882a593Smuzhiyun 		phl_status = rtw_phl_start_rx_process(phl);
2221*4882a593Smuzhiyun #endif
2222*4882a593Smuzhiyun 	}
2223*4882a593Smuzhiyun 
2224*4882a593Smuzhiyun 	/* tx interrupt */
2225*4882a593Smuzhiyun 	if (int_hdler_msk & BIT2)
2226*4882a593Smuzhiyun 		;
2227*4882a593Smuzhiyun 
2228*4882a593Smuzhiyun 	/* cmd interrupt */
2229*4882a593Smuzhiyun 	if (int_hdler_msk & BIT3)
2230*4882a593Smuzhiyun 		;/* todo */
2231*4882a593Smuzhiyun 
2232*4882a593Smuzhiyun 	/* halt c2h interrupt */
2233*4882a593Smuzhiyun 	if (int_hdler_msk & BIT4)
2234*4882a593Smuzhiyun 		phl_schedule_handler(phl_info->phl_com,
2235*4882a593Smuzhiyun 		                     &phl_info->phl_ser_handler);
2236*4882a593Smuzhiyun 
2237*4882a593Smuzhiyun 	/* halt c2h interrupt */
2238*4882a593Smuzhiyun 	if (int_hdler_msk & BIT5)
2239*4882a593Smuzhiyun 		phl_status = phl_fw_watchdog_timeout_notify(phl);
2240*4882a593Smuzhiyun 
2241*4882a593Smuzhiyun 	/* halt c2h interrupt - send msg to SER FSM to check ser event */
2242*4882a593Smuzhiyun 	if (int_hdler_msk & BIT6)
2243*4882a593Smuzhiyun 		phl_schedule_handler(phl_info->phl_com,
2244*4882a593Smuzhiyun 		                     &phl_info->phl_ser_handler);
2245*4882a593Smuzhiyun 
2246*4882a593Smuzhiyun 	if (int_hdler_msk & BIT7) {
2247*4882a593Smuzhiyun #if defined(CONFIG_PCI_HCI)
2248*4882a593Smuzhiyun 		phl_info->hci_trx_ops->read_hw_rx(phl, RP_CH);
2249*4882a593Smuzhiyun #endif
2250*4882a593Smuzhiyun 		phl_status = rtw_phl_start_rx_process(phl);
2251*4882a593Smuzhiyun 		phl_schedule_handler(phl_info->phl_com,
2252*4882a593Smuzhiyun 		                     &phl_info->phl_tx_handler);
2253*4882a593Smuzhiyun 	}
2254*4882a593Smuzhiyun 
2255*4882a593Smuzhiyun 	if (phl_status != RTW_PHL_STATUS_SUCCESS)
2256*4882a593Smuzhiyun 		PHL_INFO("rtw_phl_interrupt_handler fail !!\n");
2257*4882a593Smuzhiyun 
2258*4882a593Smuzhiyun end:
2259*4882a593Smuzhiyun 
2260*4882a593Smuzhiyun #ifdef CONFIG_SYNC_INTERRUPT
2261*4882a593Smuzhiyun 	ops->interrupt_restore(phl_to_drvpriv(phl_info), false);
2262*4882a593Smuzhiyun #endif
2263*4882a593Smuzhiyun 	return phl_status;
2264*4882a593Smuzhiyun }
2265*4882a593Smuzhiyun 
rtw_phl_enable_interrupt(void * phl)2266*4882a593Smuzhiyun void rtw_phl_enable_interrupt(void *phl)
2267*4882a593Smuzhiyun {
2268*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2269*4882a593Smuzhiyun 	rtw_hal_enable_interrupt(phl_info->phl_com, phl_info->hal);
2270*4882a593Smuzhiyun }
2271*4882a593Smuzhiyun 
rtw_phl_disable_interrupt(void * phl)2272*4882a593Smuzhiyun void rtw_phl_disable_interrupt(void *phl)
2273*4882a593Smuzhiyun {
2274*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2275*4882a593Smuzhiyun 	rtw_hal_disable_interrupt(phl_info->phl_com, phl_info->hal);
2276*4882a593Smuzhiyun }
2277*4882a593Smuzhiyun 
rtw_phl_recognize_interrupt(void * phl)2278*4882a593Smuzhiyun bool rtw_phl_recognize_interrupt(void *phl)
2279*4882a593Smuzhiyun {
2280*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2281*4882a593Smuzhiyun 
2282*4882a593Smuzhiyun 	return rtw_hal_recognize_interrupt(phl_info->hal);
2283*4882a593Smuzhiyun }
2284*4882a593Smuzhiyun 
rtw_phl_clear_interrupt(void * phl)2285*4882a593Smuzhiyun void rtw_phl_clear_interrupt(void *phl)
2286*4882a593Smuzhiyun {
2287*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2288*4882a593Smuzhiyun 
2289*4882a593Smuzhiyun 	rtw_hal_clear_interrupt(phl_info->hal);
2290*4882a593Smuzhiyun }
2291*4882a593Smuzhiyun 
rtw_phl_msg_hub_register_recver(void * phl,struct phl_msg_receiver * ctx,enum phl_msg_recver_layer layer)2292*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_msg_hub_register_recver(void* phl,
2293*4882a593Smuzhiyun 		struct phl_msg_receiver* ctx, enum phl_msg_recver_layer layer)
2294*4882a593Smuzhiyun {
2295*4882a593Smuzhiyun 	return phl_msg_hub_register_recver(phl, ctx, layer);
2296*4882a593Smuzhiyun }
rtw_phl_msg_hub_update_recver_mask(void * phl,enum phl_msg_recver_layer layer,u8 * mdl_id,u32 len,u8 clr)2297*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_msg_hub_update_recver_mask(void* phl,
2298*4882a593Smuzhiyun 		enum phl_msg_recver_layer layer, u8* mdl_id, u32 len, u8 clr)
2299*4882a593Smuzhiyun {
2300*4882a593Smuzhiyun 	return phl_msg_hub_update_recver_mask(phl, layer, mdl_id, len, clr);
2301*4882a593Smuzhiyun }
rtw_phl_msg_hub_deregister_recver(void * phl,enum phl_msg_recver_layer layer)2302*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_msg_hub_deregister_recver(void* phl,
2303*4882a593Smuzhiyun 					enum phl_msg_recver_layer layer)
2304*4882a593Smuzhiyun {
2305*4882a593Smuzhiyun 	return phl_msg_hub_deregister_recver(phl, layer);
2306*4882a593Smuzhiyun }
rtw_phl_msg_hub_send(void * phl,struct phl_msg_attribute * attr,struct phl_msg * msg)2307*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_msg_hub_send(void* phl,
2308*4882a593Smuzhiyun 			struct phl_msg_attribute* attr, struct phl_msg* msg)
2309*4882a593Smuzhiyun {
2310*4882a593Smuzhiyun 	return phl_msg_hub_send((struct phl_info_t*)phl, attr, msg);
2311*4882a593Smuzhiyun }
2312*4882a593Smuzhiyun #ifdef PHL_PLATFORM_LINUX
rtw_phl_mac_reg_dump(void * sel,void * phl)2313*4882a593Smuzhiyun void rtw_phl_mac_reg_dump(void *sel, void *phl)
2314*4882a593Smuzhiyun {
2315*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2316*4882a593Smuzhiyun 
2317*4882a593Smuzhiyun 	rtw_hal_mac_reg_dump(sel, phl_info->hal);
2318*4882a593Smuzhiyun }
2319*4882a593Smuzhiyun 
rtw_phl_bb_reg_dump(void * sel,void * phl)2320*4882a593Smuzhiyun void rtw_phl_bb_reg_dump(void *sel, void *phl)
2321*4882a593Smuzhiyun {
2322*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2323*4882a593Smuzhiyun 
2324*4882a593Smuzhiyun 	rtw_hal_bb_reg_dump(sel, phl_info->hal);
2325*4882a593Smuzhiyun }
2326*4882a593Smuzhiyun 
rtw_phl_bb_reg_dump_ex(void * sel,void * phl)2327*4882a593Smuzhiyun void rtw_phl_bb_reg_dump_ex(void *sel, void *phl)
2328*4882a593Smuzhiyun {
2329*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2330*4882a593Smuzhiyun 
2331*4882a593Smuzhiyun 	rtw_hal_bb_reg_dump_ex(sel, phl_info->hal);
2332*4882a593Smuzhiyun }
2333*4882a593Smuzhiyun 
rtw_phl_rf_reg_dump(void * sel,void * phl)2334*4882a593Smuzhiyun void rtw_phl_rf_reg_dump(void *sel, void *phl)
2335*4882a593Smuzhiyun {
2336*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2337*4882a593Smuzhiyun 
2338*4882a593Smuzhiyun 	rtw_hal_rf_reg_dump(sel, phl_info->hal);
2339*4882a593Smuzhiyun }
2340*4882a593Smuzhiyun #endif
2341*4882a593Smuzhiyun 
2342*4882a593Smuzhiyun /**
2343*4882a593Smuzhiyun  * rtw_phl_get_sec_cam() - get the security cam raw data from HW
2344*4882a593Smuzhiyun  * @phl:		struct phl_info_t *
2345*4882a593Smuzhiyun  * @num:		How many cam you wnat to dump from the first one.
2346*4882a593Smuzhiyun  * @buf:		ptr to buffer which store the content from HW.
2347*4882a593Smuzhiyun  *			If buf is NULL, use console as debug path.
2348*4882a593Smuzhiyun  * @size		Size of allocated memroy for @buf.
2349*4882a593Smuzhiyun  *			The size should be @num * size of security cam offset(0x20).
2350*4882a593Smuzhiyun  *
2351*4882a593Smuzhiyun  * Return true when function successfully works, otherwise, return fail.
2352*4882a593Smuzhiyun  */
rtw_phl_get_sec_cam(void * phl,u16 num,u8 * buf,u16 size)2353*4882a593Smuzhiyun bool rtw_phl_get_sec_cam(void *phl, u16 num, u8 *buf, u16 size)
2354*4882a593Smuzhiyun {
2355*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2356*4882a593Smuzhiyun 	enum rtw_hal_status ret = RTW_HAL_STATUS_SUCCESS;
2357*4882a593Smuzhiyun 
2358*4882a593Smuzhiyun 	ret = rtw_hal_get_sec_cam(phl_info->hal, num, buf, size);
2359*4882a593Smuzhiyun 	if (ret != RTW_HAL_STATUS_SUCCESS)
2360*4882a593Smuzhiyun 		return false;
2361*4882a593Smuzhiyun 
2362*4882a593Smuzhiyun 	return true;
2363*4882a593Smuzhiyun }
2364*4882a593Smuzhiyun 
2365*4882a593Smuzhiyun /**
2366*4882a593Smuzhiyun  * rtw_phl_get_addr_cam() - get the address cam raw data from HW
2367*4882a593Smuzhiyun  * @phl:		struct phl_info_t *
2368*4882a593Smuzhiyun  * @num:		How many cam you wnat to dump from the first one.
2369*4882a593Smuzhiyun  * @buf:		ptr to buffer which store the content from HW.
2370*4882a593Smuzhiyun  *			If buf is NULL, use console as debug path.
2371*4882a593Smuzhiyun  * @size		Size of allocated memroy for @buf.
2372*4882a593Smuzhiyun  *			The size should be @num * size of Addr cam offset(0x40).
2373*4882a593Smuzhiyun  *
2374*4882a593Smuzhiyun  * Return true when function successfully works, otherwise, return fail.
2375*4882a593Smuzhiyun  */
rtw_phl_get_addr_cam(void * phl,u16 num,u8 * buf,u16 size)2376*4882a593Smuzhiyun bool rtw_phl_get_addr_cam(void *phl, u16 num, u8 *buf, u16 size)
2377*4882a593Smuzhiyun {
2378*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2379*4882a593Smuzhiyun 	enum rtw_hal_status ret = RTW_HAL_STATUS_SUCCESS;
2380*4882a593Smuzhiyun 
2381*4882a593Smuzhiyun 	ret = rtw_hal_get_addr_cam(phl_info->hal, num, buf, size);
2382*4882a593Smuzhiyun 	if (ret != RTW_HAL_STATUS_SUCCESS)
2383*4882a593Smuzhiyun 		return false;
2384*4882a593Smuzhiyun 
2385*4882a593Smuzhiyun 	return true;
2386*4882a593Smuzhiyun }
2387*4882a593Smuzhiyun 
rtw_phl_mac_dbg_status_dump(void * phl,u32 * val,u8 * en)2388*4882a593Smuzhiyun void rtw_phl_mac_dbg_status_dump(void *phl, u32 *val, u8 *en)
2389*4882a593Smuzhiyun {
2390*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2391*4882a593Smuzhiyun 	struct hal_mac_dbg_dump_cfg cfg = {0};
2392*4882a593Smuzhiyun 
2393*4882a593Smuzhiyun 	cfg.ss_dbg_0 = val[0];
2394*4882a593Smuzhiyun 	cfg.ss_dbg_1 = val[1];
2395*4882a593Smuzhiyun 
2396*4882a593Smuzhiyun 	cfg.ss_dbg = (*en & BIT0);
2397*4882a593Smuzhiyun 	cfg.dle_dbg = (*en & BIT1) >> 1;
2398*4882a593Smuzhiyun 	cfg.dmac_dbg = (*en & BIT2) >> 2;
2399*4882a593Smuzhiyun 	cfg.cmac_dbg = (*en & BIT3) >> 3;
2400*4882a593Smuzhiyun 	cfg.mac_dbg_port = (*en & BIT4) >> 4;
2401*4882a593Smuzhiyun 	cfg.plersvd_dbg = (*en & BIT5) >> 5;
2402*4882a593Smuzhiyun 	cfg.tx_flow_dbg = (*en & BIT6) >> 6;
2403*4882a593Smuzhiyun 
2404*4882a593Smuzhiyun 	rtw_hal_dbg_status_dump(phl_info->hal, &cfg);
2405*4882a593Smuzhiyun }
2406*4882a593Smuzhiyun 
rtw_phl_get_mac_addr_efuse(void * phl,u8 * addr)2407*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_get_mac_addr_efuse(void* phl, u8 *addr)
2408*4882a593Smuzhiyun {
2409*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_SUCCESS;
2410*4882a593Smuzhiyun 	enum rtw_hal_status hstatus = RTW_HAL_STATUS_SUCCESS;
2411*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2412*4882a593Smuzhiyun 	void *d = phl_to_drvpriv(phl_info);
2413*4882a593Smuzhiyun 	u8 addr_efuse[MAC_ADDRESS_LENGTH] = {0};
2414*4882a593Smuzhiyun 
2415*4882a593Smuzhiyun 	hstatus = rtw_hal_get_efuse_info(phl_info->hal,
2416*4882a593Smuzhiyun 			EFUSE_INFO_MAC_ADDR,
2417*4882a593Smuzhiyun 			(void *)addr_efuse,
2418*4882a593Smuzhiyun 			MAC_ADDRESS_LENGTH);
2419*4882a593Smuzhiyun 	if (is_broadcast_mac_addr(addr_efuse)) {
2420*4882a593Smuzhiyun 		PHL_INFO("[WARNING] MAC Address from EFUSE is FF:FF:FF:FF:FF:FF\n");
2421*4882a593Smuzhiyun 		hstatus = RTW_HAL_STATUS_FAILURE;
2422*4882a593Smuzhiyun 	}
2423*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != hstatus) {
2424*4882a593Smuzhiyun 		pstatus = RTW_PHL_STATUS_FAILURE;
2425*4882a593Smuzhiyun 	} else {
2426*4882a593Smuzhiyun 		_os_mem_cpy(d, addr, addr_efuse, MAC_ADDRESS_LENGTH);
2427*4882a593Smuzhiyun 		PHL_INFO("%s : 0x%2x - 0x%2x - 0x%2x - 0x%2x - 0x%2x - 0x%2x\n",
2428*4882a593Smuzhiyun 			 __func__, addr[0], addr[1], addr[2],
2429*4882a593Smuzhiyun 			 addr[3], addr[4], addr[5]);
2430*4882a593Smuzhiyun 
2431*4882a593Smuzhiyun 	}
2432*4882a593Smuzhiyun 	return pstatus;
2433*4882a593Smuzhiyun }
2434*4882a593Smuzhiyun 
2435*4882a593Smuzhiyun enum rtw_phl_status
rtw_phl_cfg_trx_path(void * phl,enum rf_path tx,u8 tx_nss,enum rf_path rx,u8 rx_nss)2436*4882a593Smuzhiyun rtw_phl_cfg_trx_path(void* phl, enum rf_path tx, u8 tx_nss,
2437*4882a593Smuzhiyun 		     enum rf_path rx, u8 rx_nss)
2438*4882a593Smuzhiyun {
2439*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_SUCCESS;
2440*4882a593Smuzhiyun 	enum rtw_hal_status hstatus = RTW_HAL_STATUS_SUCCESS;
2441*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2442*4882a593Smuzhiyun 
2443*4882a593Smuzhiyun 	hstatus = rtw_hal_cfg_trx_path(phl_info->hal, tx, tx_nss, rx, rx_nss);
2444*4882a593Smuzhiyun 
2445*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != hstatus)
2446*4882a593Smuzhiyun 		pstatus = RTW_PHL_STATUS_FAILURE;
2447*4882a593Smuzhiyun 
2448*4882a593Smuzhiyun 	return pstatus;
2449*4882a593Smuzhiyun }
2450*4882a593Smuzhiyun 
2451*4882a593Smuzhiyun 
rtw_phl_reset_stat_ma_rssi(struct rtw_phl_com_t * phl_com)2452*4882a593Smuzhiyun void rtw_phl_reset_stat_ma_rssi(struct rtw_phl_com_t *phl_com)
2453*4882a593Smuzhiyun {
2454*4882a593Smuzhiyun 	u8 i = 0, j = 0;
2455*4882a593Smuzhiyun 	PHL_INFO("--> %s\n", __func__);
2456*4882a593Smuzhiyun 	do{
2457*4882a593Smuzhiyun 		if (NULL == phl_com)
2458*4882a593Smuzhiyun 			break;
2459*4882a593Smuzhiyun 
2460*4882a593Smuzhiyun 		_os_spinlock(phl_com->drv_priv,
2461*4882a593Smuzhiyun 			     &(phl_com->rssi_stat.lock), _bh, NULL);
2462*4882a593Smuzhiyun 		for (i = 0; i < RTW_RSSI_TYPE_MAX; i++) {
2463*4882a593Smuzhiyun 			phl_com->rssi_stat.ma_rssi_ele_idx[i] = 0;
2464*4882a593Smuzhiyun 			phl_com->rssi_stat.ma_rssi_ele_cnt[i] = 0;
2465*4882a593Smuzhiyun 			phl_com->rssi_stat.ma_rssi_ele_sum[i] = 0;
2466*4882a593Smuzhiyun 			phl_com->rssi_stat.ma_rssi[i] = 0;
2467*4882a593Smuzhiyun 			for (j = 0; j < PHL_RSSI_MAVG_NUM; j++)
2468*4882a593Smuzhiyun 				phl_com->rssi_stat.ma_rssi_ele[i][j] = 0;
2469*4882a593Smuzhiyun 		}
2470*4882a593Smuzhiyun 		_os_spinunlock(phl_com->drv_priv,
2471*4882a593Smuzhiyun 			       &(phl_com->rssi_stat.lock), _bh, NULL);
2472*4882a593Smuzhiyun 	} while (0);
2473*4882a593Smuzhiyun 
2474*4882a593Smuzhiyun 	PHL_INFO("<-- %s\n", __func__);
2475*4882a593Smuzhiyun }
2476*4882a593Smuzhiyun 
2477*4882a593Smuzhiyun u8
rtw_phl_get_ma_rssi(struct rtw_phl_com_t * phl_com,enum rtw_rssi_type rssi_type)2478*4882a593Smuzhiyun rtw_phl_get_ma_rssi(struct rtw_phl_com_t *phl_com,
2479*4882a593Smuzhiyun 		    enum rtw_rssi_type rssi_type)
2480*4882a593Smuzhiyun {
2481*4882a593Smuzhiyun 
2482*4882a593Smuzhiyun 	u8 ret = 0;
2483*4882a593Smuzhiyun 	if (NULL == phl_com)
2484*4882a593Smuzhiyun 		return ret;
2485*4882a593Smuzhiyun 
2486*4882a593Smuzhiyun 	_os_spinlock(phl_com->drv_priv,
2487*4882a593Smuzhiyun 		     &(phl_com->rssi_stat.lock), _bh, NULL);
2488*4882a593Smuzhiyun 	ret = phl_com->rssi_stat.ma_rssi[rssi_type];
2489*4882a593Smuzhiyun 	_os_spinunlock(phl_com->drv_priv,
2490*4882a593Smuzhiyun 		       &(phl_com->rssi_stat.lock), _bh, NULL);
2491*4882a593Smuzhiyun 
2492*4882a593Smuzhiyun 	return ret;
2493*4882a593Smuzhiyun }
2494*4882a593Smuzhiyun 
2495*4882a593Smuzhiyun #ifdef RTW_WKARD_DYNAMIC_BFEE_CAP
2496*4882a593Smuzhiyun enum rtw_phl_status
rtw_phl_bfee_ctrl(void * phl,struct rtw_wifi_role_t * wrole,bool ctrl)2497*4882a593Smuzhiyun rtw_phl_bfee_ctrl(void *phl, struct rtw_wifi_role_t *wrole, bool ctrl)
2498*4882a593Smuzhiyun {
2499*4882a593Smuzhiyun 	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
2500*4882a593Smuzhiyun 	enum rtw_phl_status pstatus = RTW_PHL_STATUS_SUCCESS;
2501*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS !=
2502*4882a593Smuzhiyun 	    rtw_hal_bf_bfee_ctrl(phl_info->hal, wrole->hw_band, ctrl)) {
2503*4882a593Smuzhiyun 		pstatus = RTW_PHL_STATUS_FAILURE;
2504*4882a593Smuzhiyun 	}
2505*4882a593Smuzhiyun 	return pstatus;
2506*4882a593Smuzhiyun }
2507*4882a593Smuzhiyun #endif
2508*4882a593Smuzhiyun 
2509*4882a593Smuzhiyun u8
rtw_phl_get_sta_mgnt_rssi(struct rtw_phl_stainfo_t * psta)2510*4882a593Smuzhiyun rtw_phl_get_sta_mgnt_rssi(struct rtw_phl_stainfo_t *psta)
2511*4882a593Smuzhiyun {
2512*4882a593Smuzhiyun 	u8 ret = PHL_MAX_RSSI;
2513*4882a593Smuzhiyun 
2514*4882a593Smuzhiyun 	if (psta != NULL) {
2515*4882a593Smuzhiyun 		ret  = psta->hal_sta->rssi_stat.ma_rssi_mgnt;
2516*4882a593Smuzhiyun 	}
2517*4882a593Smuzhiyun 
2518*4882a593Smuzhiyun 	return ret;
2519*4882a593Smuzhiyun }
2520