xref: /OK3568_Linux_fs/external/rkwifibt/drivers/rtl8852be/phl/phl_mcc.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_MCC_C_
16*4882a593Smuzhiyun #include "phl_headers.h"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #ifdef CONFIG_MCC_SUPPORT
19*4882a593Smuzhiyun #include "phl_mcc.h"
_mcc_dump_state(enum rtw_phl_mcc_state * state)20*4882a593Smuzhiyun void _mcc_dump_state(enum rtw_phl_mcc_state *state)
21*4882a593Smuzhiyun {
22*4882a593Smuzhiyun 	if (MCC_NONE == *state) {
23*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_NONE\n");
24*4882a593Smuzhiyun 	} else if (MCC_CFG_EN_INFO == *state) {
25*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_CFG_EN_INFO\n");
26*4882a593Smuzhiyun 	} else if (MCC_TRIGGER_FW_EN == *state) {
27*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_TRIGGER_FW_EN\n");
28*4882a593Smuzhiyun 	} else if (MCC_FW_EN_FAIL == *state) {
29*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_FW_EN_FAIL\n");
30*4882a593Smuzhiyun 	} else if (MCC_RUNING == *state) {
31*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_RUNING\n");
32*4882a593Smuzhiyun 	} else if (MCC_TRIGGER_FW_DIS == *state) {
33*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_TRIGGER_FW_DIS\n");
34*4882a593Smuzhiyun 	} else if (MCC_FW_DIS_FAIL == *state) {
35*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_FW_DIS_FAIL\n");
36*4882a593Smuzhiyun 	} else if (MCC_STOP == *state) {
37*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_state(): MCC_STOP\n");
38*4882a593Smuzhiyun 	} else {
39*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_dump_state(): Undefined state(%d)\n",
40*4882a593Smuzhiyun 			*state);
41*4882a593Smuzhiyun 	}
42*4882a593Smuzhiyun }
43*4882a593Smuzhiyun 
_mcc_dump_mode(enum rtw_phl_tdmra_wmode * mode)44*4882a593Smuzhiyun void _mcc_dump_mode(enum rtw_phl_tdmra_wmode *mode)
45*4882a593Smuzhiyun {
46*4882a593Smuzhiyun 	if (RTW_PHL_TDMRA_AP_CLIENT_WMODE == *mode) {
47*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_mode(): RTW_PHL_TDMRA_AP_CLIENT_WMODE\n");
48*4882a593Smuzhiyun 	} else if (RTW_PHL_TDMRA_2CLIENTS_WMODE == *mode) {
49*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_mode(): RTW_PHL_TDMRA_2CLIENTS_WMODE\n");
50*4882a593Smuzhiyun 	} else if (RTW_PHL_TDMRA_AP_WMODE == *mode) {
51*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_mode(): RTW_PHL_TDMRA_AP_WMODE\n");
52*4882a593Smuzhiyun 	} else {
53*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_dump_mode(): Undefined mode(%d)\n",
54*4882a593Smuzhiyun 			*mode);
55*4882a593Smuzhiyun 	}
56*4882a593Smuzhiyun }
57*4882a593Smuzhiyun 
_mcc_dump_sync_tsf_info(struct rtw_phl_mcc_sync_tsf_info * info)58*4882a593Smuzhiyun void _mcc_dump_sync_tsf_info(struct rtw_phl_mcc_sync_tsf_info *info)
59*4882a593Smuzhiyun {
60*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_sync_tsf_info(): sync_en(%d), source macid(%d), target macid(%d), offset(%d)\n",
61*4882a593Smuzhiyun 		info->sync_en, info->source, info->target, info->offset);
62*4882a593Smuzhiyun }
63*4882a593Smuzhiyun 
_mcc_dump_dur_info(struct rtw_phl_mcc_dur_info * dur_i)64*4882a593Smuzhiyun void _mcc_dump_dur_info(struct rtw_phl_mcc_dur_info *dur_i)
65*4882a593Smuzhiyun {
66*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_lim_info *dur_l = NULL;
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun 	dur_l = &dur_i->dur_limit;
69*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_dump_role_info(): dur(%d), dur lim info: enable(%d), tag(%d), max_dur(%d)\n",
70*4882a593Smuzhiyun 		dur_i->dur, dur_l->enable, dur_l->tag, dur_l->max_dur);
71*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< _mcc_dump_role_info(): max_toa(%d), max_tob(%d)\n",
72*4882a593Smuzhiyun 		dur_l->max_toa, dur_l->max_tob);
73*4882a593Smuzhiyun }
74*4882a593Smuzhiyun 
_mcc_dump_role_info(struct rtw_phl_mcc_role * mrole)75*4882a593Smuzhiyun void _mcc_dump_role_info(struct rtw_phl_mcc_role *mrole)
76*4882a593Smuzhiyun {
77*4882a593Smuzhiyun 	struct rtw_phl_mcc_policy_info *policy = &mrole->policy;
78*4882a593Smuzhiyun 	u8 i = 0;
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	policy = &mrole->policy;
81*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_dump_role_info(): wrole id(%d), type(%d), macid(%d), bcn_intvl(%d)\n",
82*4882a593Smuzhiyun 		mrole->wrole->id, mrole->wrole->type, mrole->macid,
83*4882a593Smuzhiyun 		mrole->bcn_intvl);
84*4882a593Smuzhiyun 	for (i = 0; i < PHL_MACID_MAX_ARRAY_NUM; i++) {
85*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_role_info(): macid_map[%d]= 0x%08X\n",
86*4882a593Smuzhiyun 			i, mrole->used_macid.bitmap[i]);
87*4882a593Smuzhiyun 	}
88*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_role_info(): chan(%d), center_ch(%d), bw(%d), offset(%d)\n",
89*4882a593Smuzhiyun 		mrole->chandef->chan, mrole->chandef->center_ch,
90*4882a593Smuzhiyun 		mrole->chandef->bw, mrole->chandef->offset);
91*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_role_info(): group(%d), c2h_rpt(%d), tx_null_early(%d)\n",
92*4882a593Smuzhiyun 		mrole->group, policy->c2h_rpt, policy->tx_null_early);
93*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_role_info(): dis_tx_null(%d), in_curr_ch(%d), dis_sw_retry(%d)\n",
94*4882a593Smuzhiyun 		policy->dis_tx_null, policy->in_curr_ch, policy->dis_sw_retry);
95*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_role_info(): sw_retry_count(%d), rfk_chk(%d)\n",
96*4882a593Smuzhiyun 		policy->sw_retry_count, policy->rfk_chk);
97*4882a593Smuzhiyun 	_mcc_dump_dur_info(&policy->dur_info);
98*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< _mcc_dump_role_info(): courtesy_en(%d), courtesy_num(%d), courtesy_target(0x%x)\n",
99*4882a593Smuzhiyun 		policy->courtesy_en, policy->courtesy_num,
100*4882a593Smuzhiyun 		policy->courtesy_target);
101*4882a593Smuzhiyun }
102*4882a593Smuzhiyun 
_mcc_dump_pattern(struct rtw_phl_mcc_pattern * m_pattern)103*4882a593Smuzhiyun void _mcc_dump_pattern(struct rtw_phl_mcc_pattern *m_pattern)
104*4882a593Smuzhiyun {
105*4882a593Smuzhiyun 	struct rtw_phl_mcc_courtesy *courtesy_i = &m_pattern->courtesy_i;
106*4882a593Smuzhiyun 
107*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_dump_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d), bcns_offset(%d), calc_fail(%d), d_r_d_a_spacing_max(%d), c_en(%d)\n",
108*4882a593Smuzhiyun 		m_pattern->tob_r, m_pattern->toa_r, m_pattern->tob_a,
109*4882a593Smuzhiyun 		m_pattern->toa_a, m_pattern->bcns_offset, m_pattern->calc_fail,
110*4882a593Smuzhiyun 		m_pattern->d_r_d_a_spacing_max, courtesy_i->c_en);
111*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_pattern(): slot_num(%d), bt_slot_num(%d)\n",
112*4882a593Smuzhiyun 		m_pattern->slot_num, m_pattern->bt_slot_num);
113*4882a593Smuzhiyun 	if (courtesy_i->c_en) {
114*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< _mcc_dump_pattern(): c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
115*4882a593Smuzhiyun 			courtesy_i->c_en, courtesy_i->c_num,
116*4882a593Smuzhiyun 			courtesy_i->src_role->macid,
117*4882a593Smuzhiyun 			courtesy_i->tgt_role->macid);
118*4882a593Smuzhiyun 	}
119*4882a593Smuzhiyun }
120*4882a593Smuzhiyun 
_mcc_dump_ref_role_info(struct rtw_phl_mcc_en_info * info)121*4882a593Smuzhiyun void _mcc_dump_ref_role_info(struct rtw_phl_mcc_en_info *info)
122*4882a593Smuzhiyun {
123*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *ref_role = NULL;
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun 	ref_role = get_ref_role(info);
126*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_ref_role_info(): mrole idx(%d), wrole id(%d), macid(%d) chan(%d), bw(%d), offset(%d)\n",
127*4882a593Smuzhiyun 		info->ref_role_idx, ref_role->wrole->id, ref_role->macid,
128*4882a593Smuzhiyun 		ref_role->chandef->chan, ref_role->chandef->bw,
129*4882a593Smuzhiyun 		ref_role->chandef->offset);
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun 
_mcc_dump_en_info(struct rtw_phl_mcc_en_info * info)132*4882a593Smuzhiyun void _mcc_dump_en_info(struct rtw_phl_mcc_en_info *info)
133*4882a593Smuzhiyun {
134*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
135*4882a593Smuzhiyun 	u8 midx = 0;
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_en_info(): mrole_map(0x%x), role_num(%d), mcc_intvl(%d), Start tsf(0x%08X %08X)\n",
138*4882a593Smuzhiyun 		info->mrole_map, info->mrole_num, info->mcc_intvl,
139*4882a593Smuzhiyun 		info->tsf_high, info->tsf_low);
140*4882a593Smuzhiyun 	_mcc_dump_ref_role_info(info);
141*4882a593Smuzhiyun 	_mcc_dump_sync_tsf_info(&info->sync_tsf_info);
142*4882a593Smuzhiyun 	_mcc_dump_pattern(&info->m_pattern);
143*4882a593Smuzhiyun 	for (midx = 0; midx < MCC_ROLE_NUM; midx++) {
144*4882a593Smuzhiyun 		if (!(info->mrole_map & BIT(midx)))
145*4882a593Smuzhiyun 			continue;
146*4882a593Smuzhiyun 		m_role = &info->mcc_role[midx];
147*4882a593Smuzhiyun 		_mcc_dump_role_info(m_role);
148*4882a593Smuzhiyun 	}
149*4882a593Smuzhiyun }
150*4882a593Smuzhiyun 
_mcc_dump_bt_ino(struct rtw_phl_mcc_bt_info * bt_info)151*4882a593Smuzhiyun void _mcc_dump_bt_ino(struct rtw_phl_mcc_bt_info *bt_info)
152*4882a593Smuzhiyun {
153*4882a593Smuzhiyun 	u8 seg_num = BT_SEG_NUM;
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	if (bt_info->bt_seg_num > seg_num)
156*4882a593Smuzhiyun 		return;
157*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_dump_bt_ino(): bt_dur(%d), bt_seg_num(%d), bt_seg[0](%d), bt_seg[1](%d), add_bt_role(%d)\n",
158*4882a593Smuzhiyun 		bt_info->bt_dur, bt_info->bt_seg_num, bt_info->bt_seg[0],
159*4882a593Smuzhiyun 		bt_info->bt_seg[1], bt_info->add_bt_role);
160*4882a593Smuzhiyun }
161*4882a593Smuzhiyun 
_mcc_dump_mcc_info(struct phl_mcc_info * minfo)162*4882a593Smuzhiyun void _mcc_dump_mcc_info(struct phl_mcc_info *minfo)
163*4882a593Smuzhiyun {
164*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_dump_mcc_info():\n");
165*4882a593Smuzhiyun 	_mcc_dump_mode(&minfo->mcc_mode);
166*4882a593Smuzhiyun 	_mcc_dump_state(&minfo->state);
167*4882a593Smuzhiyun 	_mcc_dump_bt_ino(&minfo->bt_info);
168*4882a593Smuzhiyun 	_mcc_dump_en_info(&minfo->en_info);
169*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< _mcc_dump_mcc_info():\n");
170*4882a593Smuzhiyun }
171*4882a593Smuzhiyun 
_mcc_set_state(struct phl_mcc_info * minfo,enum rtw_phl_mcc_state state)172*4882a593Smuzhiyun void _mcc_set_state(struct phl_mcc_info *minfo, enum rtw_phl_mcc_state state)
173*4882a593Smuzhiyun {
174*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ALWAYS_, "_mcc_set_state(): Set from (%d) to (%d)\n",
175*4882a593Smuzhiyun 		minfo->state, state);
176*4882a593Smuzhiyun 	minfo->state = state;
177*4882a593Smuzhiyun 	_mcc_dump_state(&minfo->state);
178*4882a593Smuzhiyun }
179*4882a593Smuzhiyun 
_mcc_is_ap_category(struct rtw_wifi_role_t * wrole)180*4882a593Smuzhiyun bool _mcc_is_ap_category(struct rtw_wifi_role_t *wrole)
181*4882a593Smuzhiyun {
182*4882a593Smuzhiyun 	bool ret = false;
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 	if (wrole->type == PHL_RTYPE_AP || wrole->type == PHL_RTYPE_P2P_GO)
185*4882a593Smuzhiyun 		ret = true;
186*4882a593Smuzhiyun 	return ret;
187*4882a593Smuzhiyun }
188*4882a593Smuzhiyun 
_mcc_is_client_category(struct rtw_wifi_role_t * wrole)189*4882a593Smuzhiyun bool _mcc_is_client_category(struct rtw_wifi_role_t *wrole)
190*4882a593Smuzhiyun {
191*4882a593Smuzhiyun 	bool ret = false;
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	if (wrole->type == PHL_RTYPE_STATION || wrole->type == PHL_RTYPE_P2P_GC || wrole->type == PHL_RTYPE_TDLS)
194*4882a593Smuzhiyun 		ret = true;
195*4882a593Smuzhiyun 	return ret;
196*4882a593Smuzhiyun }
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun struct rtw_phl_mcc_role *
_mcc_get_mrole_by_wrole(struct phl_mcc_info * minfo,struct rtw_wifi_role_t * wrole)199*4882a593Smuzhiyun _mcc_get_mrole_by_wrole(struct phl_mcc_info *minfo,
200*4882a593Smuzhiyun 				struct rtw_wifi_role_t *wrole)
201*4882a593Smuzhiyun {
202*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
203*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
204*4882a593Smuzhiyun 	u8 midx = 0;
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 	for (midx = 0; midx < MCC_ROLE_NUM; midx++) {
207*4882a593Smuzhiyun 		if (!(en_info->mrole_map & BIT(midx)))
208*4882a593Smuzhiyun 			continue;
209*4882a593Smuzhiyun 		m_role = &en_info->mcc_role[midx];
210*4882a593Smuzhiyun 		if (m_role->wrole == wrole) {
211*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_get_mrole_by_wrole(): Get mrole in mrole_idx(%d), wrole->type(%d), wrole->id(%d)\n",
212*4882a593Smuzhiyun 				midx, wrole->type, wrole->id);
213*4882a593Smuzhiyun 			return m_role;
214*4882a593Smuzhiyun 		}
215*4882a593Smuzhiyun 	}
216*4882a593Smuzhiyun 	return NULL;
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun u8
_mcc_get_mrole_idx_by_wrole(struct phl_mcc_info * minfo,struct rtw_wifi_role_t * wrole,u8 * idx)220*4882a593Smuzhiyun _mcc_get_mrole_idx_by_wrole(struct phl_mcc_info *minfo,
221*4882a593Smuzhiyun 				struct rtw_wifi_role_t *wrole, u8 *idx)
222*4882a593Smuzhiyun {
223*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
224*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
225*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
226*4882a593Smuzhiyun 	u8 midx = 0;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	for (midx = 0; midx < MCC_ROLE_NUM; midx++) {
229*4882a593Smuzhiyun 		if (!(en_info->mrole_map & BIT(midx)))
230*4882a593Smuzhiyun 			continue;
231*4882a593Smuzhiyun 		m_role = &en_info->mcc_role[midx];
232*4882a593Smuzhiyun 		if (m_role->wrole == wrole) {
233*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_get_mrole_idx_by_wrole(): Get mrole in mrole_idx(%d)\n",
234*4882a593Smuzhiyun 				midx);
235*4882a593Smuzhiyun 			*idx = midx;
236*4882a593Smuzhiyun 			status = RTW_PHL_STATUS_SUCCESS;
237*4882a593Smuzhiyun 			break;
238*4882a593Smuzhiyun 		}
239*4882a593Smuzhiyun 	}
240*4882a593Smuzhiyun 	return status;
241*4882a593Smuzhiyun }
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun struct rtw_phl_mcc_role *
_mcc_get_mrole_by_category(struct rtw_phl_mcc_en_info * en_info,enum _mcc_role_cat category)244*4882a593Smuzhiyun _mcc_get_mrole_by_category(struct rtw_phl_mcc_en_info *en_info,
245*4882a593Smuzhiyun 			enum _mcc_role_cat category)
246*4882a593Smuzhiyun {
247*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
248*4882a593Smuzhiyun 	u8 midx = 0;
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	for (midx = 0; midx < MCC_ROLE_NUM; midx++) {
251*4882a593Smuzhiyun 		if (!(en_info->mrole_map & BIT(midx)))
252*4882a593Smuzhiyun 			continue;
253*4882a593Smuzhiyun 		m_role = &en_info->mcc_role[midx];
254*4882a593Smuzhiyun 		if (MCC_ROLE_AP_CAT == category) {
255*4882a593Smuzhiyun 			if (_mcc_is_ap_category(m_role->wrole))
256*4882a593Smuzhiyun 				return m_role;
257*4882a593Smuzhiyun 		} else if (MCC_ROLE_CLIENT_CAT == category) {
258*4882a593Smuzhiyun 			if (_mcc_is_client_category(m_role->wrole))
259*4882a593Smuzhiyun 				return m_role;
260*4882a593Smuzhiyun 		} else {
261*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_get_mrole_by_category(): Undefined category(%d)\n",
262*4882a593Smuzhiyun 				category);
263*4882a593Smuzhiyun 			break;
264*4882a593Smuzhiyun 		}
265*4882a593Smuzhiyun 	}
266*4882a593Smuzhiyun 	return NULL;
267*4882a593Smuzhiyun }
268*4882a593Smuzhiyun 
_mcc_transfer_mode(struct phl_info_t * phl,struct phl_mcc_info * minfo,u8 role_map)269*4882a593Smuzhiyun enum rtw_phl_status _mcc_transfer_mode(struct phl_info_t *phl,
270*4882a593Smuzhiyun 				struct phl_mcc_info *minfo, u8 role_map)
271*4882a593Smuzhiyun {
272*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
273*4882a593Smuzhiyun 	struct rtw_wifi_role_t *wrole = NULL;
274*4882a593Smuzhiyun 	u8 ridx = 0, ap_num = 0, client_num = 0;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	for (ridx = 0; ridx < MAX_WIFI_ROLE_NUMBER; ridx++) {
277*4882a593Smuzhiyun 		if (!(role_map & BIT(ridx)))
278*4882a593Smuzhiyun 			continue;
279*4882a593Smuzhiyun 		wrole = rtw_phl_get_wrole_by_ridx(phl->phl_com, ridx);
280*4882a593Smuzhiyun 		if (wrole == NULL) {
281*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_transfer_mode(): get wrole fail, role_idx(%d)\n",
282*4882a593Smuzhiyun 				ridx);
283*4882a593Smuzhiyun 			goto exit;
284*4882a593Smuzhiyun 		}
285*4882a593Smuzhiyun 		if (_mcc_is_client_category(wrole)) {
286*4882a593Smuzhiyun 			client_num++;
287*4882a593Smuzhiyun 		} else if (_mcc_is_ap_category(wrole)) {
288*4882a593Smuzhiyun 			ap_num++;
289*4882a593Smuzhiyun 		} else {
290*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_transfer_mode(): undefined category, role->type(%d), ridx(%d), shall check code flow\n",
291*4882a593Smuzhiyun 				wrole->type, ridx);
292*4882a593Smuzhiyun 			goto exit;
293*4882a593Smuzhiyun 		}
294*4882a593Smuzhiyun 	}
295*4882a593Smuzhiyun 	if ((client_num + ap_num > MAX_MCC_GROUP_ROLE)){
296*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_transfer_mode(): client_num(%d) + ap_num(%d) is illegal num, please check code flow\n",
297*4882a593Smuzhiyun 			client_num, ap_num);
298*4882a593Smuzhiyun 		goto exit;
299*4882a593Smuzhiyun 	}
300*4882a593Smuzhiyun 	if (ap_num == 1 && client_num == 1) {
301*4882a593Smuzhiyun 		minfo->mcc_mode = RTW_PHL_TDMRA_AP_CLIENT_WMODE;
302*4882a593Smuzhiyun 	} else if (ap_num == 0 && client_num == 2) {
303*4882a593Smuzhiyun 		minfo->mcc_mode = RTW_PHL_TDMRA_2CLIENTS_WMODE;
304*4882a593Smuzhiyun 	} else if (ap_num == 1 && client_num == 0) {
305*4882a593Smuzhiyun 		minfo->mcc_mode = RTW_PHL_TDMRA_AP_WMODE;
306*4882a593Smuzhiyun 	} else {
307*4882a593Smuzhiyun 		minfo->mcc_mode = RTW_PHL_TDMRA_UNKNOWN_WMODE;
308*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_transfer_mode(): Undefined mode, please check code flow\n");
309*4882a593Smuzhiyun 		goto exit;
310*4882a593Smuzhiyun 	}
311*4882a593Smuzhiyun 	_mcc_dump_mode(&minfo->mcc_mode);
312*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
313*4882a593Smuzhiyun exit:
314*4882a593Smuzhiyun 	return status;
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun 
_mcc_get_role_map(struct phl_info_t * phl,struct hw_band_ctl_t * band_ctrl,u8 * role_map)317*4882a593Smuzhiyun enum rtw_phl_status _mcc_get_role_map(struct phl_info_t *phl,
318*4882a593Smuzhiyun 				struct hw_band_ctl_t *band_ctrl, u8 *role_map)
319*4882a593Smuzhiyun {
320*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
321*4882a593Smuzhiyun 	void *drv = phl_to_drvpriv(phl);
322*4882a593Smuzhiyun 	struct rtw_chan_ctx *chanctx = NULL;
323*4882a593Smuzhiyun 	_os_list *chan_ctx_list = &band_ctrl->chan_ctx_queue.queue;
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	*role_map = 0;
326*4882a593Smuzhiyun 	_os_spinlock(drv, &band_ctrl->chan_ctx_queue.lock, _ps, NULL);
327*4882a593Smuzhiyun 	phl_list_for_loop(chanctx, struct rtw_chan_ctx, chan_ctx_list, list) {
328*4882a593Smuzhiyun 		*role_map |= chanctx->role_map;
329*4882a593Smuzhiyun 	}
330*4882a593Smuzhiyun 	_os_spinunlock(drv, &band_ctrl->chan_ctx_queue.lock, _ps, NULL);
331*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_get_role_map(): role_map(%d)\n",
332*4882a593Smuzhiyun 		*role_map);
333*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
334*4882a593Smuzhiyun 	return status;
335*4882a593Smuzhiyun }
336*4882a593Smuzhiyun 
_mcc_set_fw_log_info(struct phl_info_t * phl,u8 hw_band,bool en_fw_mcc_log,u8 fw_mcc_log_lv)337*4882a593Smuzhiyun void _mcc_set_fw_log_info(struct phl_info_t *phl, u8 hw_band,
338*4882a593Smuzhiyun 			bool en_fw_mcc_log, u8 fw_mcc_log_lv)
339*4882a593Smuzhiyun {
340*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = get_mcc_info(phl, hw_band);
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	if (minfo->fw_log_i.en_fw_mcc_log != en_fw_mcc_log) {
343*4882a593Smuzhiyun 		minfo->fw_log_i.en_fw_mcc_log = en_fw_mcc_log;
344*4882a593Smuzhiyun 		minfo->fw_log_i.update = true;
345*4882a593Smuzhiyun 	}
346*4882a593Smuzhiyun 	if (minfo->fw_log_i.fw_mcc_log_lv != fw_mcc_log_lv) {
347*4882a593Smuzhiyun 		minfo->fw_log_i.fw_mcc_log_lv = fw_mcc_log_lv;
348*4882a593Smuzhiyun 		minfo->fw_log_i.update = true;
349*4882a593Smuzhiyun 	}
350*4882a593Smuzhiyun }
351*4882a593Smuzhiyun 
_mcc_up_fw_log_setting(struct phl_info_t * phl,struct phl_mcc_info * minfo)352*4882a593Smuzhiyun void _mcc_up_fw_log_setting(struct phl_info_t *phl, struct phl_mcc_info *minfo)
353*4882a593Smuzhiyun {
354*4882a593Smuzhiyun 	struct phl_mcc_fw_log_info *fw_log_i = &minfo->fw_log_i;
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	if (fw_log_i->update) {
357*4882a593Smuzhiyun 		rtw_hal_cfg_fw_mcc_log(phl->hal, fw_log_i->en_fw_mcc_log);
358*4882a593Smuzhiyun 		fw_log_i->update = false;
359*4882a593Smuzhiyun 	}
360*4882a593Smuzhiyun }
361*4882a593Smuzhiyun 
_mcc_set_unspecific_dur(struct phl_mcc_info * minfo)362*4882a593Smuzhiyun void _mcc_set_unspecific_dur(struct phl_mcc_info *minfo)
363*4882a593Smuzhiyun {
364*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
365*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
366*4882a593Smuzhiyun 	u8 midx = 0;
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 	for (midx = 0; midx < MCC_ROLE_NUM; midx++) {
369*4882a593Smuzhiyun 		if (!(en_info->mrole_map & BIT(midx)))
370*4882a593Smuzhiyun 			continue;
371*4882a593Smuzhiyun 		m_role = &en_info->mcc_role[midx];
372*4882a593Smuzhiyun 		m_role->policy.dur_info.dur = MCC_DUR_NONSPECIFIC;
373*4882a593Smuzhiyun 	}
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun 
_mcc_fill_dur_lim_info(struct phl_info_t * phl,struct rtw_phl_mcc_role * mrole,struct phl_mcc_dur_lim_req_info * dur_req)376*4882a593Smuzhiyun void _mcc_fill_dur_lim_info(struct phl_info_t *phl,
377*4882a593Smuzhiyun 				struct rtw_phl_mcc_role *mrole,
378*4882a593Smuzhiyun 				struct phl_mcc_dur_lim_req_info *dur_req)
379*4882a593Smuzhiyun {
380*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_info *dur_i = &mrole->policy.dur_info;
381*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_lim_info *dur_lim = &dur_i->dur_limit;
382*4882a593Smuzhiyun 	u64 tsf_lim = 0;
383*4882a593Smuzhiyun 	u32 max_toa = 0, max_tob = 0, max_dur = 0;
384*4882a593Smuzhiyun 	u32 bcn_intvl = mrole->bcn_intvl * TU;
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_dur_lim_info(): dur_req: tag(%d), enable(%d), start_t_h(0x%08x), start_t_l(0x%08x), dur(%d), intvl(%d)\n",
387*4882a593Smuzhiyun 		dur_req->tag, dur_req->enable, dur_req->start_t_h,
388*4882a593Smuzhiyun 		dur_req->start_t_l, dur_req->dur, dur_req->intvl);
389*4882a593Smuzhiyun 	dur_lim->enable = false;
390*4882a593Smuzhiyun 	if (!dur_req->enable) {
391*4882a593Smuzhiyun 		goto exit;
392*4882a593Smuzhiyun 	}
393*4882a593Smuzhiyun 	if (bcn_intvl != dur_req->intvl) {
394*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_dur_lim_info(): not support bcn_intvl(%d) != dur_req.intvl(%d), please check code\n",
395*4882a593Smuzhiyun 			bcn_intvl, dur_req->intvl);
396*4882a593Smuzhiyun 		goto exit;
397*4882a593Smuzhiyun 	}
398*4882a593Smuzhiyun 	/*Assume bcn allocat in TSF % BcnInvtal = 0*/
399*4882a593Smuzhiyun 	tsf_lim = dur_req->start_t_h;
400*4882a593Smuzhiyun 	tsf_lim = tsf_lim << 32;
401*4882a593Smuzhiyun 	tsf_lim |= dur_req->start_t_l;
402*4882a593Smuzhiyun 	max_toa = (u16)_os_modular64(tsf_lim, mrole->bcn_intvl * TU);
403*4882a593Smuzhiyun 	if (max_toa >= (mrole->bcn_intvl * TU - dur_req->dur) ||
404*4882a593Smuzhiyun 		max_toa == 0) {
405*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_dur_lim_info(): not support bcn allocate in limited slot, please check code\n");
406*4882a593Smuzhiyun 		goto exit;
407*4882a593Smuzhiyun 	}
408*4882a593Smuzhiyun 	max_dur = dur_req->intvl - dur_req->dur;
409*4882a593Smuzhiyun 	max_toa = max_toa / TU;
410*4882a593Smuzhiyun 	max_dur = max_dur / TU;
411*4882a593Smuzhiyun 	max_tob = max_dur - max_toa;
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 	dur_lim->max_toa = (u16)max_toa;
414*4882a593Smuzhiyun 	dur_lim->max_tob = (u16)max_tob;
415*4882a593Smuzhiyun 	dur_lim->max_dur = (u16)max_dur;
416*4882a593Smuzhiyun 	dur_lim->tag = dur_req->tag;
417*4882a593Smuzhiyun 	dur_lim->enable = true;
418*4882a593Smuzhiyun exit:
419*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_dur_lim_info(): dur_lim_info: enable(%d), tag(%d), max_toa(%d), max_tob(%d), max_dur(%d)\n",
420*4882a593Smuzhiyun 			dur_lim->enable, dur_lim->tag, dur_lim->max_toa,
421*4882a593Smuzhiyun 			dur_lim->max_tob, dur_lim->max_dur);
422*4882a593Smuzhiyun 	return;
423*4882a593Smuzhiyun }
424*4882a593Smuzhiyun 
_mcc_fill_default_policy(struct phl_info_t * phl,struct rtw_phl_mcc_role * mrole)425*4882a593Smuzhiyun void _mcc_fill_default_policy(struct phl_info_t *phl,
426*4882a593Smuzhiyun 				struct rtw_phl_mcc_role *mrole)
427*4882a593Smuzhiyun {
428*4882a593Smuzhiyun 	struct rtw_phl_mcc_policy_info *policy = &mrole->policy;
429*4882a593Smuzhiyun 	struct phl_mcc_dur_lim_req_info dur_req = {0};
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_default_policy(): set mcc policy by default setting\n");
432*4882a593Smuzhiyun 	policy->c2h_rpt = RTW_MCC_RPT_ALL;
433*4882a593Smuzhiyun 	policy->tx_null_early = 3;
434*4882a593Smuzhiyun 	policy->dis_tx_null = _mcc_is_client_category(mrole->wrole) ? 0 : 1;
435*4882a593Smuzhiyun 	policy->in_curr_ch = 0;
436*4882a593Smuzhiyun 	policy->dis_sw_retry = 1;
437*4882a593Smuzhiyun 	policy->sw_retry_count = 0;
438*4882a593Smuzhiyun 	policy->dur_info.dur = _mcc_is_client_category(mrole->wrole) ?
439*4882a593Smuzhiyun 					DEFAULT_CLIENT_DUR : DEFAULT_AP_DUR;
440*4882a593Smuzhiyun 	phl_mr_mcc_query_role_time_slot_lim(phl, mrole->wrole, &dur_req);
441*4882a593Smuzhiyun 	_mcc_fill_dur_lim_info(phl, mrole, &dur_req);
442*4882a593Smuzhiyun 	policy->rfk_chk = rtw_hal_check_ch_rfk(phl->hal, &mrole->wrole->chandef);
443*4882a593Smuzhiyun 	if (false == policy->rfk_chk) {
444*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_default_policy(): No rfk, it will degrade perormance, please check code\n");
445*4882a593Smuzhiyun 	}
446*4882a593Smuzhiyun }
447*4882a593Smuzhiyun 
_mcc_fill_mcc_role_policy_info(struct phl_info_t * phl,struct rtw_wifi_role_t * wrole,struct rtw_phl_mcc_role * mrole)448*4882a593Smuzhiyun void _mcc_fill_mcc_role_policy_info(struct phl_info_t *phl,
449*4882a593Smuzhiyun 		struct rtw_wifi_role_t *wrole, struct rtw_phl_mcc_role *mrole)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun 	struct phl_com_mcc_info *com_info = phl_to_com_mcc_info(phl);
452*4882a593Smuzhiyun 	struct rtw_phl_mcc_policy_info *policy = &mrole->policy;
453*4882a593Smuzhiyun 	struct rtw_phl_mcc_setting_info param = {0};
454*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = get_mcc_info(phl, wrole->hw_band);
455*4882a593Smuzhiyun 
456*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, ">>> _mcc_fill_mcc_role_policy_info()\n");
457*4882a593Smuzhiyun 	_mcc_fill_default_policy(phl, mrole);
458*4882a593Smuzhiyun 	if (NULL == com_info->ops.mcc_get_setting)
459*4882a593Smuzhiyun 		goto exit;
460*4882a593Smuzhiyun 	param.wrole = wrole;
461*4882a593Smuzhiyun 	param.role_map = minfo->role_map;
462*4882a593Smuzhiyun 	param.tx_null_early = NONSPECIFIC_SETTING;
463*4882a593Smuzhiyun 	param.dur = NONSPECIFIC_SETTING;
464*4882a593Smuzhiyun 	if (!com_info->ops.mcc_get_setting(com_info->ops.priv, &param)) {
465*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_mcc_role_policy_info(): mcc_get_setting from core layer fail\n");
466*4882a593Smuzhiyun 		goto exit;
467*4882a593Smuzhiyun 	}
468*4882a593Smuzhiyun 	if (NONSPECIFIC_SETTING != param.tx_null_early) {
469*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_mcc_role_policy_info(): Core layer change tx_null_early from %d to %d\n",
470*4882a593Smuzhiyun 			policy->tx_null_early, param.tx_null_early);
471*4882a593Smuzhiyun 		policy->tx_null_early = param.tx_null_early;
472*4882a593Smuzhiyun 	}
473*4882a593Smuzhiyun 	if (NONSPECIFIC_SETTING != param.dur) {
474*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_mcc_role_policy_info(): Core layer change dur from %d to %d\n",
475*4882a593Smuzhiyun 			policy->dur_info.dur, param.dur);
476*4882a593Smuzhiyun 		policy->dur_info.dur = param.dur;
477*4882a593Smuzhiyun 	}
478*4882a593Smuzhiyun 	_mcc_set_fw_log_info(phl, wrole->hw_band, param.en_fw_mcc_log,
479*4882a593Smuzhiyun 				param.fw_mcc_log_lv);
480*4882a593Smuzhiyun exit:
481*4882a593Smuzhiyun 	return;
482*4882a593Smuzhiyun }
483*4882a593Smuzhiyun 
_mcc_fill_macid_bitmap_by_role(struct phl_info_t * phl,struct rtw_phl_mcc_role * mrole)484*4882a593Smuzhiyun void _mcc_fill_macid_bitmap_by_role(struct phl_info_t *phl,
485*4882a593Smuzhiyun 					struct rtw_phl_mcc_role *mrole)
486*4882a593Smuzhiyun {
487*4882a593Smuzhiyun 	struct macid_ctl_t *mc = phl_to_mac_ctrl(phl);
488*4882a593Smuzhiyun 	struct rtw_phl_mcc_macid_bitmap *used_macid = &mrole->used_macid;
489*4882a593Smuzhiyun 	u8 i = 0, max_map_idx = 0;
490*4882a593Smuzhiyun 
491*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_fill_macid_bitmap_by_role()\n");
492*4882a593Smuzhiyun 	for (i = 0; i < PHL_MACID_MAX_ARRAY_NUM; i++) {
493*4882a593Smuzhiyun 		if ((mc->wifi_role_usedmap[mrole->wrole->id][i] != 0) &&
494*4882a593Smuzhiyun 							(max_map_idx <= i)) {
495*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_macid_bitmap_by_role(): macid_map[%d]=0x%08x\n",
496*4882a593Smuzhiyun 				i, mc->wifi_role_usedmap[mrole->wrole->id][i]);
497*4882a593Smuzhiyun 			max_map_idx = i;
498*4882a593Smuzhiyun 		}
499*4882a593Smuzhiyun 	}
500*4882a593Smuzhiyun 	used_macid->bitmap = &mc->wifi_role_usedmap[mrole->wrole->id][0];
501*4882a593Smuzhiyun 	used_macid->len = (max_map_idx + 1) * sizeof(u32);
502*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_macid_bitmap_by_role(): bitmap->len(%d), max_map_idx(%d)\n",
503*4882a593Smuzhiyun 		used_macid->len, max_map_idx);
504*4882a593Smuzhiyun }
505*4882a593Smuzhiyun 
_mcc_fill_mcc_role_basic_info(struct phl_info_t * phl,struct rtw_wifi_role_t * wrole,struct rtw_phl_mcc_role * mrole)506*4882a593Smuzhiyun enum rtw_phl_status _mcc_fill_mcc_role_basic_info(struct phl_info_t *phl,
507*4882a593Smuzhiyun 		struct rtw_wifi_role_t *wrole, struct rtw_phl_mcc_role *mrole)
508*4882a593Smuzhiyun {
509*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
510*4882a593Smuzhiyun 	struct rtw_phl_stainfo_t *sta = rtw_phl_get_stainfo_self(phl, wrole);
511*4882a593Smuzhiyun 
512*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_fill_mcc_role_basic_info()\n");
513*4882a593Smuzhiyun 	if (sta == NULL) {
514*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_mcc_role_basic_info(): transfer mcc mode failed\n");
515*4882a593Smuzhiyun 		goto exit;
516*4882a593Smuzhiyun 	}
517*4882a593Smuzhiyun 	mrole->wrole = wrole;
518*4882a593Smuzhiyun 	mrole->macid = sta->macid;
519*4882a593Smuzhiyun #ifdef RTW_PHL_BCN
520*4882a593Smuzhiyun 	if (_mcc_is_ap_category(wrole))
521*4882a593Smuzhiyun 		mrole->bcn_intvl = (u16)wrole->bcn_cmn.bcn_interval;
522*4882a593Smuzhiyun 	else
523*4882a593Smuzhiyun #endif
524*4882a593Smuzhiyun 		mrole->bcn_intvl = sta->asoc_cap.bcn_interval;
525*4882a593Smuzhiyun 	if (mrole->bcn_intvl == 0) {
526*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_mcc_role_basic_info(): mrole->bcn_intvl ==0, please check code of core layer.\n");
527*4882a593Smuzhiyun 		goto exit;
528*4882a593Smuzhiyun 	}
529*4882a593Smuzhiyun 	mrole->chandef = &wrole->chandef;
530*4882a593Smuzhiyun 	_mcc_fill_macid_bitmap_by_role(phl, mrole);
531*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
532*4882a593Smuzhiyun exit:
533*4882a593Smuzhiyun 	return status;
534*4882a593Smuzhiyun }
535*4882a593Smuzhiyun 
_mcc_fill_ref_role_info(struct phl_info_t * phl,struct rtw_phl_mcc_en_info * en_info,struct rtw_wifi_role_t * wrole)536*4882a593Smuzhiyun enum rtw_phl_status _mcc_fill_ref_role_info(struct phl_info_t *phl,
537*4882a593Smuzhiyun 			struct rtw_phl_mcc_en_info *en_info,
538*4882a593Smuzhiyun 			struct rtw_wifi_role_t *wrole)
539*4882a593Smuzhiyun {
540*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
541*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *mrole = NULL;
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_fill_ref_role_info()\n");
544*4882a593Smuzhiyun 	mrole = &en_info->mcc_role[REF_ROLE_IDX];
545*4882a593Smuzhiyun 	status = _mcc_fill_mcc_role_basic_info(phl, wrole, mrole);
546*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != status) {
547*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_ref_role_info(): set basic info failed\n");
548*4882a593Smuzhiyun 		goto exit;
549*4882a593Smuzhiyun 	}
550*4882a593Smuzhiyun 	_mcc_fill_mcc_role_policy_info(phl, wrole, mrole);
551*4882a593Smuzhiyun 	en_info->mrole_map |= BIT(REF_ROLE_IDX);
552*4882a593Smuzhiyun 	en_info->mrole_num++;
553*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
554*4882a593Smuzhiyun exit:
555*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_ref_role_info(): status(%d), wrole id(%d), wrole->type(%d), Fill mrole(%d) Info\n",
556*4882a593Smuzhiyun 			status, wrole->id, wrole->type, REF_ROLE_IDX);
557*4882a593Smuzhiyun 	return status;
558*4882a593Smuzhiyun }
559*4882a593Smuzhiyun 
_mcc_fill_role_info(struct phl_info_t * phl,struct rtw_phl_mcc_en_info * en_info,u8 role_map,struct rtw_wifi_role_t * cur_role)560*4882a593Smuzhiyun enum rtw_phl_status _mcc_fill_role_info(struct phl_info_t *phl,
561*4882a593Smuzhiyun 			struct rtw_phl_mcc_en_info *en_info, u8 role_map,
562*4882a593Smuzhiyun 			struct rtw_wifi_role_t *cur_role)
563*4882a593Smuzhiyun {
564*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
565*4882a593Smuzhiyun 	struct rtw_wifi_role_t *wrole = NULL;
566*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *mrole = NULL;
567*4882a593Smuzhiyun 	u8 ridx = 0, mcc_idx = 0;
568*4882a593Smuzhiyun 
569*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_fill_role_info()\n");
570*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_fill_ref_role_info(phl, en_info,
571*4882a593Smuzhiyun 								cur_role)) {
572*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_role_info(): set ref role info failed\n");
573*4882a593Smuzhiyun 		goto exit;
574*4882a593Smuzhiyun 	}
575*4882a593Smuzhiyun 	mcc_idx = en_info->mrole_num;
576*4882a593Smuzhiyun 	role_map &= ~(BIT(cur_role->id));
577*4882a593Smuzhiyun 	for (ridx = 0; ridx < MAX_WIFI_ROLE_NUMBER; ridx++) {
578*4882a593Smuzhiyun 		if (!(role_map & BIT(ridx)))
579*4882a593Smuzhiyun 			continue;
580*4882a593Smuzhiyun 		wrole = rtw_phl_get_wrole_by_ridx(phl->phl_com, ridx);
581*4882a593Smuzhiyun 		if (wrole == NULL) {
582*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_role_info(): get wrole fail, role_idx(%d)\n",
583*4882a593Smuzhiyun 				ridx);
584*4882a593Smuzhiyun 			goto exit;
585*4882a593Smuzhiyun 		}
586*4882a593Smuzhiyun 		if (mcc_idx >= MCC_ROLE_NUM) {
587*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_role_info(): mcc_idx(%d) >= MCC_ROLE_NUM(%d)\n",
588*4882a593Smuzhiyun 				mcc_idx, MCC_ROLE_NUM);
589*4882a593Smuzhiyun 			goto exit;
590*4882a593Smuzhiyun 		}
591*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_role_info(): wrole(%d), wrole->type(%d), Fill mrole(%d) Info\n",
592*4882a593Smuzhiyun 			ridx, wrole->type, mcc_idx);
593*4882a593Smuzhiyun 		mrole = &en_info->mcc_role[mcc_idx];
594*4882a593Smuzhiyun 		status = _mcc_fill_mcc_role_basic_info(phl, wrole, mrole);
595*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != status) {
596*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_role_info(): set basic info failed\n");
597*4882a593Smuzhiyun 			goto exit;
598*4882a593Smuzhiyun 		}
599*4882a593Smuzhiyun 		_mcc_fill_mcc_role_policy_info(phl, wrole, mrole);
600*4882a593Smuzhiyun 		en_info->mrole_map |= BIT(mcc_idx);
601*4882a593Smuzhiyun 		en_info->mrole_num++;
602*4882a593Smuzhiyun 		mcc_idx ++;
603*4882a593Smuzhiyun 	}
604*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
605*4882a593Smuzhiyun exit:
606*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< _mcc_fill_role_info(): status(%d), role_map(0x%x), mcc_role_map(0x%x)\n",
607*4882a593Smuzhiyun 		status, role_map, en_info->mrole_map);
608*4882a593Smuzhiyun 	return status;
609*4882a593Smuzhiyun }
610*4882a593Smuzhiyun 
_mcc_fill_coex_mode(struct phl_info_t * phl,struct phl_mcc_info * minfo)611*4882a593Smuzhiyun void _mcc_fill_coex_mode(struct phl_info_t *phl, struct phl_mcc_info *minfo)
612*4882a593Smuzhiyun {
613*4882a593Smuzhiyun 	/* if get from core or ....
614*4882a593Smuzhiyun 	else*/
615*4882a593Smuzhiyun 	minfo->coex_mode = RTW_PHL_MCC_COEX_MODE_BT_MASTER;
616*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_coex_mode(): Set default mode(%d)\n",
617*4882a593Smuzhiyun 		minfo->coex_mode);
618*4882a593Smuzhiyun }
619*4882a593Smuzhiyun 
_mcc_fill_bt_dur(struct phl_info_t * phl,struct phl_mcc_info * minfo)620*4882a593Smuzhiyun void _mcc_fill_bt_dur(struct phl_info_t *phl, struct phl_mcc_info *minfo)
621*4882a593Smuzhiyun {
622*4882a593Smuzhiyun 	minfo->bt_info.bt_dur = (u16)rtw_hal_get_btc_req_slot(phl->hal);
623*4882a593Smuzhiyun 	minfo->bt_info.bt_seg_num = 1;
624*4882a593Smuzhiyun 	minfo->bt_info.bt_seg[0] = minfo->bt_info.bt_dur;
625*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_bt_dur(): minfo->bt_info.bt_dur(%d)\n",
626*4882a593Smuzhiyun 		minfo->bt_info.bt_dur);
627*4882a593Smuzhiyun 
628*4882a593Smuzhiyun }
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun /*
631*4882a593Smuzhiyun  * fill slot info
632*4882a593Smuzhiyun  * @m_pattern: pattern info
633*4882a593Smuzhiyun  * @bt_role: True: BT Role; False: Wifi Role
634*4882a593Smuzhiyun  * @dur: time slot
635*4882a593Smuzhiyun  * @mrole: mcc role info
636*4882a593Smuzhiyun  */
_mcc_fill_slot_info(struct rtw_phl_mcc_pattern * m_pattern,bool bt_role,u16 dur,struct rtw_phl_mcc_role * mrole)637*4882a593Smuzhiyun void _mcc_fill_slot_info(struct rtw_phl_mcc_pattern *m_pattern, bool bt_role,
638*4882a593Smuzhiyun 				u16 dur, struct rtw_phl_mcc_role *mrole)
639*4882a593Smuzhiyun {
640*4882a593Smuzhiyun 	if (m_pattern->slot_num >= SLOT_NUM) {
641*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_slot_info(): Fail, m_pattern->slot_num(%d) >= SLOT_NUM(%d)\n",
642*4882a593Smuzhiyun 		m_pattern->slot_num, SLOT_NUM);
643*4882a593Smuzhiyun 		return;
644*4882a593Smuzhiyun 	}
645*4882a593Smuzhiyun 	if (bt_role) {
646*4882a593Smuzhiyun 		m_pattern->slot_order[m_pattern->slot_num].bt_role = true;
647*4882a593Smuzhiyun 		m_pattern->slot_order[m_pattern->slot_num].slot = dur;
648*4882a593Smuzhiyun 		m_pattern->slot_order[m_pattern->slot_num].mrole = NULL;
649*4882a593Smuzhiyun 		m_pattern->bt_slot_num++;
650*4882a593Smuzhiyun 	} else {
651*4882a593Smuzhiyun 		m_pattern->slot_order[m_pattern->slot_num].bt_role = false;
652*4882a593Smuzhiyun 		m_pattern->slot_order[m_pattern->slot_num].slot = dur;
653*4882a593Smuzhiyun 		m_pattern->slot_order[m_pattern->slot_num].mrole = mrole;
654*4882a593Smuzhiyun 	}
655*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "m_pattern->slot_num(): Fill slot, Idx(%d), dur(%d), is BT slot(%d)\n",
656*4882a593Smuzhiyun 		m_pattern->slot_num, dur, bt_role);
657*4882a593Smuzhiyun 	m_pattern->slot_num++;
658*4882a593Smuzhiyun }
659*4882a593Smuzhiyun 
_mcc_reset_minfo(struct phl_info_t * phl,struct phl_mcc_info * minfo,enum _mcc_minfo_reset_type reset_type)660*4882a593Smuzhiyun void _mcc_reset_minfo(struct phl_info_t *phl, struct phl_mcc_info *minfo,
661*4882a593Smuzhiyun 				enum _mcc_minfo_reset_type reset_type)
662*4882a593Smuzhiyun {
663*4882a593Smuzhiyun 	void *priv = phl_to_drvpriv(phl);
664*4882a593Smuzhiyun 
665*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_reset_minfo\n");
666*4882a593Smuzhiyun 	if (reset_type == MINFO_RESET_ALL) {
667*4882a593Smuzhiyun 		_os_mem_set(priv, minfo, 0, sizeof(struct phl_mcc_info));
668*4882a593Smuzhiyun 		return;
669*4882a593Smuzhiyun 	}
670*4882a593Smuzhiyun 	if (reset_type & MINFO_RESET_EN_INFO)
671*4882a593Smuzhiyun 		_os_mem_set(priv, &minfo->en_info, 0,
672*4882a593Smuzhiyun 				sizeof(struct rtw_phl_mcc_en_info));
673*4882a593Smuzhiyun 	if (reset_type & MINFO_RESET_MODE)
674*4882a593Smuzhiyun 		_os_mem_set(priv, &minfo->mcc_mode, 0,
675*4882a593Smuzhiyun 				sizeof(enum rtw_phl_tdmra_wmode));
676*4882a593Smuzhiyun 	if (reset_type & MINFO_RESET_ROLE_MAP)
677*4882a593Smuzhiyun 		_os_mem_set(priv, &minfo->role_map, 0,
678*4882a593Smuzhiyun 				sizeof(minfo->role_map));
679*4882a593Smuzhiyun 	if (reset_type & MINFO_RESET_STATE)
680*4882a593Smuzhiyun 		_os_mem_set(priv, &minfo->state, 0,
681*4882a593Smuzhiyun 				sizeof(enum rtw_phl_mcc_state));
682*4882a593Smuzhiyun 	if (reset_type & MINFO_RESET_COEX_MODE)
683*4882a593Smuzhiyun 		_os_mem_set(priv, &minfo->coex_mode, 0,
684*4882a593Smuzhiyun 				sizeof(enum rtw_phl_mcc_coex_mode));
685*4882a593Smuzhiyun 	if (reset_type & MINFO_RESET_BT_INFO)
686*4882a593Smuzhiyun 		_os_mem_set(priv, &minfo->bt_info, 0,
687*4882a593Smuzhiyun 				sizeof(struct rtw_phl_mcc_bt_info));
688*4882a593Smuzhiyun 	if (reset_type & MINFO_RESET_PATTERN_INFO)
689*4882a593Smuzhiyun 		_os_mem_set(priv, &minfo->en_info.m_pattern, 0,
690*4882a593Smuzhiyun 				sizeof(struct rtw_phl_mcc_pattern));
691*4882a593Smuzhiyun }
692*4882a593Smuzhiyun 
_mcc_clean_noa(struct phl_info_t * phl,struct rtw_phl_mcc_en_info * en_info)693*4882a593Smuzhiyun void _mcc_clean_noa(struct phl_info_t *phl, struct rtw_phl_mcc_en_info *en_info)
694*4882a593Smuzhiyun {
695*4882a593Smuzhiyun 	struct phl_com_mcc_info *com_info = phl_to_com_mcc_info(phl);
696*4882a593Smuzhiyun 	struct rtw_phl_mcc_noa param = {0};
697*4882a593Smuzhiyun 
698*4882a593Smuzhiyun 	if (com_info == NULL) {
699*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_clean_noa(): Get mcc common info failed\n");
700*4882a593Smuzhiyun 	} else if (com_info->ops.mcc_update_noa) {
701*4882a593Smuzhiyun 		struct rtw_phl_mcc_role *ap_role = NULL;
702*4882a593Smuzhiyun 		ap_role = _mcc_get_mrole_by_category(en_info, MCC_ROLE_AP_CAT);
703*4882a593Smuzhiyun 		if (NULL == ap_role) {
704*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_clean_noa(): Get AP role fail\n");
705*4882a593Smuzhiyun 			goto exit;
706*4882a593Smuzhiyun 		}
707*4882a593Smuzhiyun 		param.wrole = ap_role->wrole;
708*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_clean_noa()\n");
709*4882a593Smuzhiyun 		com_info->ops.mcc_update_noa(com_info->ops.priv, &param);
710*4882a593Smuzhiyun 	}
711*4882a593Smuzhiyun exit:
712*4882a593Smuzhiyun 	return;
713*4882a593Smuzhiyun }
714*4882a593Smuzhiyun 
_tdmra_calc_noa_2wrole(struct phl_info_t * phl,struct phl_mcc_info * minfo,struct rtw_phl_mcc_noa * param)715*4882a593Smuzhiyun bool _tdmra_calc_noa_2wrole(struct phl_info_t *phl, struct phl_mcc_info *minfo,
716*4882a593Smuzhiyun 				struct rtw_phl_mcc_noa *param)
717*4882a593Smuzhiyun {
718*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
719*4882a593Smuzhiyun 	struct rtw_phl_mcc_bt_info *bt = &minfo->bt_info;
720*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref = get_ref_role(en_info);
721*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ano = (role_ref == &en_info->mcc_role[0])
722*4882a593Smuzhiyun 				? &en_info->mcc_role[1] : &en_info->mcc_role[0];
723*4882a593Smuzhiyun 	u16 d_r = role_ref->policy.dur_info.dur;
724*4882a593Smuzhiyun 	u16 d_a = role_ano->policy.dur_info.dur;
725*4882a593Smuzhiyun 	u64 mcc_start = 0, noa_start = 0;
726*4882a593Smuzhiyun 	bool ret = false;
727*4882a593Smuzhiyun 
728*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, ">>> _tdmra_calc_noa_2wrole()\n");
729*4882a593Smuzhiyun 	mcc_start = en_info->tsf_high;
730*4882a593Smuzhiyun 	mcc_start = mcc_start << 32;
731*4882a593Smuzhiyun 	mcc_start |= en_info->tsf_low;
732*4882a593Smuzhiyun 	if (_mcc_is_ap_category(role_ref->wrole)){
733*4882a593Smuzhiyun 		/*calculate end time of GO*/
734*4882a593Smuzhiyun 		noa_start = mcc_start + (d_r * TU);
735*4882a593Smuzhiyun 		param->dur = en_info->mcc_intvl - d_r;
736*4882a593Smuzhiyun 		param->wrole = role_ref->wrole;
737*4882a593Smuzhiyun 	} else {
738*4882a593Smuzhiyun 		u32 tsf_ref_h = 0, tsf_ref_l = 0, tsf_ano_h = 0, tsf_ano_l = 0;
739*4882a593Smuzhiyun 		u64 tsf_ref = 0, tsf_ano = 0;
740*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_tdmra_calc_noa_2wrole(): AP Role isn't ref role, we need to get 2 port tsf\n");
741*4882a593Smuzhiyun 		_mcc_dump_bt_ino(bt);
742*4882a593Smuzhiyun 		if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_get_2ports_tsf(
743*4882a593Smuzhiyun 				phl->hal, role_ref->group, role_ref->macid,
744*4882a593Smuzhiyun 				role_ano->macid, &tsf_ref_h, &tsf_ref_l,
745*4882a593Smuzhiyun 				&tsf_ano_h, &tsf_ano_l)) {
746*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_tdmra_calc_noa_2wrole(): Get 2 port tsf failed\n");
747*4882a593Smuzhiyun 			goto exit;
748*4882a593Smuzhiyun 		}
749*4882a593Smuzhiyun 		tsf_ref = tsf_ref_h;
750*4882a593Smuzhiyun 		tsf_ref = tsf_ref << 32;
751*4882a593Smuzhiyun 		tsf_ref |= tsf_ref_l;
752*4882a593Smuzhiyun 		tsf_ano = tsf_ano_h;
753*4882a593Smuzhiyun 		tsf_ano = tsf_ano << 32;
754*4882a593Smuzhiyun 		tsf_ano |= tsf_ano_l;
755*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_tdmra_calc_noa_2wrole(): tsf_ref: 0x%08X %08x, tsf_ano: 0x%08x %08x\n",
756*4882a593Smuzhiyun 			(u32)(tsf_ref >> 32), (u32)tsf_ref,
757*4882a593Smuzhiyun 			(u32)(tsf_ano >> 32), (u32)tsf_ano);
758*4882a593Smuzhiyun 		/*calculate end time of GO*/
759*4882a593Smuzhiyun 		noa_start = mcc_start + (en_info->mcc_intvl * TU);
760*4882a593Smuzhiyun 		if (bt->add_bt_role) {
761*4882a593Smuzhiyun 			if(bt->bt_seg_num == 1) {
762*4882a593Smuzhiyun 				noa_start -= (bt->bt_seg[0] * TU);
763*4882a593Smuzhiyun 			} else if (bt->bt_seg_num == 2) {
764*4882a593Smuzhiyun 				noa_start -= (bt->bt_seg[1] * TU);
765*4882a593Smuzhiyun 			} else {
766*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_tdmra_calc_noa_2wrole(): error bt_seg_num(%d), please check code flow\n",
767*4882a593Smuzhiyun 					bt->bt_seg_num);
768*4882a593Smuzhiyun 				goto exit;
769*4882a593Smuzhiyun 			}
770*4882a593Smuzhiyun 		}
771*4882a593Smuzhiyun 		noa_start = noa_start - tsf_ref + tsf_ano;
772*4882a593Smuzhiyun 		param->dur = en_info->mcc_intvl - d_a;
773*4882a593Smuzhiyun 		param->wrole = role_ano->wrole;
774*4882a593Smuzhiyun 	}
775*4882a593Smuzhiyun 	param->start_t_h = noa_start >> 32;
776*4882a593Smuzhiyun 	param->start_t_l = (u32)noa_start;
777*4882a593Smuzhiyun 	param->cnt = 255;
778*4882a593Smuzhiyun 	param->interval = en_info->mcc_intvl;
779*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_tdmra_calc_noa_2wrole(): IsGORef(%d), mcc_start(0x%08x %08x)\n",
780*4882a593Smuzhiyun 		_mcc_is_ap_category(role_ref->wrole),
781*4882a593Smuzhiyun 		(u32)(mcc_start >> 32), (u32)mcc_start);
782*4882a593Smuzhiyun 	ret = true;
783*4882a593Smuzhiyun exit:
784*4882a593Smuzhiyun 	return ret;
785*4882a593Smuzhiyun }
786*4882a593Smuzhiyun 
_tdmra_calc_noa_1wrole(struct phl_info_t * phl,struct phl_mcc_info * minfo,struct rtw_phl_mcc_noa * param)787*4882a593Smuzhiyun bool _tdmra_calc_noa_1wrole(struct phl_info_t *phl, struct phl_mcc_info *minfo,
788*4882a593Smuzhiyun 				struct rtw_phl_mcc_noa *param)
789*4882a593Smuzhiyun {
790*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
791*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref = get_ref_role(en_info);
792*4882a593Smuzhiyun 	u16 d_r = role_ref->policy.dur_info.dur;
793*4882a593Smuzhiyun 	u64 mcc_start = 0, noa_start = 0;
794*4882a593Smuzhiyun 	bool ret = false;
795*4882a593Smuzhiyun 
796*4882a593Smuzhiyun 	mcc_start = en_info->tsf_high;
797*4882a593Smuzhiyun 	mcc_start = mcc_start << 32;
798*4882a593Smuzhiyun 	mcc_start |= en_info->tsf_low;
799*4882a593Smuzhiyun 	/*calculate end time of GO*/
800*4882a593Smuzhiyun 	noa_start = mcc_start + (d_r * TU);
801*4882a593Smuzhiyun 	param->dur = en_info->mcc_intvl - d_r;
802*4882a593Smuzhiyun 	param->wrole = role_ref->wrole;
803*4882a593Smuzhiyun 	param->start_t_h = noa_start >> 32;
804*4882a593Smuzhiyun 	param->start_t_l = (u32)noa_start;
805*4882a593Smuzhiyun 	param->cnt = 255;
806*4882a593Smuzhiyun 	param->interval = en_info->mcc_intvl;
807*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_tdmra_calc_noa_1wrole(): IsGORef(%d), mcc_start(0x%08x %08x)\n",
808*4882a593Smuzhiyun 		_mcc_is_ap_category(role_ref->wrole),
809*4882a593Smuzhiyun 		(u32)(mcc_start >> 32), (u32)mcc_start);
810*4882a593Smuzhiyun 	ret = true;
811*4882a593Smuzhiyun 	return ret;
812*4882a593Smuzhiyun }
813*4882a593Smuzhiyun 
814*4882a593Smuzhiyun 
_mcc_up_noa(struct phl_info_t * phl,struct phl_mcc_info * minfo)815*4882a593Smuzhiyun void _mcc_up_noa(struct phl_info_t *phl, struct phl_mcc_info *minfo)
816*4882a593Smuzhiyun 
817*4882a593Smuzhiyun {
818*4882a593Smuzhiyun 	struct phl_com_mcc_info *com_info = phl_to_com_mcc_info(phl);
819*4882a593Smuzhiyun 	struct rtw_phl_mcc_noa param = {0};
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, ">>> _mcc_up_noa()\n");
822*4882a593Smuzhiyun 	if (com_info == NULL) {
823*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_up_noa(): Get mcc common info failed\n");
824*4882a593Smuzhiyun 		goto exit;
825*4882a593Smuzhiyun 	}
826*4882a593Smuzhiyun 	if (!com_info->ops.mcc_update_noa)
827*4882a593Smuzhiyun 		goto exit;
828*4882a593Smuzhiyun 	if (RTW_PHL_TDMRA_AP_CLIENT_WMODE == minfo->mcc_mode) {
829*4882a593Smuzhiyun 		if (false == _tdmra_calc_noa_2wrole(phl, minfo, &param))
830*4882a593Smuzhiyun 			goto exit;
831*4882a593Smuzhiyun 	} else if (RTW_PHL_TDMRA_AP_WMODE == minfo->mcc_mode) {
832*4882a593Smuzhiyun 		if (false == _tdmra_calc_noa_1wrole(phl, minfo, &param))
833*4882a593Smuzhiyun 			goto exit;
834*4882a593Smuzhiyun 	} else {
835*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_up_noa(): error wmode\n");
836*4882a593Smuzhiyun 		_mcc_dump_mode(&minfo->mcc_mode);
837*4882a593Smuzhiyun 		goto exit;
838*4882a593Smuzhiyun 	}
839*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_up_noa(): NOA_start(0x%08x %08x), dur(%d), cnt(%d), interval(%d)\n",
840*4882a593Smuzhiyun 		param.start_t_h, param.start_t_l, param.dur, param.cnt,
841*4882a593Smuzhiyun 		param.interval);
842*4882a593Smuzhiyun 	com_info->ops.mcc_update_noa(com_info->ops.priv, &param);
843*4882a593Smuzhiyun exit:
844*4882a593Smuzhiyun 	return;
845*4882a593Smuzhiyun }
846*4882a593Smuzhiyun 
_mcc_adjust_dur_for_2g_mcc_2role_bt(struct phl_mcc_info * minfo)847*4882a593Smuzhiyun bool _mcc_adjust_dur_for_2g_mcc_2role_bt(struct phl_mcc_info *minfo)
848*4882a593Smuzhiyun {
849*4882a593Smuzhiyun 	struct rtw_phl_mcc_bt_info *bt_info = &minfo->bt_info;
850*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
851*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role1 = &en_info->mcc_role[0];
852*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role2 = &en_info->mcc_role[1];
853*4882a593Smuzhiyun 	u16 d1 = m_role1->policy.dur_info.dur;
854*4882a593Smuzhiyun 	u16 d2 = m_role2->policy.dur_info.dur;
855*4882a593Smuzhiyun 	u16 d1_max = (m_role1->policy.dur_info.dur_limit.enable) ?
856*4882a593Smuzhiyun 		m_role1->policy.dur_info.dur_limit.max_dur : en_info->mcc_intvl;
857*4882a593Smuzhiyun 	u16 d2_max = (m_role2->policy.dur_info.dur_limit.enable) ?
858*4882a593Smuzhiyun 		m_role2->policy.dur_info.dur_limit.max_dur : en_info->mcc_intvl;
859*4882a593Smuzhiyun 	u16 d1_min = _mcc_is_ap_category(m_role1->wrole) ?
860*4882a593Smuzhiyun 					MIN_AP_DUR : MIN_CLIENT_DUR;
861*4882a593Smuzhiyun 	u16 d2_min = _mcc_is_ap_category(m_role2->wrole) ?
862*4882a593Smuzhiyun 					MIN_AP_DUR : MIN_CLIENT_DUR;
863*4882a593Smuzhiyun 	u16 wifi_dur = 0, bt_dur = bt_info->bt_dur;
864*4882a593Smuzhiyun 	u16 i = 0;
865*4882a593Smuzhiyun 	bool adjust_ok = false;
866*4882a593Smuzhiyun 
867*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_adjust_dur_for_2g_mcc_2role_bt(): mcc_intvl(%d), bt_dur(%d), d1(%d), d2(%d), d1_min(%d), d1_max(%d), d2_min(%d), d2_max(%d)\n",
868*4882a593Smuzhiyun 		en_info->mcc_intvl, bt_dur, d1, d2, d1_min, d1_max, d2_min, d2_max);
869*4882a593Smuzhiyun 	for (i = 0; i < en_info->mcc_intvl; i++) {
870*4882a593Smuzhiyun 		wifi_dur = en_info->mcc_intvl - bt_dur;
871*4882a593Smuzhiyun 		d1 = ((d1 * 100 / (d1 + d2)) * wifi_dur) / 100;
872*4882a593Smuzhiyun 		if (d1 < d1_min) {
873*4882a593Smuzhiyun 			d1 = d1_min;
874*4882a593Smuzhiyun 		} else if (d1 > d1_max) {
875*4882a593Smuzhiyun 			d1 = d1_max;
876*4882a593Smuzhiyun 		}
877*4882a593Smuzhiyun 		d2 = wifi_dur - d1;
878*4882a593Smuzhiyun 		if (d2 < d2_min) {
879*4882a593Smuzhiyun 			d2 = d2_min;
880*4882a593Smuzhiyun 			d1 = wifi_dur - d2;
881*4882a593Smuzhiyun 		} else if (d2 > d2_max) {
882*4882a593Smuzhiyun 			d2 = d2_max;
883*4882a593Smuzhiyun 			d1 = wifi_dur - d2;
884*4882a593Smuzhiyun 		}
885*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_adjust_dur_for_2g_mcc_2role_bt(): Loop bt_dur(%d), d1(%d), d2(%d)\n",
886*4882a593Smuzhiyun 				bt_dur, d1, d2);
887*4882a593Smuzhiyun 		if ((d1 >= d1_min) && (d1 <= d1_max) &&
888*4882a593Smuzhiyun 			(d2 >= d2_min) && (d2 <= d2_max)) {
889*4882a593Smuzhiyun 			m_role1->policy.dur_info.dur = d1;
890*4882a593Smuzhiyun 			m_role2->policy.dur_info.dur = d2;
891*4882a593Smuzhiyun 			bt_info->bt_dur = bt_dur;
892*4882a593Smuzhiyun 			en_info->m_pattern.d_r_d_a_spacing_max = bt_info->bt_dur;
893*4882a593Smuzhiyun 			adjust_ok = true;
894*4882a593Smuzhiyun 			break;
895*4882a593Smuzhiyun 		}
896*4882a593Smuzhiyun 		bt_dur--;
897*4882a593Smuzhiyun 	}
898*4882a593Smuzhiyun 	if (adjust_ok == false){
899*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_adjust_dur_for_2g_mcc_2role_bt(): Adjust fail\n");
900*4882a593Smuzhiyun 	} else {
901*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_adjust_dur_for_2g_mcc_2role_bt(): Adjust ok, d1(%d), d2(%d), bt dur(%d), d_r_d_a_spacing_max(%d)\n",
902*4882a593Smuzhiyun 			m_role1->policy.dur_info.dur,
903*4882a593Smuzhiyun 			m_role2->policy.dur_info.dur,
904*4882a593Smuzhiyun 			bt_info->bt_dur, en_info->m_pattern.d_r_d_a_spacing_max);
905*4882a593Smuzhiyun 	}
906*4882a593Smuzhiyun 	return adjust_ok;
907*4882a593Smuzhiyun }
908*4882a593Smuzhiyun 
_mcc_adjust_dur_for_2_band_mcc_2role_bt(struct phl_mcc_info * minfo,struct rtw_phl_mcc_role * role_2g,struct rtw_phl_mcc_role * role_non_2g)909*4882a593Smuzhiyun void _mcc_adjust_dur_for_2_band_mcc_2role_bt(struct phl_mcc_info *minfo,
910*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_2g, struct rtw_phl_mcc_role *role_non_2g)
911*4882a593Smuzhiyun {
912*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
913*4882a593Smuzhiyun 	enum rtw_phl_mcc_coex_mode *coex_mode = &minfo->coex_mode;
914*4882a593Smuzhiyun 	struct rtw_phl_mcc_policy_info *plcy_2g = &role_2g->policy;
915*4882a593Smuzhiyun 	struct rtw_phl_mcc_policy_info *plcy_non2g = &role_non_2g->policy;
916*4882a593Smuzhiyun 	u16 *bt_dur = &minfo->bt_info.bt_dur;
917*4882a593Smuzhiyun 	u16 dur_2g = 0, dur_non2g = 0;
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): coex_mode(%d) 2G_Dur(%d), 5G_Dur(%d), BT_Dur(%d)\n",
920*4882a593Smuzhiyun 		*coex_mode, plcy_2g->dur_info.dur, plcy_non2g->dur_info.dur,
921*4882a593Smuzhiyun 		*bt_dur);
922*4882a593Smuzhiyun 	if (plcy_non2g->dur_info.dur >= *bt_dur) {
923*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): 5G_Dur(%d) >= BT_Dur(%d), no need to adjust 5G duration for BT\n",
924*4882a593Smuzhiyun 			plcy_non2g->dur_info.dur, *bt_dur);
925*4882a593Smuzhiyun 		goto exit;
926*4882a593Smuzhiyun 	}
927*4882a593Smuzhiyun 	if (plcy_non2g->dur_info.dur_limit.enable &&
928*4882a593Smuzhiyun 		plcy_non2g->dur_info.dur_limit.max_dur < *bt_dur) {
929*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): dur_limit.max_dur(%d) < bt_dur(%d), We can't adjust 5G duration(%d) for BT\n",
930*4882a593Smuzhiyun 			plcy_non2g->dur_info.dur_limit.max_dur,
931*4882a593Smuzhiyun 			*bt_dur, plcy_non2g->dur_info.dur);
932*4882a593Smuzhiyun 		goto exit;
933*4882a593Smuzhiyun 	}
934*4882a593Smuzhiyun 	if (*coex_mode == RTW_PHL_MCC_COEX_MODE_BT_MASTER) {
935*4882a593Smuzhiyun 		dur_non2g = *bt_dur;
936*4882a593Smuzhiyun 		dur_2g = en_info->mcc_intvl - dur_non2g;
937*4882a593Smuzhiyun 		if (plcy_2g->dur_info.dur_limit.enable &&
938*4882a593Smuzhiyun 			plcy_2g->dur_info.dur_limit.max_dur < dur_2g) {
939*4882a593Smuzhiyun 			dur_2g = plcy_2g->dur_info.dur_limit.max_dur;
940*4882a593Smuzhiyun 			dur_non2g = en_info->mcc_intvl - dur_2g;
941*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): plcy_2g->max_dur(%d) < dur_2g(%d), We can adjust some 5G duration for BT\n",
942*4882a593Smuzhiyun 				plcy_2g->dur_info.dur_limit.max_dur, dur_2g);
943*4882a593Smuzhiyun 		}
944*4882a593Smuzhiyun 		plcy_non2g->dur_info.dur = dur_non2g;
945*4882a593Smuzhiyun 		plcy_2g->dur_info.dur = dur_2g;
946*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): coex_mode == RTW_PHL_MCC_COEX_MODE_BT_MASTER, we adjust 5G duration for BT\n");
947*4882a593Smuzhiyun 	} else if (*coex_mode == RTW_PHL_MCC_COEX_MODE_WIFI_MASTER) {
948*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): coex_mode == RTW_PHL_MCC_COEX_MODE_WIFI_MASTER, we don't adjust 5G duration for BT\n");
949*4882a593Smuzhiyun 		goto exit;
950*4882a593Smuzhiyun 	} else {
951*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): coex_mode(%d), Undefined mode, ignore bt duration\n",
952*4882a593Smuzhiyun 			*coex_mode);
953*4882a593Smuzhiyun 		goto exit;
954*4882a593Smuzhiyun 	}
955*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_adjust_dur_for_2_band_mcc_2role_bt(): After adjust, 2G_Dur(%d), 5G_Dur(%d), BT_Dur(%d)\n",
956*4882a593Smuzhiyun 		plcy_2g->dur_info.dur, plcy_non2g->dur_info.dur,
957*4882a593Smuzhiyun 		*bt_dur);
958*4882a593Smuzhiyun exit:
959*4882a593Smuzhiyun 	return;
960*4882a593Smuzhiyun }
961*4882a593Smuzhiyun 
_mcc_need_to_seg_bt_dur(struct phl_mcc_info * minfo)962*4882a593Smuzhiyun bool _mcc_need_to_seg_bt_dur(struct phl_mcc_info *minfo)
963*4882a593Smuzhiyun {
964*4882a593Smuzhiyun /* Not ready for implementation*/
965*4882a593Smuzhiyun 	return false;
966*4882a593Smuzhiyun #if 0
967*4882a593Smuzhiyun 	bool seg = false;
968*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *info = &minfo->en_info;
969*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_lim_info *limit_i = NULL;
970*4882a593Smuzhiyun 	u8 i = 0;
971*4882a593Smuzhiyun 
972*4882a593Smuzhiyun 	if (minfo->mcc_mode != RTW_PHL_TDMRA_2CLIENTS_WMODE)
973*4882a593Smuzhiyun 		goto exit;
974*4882a593Smuzhiyun 	if (minfo->bt_info.bt_dur < BT_DUR_SEG_TH || BT_SEG_NUM < 2)
975*4882a593Smuzhiyun 		goto exit;
976*4882a593Smuzhiyun 	for (i = 0; i < MCC_ROLE_NUM; i++) {
977*4882a593Smuzhiyun 		limit_i = &minfo->en_info.mcc_role[i].policy.dur_info.dur_limit;
978*4882a593Smuzhiyun 		if (limit_i->enable) {
979*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_need_to_seg_bt_dur(): Can't seg bt slot when wifi slot with limitation\n");
980*4882a593Smuzhiyun 			goto exit;
981*4882a593Smuzhiyun 		}
982*4882a593Smuzhiyun 	}
983*4882a593Smuzhiyun 	seg = true;
984*4882a593Smuzhiyun exit:
985*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_need_to_seg_bt_dur(): seg(%d)\n",
986*4882a593Smuzhiyun 		seg);
987*4882a593Smuzhiyun 	return seg;
988*4882a593Smuzhiyun #endif
989*4882a593Smuzhiyun }
990*4882a593Smuzhiyun 
991*4882a593Smuzhiyun /*
992*4882a593Smuzhiyun  * 2 wifi slot req + bt slot req
993*4882a593Smuzhiyun  */
_mcc_discision_dur_for_2g_mcc_2role_bt(struct phl_mcc_info * minfo)994*4882a593Smuzhiyun void _mcc_discision_dur_for_2g_mcc_2role_bt(struct phl_mcc_info *minfo)
995*4882a593Smuzhiyun {
996*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
997*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role1 = &en_info->mcc_role[0];
998*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role2 = &en_info->mcc_role[1];
999*4882a593Smuzhiyun 	u16 d1 = 0, d2 = 0;
1000*4882a593Smuzhiyun 
1001*4882a593Smuzhiyun 	/* Segment bt slot, don't support in current code*/
1002*4882a593Smuzhiyun 	if (_mcc_need_to_seg_bt_dur(minfo)) {
1003*4882a593Smuzhiyun 		/*2 wifi slot + 2bt slot*/
1004*4882a593Smuzhiyun 		d1 = m_role1->policy.dur_info.dur;
1005*4882a593Smuzhiyun 		d2 = m_role2->policy.dur_info.dur;
1006*4882a593Smuzhiyun 		en_info->mcc_intvl = WORSECASE_INTVL;
1007*4882a593Smuzhiyun 		_mcc_adjust_dur_for_2g_mcc_2role_bt(minfo);
1008*4882a593Smuzhiyun 		minfo->bt_info.bt_seg_num = 2;
1009*4882a593Smuzhiyun 		minfo->bt_info.bt_seg[0] = minfo->bt_info.bt_dur / 2;
1010*4882a593Smuzhiyun 		minfo->bt_info.bt_seg[1] = minfo->bt_info.bt_dur -
1011*4882a593Smuzhiyun 						minfo->bt_info.bt_seg[0];
1012*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_discision_dur_for_2g_mcc_2role_bt(): Change D1(%d), D2(%d) to D1(%d), D2(%d), bt_seg[0](%d), bt_seg[1](%d)\n",
1013*4882a593Smuzhiyun 			d1, d2, m_role1->policy.dur_info.dur,
1014*4882a593Smuzhiyun 			m_role2->policy.dur_info.dur,
1015*4882a593Smuzhiyun 			minfo->bt_info.bt_seg[0], minfo->bt_info.bt_seg[1]);
1016*4882a593Smuzhiyun 	} else {
1017*4882a593Smuzhiyun 	/*2 wifi slot + 1bt slot*/
1018*4882a593Smuzhiyun 		if (minfo->bt_info.bt_dur > BT_DUR_MAX_2WS) {
1019*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_discision_dur_for_2g_mcc_2role_bt(): bt req slot(%d) > BT_DUR_MAX_2WS(%d)\n",
1020*4882a593Smuzhiyun 				minfo->bt_info.bt_dur, BT_DUR_MAX_2WS);
1021*4882a593Smuzhiyun 			minfo->bt_info.bt_dur = BT_DUR_MAX_2WS;
1022*4882a593Smuzhiyun 			minfo->bt_info.bt_seg[0] = BT_DUR_MAX_2WS;
1023*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_discision_dur_for_2g_mcc_2role_bt(): set bt rq slot to (%d)\n",
1024*4882a593Smuzhiyun 				minfo->bt_info.bt_dur);
1025*4882a593Smuzhiyun 		}
1026*4882a593Smuzhiyun 		_mcc_adjust_dur_for_2g_mcc_2role_bt(minfo);
1027*4882a593Smuzhiyun 	}
1028*4882a593Smuzhiyun }
1029*4882a593Smuzhiyun 
_mcc_discision_duration_for_2role_bt_v2(struct phl_mcc_info * minfo)1030*4882a593Smuzhiyun bool _mcc_discision_duration_for_2role_bt_v2(struct phl_mcc_info *minfo)
1031*4882a593Smuzhiyun {
1032*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
1033*4882a593Smuzhiyun 	struct rtw_phl_mcc_bt_info *bt_info = &minfo->bt_info;
1034*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role1 = &en_info->mcc_role[0];
1035*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role2 = &en_info->mcc_role[1];
1036*4882a593Smuzhiyun 	bool add_extra_bt_role = false;
1037*4882a593Smuzhiyun 
1038*4882a593Smuzhiyun 	if (bt_info->bt_dur == 0)
1039*4882a593Smuzhiyun 		goto exit;
1040*4882a593Smuzhiyun 	if (m_role1->chandef->band == BAND_ON_24G &&
1041*4882a593Smuzhiyun 		m_role2->chandef->band == BAND_ON_24G) {
1042*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_discision_duration_for_2role_bt_v2(): Not support , We will ignore Bt slot\n");
1043*4882a593Smuzhiyun #if 0
1044*4882a593Smuzhiyun 		if (_mcc_adjust_dur_for_2g_mcc_2role_bt(minfo)) {
1045*4882a593Smuzhiyun 			add_extra_bt_role = true;
1046*4882a593Smuzhiyun 		} else {
1047*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_discision_duration_for_2role_bt(): Adjust dur fail, We will ignore Bt slot\n");
1048*4882a593Smuzhiyun 		}
1049*4882a593Smuzhiyun #endif
1050*4882a593Smuzhiyun 		goto exit;
1051*4882a593Smuzhiyun 	}
1052*4882a593Smuzhiyun 	if (m_role1->chandef->band != BAND_ON_24G &&
1053*4882a593Smuzhiyun 		m_role2->chandef->band != BAND_ON_24G) {
1054*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_discision_duration_for_2role_bt_v2(): All 5G, Don't care BT duration\n");
1055*4882a593Smuzhiyun 		goto exit;
1056*4882a593Smuzhiyun 	}
1057*4882a593Smuzhiyun 	if (m_role1->chandef->band == BAND_ON_24G)
1058*4882a593Smuzhiyun 		_mcc_adjust_dur_for_2_band_mcc_2role_bt(minfo, m_role1, m_role2);
1059*4882a593Smuzhiyun 	else
1060*4882a593Smuzhiyun 		_mcc_adjust_dur_for_2_band_mcc_2role_bt(minfo, m_role2, m_role1);
1061*4882a593Smuzhiyun exit:
1062*4882a593Smuzhiyun 	return add_extra_bt_role;
1063*4882a593Smuzhiyun }
1064*4882a593Smuzhiyun 
_mcc_discision_duration_for_2role_bt(struct phl_mcc_info * minfo)1065*4882a593Smuzhiyun bool _mcc_discision_duration_for_2role_bt(struct phl_mcc_info *minfo)
1066*4882a593Smuzhiyun {
1067*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
1068*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role1 = &en_info->mcc_role[0];
1069*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role2 = &en_info->mcc_role[1];
1070*4882a593Smuzhiyun 	bool add_extra_bt_role = false;
1071*4882a593Smuzhiyun 
1072*4882a593Smuzhiyun 	if (minfo->bt_info.bt_dur == 0)
1073*4882a593Smuzhiyun 		goto exit;
1074*4882a593Smuzhiyun 	if (m_role1->chandef->band == BAND_ON_24G &&
1075*4882a593Smuzhiyun 		m_role2->chandef->band == BAND_ON_24G) {
1076*4882a593Smuzhiyun 		_mcc_discision_dur_for_2g_mcc_2role_bt(minfo);
1077*4882a593Smuzhiyun 		add_extra_bt_role = true;
1078*4882a593Smuzhiyun 		goto exit;
1079*4882a593Smuzhiyun 	}
1080*4882a593Smuzhiyun 	if (m_role1->chandef->band != BAND_ON_24G &&
1081*4882a593Smuzhiyun 		m_role2->chandef->band != BAND_ON_24G) {
1082*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_discision_duration_for_2role_bt(): All 5G, Don't care BT duration\n");
1083*4882a593Smuzhiyun 		goto exit;
1084*4882a593Smuzhiyun 	}
1085*4882a593Smuzhiyun 	if (m_role1->chandef->band == BAND_ON_24G)
1086*4882a593Smuzhiyun 		_mcc_adjust_dur_for_2_band_mcc_2role_bt(minfo, m_role1, m_role2);
1087*4882a593Smuzhiyun 	else
1088*4882a593Smuzhiyun 		_mcc_adjust_dur_for_2_band_mcc_2role_bt(minfo, m_role2, m_role1);
1089*4882a593Smuzhiyun 
1090*4882a593Smuzhiyun exit:
1091*4882a593Smuzhiyun 	return add_extra_bt_role;
1092*4882a593Smuzhiyun }
1093*4882a593Smuzhiyun 
_mcc_calculate_start_tsf(struct phl_info_t * phl,struct rtw_phl_mcc_en_info * en_info)1094*4882a593Smuzhiyun enum rtw_phl_status _mcc_calculate_start_tsf(struct phl_info_t *phl,
1095*4882a593Smuzhiyun 					struct rtw_phl_mcc_en_info *en_info
1096*4882a593Smuzhiyun )
1097*4882a593Smuzhiyun {
1098*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
1099*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *ref_role = get_ref_role(en_info);
1100*4882a593Smuzhiyun 	u32 tsf_h = 0, tsf_l = 0;
1101*4882a593Smuzhiyun 	u64 tsf = 0, start_tsf = 0;
1102*4882a593Smuzhiyun 	u8 i = 0, max_loop = 10, calc_done = 0;
1103*4882a593Smuzhiyun 	u16 offset = 0;
1104*4882a593Smuzhiyun 
1105*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_get_tsf(phl->hal,
1106*4882a593Smuzhiyun 				ref_role->wrole->hw_port, &tsf_h, &tsf_l)) {
1107*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_start_tsf(): Get tsf fail\n");
1108*4882a593Smuzhiyun 		goto exit;
1109*4882a593Smuzhiyun 	}
1110*4882a593Smuzhiyun 	tsf = tsf_h;
1111*4882a593Smuzhiyun 	tsf = tsf << 32;
1112*4882a593Smuzhiyun 	tsf |= tsf_l;
1113*4882a593Smuzhiyun 	/*calculate the value between current TSF and TBTT*/
1114*4882a593Smuzhiyun 	phl_calc_offset_from_tbtt(phl, ref_role->wrole, tsf, &offset);
1115*4882a593Smuzhiyun 	start_tsf = tsf - ((offset + en_info->m_pattern.tob_r) * TU);
1116*4882a593Smuzhiyun 	for (i = 0; i < max_loop; i++) {
1117*4882a593Smuzhiyun 		if (start_tsf < (tsf + (MIN_TRIGGER_MCC_TIME * TU))) {
1118*4882a593Smuzhiyun 			start_tsf += (ref_role->bcn_intvl * TU);
1119*4882a593Smuzhiyun 		} else {
1120*4882a593Smuzhiyun 			calc_done = 1;
1121*4882a593Smuzhiyun 			break;
1122*4882a593Smuzhiyun 		}
1123*4882a593Smuzhiyun 	}
1124*4882a593Smuzhiyun 	if (!calc_done) {
1125*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calculate_start_tsf(): Calcculate start tsf fail, please check code flow\n");
1126*4882a593Smuzhiyun 		goto exit;
1127*4882a593Smuzhiyun 	}
1128*4882a593Smuzhiyun 	en_info->tsf_high = start_tsf >> 32;
1129*4882a593Smuzhiyun 	en_info->tsf_low = (u32)start_tsf;
1130*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_start_tsf(): start_tsf(0x%08x %08x), cur_tsf(0x%08x %08x), ref_role->bcn_intvl(%d), ref_role->duration(%d)\n",
1131*4882a593Smuzhiyun 		(u32)(start_tsf >> 32), (u32)start_tsf, (u32)(tsf >> 32),
1132*4882a593Smuzhiyun 		(u32)tsf, ref_role->bcn_intvl, ref_role->policy.dur_info.dur);
1133*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
1134*4882a593Smuzhiyun exit:
1135*4882a593Smuzhiyun 	return status;
1136*4882a593Smuzhiyun }
1137*4882a593Smuzhiyun 
_mcc_set_2_clients_worsecase_default_pattern(struct rtw_phl_mcc_pattern * m_pattern,u16 dur_ref)1138*4882a593Smuzhiyun void _mcc_set_2_clients_worsecase_default_pattern(struct rtw_phl_mcc_pattern *m_pattern,
1139*4882a593Smuzhiyun 					u16 dur_ref)
1140*4882a593Smuzhiyun {
1141*4882a593Smuzhiyun 	m_pattern->toa_r = CLIENTS_WORSECASE_REF_TOA;
1142*4882a593Smuzhiyun 	m_pattern->tob_r = dur_ref - m_pattern->toa_r;
1143*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false,
1144*4882a593Smuzhiyun 				m_pattern->role_ref->policy.dur_info.dur,
1145*4882a593Smuzhiyun 				m_pattern->role_ref);
1146*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false,
1147*4882a593Smuzhiyun 				m_pattern->role_ano->policy.dur_info.dur,
1148*4882a593Smuzhiyun 				m_pattern->role_ano);
1149*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_set_2_clients_worsecase_default_pattern(): tob_r(%d), toa_r(%d)\n",
1150*4882a593Smuzhiyun 		m_pattern->tob_r, m_pattern->toa_r);
1151*4882a593Smuzhiyun }
1152*4882a593Smuzhiyun 
1153*4882a593Smuzhiyun /*
1154*4882a593Smuzhiyun  * get bcn offset for 2 wifi slot and 1 bt slot for pattern1
1155*4882a593Smuzhiyun  * Pattern:
1156*4882a593Smuzhiyun  * |      Dur_r     |     Dur_a      | Bt slot |
1157*4882a593Smuzhiyun  *          bcn                bcn
1158*4882a593Smuzhiyun  * | tob_r | toa_r|tob_a | toa_a| Bt slot |
1159*4882a593Smuzhiyun  */
_mcc_get_offset_for_2_wslot_1_btslot_p1(s16 dur_r,s16 tob_r,s16 tob_a)1160*4882a593Smuzhiyun s16 _mcc_get_offset_for_2_wslot_1_btslot_p1(s16 dur_r,
1161*4882a593Smuzhiyun 				s16 tob_r, s16 tob_a)
1162*4882a593Smuzhiyun {
1163*4882a593Smuzhiyun 	return dur_r - tob_r + tob_a;
1164*4882a593Smuzhiyun }
1165*4882a593Smuzhiyun 
1166*4882a593Smuzhiyun /*
1167*4882a593Smuzhiyun  * get bcn offset for 2 wifi slot and 1 bt slot for pattern2
1168*4882a593Smuzhiyun  * Pattern:
1169*4882a593Smuzhiyun  * |      Dur_r     | Bt slot |     Dur_a      |
1170*4882a593Smuzhiyun  *          bcn                            bcn
1171*4882a593Smuzhiyun  * | tob_r | toa_r| Bt slot |tob_a | toa_a|
1172*4882a593Smuzhiyun  */
_mcc_get_offset_for_2_wslot_1_btslot_p2(s16 dur_r,s16 bt_dur,s16 tob_r,s16 tob_a)1173*4882a593Smuzhiyun s16 _mcc_get_offset_for_2_wslot_1_btslot_p2(s16 dur_r, s16 bt_dur,
1174*4882a593Smuzhiyun 				s16 tob_r, s16 tob_a)
1175*4882a593Smuzhiyun {
1176*4882a593Smuzhiyun 	return dur_r - tob_r + bt_dur + tob_a;
1177*4882a593Smuzhiyun }
1178*4882a593Smuzhiyun 
_mcc_get_offset_range_for_2wslot_1btslot_p1(s16 ref_dur,s16 ano_dur,s16 * bcn_min,s16 * bcn_max)1179*4882a593Smuzhiyun void _mcc_get_offset_range_for_2wslot_1btslot_p1(s16 ref_dur, s16 ano_dur,
1180*4882a593Smuzhiyun 				s16 *bcn_min, s16 *bcn_max)
1181*4882a593Smuzhiyun {
1182*4882a593Smuzhiyun 	s16 min1 = 0, max1 = 0;
1183*4882a593Smuzhiyun 
1184*4882a593Smuzhiyun 	*bcn_min = _mcc_get_offset_for_2_wslot_1_btslot_p1(ref_dur, EARLY_RX_BCN_T,
1185*4882a593Smuzhiyun 							EARLY_RX_BCN_T);
1186*4882a593Smuzhiyun 	*bcn_max = _mcc_get_offset_for_2_wslot_1_btslot_p1(ref_dur, EARLY_RX_BCN_T,
1187*4882a593Smuzhiyun 							ano_dur - MIN_RX_BCN_T);
1188*4882a593Smuzhiyun 	min1 = _mcc_get_offset_for_2_wslot_1_btslot_p1(ref_dur,
1189*4882a593Smuzhiyun 					ref_dur - MIN_RX_BCN_T, EARLY_RX_BCN_T);
1190*4882a593Smuzhiyun 	max1 = _mcc_get_offset_for_2_wslot_1_btslot_p1(ref_dur,
1191*4882a593Smuzhiyun 				ref_dur - MIN_RX_BCN_T, ano_dur - MIN_RX_BCN_T);
1192*4882a593Smuzhiyun 	if (min1 < *bcn_min)
1193*4882a593Smuzhiyun 		*bcn_min = min1;
1194*4882a593Smuzhiyun 	if (max1 > *bcn_max)
1195*4882a593Smuzhiyun 		*bcn_max = max1;
1196*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_get_offset_range_for_2wslot_1btslot_p1(): min(%d), max(%d)\n",
1197*4882a593Smuzhiyun 		*bcn_min, *bcn_max);
1198*4882a593Smuzhiyun }
1199*4882a593Smuzhiyun 
_mcc_get_offset_range_for_2wslot_1btslot_p2(s16 ref_dur,s16 ano_dur,s16 bt_dur,s16 * bcn_min,s16 * bcn_max)1200*4882a593Smuzhiyun void _mcc_get_offset_range_for_2wslot_1btslot_p2(s16 ref_dur, s16 ano_dur,
1201*4882a593Smuzhiyun 				s16 bt_dur, s16 *bcn_min, s16 *bcn_max)
1202*4882a593Smuzhiyun {
1203*4882a593Smuzhiyun 	s16 min1 = 0, max1 = 0;
1204*4882a593Smuzhiyun 
1205*4882a593Smuzhiyun 	*bcn_min = _mcc_get_offset_for_2_wslot_1_btslot_p2(ref_dur, bt_dur,
1206*4882a593Smuzhiyun 						EARLY_RX_BCN_T, EARLY_RX_BCN_T);
1207*4882a593Smuzhiyun 	*bcn_max = _mcc_get_offset_for_2_wslot_1_btslot_p2(ref_dur, bt_dur,
1208*4882a593Smuzhiyun 					EARLY_RX_BCN_T, ano_dur - MIN_RX_BCN_T);
1209*4882a593Smuzhiyun 	min1 = _mcc_get_offset_for_2_wslot_1_btslot_p2(ref_dur, bt_dur,
1210*4882a593Smuzhiyun 					ref_dur - MIN_RX_BCN_T, EARLY_RX_BCN_T);
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun 	min1 = _mcc_get_offset_for_2_wslot_1_btslot_p2(ref_dur, bt_dur,
1213*4882a593Smuzhiyun 				ref_dur - MIN_RX_BCN_T, ano_dur - MIN_RX_BCN_T);
1214*4882a593Smuzhiyun 	if (min1 < *bcn_min)
1215*4882a593Smuzhiyun 		*bcn_min = min1;
1216*4882a593Smuzhiyun 	if (max1 > *bcn_max)
1217*4882a593Smuzhiyun 		*bcn_max = max1;
1218*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_get_offset_range_for_2wslot_1btslot_p2(): min(%d), max(%d)\n",
1219*4882a593Smuzhiyun 		*bcn_min, *bcn_max);
1220*4882a593Smuzhiyun }
1221*4882a593Smuzhiyun 
_mcc_get_offset_for_2_clients_worsecase(s16 ref_dur,s16 ano_dur,u16 ref_bcn_intvl,s16 toa_ref,s16 tob_ano)1222*4882a593Smuzhiyun s16 _mcc_get_offset_for_2_clients_worsecase(s16 ref_dur, s16 ano_dur,
1223*4882a593Smuzhiyun 				u16 ref_bcn_intvl, s16 toa_ref, s16 tob_ano)
1224*4882a593Smuzhiyun {
1225*4882a593Smuzhiyun 	return toa_ref + tob_ano + ref_dur + ano_dur - (2 * ref_bcn_intvl);
1226*4882a593Smuzhiyun }
1227*4882a593Smuzhiyun 
_mcc_get_offset_range_for_2_clients_worsecase(s16 ref_dur,s16 ano_dur,u16 ref_bcn_intvl,s16 * bcn_min,s16 * bcn_max)1228*4882a593Smuzhiyun void _mcc_get_offset_range_for_2_clients_worsecase(s16 ref_dur, s16 ano_dur,
1229*4882a593Smuzhiyun 				u16 ref_bcn_intvl, s16 *bcn_min, s16 *bcn_max)
1230*4882a593Smuzhiyun {
1231*4882a593Smuzhiyun 	s16 min1 = 0, min2 = 0, max1 = 0, max2 = 0;
1232*4882a593Smuzhiyun 	min1 = _mcc_get_offset_for_2_clients_worsecase(ref_dur, ano_dur,
1233*4882a593Smuzhiyun 				ref_bcn_intvl, MIN_RX_BCN_T, EARLY_RX_BCN_T);
1234*4882a593Smuzhiyun 	max1 = _mcc_get_offset_for_2_clients_worsecase(ref_dur, ano_dur,
1235*4882a593Smuzhiyun 				ref_bcn_intvl, MIN_RX_BCN_T, ano_dur -
1236*4882a593Smuzhiyun 				MIN_RX_BCN_T);
1237*4882a593Smuzhiyun 	min2 = _mcc_get_offset_for_2_clients_worsecase(ref_dur, ano_dur,
1238*4882a593Smuzhiyun 				ref_bcn_intvl, ref_dur - EARLY_RX_BCN_T,
1239*4882a593Smuzhiyun 				EARLY_RX_BCN_T);
1240*4882a593Smuzhiyun 	max2 = _mcc_get_offset_for_2_clients_worsecase(ref_dur, ano_dur,
1241*4882a593Smuzhiyun 				ref_bcn_intvl, ref_dur -EARLY_RX_BCN_T,
1242*4882a593Smuzhiyun 				ano_dur - MIN_RX_BCN_T);
1243*4882a593Smuzhiyun 	if (min1 < min2)
1244*4882a593Smuzhiyun 		*bcn_min = min1;
1245*4882a593Smuzhiyun 	else
1246*4882a593Smuzhiyun 		*bcn_min = min2;
1247*4882a593Smuzhiyun 	if (max1 > max2)
1248*4882a593Smuzhiyun 		*bcn_max = max1;
1249*4882a593Smuzhiyun 	else
1250*4882a593Smuzhiyun 		*bcn_max = max2;
1251*4882a593Smuzhiyun }
1252*4882a593Smuzhiyun 
1253*4882a593Smuzhiyun /*
1254*4882a593Smuzhiyun  * copy from _mcc_calc_2wslot_1btslot_nego_p1
1255*4882a593Smuzhiyun  * | Wifi slot1 | Bt slot | Wifi slot2 |
1256*4882a593Smuzhiyun  */
_mcc_calc_2wslot_1btslot_nego_p2(struct rtw_phl_mcc_dur_info * ref_dur,struct rtw_phl_mcc_dur_info * ano_dur,s16 bt_dur,s16 offset,struct rtw_phl_mcc_pattern * m_pattern)1257*4882a593Smuzhiyun bool _mcc_calc_2wslot_1btslot_nego_p2(struct rtw_phl_mcc_dur_info *ref_dur,
1258*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ano_dur, s16 bt_dur,
1259*4882a593Smuzhiyun 			s16 offset, struct rtw_phl_mcc_pattern *m_pattern)
1260*4882a593Smuzhiyun {
1261*4882a593Smuzhiyun 	bool cal_ok = false;
1262*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0;
1263*4882a593Smuzhiyun 
1264*4882a593Smuzhiyun 	if ((ref_dur->dur_limit.enable) && (ano_dur->dur_limit.enable)) {
1265*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2wslot_1btslot_nego_p2(): not support, both enable slot limitation\n");
1266*4882a593Smuzhiyun 		/*todo*/
1267*4882a593Smuzhiyun 		goto exit;
1268*4882a593Smuzhiyun 	}
1269*4882a593Smuzhiyun 	if (ref_dur->dur_limit.enable) {
1270*4882a593Smuzhiyun 		tob_r = ref_dur->dur / 2;
1271*4882a593Smuzhiyun 		toa_r = ref_dur->dur - tob_r;
1272*4882a593Smuzhiyun 		if (tob_r > ref_dur->dur_limit.max_tob) {
1273*4882a593Smuzhiyun 			tob_r = ref_dur->dur_limit.max_tob;
1274*4882a593Smuzhiyun 			toa_r = ref_dur->dur - tob_r;
1275*4882a593Smuzhiyun 		}
1276*4882a593Smuzhiyun 		if (toa_r > ref_dur->dur_limit.max_toa) {
1277*4882a593Smuzhiyun 			toa_r = ref_dur->dur_limit.max_toa;
1278*4882a593Smuzhiyun 			tob_r = ref_dur->dur - toa_r;
1279*4882a593Smuzhiyun 		}
1280*4882a593Smuzhiyun 		if ((tob_r > ref_dur->dur_limit.max_tob) ||
1281*4882a593Smuzhiyun 			(toa_r > ref_dur->dur_limit.max_toa)) {
1282*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2wslot_1btslot_nego_p2(): After adjust tob_r(%d) > max_tob(%d) or toa_r(%d) > max_toa(%d)\n",
1283*4882a593Smuzhiyun 				tob_r, ref_dur->dur_limit.max_tob,
1284*4882a593Smuzhiyun 				toa_r, ref_dur->dur_limit.max_toa);
1285*4882a593Smuzhiyun 			goto exit;
1286*4882a593Smuzhiyun 		}
1287*4882a593Smuzhiyun 		tob_a = offset - toa_r - bt_dur;
1288*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1289*4882a593Smuzhiyun 		if (tob_a <= 0 || toa_a <= 0) {
1290*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1291*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1292*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ref;
1293*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ano;
1294*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2wslot_1btslot_nego_p2(): Limi by ref dur, courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1295*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1296*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1297*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1298*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1299*4882a593Smuzhiyun 		}
1300*4882a593Smuzhiyun 		goto fill_pattern;
1301*4882a593Smuzhiyun 	} else if (ano_dur->dur_limit.enable) {
1302*4882a593Smuzhiyun 		tob_a = ano_dur->dur / 2;
1303*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1304*4882a593Smuzhiyun 		if (tob_a > ano_dur->dur_limit.max_tob) {
1305*4882a593Smuzhiyun 			tob_a = ano_dur->dur_limit.max_tob;
1306*4882a593Smuzhiyun 			toa_a = ano_dur->dur - tob_a;
1307*4882a593Smuzhiyun 		}
1308*4882a593Smuzhiyun 		if (toa_a > ano_dur->dur_limit.max_toa) {
1309*4882a593Smuzhiyun 			toa_a = ano_dur->dur_limit.max_toa;
1310*4882a593Smuzhiyun 			tob_a = ano_dur->dur - toa_a;
1311*4882a593Smuzhiyun 		}
1312*4882a593Smuzhiyun 		if ((tob_a > ano_dur->dur_limit.max_tob) ||
1313*4882a593Smuzhiyun 			(toa_a > ano_dur->dur_limit.max_toa)) {
1314*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2wslot_1btslot_nego_p2(): After adjust tob_r(%d) > max_tob(%d) or toa_r(%d) > max_toa(%d)\n",
1315*4882a593Smuzhiyun 				tob_a, ano_dur->dur_limit.max_tob,
1316*4882a593Smuzhiyun 				toa_a, ano_dur->dur_limit.max_toa);
1317*4882a593Smuzhiyun 			goto exit;
1318*4882a593Smuzhiyun 		}
1319*4882a593Smuzhiyun 		toa_r = offset - tob_a - bt_dur;
1320*4882a593Smuzhiyun 		tob_r = ref_dur->dur - toa_r;
1321*4882a593Smuzhiyun 		if (toa_r <= 0 || tob_r <= 0) {
1322*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1323*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1324*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ano;
1325*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ref;
1326*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2wslot_1btslot_nego_p2(): Limi by ano dur, courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1327*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1328*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1329*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1330*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1331*4882a593Smuzhiyun 		}
1332*4882a593Smuzhiyun 		goto fill_pattern;
1333*4882a593Smuzhiyun 	} else {
1334*4882a593Smuzhiyun 		tob_r = ref_dur->dur / 2;
1335*4882a593Smuzhiyun 		toa_r = ref_dur->dur - tob_r;
1336*4882a593Smuzhiyun 		tob_a = offset - toa_r - bt_dur;
1337*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1338*4882a593Smuzhiyun 		if (tob_a <= 0 || toa_a <= 0) {
1339*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1340*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1341*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ref;
1342*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ano;
1343*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2wslot_1btslot_nego_p2(): Limi by ref dur, courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1344*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1345*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1346*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1347*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1348*4882a593Smuzhiyun 		}
1349*4882a593Smuzhiyun 		goto fill_pattern;
1350*4882a593Smuzhiyun 	}
1351*4882a593Smuzhiyun fill_pattern:
1352*4882a593Smuzhiyun 	cal_ok = true;
1353*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r;
1354*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r;
1355*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a;
1356*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a;
1357*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
1358*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, true, bt_dur, NULL);
1359*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
1360*4882a593Smuzhiyun exit:
1361*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2wslot_1btslot_nego_p2(): calc nego patter ok(%d)\n",
1362*4882a593Smuzhiyun 		cal_ok);
1363*4882a593Smuzhiyun 	return cal_ok;
1364*4882a593Smuzhiyun }
1365*4882a593Smuzhiyun 
1366*4882a593Smuzhiyun /*
1367*4882a593Smuzhiyun  * copy from _mcc_calc_2_wrole_nego_pattern
1368*4882a593Smuzhiyun  * |   Wifi slot1   |   Wifi slot2   | Bt slot |
1369*4882a593Smuzhiyun  * |      Dur_r     |     Dur_a      | Bt slot |
1370*4882a593Smuzhiyun  *          bcn                bcn
1371*4882a593Smuzhiyun  * | tob_r | toa_r|tob_a | toa_a| Bt slot |
1372*4882a593Smuzhiyun  */
_mcc_calc_2wslot_1btslot_nego_p1(struct rtw_phl_mcc_dur_info * ref_dur,struct rtw_phl_mcc_dur_info * ano_dur,s16 offset,s16 bt_dur,struct rtw_phl_mcc_pattern * m_pattern)1373*4882a593Smuzhiyun bool _mcc_calc_2wslot_1btslot_nego_p1(struct rtw_phl_mcc_dur_info *ref_dur,
1374*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ano_dur, s16 offset,
1375*4882a593Smuzhiyun 			s16 bt_dur, struct rtw_phl_mcc_pattern *m_pattern)
1376*4882a593Smuzhiyun {
1377*4882a593Smuzhiyun 	bool cal_ok = false;
1378*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0;
1379*4882a593Smuzhiyun 
1380*4882a593Smuzhiyun 	if ((ref_dur->dur_limit.enable) && (ano_dur->dur_limit.enable)) {
1381*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2wslot_1btslot_nego_p1(): not support, both enable slot limitation\n");
1382*4882a593Smuzhiyun 		/*todo*/
1383*4882a593Smuzhiyun 		goto exit;
1384*4882a593Smuzhiyun 	}
1385*4882a593Smuzhiyun 	if (ref_dur->dur_limit.enable) {
1386*4882a593Smuzhiyun 		tob_r = ref_dur->dur / 2;
1387*4882a593Smuzhiyun 		toa_r = ref_dur->dur - tob_r;
1388*4882a593Smuzhiyun 		if (tob_r > ref_dur->dur_limit.max_tob) {
1389*4882a593Smuzhiyun 			tob_r = ref_dur->dur_limit.max_tob;
1390*4882a593Smuzhiyun 			toa_r = ref_dur->dur - tob_r;
1391*4882a593Smuzhiyun 		}
1392*4882a593Smuzhiyun 		if (toa_r > ref_dur->dur_limit.max_toa) {
1393*4882a593Smuzhiyun 			toa_r = ref_dur->dur_limit.max_toa;
1394*4882a593Smuzhiyun 			tob_r = ref_dur->dur - toa_r;
1395*4882a593Smuzhiyun 		}
1396*4882a593Smuzhiyun 		if ((tob_r > ref_dur->dur_limit.max_tob) ||
1397*4882a593Smuzhiyun 			(toa_r > ref_dur->dur_limit.max_toa)) {
1398*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2wslot_1btslot_nego_p1(): After adjust tob_r(%d) > max_tob(%d) or toa_r(%d) > max_toa(%d)\n",
1399*4882a593Smuzhiyun 				tob_r, ref_dur->dur_limit.max_tob,
1400*4882a593Smuzhiyun 				toa_r, ref_dur->dur_limit.max_toa);
1401*4882a593Smuzhiyun 			goto exit;
1402*4882a593Smuzhiyun 		}
1403*4882a593Smuzhiyun 		tob_a = offset - toa_r;
1404*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1405*4882a593Smuzhiyun 		if (tob_a <= 0 || toa_a <= 0) {
1406*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1407*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1408*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ref;
1409*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ano;
1410*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2wslot_1btslot_nego_p1(): Limi by ref dur, courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1411*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1412*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1413*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1414*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1415*4882a593Smuzhiyun 		}
1416*4882a593Smuzhiyun 		goto fill_pattern;
1417*4882a593Smuzhiyun 	} else if (ano_dur->dur_limit.enable) {
1418*4882a593Smuzhiyun 		tob_a = ano_dur->dur / 2;
1419*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1420*4882a593Smuzhiyun 		if (tob_a > ano_dur->dur_limit.max_tob) {
1421*4882a593Smuzhiyun 			tob_a = ano_dur->dur_limit.max_tob;
1422*4882a593Smuzhiyun 			toa_a = ano_dur->dur - tob_a;
1423*4882a593Smuzhiyun 		}
1424*4882a593Smuzhiyun 		if (toa_a > ano_dur->dur_limit.max_toa) {
1425*4882a593Smuzhiyun 			toa_a = ano_dur->dur_limit.max_toa;
1426*4882a593Smuzhiyun 			tob_a = ano_dur->dur - toa_a;
1427*4882a593Smuzhiyun 		}
1428*4882a593Smuzhiyun 		if ((tob_a > ano_dur->dur_limit.max_tob) ||
1429*4882a593Smuzhiyun 			(toa_a > ano_dur->dur_limit.max_toa)) {
1430*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2wslot_1btslot_nego_p1(): After adjust tob_r(%d) > max_tob(%d) or toa_r(%d) > max_toa(%d)\n",
1431*4882a593Smuzhiyun 				tob_a, ano_dur->dur_limit.max_tob,
1432*4882a593Smuzhiyun 				toa_a, ano_dur->dur_limit.max_toa);
1433*4882a593Smuzhiyun 			goto exit;
1434*4882a593Smuzhiyun 		}
1435*4882a593Smuzhiyun 		toa_r = offset - tob_a;
1436*4882a593Smuzhiyun 		tob_r = ref_dur->dur - toa_r;
1437*4882a593Smuzhiyun 		if (toa_r <= 0 || tob_r <= 0) {
1438*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1439*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1440*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ano;
1441*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ref;
1442*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2wslot_1btslot_nego_p1(): Limi by ano dur, courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1443*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1444*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1445*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1446*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1447*4882a593Smuzhiyun 		}
1448*4882a593Smuzhiyun 		goto fill_pattern;
1449*4882a593Smuzhiyun 	} else {
1450*4882a593Smuzhiyun 		tob_r = ref_dur->dur / 2;
1451*4882a593Smuzhiyun 		toa_r = ref_dur->dur - tob_r;
1452*4882a593Smuzhiyun 		tob_a = offset - toa_r;
1453*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1454*4882a593Smuzhiyun 		if (tob_a <= 0 || toa_a <= 0) {
1455*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1456*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1457*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ref;
1458*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ano;
1459*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2wslot_1btslot_nego_p1(): courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1460*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1461*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1462*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1463*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1464*4882a593Smuzhiyun 		}
1465*4882a593Smuzhiyun 		goto fill_pattern;
1466*4882a593Smuzhiyun 	}
1467*4882a593Smuzhiyun fill_pattern:
1468*4882a593Smuzhiyun 	cal_ok = true;
1469*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r;
1470*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r;
1471*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a;
1472*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a;
1473*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
1474*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
1475*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, true, bt_dur, NULL);
1476*4882a593Smuzhiyun exit:
1477*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2wslot_1btslot_nego_p1(): calc nego patter ok(%d)\n",
1478*4882a593Smuzhiyun 		cal_ok);
1479*4882a593Smuzhiyun 	return cal_ok;
1480*4882a593Smuzhiyun }
1481*4882a593Smuzhiyun 
1482*4882a593Smuzhiyun /*
1483*4882a593Smuzhiyun  * copy from _mcc_calculate_2_clients_pattern
1484*4882a593Smuzhiyun  * Calculate pattern2 for 2 wifi slot and 1 bt slot
1485*4882a593Smuzhiyun  * Pattern:
1486*4882a593Smuzhiyun  * |   Wifi slot1   | Bt slot |   Wifi slot2   |
1487*4882a593Smuzhiyun  * |      Dur_r     | Bt slot |     Dur_a      |
1488*4882a593Smuzhiyun  *          bcn                            bcn
1489*4882a593Smuzhiyun  * | tob_r | toa_r| Bt slot |tob_a | toa_a|
1490*4882a593Smuzhiyun  * @offset: The offset of Bcns
1491*4882a593Smuzhiyun  * @m_pattern: pattern info
1492*4882a593Smuzhiyun  */
_mcc_calculate_2wslot_1btslot_pattern2(struct rtw_phl_mcc_dur_info * ref_dur,struct rtw_phl_mcc_dur_info * ano_dur,u16 offset,s16 bt_dur,struct rtw_phl_mcc_pattern * m_pattern)1493*4882a593Smuzhiyun enum rtw_phl_status _mcc_calculate_2wslot_1btslot_pattern2(
1494*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ref_dur,
1495*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ano_dur,
1496*4882a593Smuzhiyun 				u16 offset, s16 bt_dur,
1497*4882a593Smuzhiyun 				struct rtw_phl_mcc_pattern *m_pattern)
1498*4882a593Smuzhiyun {
1499*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
1500*4882a593Smuzhiyun 	u16 mcc_intvl = ref_dur->dur + ano_dur->dur;
1501*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0, tob_r_cand = 0;
1502*4882a593Smuzhiyun 	s16 d_r = ref_dur->dur, d_a = ano_dur->dur, bcns_offset = offset;
1503*4882a593Smuzhiyun 	s16 sum = 0, sum_last = 0;
1504*4882a593Smuzhiyun 	s16 tob_r_l = ref_dur->dur_limit.max_tob;
1505*4882a593Smuzhiyun 	s16 toa_r_l = ref_dur->dur_limit.max_toa;
1506*4882a593Smuzhiyun 	s16 tob_a_l = ano_dur->dur_limit.max_tob;
1507*4882a593Smuzhiyun 	s16 toa_a_l = ano_dur->dur_limit.max_toa;
1508*4882a593Smuzhiyun 
1509*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): ref_dur(%d), ano_dur(%d), bt_dur(%d), bcns offset(%d)\n",
1510*4882a593Smuzhiyun 		d_r, d_a, bt_dur, bcns_offset);
1511*4882a593Smuzhiyun 	for (tob_r = EARLY_RX_BCN_T; tob_r < mcc_intvl; tob_r++) {
1512*4882a593Smuzhiyun 		toa_r = d_r - tob_r;
1513*4882a593Smuzhiyun 		if (toa_r < MIN_RX_BCN_T) {
1514*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): break loop, by toa_r(%d) < MIN_RX_BCN_T(%d)\n",
1515*4882a593Smuzhiyun 				toa_r, MIN_RX_BCN_T);
1516*4882a593Smuzhiyun 			break;
1517*4882a593Smuzhiyun 		}
1518*4882a593Smuzhiyun 		if (ref_dur->dur_limit.enable) {
1519*4882a593Smuzhiyun 			if (tob_r > tob_r_l) {
1520*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): tob_r(%d) > tob_r_l(%d), Break loop\n",
1521*4882a593Smuzhiyun 					tob_r, tob_r_l);
1522*4882a593Smuzhiyun 				break;
1523*4882a593Smuzhiyun 			} else if (toa_r > toa_r_l) {
1524*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): toa_r(%d) > toa_r_l(%d), continue next loop\n",
1525*4882a593Smuzhiyun 					toa_r, toa_r_l);
1526*4882a593Smuzhiyun 				continue;
1527*4882a593Smuzhiyun 			}
1528*4882a593Smuzhiyun 		}
1529*4882a593Smuzhiyun 		tob_a = bcns_offset - toa_r - bt_dur;
1530*4882a593Smuzhiyun 		if (tob_a < EARLY_RX_BCN_T)
1531*4882a593Smuzhiyun 			continue;
1532*4882a593Smuzhiyun 		toa_a = d_a - tob_a;
1533*4882a593Smuzhiyun 		if (toa_a < MIN_RX_BCN_T){
1534*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): break loop, by toa_a(%d) < MIN_RX_BCN_T(%d)\n",
1535*4882a593Smuzhiyun 				toa_a, MIN_RX_BCN_T);
1536*4882a593Smuzhiyun 			break;
1537*4882a593Smuzhiyun 		}
1538*4882a593Smuzhiyun 		if (ano_dur->dur_limit.enable) {
1539*4882a593Smuzhiyun 			if (tob_a > tob_a_l || toa_a > toa_a_l) {
1540*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): tob_a(%d) > tob_a_l(%d) || toa_a(%d) > toa_a_l(%d), continue next loop\n",
1541*4882a593Smuzhiyun 					tob_a, tob_a_l, toa_a, toa_a_l);
1542*4882a593Smuzhiyun 				continue;
1543*4882a593Smuzhiyun 			}
1544*4882a593Smuzhiyun 		}
1545*4882a593Smuzhiyun 		sum = ((tob_r - toa_r) * (tob_r - toa_r)) +
1546*4882a593Smuzhiyun 			((tob_r - tob_a) * (tob_r - tob_a)) +
1547*4882a593Smuzhiyun 			((tob_r - toa_a) * (tob_r - toa_a)) +
1548*4882a593Smuzhiyun 			((toa_r - tob_a) * (toa_r - tob_a)) +
1549*4882a593Smuzhiyun 			((toa_r - toa_a) * (toa_r - toa_a)) +
1550*4882a593Smuzhiyun 			((tob_a - toa_a) * (tob_a - toa_a));
1551*4882a593Smuzhiyun 		tob_r_cand = tob_r;
1552*4882a593Smuzhiyun 		if (sum_last !=0 && sum > sum_last) {
1553*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): Find the optimal pattern, by get minSum\n");
1554*4882a593Smuzhiyun 			break;
1555*4882a593Smuzhiyun 		}
1556*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d), sum_last(%d), sum(%d)\n",
1557*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a, sum_last, sum);
1558*4882a593Smuzhiyun 		sum_last = sum;
1559*4882a593Smuzhiyun 	}
1560*4882a593Smuzhiyun 	if (0 == tob_r_cand) {
1561*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2wslot_1btslot_pattern2(): Can't found suitable pattern, goto calc_nego_pattern\n");
1562*4882a593Smuzhiyun 		goto exit;
1563*4882a593Smuzhiyun 	}
1564*4882a593Smuzhiyun 	tob_r = tob_r_cand;
1565*4882a593Smuzhiyun 	toa_r = d_r - tob_r;
1566*4882a593Smuzhiyun 	tob_a = bcns_offset - toa_r;
1567*4882a593Smuzhiyun 	toa_a = d_a - tob_a;
1568*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r;
1569*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r;
1570*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a;
1571*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a;
1572*4882a593Smuzhiyun 	/*Update slot order*/
1573*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
1574*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, true, bt_dur, NULL);
1575*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
1576*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
1577*4882a593Smuzhiyun exit:
1578*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern2(): status(%d), tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
1579*4882a593Smuzhiyun 		status, m_pattern->tob_r, m_pattern->toa_r, m_pattern->tob_a,
1580*4882a593Smuzhiyun 		m_pattern->toa_a);
1581*4882a593Smuzhiyun 	return status;
1582*4882a593Smuzhiyun }
1583*4882a593Smuzhiyun 
1584*4882a593Smuzhiyun /*
1585*4882a593Smuzhiyun  * copy from _mcc_calculate_2_clients_pattern
1586*4882a593Smuzhiyun  * Calculate pattern1 for 2 wifi slot and 1 bt slot
1587*4882a593Smuzhiyun  * Pattern:
1588*4882a593Smuzhiyun  * |   Wifi slot1   |   Wifi slot2   | Bt slot |
1589*4882a593Smuzhiyun  * |      Dur_r     |     Dur_a      | Bt slot |
1590*4882a593Smuzhiyun  *          bcn                bcn
1591*4882a593Smuzhiyun  * | tob_r | toa_r|tob_a | toa_a| Bt slot |
1592*4882a593Smuzhiyun  * @offset: The offset of Bcns
1593*4882a593Smuzhiyun  * @m_pattern: pattern info
1594*4882a593Smuzhiyun  */
_mcc_calculate_2wslot_1btslot_pattern1(struct rtw_phl_mcc_dur_info * ref_dur,struct rtw_phl_mcc_dur_info * ano_dur,u16 offset,s16 bt_dur,struct rtw_phl_mcc_pattern * m_pattern)1595*4882a593Smuzhiyun enum rtw_phl_status _mcc_calculate_2wslot_1btslot_pattern1(
1596*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ref_dur,
1597*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ano_dur,
1598*4882a593Smuzhiyun 			u16 offset, s16 bt_dur,
1599*4882a593Smuzhiyun 			struct rtw_phl_mcc_pattern *m_pattern)
1600*4882a593Smuzhiyun {
1601*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
1602*4882a593Smuzhiyun 	u16 mcc_intvl = ref_dur->dur + ano_dur->dur;
1603*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0, tob_r_cand = 0;
1604*4882a593Smuzhiyun 	s16 d_r = ref_dur->dur, d_a = ano_dur->dur, bcns_offset = offset;
1605*4882a593Smuzhiyun 	s16 sum = 0, sum_last = 0;
1606*4882a593Smuzhiyun 	s16 tob_r_l = ref_dur->dur_limit.max_tob;
1607*4882a593Smuzhiyun 	s16 toa_r_l = ref_dur->dur_limit.max_toa;
1608*4882a593Smuzhiyun 	s16 tob_a_l = ano_dur->dur_limit.max_tob;
1609*4882a593Smuzhiyun 	s16 toa_a_l = ano_dur->dur_limit.max_toa;
1610*4882a593Smuzhiyun 
1611*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): ref_dur(%d), ano_dur(%d), bcns offset(%d)\n",
1612*4882a593Smuzhiyun 		d_r, d_a, bcns_offset);
1613*4882a593Smuzhiyun 	for (tob_r = EARLY_RX_BCN_T; tob_r < mcc_intvl; tob_r++) {
1614*4882a593Smuzhiyun 		toa_r = d_r - tob_r;
1615*4882a593Smuzhiyun 		if (toa_r < MIN_RX_BCN_T) {
1616*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): break loop, by toa_r(%d) < MIN_RX_BCN_T(%d)\n",
1617*4882a593Smuzhiyun 				toa_r, MIN_RX_BCN_T);
1618*4882a593Smuzhiyun 			break;
1619*4882a593Smuzhiyun 		}
1620*4882a593Smuzhiyun 		if (ref_dur->dur_limit.enable) {
1621*4882a593Smuzhiyun 			if (tob_r > tob_r_l) {
1622*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): tob_r(%d) > tob_r_l(%d), Break loop\n",
1623*4882a593Smuzhiyun 					tob_r, tob_r_l);
1624*4882a593Smuzhiyun 				break;
1625*4882a593Smuzhiyun 			} else if (toa_r > toa_r_l) {
1626*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): toa_r(%d) > toa_r_l(%d), continue next loop\n",
1627*4882a593Smuzhiyun 					toa_r, toa_r_l);
1628*4882a593Smuzhiyun 				continue;
1629*4882a593Smuzhiyun 			}
1630*4882a593Smuzhiyun 		}
1631*4882a593Smuzhiyun 		tob_a = bcns_offset - toa_r;
1632*4882a593Smuzhiyun 		if (tob_a < EARLY_RX_BCN_T)
1633*4882a593Smuzhiyun 			continue;
1634*4882a593Smuzhiyun 		toa_a = d_a - tob_a;
1635*4882a593Smuzhiyun 		if (toa_a < MIN_RX_BCN_T){
1636*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): break loop, by toa_a(%d) < MIN_RX_BCN_T(%d)\n",
1637*4882a593Smuzhiyun 				toa_a, MIN_RX_BCN_T);
1638*4882a593Smuzhiyun 			break;
1639*4882a593Smuzhiyun 		}
1640*4882a593Smuzhiyun 		if (ano_dur->dur_limit.enable) {
1641*4882a593Smuzhiyun 			if (tob_a > tob_a_l || toa_a > toa_a_l) {
1642*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): tob_a(%d) > tob_a_l(%d) || toa_a(%d) > toa_a_l(%d), continue next loop\n",
1643*4882a593Smuzhiyun 					tob_a, tob_a_l, toa_a, toa_a_l);
1644*4882a593Smuzhiyun 				continue;
1645*4882a593Smuzhiyun 			}
1646*4882a593Smuzhiyun 		}
1647*4882a593Smuzhiyun 		sum = ((tob_r - toa_r) * (tob_r - toa_r)) +
1648*4882a593Smuzhiyun 			((tob_r - tob_a) * (tob_r - tob_a)) +
1649*4882a593Smuzhiyun 			((tob_r - toa_a) * (tob_r - toa_a)) +
1650*4882a593Smuzhiyun 			((toa_r - tob_a) * (toa_r - tob_a)) +
1651*4882a593Smuzhiyun 			((toa_r - toa_a) * (toa_r - toa_a)) +
1652*4882a593Smuzhiyun 			((tob_a - toa_a) * (tob_a - toa_a));
1653*4882a593Smuzhiyun 		tob_r_cand = tob_r;
1654*4882a593Smuzhiyun 		if (sum_last !=0 && sum > sum_last) {
1655*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): Find the optimal pattern, by get minSum\n");
1656*4882a593Smuzhiyun 			break;
1657*4882a593Smuzhiyun 		}
1658*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d), sum_last(%d), sum(%d)\n",
1659*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a, sum_last, sum);
1660*4882a593Smuzhiyun 		sum_last = sum;
1661*4882a593Smuzhiyun 	}
1662*4882a593Smuzhiyun 	if (0 == tob_r_cand) {
1663*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2wslot_1btslot_pattern1(): Can't found suitable pattern, goto calc_nego_pattern\n");
1664*4882a593Smuzhiyun 		goto exit;
1665*4882a593Smuzhiyun 	}
1666*4882a593Smuzhiyun 	tob_r = tob_r_cand;
1667*4882a593Smuzhiyun 	toa_r = d_r - tob_r;
1668*4882a593Smuzhiyun 	tob_a = bcns_offset - toa_r;
1669*4882a593Smuzhiyun 	toa_a = d_a - tob_a;
1670*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r;
1671*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r;
1672*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a;
1673*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a;
1674*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
1675*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
1676*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, true, bt_dur, NULL);
1677*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
1678*4882a593Smuzhiyun exit:
1679*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2wslot_1btslot_pattern1(): status(%d), tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
1680*4882a593Smuzhiyun 		status, m_pattern->tob_r, m_pattern->toa_r, m_pattern->tob_a,
1681*4882a593Smuzhiyun 		m_pattern->toa_a);
1682*4882a593Smuzhiyun 	return status;
1683*4882a593Smuzhiyun }
1684*4882a593Smuzhiyun 
1685*4882a593Smuzhiyun /*
1686*4882a593Smuzhiyun  * Calculate pattern for 2 wifi slot and 1 bt slot
1687*4882a593Smuzhiyun  */
_mcc_calculate_2wslot_1btslot_pattern(struct rtw_phl_mcc_dur_info * ref_dur,struct rtw_phl_mcc_dur_info * ano_dur,s16 bt_dur,struct rtw_phl_mcc_pattern * m_pattern)1688*4882a593Smuzhiyun enum rtw_phl_status _mcc_calculate_2wslot_1btslot_pattern(
1689*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ref_dur,
1690*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ano_dur,
1691*4882a593Smuzhiyun 			s16 bt_dur, struct rtw_phl_mcc_pattern *m_pattern)
1692*4882a593Smuzhiyun {
1693*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
1694*4882a593Smuzhiyun 	s16 offset_min = 0, offset_max = 0;
1695*4882a593Smuzhiyun 	u16 offset = m_pattern->bcns_offset;
1696*4882a593Smuzhiyun 
1697*4882a593Smuzhiyun 	_mcc_get_offset_range_for_2wslot_1btslot_p1(ref_dur->dur, ano_dur->dur,
1698*4882a593Smuzhiyun 						&offset_min, &offset_max);
1699*4882a593Smuzhiyun 	if (offset >= offset_min && offset <= offset_max) {
1700*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS !=
1701*4882a593Smuzhiyun 			_mcc_calculate_2wslot_1btslot_pattern1(ref_dur, ano_dur,
1702*4882a593Smuzhiyun 						offset, bt_dur, m_pattern)) {
1703*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2wslot_1btslot_pattern(): Pattern1, Can't found suitable pattern, goto calc_nego_pattern\n");
1704*4882a593Smuzhiyun 			goto calc_nego_pattern;
1705*4882a593Smuzhiyun 		} else {
1706*4882a593Smuzhiyun 			status = RTW_PHL_STATUS_SUCCESS;
1707*4882a593Smuzhiyun 			goto exit;
1708*4882a593Smuzhiyun 		}
1709*4882a593Smuzhiyun 	}
1710*4882a593Smuzhiyun 	_mcc_get_offset_range_for_2wslot_1btslot_p2(ref_dur->dur, ano_dur->dur,
1711*4882a593Smuzhiyun 					bt_dur, &offset_min, &offset_max);
1712*4882a593Smuzhiyun 	if (offset >= offset_min && offset <= offset_max) {
1713*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS !=
1714*4882a593Smuzhiyun 			_mcc_calculate_2wslot_1btslot_pattern2(ref_dur, ano_dur,
1715*4882a593Smuzhiyun 						offset, bt_dur, m_pattern)) {
1716*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2wslot_1btslot_pattern(): Pattern2, Can't found suitable pattern, goto calc_nego_pattern\n");
1717*4882a593Smuzhiyun 			goto calc_nego_pattern;
1718*4882a593Smuzhiyun 		} else {
1719*4882a593Smuzhiyun 			status = RTW_PHL_STATUS_SUCCESS;
1720*4882a593Smuzhiyun 			goto exit;
1721*4882a593Smuzhiyun 		}
1722*4882a593Smuzhiyun 	} else {
1723*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2wslot_1btslot_pattern(): worsecase, goto calc_nego_pattern\n");
1724*4882a593Smuzhiyun 		goto calc_nego_pattern;
1725*4882a593Smuzhiyun 	}
1726*4882a593Smuzhiyun calc_nego_pattern:
1727*4882a593Smuzhiyun 	if (_mcc_calc_2wslot_1btslot_nego_p1(ref_dur,
1728*4882a593Smuzhiyun 					ano_dur, offset, bt_dur, m_pattern)) {
1729*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2wslot_1btslot_pattern(): calc_nego_pattern1 ok\n");
1730*4882a593Smuzhiyun 	} else if (_mcc_calc_2wslot_1btslot_nego_p2(ref_dur,
1731*4882a593Smuzhiyun 					ano_dur, offset, bt_dur, m_pattern)) {
1732*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2wslot_1btslot_pattern(): calc_nego_pattern2 ok\n");
1733*4882a593Smuzhiyun 	} else {
1734*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calculate_2wslot_1btslot_pattern(): calc_nego_pattern fail\n");
1735*4882a593Smuzhiyun 		goto exit;
1736*4882a593Smuzhiyun 	}
1737*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
1738*4882a593Smuzhiyun exit:
1739*4882a593Smuzhiyun 	return status;
1740*4882a593Smuzhiyun }
1741*4882a593Smuzhiyun 
1742*4882a593Smuzhiyun /*
1743*4882a593Smuzhiyun  * |Wifi1 slot| Wifi2 slot|
1744*4882a593Smuzhiyun  * <              150TU               ><              150TU               >
1745*4882a593Smuzhiyun  * |      Dur_r     |     Dur_a      |      Dur_r     |     Dur_a      |
1746*4882a593Smuzhiyun  *          bcn_r                                                     bcn_a
1747*4882a593Smuzhiyun  * | tob_r | toa_r|                                        |tob_a | toa_a|
1748*4882a593Smuzhiyun  */
_mcc_calc_2_clients_worsecase_pattern(u16 ref_dur,u16 ano_dur,u16 offset,u16 ref_bcn_intvl,struct rtw_phl_mcc_pattern * m_pattern)1749*4882a593Smuzhiyun enum rtw_phl_status _mcc_calc_2_clients_worsecase_pattern(u16 ref_dur,
1750*4882a593Smuzhiyun 				u16 ano_dur, u16 offset, u16 ref_bcn_intvl,
1751*4882a593Smuzhiyun 				struct rtw_phl_mcc_pattern *m_pattern)
1752*4882a593Smuzhiyun {
1753*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
1754*4882a593Smuzhiyun 	u16 mcc_intvl = ref_dur + ano_dur;
1755*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0;
1756*4882a593Smuzhiyun 	s16 d_r = ref_dur, d_a = ano_dur, bcns_offset = offset;
1757*4882a593Smuzhiyun 	s16 sum = 0, sum_last = 0, offset_min = 0, offset_max = 0;
1758*4882a593Smuzhiyun 
1759*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): ref_dur(%d), ano_dur(%d), bcns offset(%d), ref_bcn_intvl(%d)\n",
1760*4882a593Smuzhiyun 		ref_dur, ano_dur, offset, ref_bcn_intvl);
1761*4882a593Smuzhiyun 	if (ref_bcn_intvl != HANDLE_BCN_INTVL) {
1762*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2_clients_worsecase_pattern(): ref_bcn_intvl(%d) != HANDLE_BCN_INTVL(%d), now, we can't calculate the pattern\n",
1763*4882a593Smuzhiyun 			ref_bcn_intvl, HANDLE_BCN_INTVL);
1764*4882a593Smuzhiyun 		goto exit;
1765*4882a593Smuzhiyun 	}
1766*4882a593Smuzhiyun 	_mcc_get_offset_range_for_2_clients_worsecase(d_r, d_a, ref_bcn_intvl,
1767*4882a593Smuzhiyun 						&offset_min, &offset_max);
1768*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): we can calculate the range of bcn offset is %d~%d\n",
1769*4882a593Smuzhiyun 			offset_min, offset_max);
1770*4882a593Smuzhiyun 	if ((bcns_offset >= offset_min) && (bcns_offset <= offset_max))
1771*4882a593Smuzhiyun 		goto calc;
1772*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): transform bcn offset from %d to %d\n",
1773*4882a593Smuzhiyun 			bcns_offset, ref_bcn_intvl - bcns_offset);
1774*4882a593Smuzhiyun 	/*bcn offfset = 85, we can transform to -15*/
1775*4882a593Smuzhiyun 	bcns_offset = ref_bcn_intvl - bcns_offset;
1776*4882a593Smuzhiyun 	if (bcns_offset >= offset_min && offset_min <=offset_max) {
1777*4882a593Smuzhiyun 		goto calc;
1778*4882a593Smuzhiyun 	} else {
1779*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calculate_2_clients_worsecase_pattern(): bcn offset out of range, we can't calculate it\n");
1780*4882a593Smuzhiyun 		goto exit;
1781*4882a593Smuzhiyun 	}
1782*4882a593Smuzhiyun calc:
1783*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): Start calculate\n");
1784*4882a593Smuzhiyun 	for (tob_r = EARLY_RX_BCN_T; tob_r < mcc_intvl; tob_r++) {
1785*4882a593Smuzhiyun 		toa_r = d_r - tob_r;
1786*4882a593Smuzhiyun 		if (toa_r < MIN_RX_BCN_T) {
1787*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): Find the optimal pattern, by toa_r(%d) < MIN_RX_BCN_T(%d)\n",
1788*4882a593Smuzhiyun 				toa_r, MIN_RX_BCN_T);
1789*4882a593Smuzhiyun 			break;
1790*4882a593Smuzhiyun 		}
1791*4882a593Smuzhiyun 		tob_a = bcns_offset + 2 * ref_bcn_intvl - toa_r - mcc_intvl;
1792*4882a593Smuzhiyun 		if (tob_a < EARLY_RX_BCN_T)
1793*4882a593Smuzhiyun 			continue;
1794*4882a593Smuzhiyun 		toa_a = d_a - tob_a;
1795*4882a593Smuzhiyun 		if (toa_a < MIN_RX_BCN_T){
1796*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): Find the optimal pattern, by toa_a(%d) < MIN_RX_BCN_T(%d)\n",
1797*4882a593Smuzhiyun 				toa_a, MIN_RX_BCN_T);
1798*4882a593Smuzhiyun 			break;
1799*4882a593Smuzhiyun 		}
1800*4882a593Smuzhiyun 		sum = ((tob_r - toa_r) * (tob_r - toa_r)) +
1801*4882a593Smuzhiyun 			((tob_r - tob_a) * (tob_r - tob_a)) +
1802*4882a593Smuzhiyun 			((tob_r - toa_a) * (tob_r - toa_a)) +
1803*4882a593Smuzhiyun 			((toa_r - tob_a) * (toa_r - tob_a)) +
1804*4882a593Smuzhiyun 			((toa_r - toa_a) * (toa_r - toa_a)) +
1805*4882a593Smuzhiyun 			((tob_a - toa_a) * (tob_a - toa_a));
1806*4882a593Smuzhiyun 		if (sum_last !=0 && sum > sum_last) {
1807*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): Find the optimal pattern, by get minSum\n");
1808*4882a593Smuzhiyun 			break;
1809*4882a593Smuzhiyun 		}
1810*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d), sum_last(%d), sum(%d)\n",
1811*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a, sum_last, sum);
1812*4882a593Smuzhiyun 		sum_last = sum;
1813*4882a593Smuzhiyun 
1814*4882a593Smuzhiyun 	}
1815*4882a593Smuzhiyun 	tob_r = tob_r - 1;
1816*4882a593Smuzhiyun 	toa_r = d_r - tob_r;
1817*4882a593Smuzhiyun 	tob_a = bcns_offset + 2 * ref_bcn_intvl - toa_r - mcc_intvl;
1818*4882a593Smuzhiyun 	toa_a = d_a - tob_a;
1819*4882a593Smuzhiyun 	m_pattern->tob_r = (u8)tob_r;
1820*4882a593Smuzhiyun 	m_pattern->toa_r = (u8)toa_r;
1821*4882a593Smuzhiyun 	m_pattern->tob_a = (u8)tob_a;
1822*4882a593Smuzhiyun 	m_pattern->toa_a = (u8)toa_a;
1823*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur, m_pattern->role_ref);
1824*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur, m_pattern->role_ano);
1825*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_worsecase_pattern(): Result, tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
1826*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a);
1827*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
1828*4882a593Smuzhiyun exit:
1829*4882a593Smuzhiyun 	if (status != RTW_PHL_STATUS_SUCCESS)
1830*4882a593Smuzhiyun 		m_pattern->calc_fail = true;
1831*4882a593Smuzhiyun 	return status;
1832*4882a593Smuzhiyun }
1833*4882a593Smuzhiyun 
1834*4882a593Smuzhiyun #if 0
1835*4882a593Smuzhiyun void _mcc_fill_bt_slot(struct phl_mcc_info *minfo,
1836*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ref_dur,
1837*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ano_dur)
1838*4882a593Smuzhiyun {
1839*4882a593Smuzhiyun 	struct rtw_phl_mcc_bt_info *bt_info = &minfo->bt_info;
1840*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
1841*4882a593Smuzhiyun 	struct rtw_phl_mcc_pattern *m_pattern = &en_info->m_pattern;
1842*4882a593Smuzhiyun 	u8 i = 0;
1843*4882a593Smuzhiyun 	s16 spacing = 0;
1844*4882a593Smuzhiyun 
1845*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_fill_bt_slot()\n");
1846*4882a593Smuzhiyun 	if (false == bt_info->add_bt_role)
1847*4882a593Smuzhiyun 		goto exit;
1848*4882a593Smuzhiyun 	spacing = m_pattern->bcns_offset - m_pattern->toa_r - m_pattern->tob_a;
1849*4882a593Smuzhiyun 	if (0 < spacing) {
1850*4882a593Smuzhiyun 		if (bt_info->bt_dur < spacing) {
1851*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_bt_slot(): bt_info->bt_dur(%d) < spacing(%d), adjust BT dur to (%d), please check code\n",
1852*4882a593Smuzhiyun 				bt_info->bt_dur, spacing, spacing);
1853*4882a593Smuzhiyun 			bt_info->bt_dur = spacing;
1854*4882a593Smuzhiyun 			bt_info->bt_seg[0] = bt_info->bt_dur;
1855*4882a593Smuzhiyun 			bt_info->bt_seg_num = 1;
1856*4882a593Smuzhiyun 			goto exit;
1857*4882a593Smuzhiyun 		}
1858*4882a593Smuzhiyun 		bt_info->bt_seg[0] = spacing;
1859*4882a593Smuzhiyun 		bt_info->bt_seg[1] = bt_info->bt_dur - bt_info->bt_seg[0];
1860*4882a593Smuzhiyun 		bt_info->bt_seg_num = 2;
1861*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_bt_slot(): Segment Bt dur to Seg1(%d), Seg2(%d)\n",
1862*4882a593Smuzhiyun 			bt_info->bt_seg[0], bt_info->bt_seg[1]);
1863*4882a593Smuzhiyun 	} else if (0 == spacing){
1864*4882a593Smuzhiyun 		bt_info->bt_seg[0] = bt_info->bt_dur;
1865*4882a593Smuzhiyun 		bt_info->bt_seg_num = 1;
1866*4882a593Smuzhiyun 	} else {
1867*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_bt_slot(): spacing(%d) < 0, please check code,\n",
1868*4882a593Smuzhiyun 			spacing);
1869*4882a593Smuzhiyun 	}
1870*4882a593Smuzhiyun exit:
1871*4882a593Smuzhiyun 	_mcc_dump_bt_ino(bt_info);
1872*4882a593Smuzhiyun 	return;
1873*4882a593Smuzhiyun }
1874*4882a593Smuzhiyun #endif
1875*4882a593Smuzhiyun 
1876*4882a593Smuzhiyun /*
1877*4882a593Smuzhiyun  * |Wifi1 slot|Wifi2 slot|
1878*4882a593Smuzhiyun  */
_mcc_calc_2_wrole_nego_pattern(struct rtw_phl_mcc_dur_info * ref_dur,struct rtw_phl_mcc_dur_info * ano_dur,s16 offset,struct rtw_phl_mcc_pattern * m_pattern)1879*4882a593Smuzhiyun bool _mcc_calc_2_wrole_nego_pattern(struct rtw_phl_mcc_dur_info *ref_dur,
1880*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ano_dur, s16 offset,
1881*4882a593Smuzhiyun 				struct rtw_phl_mcc_pattern *m_pattern)
1882*4882a593Smuzhiyun {
1883*4882a593Smuzhiyun 	bool cal_ok = false;
1884*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0;
1885*4882a593Smuzhiyun 
1886*4882a593Smuzhiyun 	if ((!ref_dur->dur_limit.enable) && (!ano_dur->dur_limit.enable)) {
1887*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2_wrole_nego_pattern(): not support, both not enable slot limitation\n");
1888*4882a593Smuzhiyun 		/*todo*/
1889*4882a593Smuzhiyun 		goto exit;
1890*4882a593Smuzhiyun 	}
1891*4882a593Smuzhiyun 	if ((ref_dur->dur_limit.enable) && (ano_dur->dur_limit.enable)) {
1892*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2_wrole_nego_pattern(): not support, both enable slot limitation\n");
1893*4882a593Smuzhiyun 		/*todo*/
1894*4882a593Smuzhiyun 		goto exit;
1895*4882a593Smuzhiyun 	}
1896*4882a593Smuzhiyun 	if ((ref_dur->dur_limit.enable) && (!ano_dur->dur_limit.enable)) {
1897*4882a593Smuzhiyun 		tob_r = ref_dur->dur / 2;
1898*4882a593Smuzhiyun 		toa_r = ref_dur->dur - tob_r;
1899*4882a593Smuzhiyun 		if (tob_r > ref_dur->dur_limit.max_tob) {
1900*4882a593Smuzhiyun 			tob_r = ref_dur->dur_limit.max_tob;
1901*4882a593Smuzhiyun 			toa_r = ref_dur->dur - tob_r;
1902*4882a593Smuzhiyun 		}
1903*4882a593Smuzhiyun 		if (toa_r > ref_dur->dur_limit.max_toa) {
1904*4882a593Smuzhiyun 			toa_r = ref_dur->dur_limit.max_toa;
1905*4882a593Smuzhiyun 			tob_r = ref_dur->dur - toa_r;
1906*4882a593Smuzhiyun 		}
1907*4882a593Smuzhiyun 		if ((tob_r > ref_dur->dur_limit.max_tob) ||
1908*4882a593Smuzhiyun 			(toa_r > ref_dur->dur_limit.max_toa)) {
1909*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2_wrole_nego_pattern(): After adjust tob_r(%d) > max_tob(%d) or toa_r(%d) > max_toa(%d)\n",
1910*4882a593Smuzhiyun 				tob_r, ref_dur->dur_limit.max_tob,
1911*4882a593Smuzhiyun 				toa_r, ref_dur->dur_limit.max_toa);
1912*4882a593Smuzhiyun 			goto exit;
1913*4882a593Smuzhiyun 		}
1914*4882a593Smuzhiyun 		tob_a = offset - toa_r;
1915*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1916*4882a593Smuzhiyun 		if (tob_a <= 0 || toa_a <= 0) {
1917*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1918*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1919*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ref;
1920*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ano;
1921*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2_wrole_nego_pattern(): Limi by ref dur, courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1922*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1923*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1924*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1925*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1926*4882a593Smuzhiyun 		}
1927*4882a593Smuzhiyun 		goto fill_pattern;
1928*4882a593Smuzhiyun 	}
1929*4882a593Smuzhiyun 	if ((!ref_dur->dur_limit.enable) && (ano_dur->dur_limit.enable)) {
1930*4882a593Smuzhiyun 		tob_a = ano_dur->dur / 2;
1931*4882a593Smuzhiyun 		toa_a = ano_dur->dur - tob_a;
1932*4882a593Smuzhiyun 		if (tob_a > ano_dur->dur_limit.max_tob) {
1933*4882a593Smuzhiyun 			tob_a = ano_dur->dur_limit.max_tob;
1934*4882a593Smuzhiyun 			toa_a = ano_dur->dur - tob_a;
1935*4882a593Smuzhiyun 		}
1936*4882a593Smuzhiyun 		if (toa_a > ano_dur->dur_limit.max_toa) {
1937*4882a593Smuzhiyun 			toa_a = ano_dur->dur_limit.max_toa;
1938*4882a593Smuzhiyun 			tob_a = ano_dur->dur - toa_a;
1939*4882a593Smuzhiyun 		}
1940*4882a593Smuzhiyun 		if ((tob_a > ano_dur->dur_limit.max_tob) ||
1941*4882a593Smuzhiyun 			(toa_a > ano_dur->dur_limit.max_toa)) {
1942*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2_wrole_nego_pattern(): After adjust tob_r(%d) > max_tob(%d) or toa_r(%d) > max_toa(%d)\n",
1943*4882a593Smuzhiyun 				tob_a, ano_dur->dur_limit.max_tob,
1944*4882a593Smuzhiyun 				toa_a, ano_dur->dur_limit.max_toa);
1945*4882a593Smuzhiyun 			goto exit;
1946*4882a593Smuzhiyun 		}
1947*4882a593Smuzhiyun 		toa_r = offset - tob_a;
1948*4882a593Smuzhiyun 		tob_r = ref_dur->dur - toa_r;
1949*4882a593Smuzhiyun 		if (toa_r <= 0 || tob_r <= 0) {
1950*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_en= true;
1951*4882a593Smuzhiyun 			m_pattern->courtesy_i.c_num = 3;
1952*4882a593Smuzhiyun 			m_pattern->courtesy_i.src_role = m_pattern->role_ano;
1953*4882a593Smuzhiyun 			m_pattern->courtesy_i.tgt_role = m_pattern->role_ref;
1954*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2_wrole_nego_pattern(): Limi by ano dur, courtesy_info: c_en(%d), c_num(%d), src_role->macid(0x%x), tgt_role->macid(0x%x)\n",
1955*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_en,
1956*4882a593Smuzhiyun 				m_pattern->courtesy_i.c_num,
1957*4882a593Smuzhiyun 				m_pattern->courtesy_i.src_role->macid,
1958*4882a593Smuzhiyun 				m_pattern->courtesy_i.tgt_role->macid);
1959*4882a593Smuzhiyun 		}
1960*4882a593Smuzhiyun 		goto fill_pattern;
1961*4882a593Smuzhiyun 	}
1962*4882a593Smuzhiyun fill_pattern:
1963*4882a593Smuzhiyun 	cal_ok = true;
1964*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r;
1965*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r;
1966*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a;
1967*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a;
1968*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
1969*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
1970*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wrole_nego_pattern(): calc nego patter\n");
1971*4882a593Smuzhiyun exit:
1972*4882a593Smuzhiyun 	return cal_ok;
1973*4882a593Smuzhiyun }
1974*4882a593Smuzhiyun 
1975*4882a593Smuzhiyun #if 0
1976*4882a593Smuzhiyun /**
1977*4882a593Smuzhiyun  * Calculate the optimal pattern for 2wrole MCC with limitation of time slot v2
1978*4882a593Smuzhiyun  * @ref_dur: Duration info of reference ch
1979*4882a593Smuzhiyun  * @ano_dur: Duration info of another ch
1980*4882a593Smuzhiyun  * @offset: The offset between beacon of ref_role and beacon of ano_role
1981*4882a593Smuzhiyun  * @m_pattern: mcc pattern.
1982*4882a593Smuzhiyun  **/
1983*4882a593Smuzhiyun enum rtw_phl_status _mcc_calculate_2_wrole_pattern_v2(
1984*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ref_dur,
1985*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ano_dur,
1986*4882a593Smuzhiyun 				u16 offset,
1987*4882a593Smuzhiyun 				struct rtw_phl_mcc_pattern *m_pattern)
1988*4882a593Smuzhiyun {
1989*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
1990*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0;
1991*4882a593Smuzhiyun 	s16 tob_r_cand = 0, toa_r_cand = 0, tob_a_cand = 0, toa_a_cand = 0;
1992*4882a593Smuzhiyun 	s16 d_r = ref_dur->dur, d_a = ano_dur->dur, bcns_offset = offset;
1993*4882a593Smuzhiyun 	s16 sum = 0, sum_last = 0;
1994*4882a593Smuzhiyun 	s16 tob_r_min = _mcc_is_ap_category(m_pattern->role_ref->wrole) ?
1995*4882a593Smuzhiyun 			EARLY_TX_BCN_T : EARLY_RX_BCN_T;
1996*4882a593Smuzhiyun 	s16 toa_r_min = _mcc_is_ap_category(m_pattern->role_ref->wrole) ?
1997*4882a593Smuzhiyun 			MIN_TX_BCN_T : MIN_RX_BCN_T;
1998*4882a593Smuzhiyun 	s16 tob_a_min = _mcc_is_ap_category(m_pattern->role_ano->wrole) ?
1999*4882a593Smuzhiyun 			EARLY_TX_BCN_T : EARLY_RX_BCN_T;
2000*4882a593Smuzhiyun 	s16 toa_a_min = _mcc_is_ap_category(m_pattern->role_ano->wrole) ?
2001*4882a593Smuzhiyun 			MIN_TX_BCN_T : MIN_RX_BCN_T;
2002*4882a593Smuzhiyun 	s16 min_bcns_offset = toa_r_min + tob_a_min;
2003*4882a593Smuzhiyun 	s16 i = 0, cnt = 0;
2004*4882a593Smuzhiyun 	bool bdry_r = false, bdry_a = false; /*reach boundary edge*/
2005*4882a593Smuzhiyun 
2006*4882a593Smuzhiyun 	if ((bcns_offset > (m_pattern->role_ref->bcn_intvl - min_bcns_offset))
2007*4882a593Smuzhiyun 		|| (bcns_offset < min_bcns_offset)) {
2008*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2_wrole_pattern_v2(): bcns_offset(%d) > max_offset(%d) || bcns_offset < min_offset(%d), goto calc_nego_pattern\n",
2009*4882a593Smuzhiyun 			bcns_offset,
2010*4882a593Smuzhiyun 			(m_pattern->role_ref->bcn_intvl - min_bcns_offset),
2011*4882a593Smuzhiyun 			min_bcns_offset);
2012*4882a593Smuzhiyun 		goto calc_nego_pattern;
2013*4882a593Smuzhiyun 	}
2014*4882a593Smuzhiyun 	cnt = bcns_offset - toa_r_min - tob_a_min;
2015*4882a593Smuzhiyun 	toa_r = toa_r_min;
2016*4882a593Smuzhiyun 	tob_a = tob_a_min;
2017*4882a593Smuzhiyun 	for (i = 0; i < cnt; i++) {
2018*4882a593Smuzhiyun 		if ((true == bdry_r) && (true == bdry_a)) {
2019*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2_wrole_pattern_v2(): braek loop by (true == bdry_r) && (true == bdry_a)\n");
2020*4882a593Smuzhiyun 			break;
2021*4882a593Smuzhiyun 		}
2022*4882a593Smuzhiyun 		if (true == bdry_r)
2023*4882a593Smuzhiyun 			goto calc_ano;
2024*4882a593Smuzhiyun 		if (i > 0)
2025*4882a593Smuzhiyun 			toa_r++;
2026*4882a593Smuzhiyun 		tob_r = d_r - toa_r;
2027*4882a593Smuzhiyun 		if (tob_r < tob_r_min) {
2028*4882a593Smuzhiyun 			bdry_r = true;
2029*4882a593Smuzhiyun 			goto calc_ano;
2030*4882a593Smuzhiyun 		}
2031*4882a593Smuzhiyun 		if (!ref_dur->dur_limit.enable)
2032*4882a593Smuzhiyun 			goto check_conflict1;
2033*4882a593Smuzhiyun 		if ((tob_r > ref_dur->dur_limit.max_tob) ||
2034*4882a593Smuzhiyun 			(toa_r > ref_dur->dur_limit.max_toa)) {
2035*4882a593Smuzhiyun 			goto calc_ano;
2036*4882a593Smuzhiyun 		}
2037*4882a593Smuzhiyun check_conflict1:
2038*4882a593Smuzhiyun 		if ((toa_r + tob_a_cand) > bcns_offset) {
2039*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2_wrole_pattern_v2(): braek loop by conflict(toa_r(%d) + tob_a_cand(%d)) > bcns_offset(%d)\n",
2040*4882a593Smuzhiyun 				toa_r, tob_a_cand, bcns_offset);
2041*4882a593Smuzhiyun 			break;
2042*4882a593Smuzhiyun 		}
2043*4882a593Smuzhiyun 		toa_r_cand = toa_r;
2044*4882a593Smuzhiyun calc_ano:
2045*4882a593Smuzhiyun 		if (true == bdry_a)
2046*4882a593Smuzhiyun 			continue;
2047*4882a593Smuzhiyun 		if (i > 0)
2048*4882a593Smuzhiyun 			tob_a++;
2049*4882a593Smuzhiyun 		toa_a = d_a - tob_a;
2050*4882a593Smuzhiyun 		if (toa_a < toa_a_min) {
2051*4882a593Smuzhiyun 			bdry_a = true;
2052*4882a593Smuzhiyun 			continue;
2053*4882a593Smuzhiyun 		}
2054*4882a593Smuzhiyun 		if (!ano_dur->dur_limit.enable)
2055*4882a593Smuzhiyun 			goto check_conflict2;
2056*4882a593Smuzhiyun 		if ((tob_a > ano_dur->dur_limit.max_tob) ||
2057*4882a593Smuzhiyun 			(toa_a > ano_dur->dur_limit.max_toa)) {
2058*4882a593Smuzhiyun 			continue;
2059*4882a593Smuzhiyun 		}
2060*4882a593Smuzhiyun check_conflict2:
2061*4882a593Smuzhiyun 		if ((bcns_offset - (tob_a + toa_r_cand)) >
2062*4882a593Smuzhiyun 			(m_pattern->d_r_d_a_spacing_max)) {
2063*4882a593Smuzhiyun 			continue;
2064*4882a593Smuzhiyun 		}
2065*4882a593Smuzhiyun 		if ((tob_a + toa_r_cand) > bcns_offset) {
2066*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2_wrole_pattern_v2(): braek loop by conflict(tob_a(%d) + toa_r_cand(%d)) > bcns_offset(%d)\n",
2067*4882a593Smuzhiyun 				tob_a, toa_r_cand, bcns_offset);
2068*4882a593Smuzhiyun 			break;
2069*4882a593Smuzhiyun 		}
2070*4882a593Smuzhiyun 		tob_a_cand = tob_a;
2071*4882a593Smuzhiyun /*calculate candidate result*/
2072*4882a593Smuzhiyun 		tob_r_cand = d_r - toa_r_cand;
2073*4882a593Smuzhiyun 		toa_a_cand = d_a - tob_a_cand;
2074*4882a593Smuzhiyun 		sum = ((tob_r_cand - toa_r_cand) * (tob_r_cand - toa_r_cand)) +
2075*4882a593Smuzhiyun 		      ((tob_r_cand - tob_a_cand) * (tob_r_cand - tob_a_cand)) +
2076*4882a593Smuzhiyun 		      ((tob_r_cand - toa_a_cand) * (tob_r_cand - toa_a_cand)) +
2077*4882a593Smuzhiyun 		      ((toa_r_cand - tob_a_cand) * (toa_r_cand - tob_a_cand)) +
2078*4882a593Smuzhiyun 		      ((toa_r_cand - toa_a_cand) * (toa_r_cand - toa_a_cand)) +
2079*4882a593Smuzhiyun 		      ((tob_a_cand - toa_a_cand) * (tob_a_cand - toa_a_cand));
2080*4882a593Smuzhiyun 		if (sum_last !=0 && sum > sum_last) {
2081*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern_v2(): Find the optimal pattern, by get minSum\n");
2082*4882a593Smuzhiyun 			break;
2083*4882a593Smuzhiyun 		}
2084*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern_v2(): tob_r_cand(%d), toa_r_cand(%d), tob_a_cand(%d), toa_a_cand(%d), sum_last(%d), sum(%d)\n",
2085*4882a593Smuzhiyun 			tob_r_cand, toa_r_cand, tob_a_cand, toa_a_cand,
2086*4882a593Smuzhiyun 			sum_last, sum);
2087*4882a593Smuzhiyun 		sum_last = sum;
2088*4882a593Smuzhiyun 	}
2089*4882a593Smuzhiyun 	if ((0 == toa_r_cand) || (0 == tob_a_cand)) {
2090*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2_wrole_pattern_v2(): Can't found suitable pattern, goto calc_nego_pattern\n");
2091*4882a593Smuzhiyun 		goto calc_nego_pattern;
2092*4882a593Smuzhiyun 	}
2093*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r_cand;
2094*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r_cand;
2095*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a_cand;
2096*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a_cand;
2097*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
2098*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
2099*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2100*4882a593Smuzhiyun 	goto exit;
2101*4882a593Smuzhiyun calc_nego_pattern:
2102*4882a593Smuzhiyun 	if (_mcc_calc_2_wrole_nego_pattern(ref_dur, ano_dur, bcns_offset,
2103*4882a593Smuzhiyun 						m_pattern)) {
2104*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_SUCCESS;
2105*4882a593Smuzhiyun 	}
2106*4882a593Smuzhiyun exit:
2107*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern_v2(): m_pattern: tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
2108*4882a593Smuzhiyun 		m_pattern->tob_r, m_pattern->toa_r, m_pattern->tob_a,
2109*4882a593Smuzhiyun 		m_pattern->toa_a);
2110*4882a593Smuzhiyun 	return status;
2111*4882a593Smuzhiyun }
2112*4882a593Smuzhiyun #endif
2113*4882a593Smuzhiyun 
2114*4882a593Smuzhiyun #if 0
2115*4882a593Smuzhiyun /**
2116*4882a593Smuzhiyun  * Copy from _mcc_calc_2_clients_worsecase_pattern and add limitation of time slot
2117*4882a593Smuzhiyun  * worsecase: TDMA interval is 150 TU
2118*4882a593Smuzhiyun  * Calculate the optimal pattern for 2wifi slot with limitation of time slot for worsecase
2119*4882a593Smuzhiyun  * @ref_dur: Duration info of reference slot
2120*4882a593Smuzhiyun  * @ano_dur: Duration info of another slot
2121*4882a593Smuzhiyun  * @offset: The offset between beacon of ref_role and beacon of ano_role
2122*4882a593Smuzhiyun  * @ref_bcn_intvl: Bcn interval of reference role
2123*4882a593Smuzhiyun  * @m_pattern: mcc pattern.
2124*4882a593Smuzhiyun  **/
2125*4882a593Smuzhiyun enum rtw_phl_status _mcc_calc_2_wifi_slot_worsecase_pattern(
2126*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ref_dur,
2127*4882a593Smuzhiyun 			struct rtw_phl_mcc_dur_info *ano_dur, u16 offset,
2128*4882a593Smuzhiyun 			u16 ref_bcn_intvl, struct rtw_phl_mcc_pattern *m_pattern)
2129*4882a593Smuzhiyun {
2130*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2131*4882a593Smuzhiyun 	u16 mcc_intvl = ref_dur->dur + ano_dur->dur;
2132*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0, tob_r_cand = 0;
2133*4882a593Smuzhiyun 
2134*4882a593Smuzhiyun 	s16 d_r = ref_dur->dur, d_a = ano_dur->dur, bcns_offset = offset;
2135*4882a593Smuzhiyun 	s16 sum = 0, sum_last = 0, offset_min = 0, offset_max = 0;
2136*4882a593Smuzhiyun 	s16 tob_r_l = ref_dur->dur_limit.max_tob;
2137*4882a593Smuzhiyun 	s16 toa_r_l = ref_dur->dur_limit.max_toa;
2138*4882a593Smuzhiyun 	s16 tob_a_l = ano_dur->dur_limit.max_tob;
2139*4882a593Smuzhiyun 	s16 toa_a_l = ano_dur->dur_limit.max_toa;
2140*4882a593Smuzhiyun 
2141*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): ref_dur(%d), ano_dur(%d), bcns offset(%d), ref_bcn_intvl(%d)\n",
2142*4882a593Smuzhiyun 		d_r, d_a, offset, ref_bcn_intvl);
2143*4882a593Smuzhiyun 	if (ref_bcn_intvl != HANDLE_BCN_INTVL) {
2144*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): ref_bcn_intvl(%d) != HANDLE_BCN_INTVL(%d), now, we can't calculate the pattern\n",
2145*4882a593Smuzhiyun 			ref_bcn_intvl, HANDLE_BCN_INTVL);
2146*4882a593Smuzhiyun 		goto exit;
2147*4882a593Smuzhiyun 	}
2148*4882a593Smuzhiyun 	_mcc_get_offset_range_for_2_clients_worsecase(d_r, d_a, ref_bcn_intvl,
2149*4882a593Smuzhiyun 						&offset_min, &offset_max);
2150*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): we can calculate the range of bcn offset is %d~%d\n",
2151*4882a593Smuzhiyun 			offset_min, offset_max);
2152*4882a593Smuzhiyun 	if ((bcns_offset >= offset_min) && (bcns_offset <= offset_max))
2153*4882a593Smuzhiyun 		goto calc;
2154*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): transform bcn offset from %d to %d\n",
2155*4882a593Smuzhiyun 			bcns_offset, ref_bcn_intvl - bcns_offset);
2156*4882a593Smuzhiyun 	/*bcn offfset = 85, we can transform to -15*/
2157*4882a593Smuzhiyun 	bcns_offset = ref_bcn_intvl - bcns_offset;
2158*4882a593Smuzhiyun 	if (bcns_offset >= offset_min && offset_min <=offset_max) {
2159*4882a593Smuzhiyun 		goto calc;
2160*4882a593Smuzhiyun 	} else {
2161*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): bcn offset out of range, we can't calculate it\n");
2162*4882a593Smuzhiyun 		goto exit;
2163*4882a593Smuzhiyun 	}
2164*4882a593Smuzhiyun calc:
2165*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): Start calculate\n");
2166*4882a593Smuzhiyun 	for (tob_r = EARLY_RX_BCN_T; tob_r < mcc_intvl; tob_r++) {
2167*4882a593Smuzhiyun 		toa_r = d_r - tob_r;
2168*4882a593Smuzhiyun 		if (toa_r < MIN_RX_BCN_T) {
2169*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): Break loop, by toa_r(%d) < MIN_RX_BCN_T(%d)\n",
2170*4882a593Smuzhiyun 				toa_r, MIN_RX_BCN_T);
2171*4882a593Smuzhiyun 			break;
2172*4882a593Smuzhiyun 		}
2173*4882a593Smuzhiyun 		if (ref_dur->dur_limit.enable) {
2174*4882a593Smuzhiyun 			if (toa_r > toa_r_l) {
2175*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): toa_r(%d) > toa_r_l(%d), continue next loop\n",
2176*4882a593Smuzhiyun 					toa_r, toa_r_l);
2177*4882a593Smuzhiyun 				continue;
2178*4882a593Smuzhiyun 			}
2179*4882a593Smuzhiyun 			if (tob_r > tob_r_l) {
2180*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): Break loop, tob_r(%d) > tob_r_l(%d)\n",
2181*4882a593Smuzhiyun 					tob_r, tob_r_l);
2182*4882a593Smuzhiyun 				break;
2183*4882a593Smuzhiyun 			}
2184*4882a593Smuzhiyun 		}
2185*4882a593Smuzhiyun 		tob_a = bcns_offset + 2 * ref_bcn_intvl - toa_r - mcc_intvl;
2186*4882a593Smuzhiyun 		if (tob_a < EARLY_RX_BCN_T)
2187*4882a593Smuzhiyun 			continue;
2188*4882a593Smuzhiyun 		toa_a = d_a - tob_a;
2189*4882a593Smuzhiyun 		if (toa_a < MIN_RX_BCN_T){
2190*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): Break loop, by toa_a(%d) < MIN_RX_BCN_T(%d)\n",
2191*4882a593Smuzhiyun 				toa_a, MIN_RX_BCN_T);
2192*4882a593Smuzhiyun 			break;
2193*4882a593Smuzhiyun 		}
2194*4882a593Smuzhiyun 		if (ano_dur->dur_limit.enable) {
2195*4882a593Smuzhiyun 			if (tob_a > tob_a_l || toa_a > toa_a_l) {
2196*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): tob_a(%d) > tob_a_l(%d) || toa_a(%d) > toa_a_l(%d), continue next loop\n",
2197*4882a593Smuzhiyun 					tob_a, tob_a_l, toa_a, toa_a_l);
2198*4882a593Smuzhiyun 				continue;
2199*4882a593Smuzhiyun 			}
2200*4882a593Smuzhiyun 		}
2201*4882a593Smuzhiyun 		sum = ((tob_r - toa_r) * (tob_r - toa_r)) +
2202*4882a593Smuzhiyun 			((tob_r - tob_a) * (tob_r - tob_a)) +
2203*4882a593Smuzhiyun 			((tob_r - toa_a) * (tob_r - toa_a)) +
2204*4882a593Smuzhiyun 			((toa_r - tob_a) * (toa_r - tob_a)) +
2205*4882a593Smuzhiyun 			((toa_r - toa_a) * (toa_r - toa_a)) +
2206*4882a593Smuzhiyun 			((tob_a - toa_a) * (tob_a - toa_a));
2207*4882a593Smuzhiyun 		tob_r_cand = tob_r;
2208*4882a593Smuzhiyun 		if (sum_last !=0 && sum > sum_last) {
2209*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): Find the optimal pattern, by get minSum\n");
2210*4882a593Smuzhiyun 			break;
2211*4882a593Smuzhiyun 		}
2212*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d), sum_last(%d), sum(%d)\n",
2213*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a, sum_last, sum);
2214*4882a593Smuzhiyun 		sum_last = sum;
2215*4882a593Smuzhiyun 
2216*4882a593Smuzhiyun 	}
2217*4882a593Smuzhiyun 	if (0 == tob_r_cand) {
2218*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): Can't found suitable pattern, goto calc_nego_pattern\n");
2219*4882a593Smuzhiyun 		goto calc_nego_pattern;
2220*4882a593Smuzhiyun 	}
2221*4882a593Smuzhiyun 	tob_r = tob_r_cand;
2222*4882a593Smuzhiyun 	toa_r = d_r - tob_r;
2223*4882a593Smuzhiyun 	tob_a = bcns_offset + 2 * ref_bcn_intvl - toa_r - mcc_intvl;
2224*4882a593Smuzhiyun 	toa_a = d_a - tob_a;
2225*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r;
2226*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r;
2227*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a;
2228*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a;
2229*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
2230*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
2231*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): Result, tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
2232*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a);
2233*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2234*4882a593Smuzhiyun 	goto exit;
2235*4882a593Smuzhiyun calc_nego_pattern:
2236*4882a593Smuzhiyun 	if (_mcc_calc_2_wrole_nego_pattern(ref_dur, ano_dur, bcns_offset,
2237*4882a593Smuzhiyun 					m_pattern))
2238*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_SUCCESS;
2239*4882a593Smuzhiyun exit:
2240*4882a593Smuzhiyun 	if (status != RTW_PHL_STATUS_SUCCESS)
2241*4882a593Smuzhiyun 		m_pattern->calc_fail = true;
2242*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calc_2_wifi_slot_worsecase_pattern(): status(%d)\n",
2243*4882a593Smuzhiyun 		status);
2244*4882a593Smuzhiyun 	return status;
2245*4882a593Smuzhiyun }
2246*4882a593Smuzhiyun #endif
2247*4882a593Smuzhiyun 
2248*4882a593Smuzhiyun /*
2249*4882a593Smuzhiyun  * Calculate the optimal pattern for 2wrole MCC with limitation of time slot
2250*4882a593Smuzhiyun  * @ref_dur: Duration of reference ch
2251*4882a593Smuzhiyun  * @ano_dur: Duration of another ch
2252*4882a593Smuzhiyun  * @offset: The offset between beacon of client1 and beacon of client2
2253*4882a593Smuzhiyun  * @m_pattern: mcc pattern.
2254*4882a593Smuzhiyun  * |          Wifi1 slot        |            Wifi2 slot        |          Wifi1 slot        |             Wifi2 slot        |
2255*4882a593Smuzhiyun  * <tob_r> Bcn_r <toa_r>                                   <tob_r> Bcn_r <toa_r>
2256*4882a593Smuzhiyun  *                                  <tob_a> Bcn_a <toa_a>                                  <tob_a> Bcn_a <toa_a>
2257*4882a593Smuzhiyun  *	         <       bcns_offset       >
2258*4882a593Smuzhiyun  */
_mcc_calculate_2_wrole_pattern(struct rtw_phl_mcc_dur_info * ref_dur,struct rtw_phl_mcc_dur_info * ano_dur,u16 offset,struct rtw_phl_mcc_pattern * m_pattern)2259*4882a593Smuzhiyun enum rtw_phl_status _mcc_calculate_2_wrole_pattern(
2260*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ref_dur,
2261*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *ano_dur,
2262*4882a593Smuzhiyun 				u16 offset,
2263*4882a593Smuzhiyun 				struct rtw_phl_mcc_pattern *m_pattern)
2264*4882a593Smuzhiyun {
2265*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2266*4882a593Smuzhiyun 	u16 mcc_intvl = ref_dur->dur + ano_dur->dur;
2267*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0, tob_r_cand = 0;
2268*4882a593Smuzhiyun 	s16 d_r = ref_dur->dur, d_a = ano_dur->dur, bcns_offset = offset;
2269*4882a593Smuzhiyun 	s16 sum = 0, sum_last = 0;
2270*4882a593Smuzhiyun 	s16 tob_r_l = ref_dur->dur_limit.max_tob;
2271*4882a593Smuzhiyun 	s16 toa_r_l = ref_dur->dur_limit.max_toa;
2272*4882a593Smuzhiyun 	s16 tob_a_l = ano_dur->dur_limit.max_tob;
2273*4882a593Smuzhiyun 	s16 toa_a_l = ano_dur->dur_limit.max_toa;
2274*4882a593Smuzhiyun 
2275*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern(): ref_dur(%d), ano_dur(%d), bcns offset(%d)\n",
2276*4882a593Smuzhiyun 		d_r, d_a, bcns_offset);
2277*4882a593Smuzhiyun 	for (tob_r = EARLY_RX_BCN_T; tob_r < mcc_intvl; tob_r++) {
2278*4882a593Smuzhiyun 		toa_r = d_r - tob_r;
2279*4882a593Smuzhiyun 		if (toa_r < MIN_RX_BCN_T) {
2280*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern(): break loop, by toa_r(%d) < MIN_RX_BCN_T(%d)\n",
2281*4882a593Smuzhiyun 				toa_r, MIN_RX_BCN_T);
2282*4882a593Smuzhiyun 			break;
2283*4882a593Smuzhiyun 		}
2284*4882a593Smuzhiyun 		if (ref_dur->dur_limit.enable) {
2285*4882a593Smuzhiyun 			if (tob_r > tob_r_l || toa_r > toa_r_l) {
2286*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern(): tob_r(%d) > tob_r_l(%d) || toa_r(%d) > toa_r_l(%d), continue next loop\n",
2287*4882a593Smuzhiyun 					tob_r, tob_r_l, toa_r, toa_r_l);
2288*4882a593Smuzhiyun 				continue;
2289*4882a593Smuzhiyun 			}
2290*4882a593Smuzhiyun 		}
2291*4882a593Smuzhiyun 		tob_a = bcns_offset - toa_r;
2292*4882a593Smuzhiyun 		if (tob_a < EARLY_RX_BCN_T)
2293*4882a593Smuzhiyun 			continue;
2294*4882a593Smuzhiyun 		toa_a = d_a - tob_a;
2295*4882a593Smuzhiyun 		if (toa_a < MIN_RX_BCN_T){
2296*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern(): break loop, by toa_a(%d) < MIN_RX_BCN_T(%d)\n",
2297*4882a593Smuzhiyun 				toa_a, MIN_RX_BCN_T);
2298*4882a593Smuzhiyun 			break;
2299*4882a593Smuzhiyun 		}
2300*4882a593Smuzhiyun 		if (ano_dur->dur_limit.enable) {
2301*4882a593Smuzhiyun 			if (tob_a > tob_a_l || toa_a > toa_a_l) {
2302*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern(): tob_a(%d) > tob_a_l(%d) || toa_a(%d) > toa_a_l(%d), continue next loop\n",
2303*4882a593Smuzhiyun 					tob_a, tob_a_l, toa_a, toa_a_l);
2304*4882a593Smuzhiyun 				continue;
2305*4882a593Smuzhiyun 			}
2306*4882a593Smuzhiyun 		}
2307*4882a593Smuzhiyun 		sum = ((tob_r - toa_r) * (tob_r - toa_r)) +
2308*4882a593Smuzhiyun 			((tob_r - tob_a) * (tob_r - tob_a)) +
2309*4882a593Smuzhiyun 			((tob_r - toa_a) * (tob_r - toa_a)) +
2310*4882a593Smuzhiyun 			((toa_r - tob_a) * (toa_r - tob_a)) +
2311*4882a593Smuzhiyun 			((toa_r - toa_a) * (toa_r - toa_a)) +
2312*4882a593Smuzhiyun 			((tob_a - toa_a) * (tob_a - toa_a));
2313*4882a593Smuzhiyun 		tob_r_cand = tob_r;
2314*4882a593Smuzhiyun 		if (sum_last !=0 && sum > sum_last) {
2315*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern(): Find the optimal pattern, by get minSum\n");
2316*4882a593Smuzhiyun 			break;
2317*4882a593Smuzhiyun 		}
2318*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_wrole_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d), sum_last(%d), sum(%d)\n",
2319*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a, sum_last, sum);
2320*4882a593Smuzhiyun 		sum_last = sum;
2321*4882a593Smuzhiyun 	}
2322*4882a593Smuzhiyun 	if (0 == tob_r_cand) {
2323*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_calculate_2_wrole_pattern(): Can't found suitable pattern, goto calc_nego_pattern\n");
2324*4882a593Smuzhiyun 		goto calc_nego_pattern;
2325*4882a593Smuzhiyun 	}
2326*4882a593Smuzhiyun 	tob_r = tob_r_cand;
2327*4882a593Smuzhiyun 	toa_r = d_r - tob_r;
2328*4882a593Smuzhiyun 	tob_a = bcns_offset - toa_r;
2329*4882a593Smuzhiyun 	toa_a = d_a - tob_a;
2330*4882a593Smuzhiyun 	m_pattern->tob_r = tob_r;
2331*4882a593Smuzhiyun 	m_pattern->toa_r = toa_r;
2332*4882a593Smuzhiyun 	m_pattern->tob_a = tob_a;
2333*4882a593Smuzhiyun 	m_pattern->toa_a = toa_a;
2334*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur->dur, m_pattern->role_ref);
2335*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur->dur, m_pattern->role_ano);
2336*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2337*4882a593Smuzhiyun 	goto exit;
2338*4882a593Smuzhiyun calc_nego_pattern:
2339*4882a593Smuzhiyun 	if (_mcc_calc_2_wrole_nego_pattern(ref_dur, ano_dur, bcns_offset,
2340*4882a593Smuzhiyun 					m_pattern))
2341*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_SUCCESS;
2342*4882a593Smuzhiyun exit:
2343*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
2344*4882a593Smuzhiyun 			m_pattern->tob_r, m_pattern->toa_r, m_pattern->tob_a,
2345*4882a593Smuzhiyun 			m_pattern->toa_a);
2346*4882a593Smuzhiyun 	return status;
2347*4882a593Smuzhiyun }
2348*4882a593Smuzhiyun 
2349*4882a593Smuzhiyun /*
2350*4882a593Smuzhiyun  * Calculate the optimal pattern for client+client MCC
2351*4882a593Smuzhiyun  * @ref_dur: Duration of reference ch
2352*4882a593Smuzhiyun  * @ano_dur: Duration of another ch
2353*4882a593Smuzhiyun  * @offset: The offset between beacon of client1 and beacon of client2
2354*4882a593Smuzhiyun  * @m_pattern: mcc pattern.
2355*4882a593Smuzhiyun  * |          Wifi1 slot        |            Wifi2 slot        |          Wifi1 slot        |             Wifi2 slot        |
2356*4882a593Smuzhiyun  * <tob_r> Bcn_r <toa_r>                                   <tob_r> Bcn_r <toa_r>
2357*4882a593Smuzhiyun  *                                  <tob_a> Bcn_a <toa_a>                                  <tob_a> Bcn_a <toa_a>
2358*4882a593Smuzhiyun  *	         <       bcns_offset       >
2359*4882a593Smuzhiyun  */
_mcc_calculate_2_clients_pattern(u16 ref_dur,u16 ano_dur,u16 offset,struct rtw_phl_mcc_pattern * m_pattern)2360*4882a593Smuzhiyun void _mcc_calculate_2_clients_pattern(u16 ref_dur, u16 ano_dur, u16 offset,
2361*4882a593Smuzhiyun 					struct rtw_phl_mcc_pattern *m_pattern)
2362*4882a593Smuzhiyun {
2363*4882a593Smuzhiyun 	u16 mcc_intvl = ref_dur + ano_dur;
2364*4882a593Smuzhiyun 	s16 tob_r = 0, toa_r = 0, tob_a = 0, toa_a = 0;
2365*4882a593Smuzhiyun 	s16 d_r = ref_dur, d_a = ano_dur, bcns_offset = offset;
2366*4882a593Smuzhiyun 	s16 sum = 0, sum_last = 0;
2367*4882a593Smuzhiyun 
2368*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_pattern(): ref_dur(%d), ano_dur(%d), bcns offset(%d)\n",
2369*4882a593Smuzhiyun 		ref_dur, ano_dur, offset);
2370*4882a593Smuzhiyun 	for (tob_r = EARLY_RX_BCN_T; tob_r < mcc_intvl; tob_r++) {
2371*4882a593Smuzhiyun 		toa_r = d_r - tob_r;
2372*4882a593Smuzhiyun 		if (toa_r < MIN_RX_BCN_T) {
2373*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_pattern(): Find the optimal pattern, by toa_r(%d) < MIN_RX_BCN_T(%d)\n",
2374*4882a593Smuzhiyun 				toa_r, MIN_RX_BCN_T);
2375*4882a593Smuzhiyun 			break;
2376*4882a593Smuzhiyun 		}
2377*4882a593Smuzhiyun 		tob_a = bcns_offset - toa_r;
2378*4882a593Smuzhiyun 		if (tob_a < EARLY_RX_BCN_T)
2379*4882a593Smuzhiyun 			continue;
2380*4882a593Smuzhiyun 		toa_a = d_a - tob_a;
2381*4882a593Smuzhiyun 		if (toa_a < MIN_RX_BCN_T){
2382*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_pattern(): Find the optimal pattern, by toa_a(%d) < MIN_RX_BCN_T(%d)\n",
2383*4882a593Smuzhiyun 				toa_a, MIN_RX_BCN_T);
2384*4882a593Smuzhiyun 			break;
2385*4882a593Smuzhiyun 		}
2386*4882a593Smuzhiyun 		sum = ((tob_r - toa_r) * (tob_r - toa_r)) +
2387*4882a593Smuzhiyun 			((tob_r - tob_a) * (tob_r - tob_a)) +
2388*4882a593Smuzhiyun 			((tob_r - toa_a) * (tob_r - toa_a)) +
2389*4882a593Smuzhiyun 			((toa_r - tob_a) * (toa_r - tob_a)) +
2390*4882a593Smuzhiyun 			((toa_r - toa_a) * (toa_r - toa_a)) +
2391*4882a593Smuzhiyun 			((tob_a - toa_a) * (tob_a - toa_a));
2392*4882a593Smuzhiyun 		if (sum_last !=0 && sum > sum_last) {
2393*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_pattern(): Find the optimal pattern, by get minSum\n");
2394*4882a593Smuzhiyun 			break;
2395*4882a593Smuzhiyun 		}
2396*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d), sum_last(%d), sum(%d)\n",
2397*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a, sum_last, sum);
2398*4882a593Smuzhiyun 		sum_last = sum;
2399*4882a593Smuzhiyun 	}
2400*4882a593Smuzhiyun 	tob_r = tob_r - 1;
2401*4882a593Smuzhiyun 	toa_r = d_r - tob_r;
2402*4882a593Smuzhiyun 	tob_a = bcns_offset - toa_r;
2403*4882a593Smuzhiyun 	toa_a = d_a - tob_a;
2404*4882a593Smuzhiyun 	m_pattern->tob_r = (u8)tob_r;
2405*4882a593Smuzhiyun 	m_pattern->toa_r = (u8)toa_r;
2406*4882a593Smuzhiyun 	m_pattern->tob_a = (u8)tob_a;
2407*4882a593Smuzhiyun 	m_pattern->toa_a = (u8)toa_a;
2408*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ref_dur, m_pattern->role_ref);
2409*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, ano_dur, m_pattern->role_ano);
2410*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_calculate_2_clients_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
2411*4882a593Smuzhiyun 			tob_r, toa_r, tob_a, toa_a);
2412*4882a593Smuzhiyun }
2413*4882a593Smuzhiyun 
2414*4882a593Smuzhiyun /*
2415*4882a593Smuzhiyun  * Fill patten info for 2wifi slot req + bt slot req
2416*4882a593Smuzhiyun  * @minfo: enable mcc info
2417*4882a593Smuzhiyun  * @role_ref: reference wifi slot req
2418*4882a593Smuzhiyun  * @role_ano: another wifi slot req
2419*4882a593Smuzhiyun  */
_mcc_fill_2_wrole_bt_pattern(struct phl_mcc_info * minfo,struct rtw_phl_mcc_role * role_ref,struct rtw_phl_mcc_role * role_ano)2420*4882a593Smuzhiyun void _mcc_fill_2_wrole_bt_pattern(struct phl_mcc_info *minfo,
2421*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref, struct rtw_phl_mcc_role *role_ano)
2422*4882a593Smuzhiyun {
2423*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
2424*4882a593Smuzhiyun 	struct rtw_phl_mcc_pattern *m_pattern = &en_info->m_pattern;
2425*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_info dur_ref = role_ref->policy.dur_info;
2426*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_info dur_ano = role_ano->policy.dur_info;
2427*4882a593Smuzhiyun #if 0
2428*4882a593Smuzhiyun 	u16 dr_max = (dur_ref.dur_limit.enable) ?
2429*4882a593Smuzhiyun 			dur_ref.dur_limit.max_dur : en_info->mcc_intvl;
2430*4882a593Smuzhiyun 	u16 da_max = (dur_ano.dur_limit.enable) ?
2431*4882a593Smuzhiyun 			dur_ano.dur_limit.max_dur : en_info->mcc_intvl;
2432*4882a593Smuzhiyun 
2433*4882a593Smuzhiyun 
2434*4882a593Smuzhiyun 	if (minfo->bt_info.bt_seg_num == 2) {
2435*4882a593Smuzhiyun 		/*temporary disable this case, we can't handle it in GC(NOA)+STA*/
2436*4882a593Smuzhiyun 		minfo->bt_info.add_bt_role = true;
2437*4882a593Smuzhiyun 		if (((dur_ref.dur + minfo->bt_info.bt_seg[0]) <= dr_max) &&
2438*4882a593Smuzhiyun 			((dur_ano.dur + minfo->bt_info.bt_seg[1]) <= da_max)) {
2439*4882a593Smuzhiyun 			dur_ref.dur += minfo->bt_info.bt_seg[0];
2440*4882a593Smuzhiyun 			dur_ano.dur += minfo->bt_info.bt_seg[1];
2441*4882a593Smuzhiyun 		} else if ((dur_ref.dur + minfo->bt_info.bt_dur) <= dr_max) {
2442*4882a593Smuzhiyun 			dur_ref.dur += minfo->bt_info.bt_dur;
2443*4882a593Smuzhiyun 		} else if ((dur_ano.dur + minfo->bt_info.bt_dur) <= da_max) {
2444*4882a593Smuzhiyun 			dur_ano.dur += minfo->bt_info.bt_dur;
2445*4882a593Smuzhiyun 		} else {
2446*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_2_wrole_bt_pattern(): Fail to combine wifi slot and bt slot to single slot, we use default worsecase pattern \n");
2447*4882a593Smuzhiyun 			_mcc_set_2_clients_worsecase_default_pattern(m_pattern, dur_ref.dur);
2448*4882a593Smuzhiyun 			goto exit;
2449*4882a593Smuzhiyun 		}
2450*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS !=
2451*4882a593Smuzhiyun 				_mcc_calc_2_wifi_slot_worsecase_pattern(
2452*4882a593Smuzhiyun 						&dur_ref, &dur_ano,
2453*4882a593Smuzhiyun 						m_pattern->bcns_offset,
2454*4882a593Smuzhiyun 						role_ref->bcn_intvl,
2455*4882a593Smuzhiyun 						m_pattern)) {
2456*4882a593Smuzhiyun 			_mcc_set_2_clients_worsecase_default_pattern(m_pattern, dur_ref.dur);
2457*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_2_wrole_bt_pattern(): _mcc_calc_2_wifi_slot_worsecase_pattern fail, we use default worsecase pattern\n");
2458*4882a593Smuzhiyun 		}
2459*4882a593Smuzhiyun 		dur_ref = role_ref->policy.dur_info;
2460*4882a593Smuzhiyun 		dur_ano = role_ano->policy.dur_info;
2461*4882a593Smuzhiyun 		if (m_pattern->tob_r > (dur_ref.dur - MIN_RX_BCN_T)) {
2462*4882a593Smuzhiyun 			role_ref->policy.protect_bcn = true;
2463*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_2_wrole_bt_pattern(): bcn will in bt dur, we set protect_bcn = true for role_ref\n");
2464*4882a593Smuzhiyun 		}
2465*4882a593Smuzhiyun 		if (m_pattern->tob_a > (dur_ano.dur - MIN_RX_BCN_T)) {
2466*4882a593Smuzhiyun 			role_ano->policy.protect_bcn = true;
2467*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_2_wrole_bt_pattern(): bcn will in bt dur, we set protect_bcn = true for role_ano\n");
2468*4882a593Smuzhiyun 		}
2469*4882a593Smuzhiyun 	} else
2470*4882a593Smuzhiyun #endif
2471*4882a593Smuzhiyun 	if (minfo->bt_info.bt_seg_num == 1) {
2472*4882a593Smuzhiyun 		minfo->bt_info.add_bt_role = true;
2473*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS !=
2474*4882a593Smuzhiyun 			_mcc_calculate_2wslot_1btslot_pattern(&dur_ref,
2475*4882a593Smuzhiyun 				&dur_ano, minfo->bt_info.bt_dur, m_pattern)) {
2476*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_2_wrole_bt_pattern(): _mcc_calculate_2wslot_1btslot_pattern fail, we use default worsecase pattern\n");
2477*4882a593Smuzhiyun 			_mcc_set_2_clients_worsecase_default_pattern(m_pattern, dur_ref.dur);
2478*4882a593Smuzhiyun 		}
2479*4882a593Smuzhiyun 	} else {
2480*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_2_wrole_bt_pattern(): error bt_seg_num(%d)\n",
2481*4882a593Smuzhiyun 			minfo->bt_info.bt_seg_num);
2482*4882a593Smuzhiyun 	}
2483*4882a593Smuzhiyun #if 0
2484*4882a593Smuzhiyun exit:
2485*4882a593Smuzhiyun #endif
2486*4882a593Smuzhiyun 	return;
2487*4882a593Smuzhiyun }
2488*4882a593Smuzhiyun 
_mcc_fill_2wrole_pattern_with_limitation(struct phl_mcc_info * minfo,struct rtw_phl_mcc_role * role_ref,struct rtw_phl_mcc_role * role_ano)2489*4882a593Smuzhiyun bool _mcc_fill_2wrole_pattern_with_limitation(struct phl_mcc_info *minfo,
2490*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref, struct rtw_phl_mcc_role *role_ano)
2491*4882a593Smuzhiyun {
2492*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
2493*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_info *dur_i_r = &role_ref->policy.dur_info;
2494*4882a593Smuzhiyun 	struct rtw_phl_mcc_dur_info *dur_i_a = &role_ano->policy.dur_info;
2495*4882a593Smuzhiyun 	struct rtw_phl_mcc_policy_info *policy_i = NULL;
2496*4882a593Smuzhiyun 	struct rtw_phl_mcc_courtesy *courtesy_i = &en_info->m_pattern.courtesy_i;
2497*4882a593Smuzhiyun 	bool ret = false;
2498*4882a593Smuzhiyun 
2499*4882a593Smuzhiyun 	if (!(dur_i_r->dur_limit.enable || dur_i_a->dur_limit.enable))
2500*4882a593Smuzhiyun 		goto exit;
2501*4882a593Smuzhiyun 	if (dur_i_r->dur_limit.enable && dur_i_a->dur_limit.enable) {
2502*4882a593Smuzhiyun 		/*implement in phase????*/
2503*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_2wrole_pattern_with_limitation(): Not support for all enable limitation, tag_r(%d), tag_a(%d)\n",
2504*4882a593Smuzhiyun 			dur_i_r->dur_limit.tag, dur_i_a->dur_limit.tag);
2505*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_2wrole_pattern_with_limitation(): we ignore the limitation of time slot, it will degrade performance\n");
2506*4882a593Smuzhiyun 		goto exit;
2507*4882a593Smuzhiyun 	}
2508*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_fill_2wrole_pattern_with_limitation\n");
2509*4882a593Smuzhiyun 	if (_mcc_discision_duration_for_2role_bt(minfo)) {
2510*4882a593Smuzhiyun 		_mcc_fill_2_wrole_bt_pattern(minfo, role_ref,  role_ano);
2511*4882a593Smuzhiyun 	} else if (RTW_PHL_STATUS_SUCCESS != _mcc_calculate_2_wrole_pattern(
2512*4882a593Smuzhiyun 					dur_i_r, dur_i_a,
2513*4882a593Smuzhiyun 					en_info->m_pattern.bcns_offset,
2514*4882a593Smuzhiyun 					&en_info->m_pattern)) {
2515*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_2wrole_pattern_with_limitation(): Calc pattern fail with limitation of time slot, we ignore the limitation of time slot, it will degrade performance\n");
2516*4882a593Smuzhiyun 		goto exit;
2517*4882a593Smuzhiyun 	}
2518*4882a593Smuzhiyun 	/*_mcc_fill_bt_slot(minfo, dur_i_r, dur_i_a);*/
2519*4882a593Smuzhiyun 	if (true == courtesy_i->c_en) {
2520*4882a593Smuzhiyun 		policy_i = &courtesy_i->src_role->policy;
2521*4882a593Smuzhiyun 		policy_i->courtesy_en = true;
2522*4882a593Smuzhiyun 		policy_i->courtesy_num = courtesy_i->c_num;
2523*4882a593Smuzhiyun 		policy_i->courtesy_target = (u8)courtesy_i->tgt_role->macid;
2524*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_2wrole_pattern_with_limitation(): Enable courtesy function, time slot of macid:0x%x replace by time slot of macid:0x%x, courtesy_num(%d)\n",
2525*4882a593Smuzhiyun 			courtesy_i->src_role->macid, policy_i->courtesy_target,
2526*4882a593Smuzhiyun 			policy_i->courtesy_num);
2527*4882a593Smuzhiyun 	}
2528*4882a593Smuzhiyun 	ret =true;
2529*4882a593Smuzhiyun exit:
2530*4882a593Smuzhiyun 	return ret;
2531*4882a593Smuzhiyun }
2532*4882a593Smuzhiyun 
_mcc_fill_2_clients_pattern(struct phl_mcc_info * minfo,u8 worsecase,struct rtw_phl_mcc_role * role_ref,struct rtw_phl_mcc_role * role_ano)2533*4882a593Smuzhiyun void _mcc_fill_2_clients_pattern(struct phl_mcc_info *minfo, u8 worsecase,
2534*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref, struct rtw_phl_mcc_role *role_ano)
2535*4882a593Smuzhiyun {
2536*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
2537*4882a593Smuzhiyun 
2538*4882a593Smuzhiyun 	if (!worsecase) {
2539*4882a593Smuzhiyun 		_mcc_calculate_2_clients_pattern(role_ref->policy.dur_info.dur,
2540*4882a593Smuzhiyun 						role_ano->policy.dur_info.dur,
2541*4882a593Smuzhiyun 						en_info->m_pattern.bcns_offset,
2542*4882a593Smuzhiyun 						&en_info->m_pattern);
2543*4882a593Smuzhiyun 		goto exit;
2544*4882a593Smuzhiyun 	}
2545*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_calc_2_clients_worsecase_pattern(
2546*4882a593Smuzhiyun 					role_ref->policy.dur_info.dur,
2547*4882a593Smuzhiyun 					role_ano->policy.dur_info.dur,
2548*4882a593Smuzhiyun 					en_info->m_pattern.bcns_offset,
2549*4882a593Smuzhiyun 					role_ref->bcn_intvl,
2550*4882a593Smuzhiyun 					&en_info->m_pattern)) {
2551*4882a593Smuzhiyun 		_mcc_set_2_clients_worsecase_default_pattern(&en_info->m_pattern,
2552*4882a593Smuzhiyun 						role_ref->policy.dur_info.dur);
2553*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_info_for_2_clients_mode(): _mcc_calc_2_clients_worsecase_pattern fail, we use default worsecase pattern\n");
2554*4882a593Smuzhiyun 	}
2555*4882a593Smuzhiyun exit:
2556*4882a593Smuzhiyun 	return;
2557*4882a593Smuzhiyun }
2558*4882a593Smuzhiyun 
_mcc_get_2_clients_bcn_offset(struct phl_info_t * phl,u16 * offset,struct rtw_phl_mcc_role * role_ref,struct rtw_phl_mcc_role * role_ano)2559*4882a593Smuzhiyun enum rtw_phl_status _mcc_get_2_clients_bcn_offset(struct phl_info_t *phl,
2560*4882a593Smuzhiyun 			u16 *offset, struct rtw_phl_mcc_role *role_ref,
2561*4882a593Smuzhiyun 			struct rtw_phl_mcc_role *role_ano)
2562*4882a593Smuzhiyun {
2563*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2564*4882a593Smuzhiyun 	u32 tsf_ref_h = 0, tsf_ref_l = 0, tsf_ano_h = 0, tsf_ano_l = 0;
2565*4882a593Smuzhiyun 	u64 tsf_ref = 0, tsf_ano = 0;
2566*4882a593Smuzhiyun 	u16 ofst_r = 0, ofst_a = 0;
2567*4882a593Smuzhiyun 
2568*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_get_2ports_tsf(phl->hal,
2569*4882a593Smuzhiyun 			role_ref->group, role_ref->macid, role_ano->macid,
2570*4882a593Smuzhiyun 			&tsf_ref_h, &tsf_ref_l, &tsf_ano_h, &tsf_ano_l)) {
2571*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_get_2_clients_bcn_offset(): Get tsf failed\n");
2572*4882a593Smuzhiyun 		goto exit;
2573*4882a593Smuzhiyun 	}
2574*4882a593Smuzhiyun 	tsf_ref = tsf_ref_h;
2575*4882a593Smuzhiyun 	tsf_ref = tsf_ref << 32;
2576*4882a593Smuzhiyun 	tsf_ref |= tsf_ref_l;
2577*4882a593Smuzhiyun 	tsf_ano = tsf_ano_h;
2578*4882a593Smuzhiyun 	tsf_ano = tsf_ano << 32;
2579*4882a593Smuzhiyun 	tsf_ano |= tsf_ano_l;
2580*4882a593Smuzhiyun 	/*calculate the value between current TSF and TBTT*/
2581*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_get_2_clients_bcn_offset(): role_ref calc_offset_from_tbtt\n");
2582*4882a593Smuzhiyun 	phl_calc_offset_from_tbtt(phl, role_ref->wrole, tsf_ref, &ofst_r);
2583*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_get_2_clients_bcn_offset(): role_ano calc_offset_from_tbtt\n");
2584*4882a593Smuzhiyun 	phl_calc_offset_from_tbtt(phl, role_ano->wrole, tsf_ano, &ofst_a);
2585*4882a593Smuzhiyun 	if (ofst_r < ofst_a)
2586*4882a593Smuzhiyun 		ofst_r += role_ref->bcn_intvl;
2587*4882a593Smuzhiyun 	*offset = ofst_r - ofst_a;
2588*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_get_2_clients_bcn_offset(): bcn offset(%d)\n",
2589*4882a593Smuzhiyun 		*offset);
2590*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2591*4882a593Smuzhiyun exit:
2592*4882a593Smuzhiyun 	return status;
2593*4882a593Smuzhiyun }
2594*4882a593Smuzhiyun 
2595*4882a593Smuzhiyun /**
2596*4882a593Smuzhiyun * set defalut pattern for ap slot+sta slot
2597*4882a593Smuzhiyun  * |       Wifi1 slot           |          Wifi2 slot         |       Wifi1 slot           |          Wifi2 slot         |
2598*4882a593Smuzhiyun  * <tob_r> Bcn_r <toa_r>                                  <tob_r> Bcn_r <toa_r>
2599*4882a593Smuzhiyun  *                                  <tob_a> Bcn_a <toa_a>                                 <tob_a> Bcn_a <toa_a>
2600*4882a593Smuzhiyun  *               <         bcns_offset         >
2601*4882a593Smuzhiyun  **/
2602*4882a593Smuzhiyun 
_mcc_set_ap_client_default_pattern(struct phl_mcc_info * minfo,u16 * bcns_offet)2603*4882a593Smuzhiyun void _mcc_set_ap_client_default_pattern(struct phl_mcc_info *minfo,
2604*4882a593Smuzhiyun 					u16 *bcns_offet)
2605*4882a593Smuzhiyun {
2606*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
2607*4882a593Smuzhiyun 	struct rtw_phl_mcc_pattern *m_pattern = &en_info->m_pattern;
2608*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref = get_ref_role(en_info);
2609*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ano = (role_ref == &en_info->mcc_role[0])
2610*4882a593Smuzhiyun 				? &en_info->mcc_role[1] : &en_info->mcc_role[0];
2611*4882a593Smuzhiyun 
2612*4882a593Smuzhiyun 	*bcns_offet = (u8)(en_info->mcc_intvl / 2);
2613*4882a593Smuzhiyun 	m_pattern->toa_r= role_ref->policy.dur_info.dur / 2;
2614*4882a593Smuzhiyun 	m_pattern->tob_r = role_ref->policy.dur_info.dur - m_pattern->toa_r;
2615*4882a593Smuzhiyun 	m_pattern->tob_a = (u8)(*bcns_offet - m_pattern->toa_r);
2616*4882a593Smuzhiyun 	m_pattern->toa_a = role_ano->policy.dur_info.dur - m_pattern->tob_a;
2617*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, role_ref->policy.dur_info.dur, role_ref);
2618*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, role_ano->policy.dur_info.dur, role_ano);
2619*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_set_ap_client_default_pattern(): tob_r(%d), toa_r(%d), tob_a(%d), toa_a(%d)\n",
2620*4882a593Smuzhiyun 		m_pattern->tob_r, m_pattern->toa_r, m_pattern->tob_a, m_pattern->toa_a);
2621*4882a593Smuzhiyun }
2622*4882a593Smuzhiyun 
_mcc_set_worsecase_dur_for_2_clients_mode(struct rtw_phl_mcc_dur_info * dur_i_1,struct rtw_phl_mcc_dur_info * dur_i_2,u16 * mcc_intvl)2623*4882a593Smuzhiyun void _mcc_set_worsecase_dur_for_2_clients_mode(
2624*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *dur_i_1,
2625*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *dur_i_2,
2626*4882a593Smuzhiyun 				u16 *mcc_intvl)
2627*4882a593Smuzhiyun {
2628*4882a593Smuzhiyun 	/*need to get from core layer for worsecase??*/
2629*4882a593Smuzhiyun 	if (dur_i_1->dur > dur_i_2->dur) {
2630*4882a593Smuzhiyun 		*mcc_intvl = WORSECASE_INTVL;
2631*4882a593Smuzhiyun 		dur_i_1->dur = CLIENTS_WORSECASE_LARGE_DUR;
2632*4882a593Smuzhiyun 		dur_i_2->dur = (*mcc_intvl - dur_i_1->dur);
2633*4882a593Smuzhiyun 	} else {
2634*4882a593Smuzhiyun 		*mcc_intvl = WORSECASE_INTVL;
2635*4882a593Smuzhiyun 		dur_i_2->dur = CLIENTS_WORSECASE_LARGE_DUR;
2636*4882a593Smuzhiyun 		dur_i_1->dur = (*mcc_intvl - dur_i_2->dur);
2637*4882a593Smuzhiyun 	}
2638*4882a593Smuzhiyun }
2639*4882a593Smuzhiyun 
_mcc_set_dur_for_2_clients_mode(struct rtw_phl_mcc_dur_info * dur_i_1,struct rtw_phl_mcc_dur_info * dur_i_2,u16 * mcc_intvl)2640*4882a593Smuzhiyun void _mcc_set_dur_for_2_clients_mode(
2641*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *dur_i_1,
2642*4882a593Smuzhiyun 				struct rtw_phl_mcc_dur_info *dur_i_2,
2643*4882a593Smuzhiyun 				u16 *mcc_intvl)
2644*4882a593Smuzhiyun {
2645*4882a593Smuzhiyun 	u16 *dur1 = &dur_i_1->dur, *dur2 = &dur_i_2->dur;
2646*4882a593Smuzhiyun 
2647*4882a593Smuzhiyun 	if (*dur1 == MCC_DUR_NONSPECIFIC) {
2648*4882a593Smuzhiyun 		*dur1 = (*mcc_intvl - (*dur2));
2649*4882a593Smuzhiyun 	} else {
2650*4882a593Smuzhiyun 		*dur2 = (*mcc_intvl - (*dur1));
2651*4882a593Smuzhiyun 	}
2652*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_set_dur_for_2_clients_mode(): Original dur1(%d), dur2(%d)\n",
2653*4882a593Smuzhiyun 		*dur1, *dur2);
2654*4882a593Smuzhiyun 	if (*dur1 < MIN_CLIENT_DUR) {
2655*4882a593Smuzhiyun 		*dur1 = MIN_CLIENT_DUR;
2656*4882a593Smuzhiyun 		*dur2 = (*mcc_intvl - (*dur1));
2657*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_set_dur_for_2_clients_mode(): Core specific unsuitable duration, we adjust dur to dur1(%d) and dur2(%d)\n",
2658*4882a593Smuzhiyun 			*dur1, *dur2);
2659*4882a593Smuzhiyun 	} else if (*dur2 < MIN_CLIENT_DUR) {
2660*4882a593Smuzhiyun 		*dur2 = MIN_CLIENT_DUR;
2661*4882a593Smuzhiyun 		*dur1 = (*mcc_intvl - (*dur2));
2662*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_set_dur_for_2_clients_mode(): Core specific unsuitable duration, we adjust dur to dur1(%d) and dur2(%d)\n",
2663*4882a593Smuzhiyun 			*dur1, *dur2);
2664*4882a593Smuzhiyun 	}
2665*4882a593Smuzhiyun 	if ((dur_i_1->dur_limit.enable) && (dur_i_1->dur_limit.max_dur != 0) &&
2666*4882a593Smuzhiyun 		(*dur1 > dur_i_1->dur_limit.max_dur)) {
2667*4882a593Smuzhiyun 		*dur1 = dur_i_1->dur_limit.max_dur;
2668*4882a593Smuzhiyun 		*dur2 = (*mcc_intvl - (*dur1));
2669*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_set_dur_for_2_clients_mode(): dur1 > max_dur(%d), we adjust dur to dur1(%d) and dur2(%d)\n",
2670*4882a593Smuzhiyun 			dur_i_1->dur_limit.max_dur, *dur1, *dur2);
2671*4882a593Smuzhiyun 	}
2672*4882a593Smuzhiyun 	if ((dur_i_2->dur_limit.enable) && (dur_i_2->dur_limit.max_dur != 0) &&
2673*4882a593Smuzhiyun 		(*dur2 > dur_i_2->dur_limit.max_dur)) {
2674*4882a593Smuzhiyun 		*dur2 = dur_i_2->dur_limit.max_dur;
2675*4882a593Smuzhiyun 		*dur1 = (*mcc_intvl - (*dur2));
2676*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_set_dur_for_2_clients_mode(): dur2 > max_dur(%d), we adjust dur to dur1(%d) and dur2(%d)\n",
2677*4882a593Smuzhiyun 			dur_i_2->dur_limit.max_dur, *dur1, *dur2);
2678*4882a593Smuzhiyun 	}
2679*4882a593Smuzhiyun }
2680*4882a593Smuzhiyun 
_mcc_fill_info_for_2_clients_mode(struct phl_info_t * phl,struct phl_mcc_info * minfo)2681*4882a593Smuzhiyun enum rtw_phl_status _mcc_fill_info_for_2_clients_mode(struct phl_info_t *phl,
2682*4882a593Smuzhiyun 						struct phl_mcc_info *minfo)
2683*4882a593Smuzhiyun {
2684*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2685*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
2686*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref = get_ref_role(en_info);
2687*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ano = (role_ref == &en_info->mcc_role[0])
2688*4882a593Smuzhiyun 				? &en_info->mcc_role[1] : &en_info->mcc_role[0];
2689*4882a593Smuzhiyun 	u16 bcns_offset = 0;
2690*4882a593Smuzhiyun 	bool worsecase = false;
2691*4882a593Smuzhiyun 
2692*4882a593Smuzhiyun 	en_info->mcc_intvl = role_ref->bcn_intvl;
2693*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_get_2_clients_bcn_offset(phl,
2694*4882a593Smuzhiyun 					&bcns_offset, role_ref, role_ano)) {
2695*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_info_for_2_clients_mode(): Get bcn offset fail\n");
2696*4882a593Smuzhiyun 		goto exit;
2697*4882a593Smuzhiyun 	}
2698*4882a593Smuzhiyun 	en_info->m_pattern.role_ref = role_ref;
2699*4882a593Smuzhiyun 	en_info->m_pattern.role_ano = role_ano;
2700*4882a593Smuzhiyun 	en_info->m_pattern.bcns_offset = bcns_offset;
2701*4882a593Smuzhiyun 	if ((bcns_offset < MIN_BCNS_OFFSET) ||
2702*4882a593Smuzhiyun 		(bcns_offset > (role_ref->bcn_intvl - MIN_BCNS_OFFSET))) {
2703*4882a593Smuzhiyun 		worsecase = true;
2704*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_fill_info_for_2_clients_mode(): worsecase, bcns_offset(%d) < %d or bcns_offset > %d\n",
2705*4882a593Smuzhiyun 			bcns_offset, MIN_BCNS_OFFSET,
2706*4882a593Smuzhiyun 			(role_ref->bcn_intvl - MIN_BCNS_OFFSET));
2707*4882a593Smuzhiyun 	}
2708*4882a593Smuzhiyun 	_mcc_set_dur_for_2_clients_mode(&role_ref->policy.dur_info,
2709*4882a593Smuzhiyun 					&role_ano->policy.dur_info,
2710*4882a593Smuzhiyun 					&en_info->mcc_intvl);
2711*4882a593Smuzhiyun 	if (_mcc_fill_2wrole_pattern_with_limitation(minfo, role_ref, role_ano)) {
2712*4882a593Smuzhiyun 		/*wifi slot, bt slot, and only 1 wifi slot with limitation*/
2713*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_info_for_2_clients_mode(): _mcc_fill_2wrole_pattern_with_limitation\n");
2714*4882a593Smuzhiyun 	} else if (_mcc_discision_duration_for_2role_bt(minfo)) {
2715*4882a593Smuzhiyun 		_mcc_fill_2_wrole_bt_pattern(minfo, role_ref, role_ano);
2716*4882a593Smuzhiyun 	} else {
2717*4882a593Smuzhiyun 	/*We only adjust dur for all wifi slot in worsecase*/
2718*4882a593Smuzhiyun 		if (worsecase) {
2719*4882a593Smuzhiyun 			_mcc_set_worsecase_dur_for_2_clients_mode(
2720*4882a593Smuzhiyun 				&role_ref->policy.dur_info,
2721*4882a593Smuzhiyun 				&role_ano->policy.dur_info, &en_info->mcc_intvl);
2722*4882a593Smuzhiyun 		}
2723*4882a593Smuzhiyun 		_mcc_fill_2_clients_pattern(minfo, worsecase, role_ref, role_ano);
2724*4882a593Smuzhiyun 	}
2725*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_calculate_start_tsf(phl, en_info)) {
2726*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_info_for_2_clients_mode(): calculate start tsf fail\n");
2727*4882a593Smuzhiyun 		goto exit;
2728*4882a593Smuzhiyun 	}
2729*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2730*4882a593Smuzhiyun exit:
2731*4882a593Smuzhiyun 	return status;
2732*4882a593Smuzhiyun }
2733*4882a593Smuzhiyun 
_mcc_set_dur_for_ap_client_mode(u16 * ap_dur,u16 * client_dur,u16 mcc_intvl)2734*4882a593Smuzhiyun void _mcc_set_dur_for_ap_client_mode(u16 *ap_dur, u16 *client_dur, u16 mcc_intvl)
2735*4882a593Smuzhiyun {
2736*4882a593Smuzhiyun 	if (*ap_dur == MCC_DUR_NONSPECIFIC)
2737*4882a593Smuzhiyun 		*ap_dur = mcc_intvl - *client_dur;
2738*4882a593Smuzhiyun 	if (*ap_dur < MIN_AP_DUR) {
2739*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_set_dur_for_ap_client_mode(): ap_dur(%d) < MIN_AP_DUR(%d), set ap_dur = MIN_AP_DUR\n",
2740*4882a593Smuzhiyun 			*ap_dur, MIN_AP_DUR);
2741*4882a593Smuzhiyun 		*ap_dur = MIN_AP_DUR;
2742*4882a593Smuzhiyun 	} else if (*ap_dur > (mcc_intvl - MIN_CLIENT_DUR)) {
2743*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_WARNING_, "_mcc_set_dur_for_ap_client_mode(): ap_dur(%d) < MAX_AP_DUR(%d), set ap_dur = MAX_AP_DUR\n",
2744*4882a593Smuzhiyun 			*ap_dur, (mcc_intvl - MIN_CLIENT_DUR));
2745*4882a593Smuzhiyun 		*ap_dur = mcc_intvl - MIN_CLIENT_DUR;
2746*4882a593Smuzhiyun 	}
2747*4882a593Smuzhiyun 	*client_dur = mcc_intvl - *ap_dur;
2748*4882a593Smuzhiyun }
2749*4882a593Smuzhiyun 
_mcc_fill_info_for_ap_client_mode(struct phl_info_t * phl,struct phl_mcc_info * minfo)2750*4882a593Smuzhiyun enum rtw_phl_status _mcc_fill_info_for_ap_client_mode(
2751*4882a593Smuzhiyun 			struct phl_info_t *phl, struct phl_mcc_info *minfo)
2752*4882a593Smuzhiyun {
2753*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2754*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
2755*4882a593Smuzhiyun 	struct rtw_phl_mcc_sync_tsf_info *sync_info = &en_info->sync_tsf_info;
2756*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *ap_role = NULL;
2757*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *client_role = NULL;
2758*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref = get_ref_role(en_info);
2759*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ano = (role_ref == &en_info->mcc_role[0])
2760*4882a593Smuzhiyun 				? &en_info->mcc_role[1] : &en_info->mcc_role[0];
2761*4882a593Smuzhiyun 
2762*4882a593Smuzhiyun 	ap_role = _mcc_get_mrole_by_category(en_info, MCC_ROLE_AP_CAT);
2763*4882a593Smuzhiyun 	client_role = _mcc_get_mrole_by_category(en_info, MCC_ROLE_CLIENT_CAT);
2764*4882a593Smuzhiyun 	if (ap_role == NULL || client_role == NULL) {
2765*4882a593Smuzhiyun 		_mcc_dump_en_info(en_info);
2766*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_info_for_ap_client_mode(): (ap_role == NULL || client_role == NULL)\n");
2767*4882a593Smuzhiyun 		goto exit;
2768*4882a593Smuzhiyun 	}
2769*4882a593Smuzhiyun 	en_info->m_pattern.role_ref = role_ref;
2770*4882a593Smuzhiyun 	en_info->m_pattern.role_ano = role_ano;
2771*4882a593Smuzhiyun 	en_info->mcc_intvl = ap_role->bcn_intvl;
2772*4882a593Smuzhiyun 	_mcc_set_dur_for_ap_client_mode(&ap_role->policy.dur_info.dur,
2773*4882a593Smuzhiyun 					&client_role->policy.dur_info.dur,
2774*4882a593Smuzhiyun 					en_info->mcc_intvl);
2775*4882a593Smuzhiyun 	if (_mcc_discision_duration_for_2role_bt(minfo)) {
2776*4882a593Smuzhiyun 		en_info->m_pattern.bcns_offset = AP_CLIENT_OFFSET;
2777*4882a593Smuzhiyun 		_mcc_fill_2_wrole_bt_pattern(minfo, role_ref, role_ano);
2778*4882a593Smuzhiyun 	} else {
2779*4882a593Smuzhiyun 		_mcc_set_ap_client_default_pattern(minfo,
2780*4882a593Smuzhiyun 					&en_info->m_pattern.bcns_offset);
2781*4882a593Smuzhiyun 	}
2782*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != rtw_phl_tbtt_sync(phl,
2783*4882a593Smuzhiyun 					client_role->wrole, ap_role->wrole,
2784*4882a593Smuzhiyun 					en_info->m_pattern.bcns_offset, true,
2785*4882a593Smuzhiyun 					&sync_info->offset)) {
2786*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_info_for_ap_client_mode(): Sync tsf fail\n");
2787*4882a593Smuzhiyun 		goto exit;
2788*4882a593Smuzhiyun 	}
2789*4882a593Smuzhiyun 	sync_info->source = client_role->macid;
2790*4882a593Smuzhiyun 	sync_info->target = ap_role->macid;
2791*4882a593Smuzhiyun 	sync_info->sync_en = true;
2792*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_calculate_start_tsf(phl, en_info)) {
2793*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_info_for_ap_client_mode(): calculate start tsf fail\n");
2794*4882a593Smuzhiyun 		goto exit;
2795*4882a593Smuzhiyun 	}
2796*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2797*4882a593Smuzhiyun exit:
2798*4882a593Smuzhiyun 	return status;
2799*4882a593Smuzhiyun }
2800*4882a593Smuzhiyun 
2801*4882a593Smuzhiyun /*
2802*4882a593Smuzhiyun  * |         Wifi slot          |          BT slot         |
2803*4882a593Smuzhiyun  * <tob_r> Bcn_r <toa_r>
2804*4882a593Smuzhiyun **/
_mcc_fill_info_for_ap_bt_mode(struct phl_info_t * phl,struct phl_mcc_info * minfo)2805*4882a593Smuzhiyun enum rtw_phl_status _mcc_fill_info_for_ap_bt_mode(
2806*4882a593Smuzhiyun 			struct phl_info_t *phl, struct phl_mcc_info *minfo)
2807*4882a593Smuzhiyun {
2808*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2809*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = &minfo->en_info;
2810*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref = get_ref_role(en_info);
2811*4882a593Smuzhiyun 	struct rtw_phl_mcc_pattern *m_pattern = &en_info->m_pattern;
2812*4882a593Smuzhiyun 
2813*4882a593Smuzhiyun 	minfo->bt_info.add_bt_role = true;
2814*4882a593Smuzhiyun 	en_info->mcc_intvl = role_ref->bcn_intvl;
2815*4882a593Smuzhiyun 	role_ref->policy.dur_info.dur = (u8)(en_info->mcc_intvl -
2816*4882a593Smuzhiyun 							minfo->bt_info.bt_dur);
2817*4882a593Smuzhiyun 	m_pattern->role_ref = role_ref;
2818*4882a593Smuzhiyun 	m_pattern->toa_r= role_ref->policy.dur_info.dur / 2;
2819*4882a593Smuzhiyun 	m_pattern->tob_r = role_ref->policy.dur_info.dur - m_pattern->toa_r;
2820*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, false, role_ref->policy.dur_info.dur, role_ref);
2821*4882a593Smuzhiyun 	_mcc_fill_slot_info(m_pattern, true, minfo->bt_info.bt_dur, NULL);
2822*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_calculate_start_tsf(phl, en_info)) {
2823*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_fill_info_for_ap_bt_mode(): calculate start tsf fail\n");
2824*4882a593Smuzhiyun 		goto exit;
2825*4882a593Smuzhiyun 	}
2826*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2827*4882a593Smuzhiyun exit:
2828*4882a593Smuzhiyun 	return status;
2829*4882a593Smuzhiyun }
2830*4882a593Smuzhiyun 
_mcc_pkt_offload_for_client(struct phl_info_t * phl,u8 macid)2831*4882a593Smuzhiyun enum rtw_phl_status _mcc_pkt_offload_for_client(struct phl_info_t *phl, u8 macid)
2832*4882a593Smuzhiyun {
2833*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2834*4882a593Smuzhiyun 	struct rtw_phl_stainfo_t *phl_sta = NULL;
2835*4882a593Smuzhiyun 	struct rtw_pkt_ofld_null_info null_info = {0};
2836*4882a593Smuzhiyun 	void *d = phl_to_drvpriv(phl);
2837*4882a593Smuzhiyun 	u32 null_token = 0;
2838*4882a593Smuzhiyun 
2839*4882a593Smuzhiyun 	phl_sta = rtw_phl_get_stainfo_by_macid(phl, macid);
2840*4882a593Smuzhiyun 	if (phl_sta == NULL) {
2841*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_pkt_offload_for_client(): get sta fail, macid(%d)\n",
2842*4882a593Smuzhiyun 			macid);
2843*4882a593Smuzhiyun 		goto exit;
2844*4882a593Smuzhiyun 	}
2845*4882a593Smuzhiyun 	if (NOT_USED != phl_pkt_ofld_get_id(phl, macid,
2846*4882a593Smuzhiyun 						PKT_TYPE_NULL_DATA)) {
2847*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_pkt_offload_for_client(): macid(%d), we had already offload NULL Pkt\n",
2848*4882a593Smuzhiyun 			macid);
2849*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_SUCCESS;
2850*4882a593Smuzhiyun 		goto exit;
2851*4882a593Smuzhiyun 	}
2852*4882a593Smuzhiyun 	_os_mem_cpy(d, &(null_info.a1[0]), &(phl_sta->mac_addr[0]),
2853*4882a593Smuzhiyun 		MAC_ADDRESS_LENGTH);
2854*4882a593Smuzhiyun 	_os_mem_cpy(d,&(null_info.a2[0]), &(phl_sta->wrole->mac_addr[0]),
2855*4882a593Smuzhiyun 		MAC_ADDRESS_LENGTH);
2856*4882a593Smuzhiyun 	_os_mem_cpy(d, &(null_info.a3[0]), &(phl_sta->mac_addr[0]),
2857*4882a593Smuzhiyun 		MAC_ADDRESS_LENGTH);
2858*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != phl_pkt_ofld_request(phl, macid,
2859*4882a593Smuzhiyun 						PKT_TYPE_NULL_DATA, &null_token,
2860*4882a593Smuzhiyun 						__func__, &null_info)) {
2861*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_pkt_offload_for_client(): Pkt offload fail, macid(%d)\n",
2862*4882a593Smuzhiyun 			macid);
2863*4882a593Smuzhiyun 		goto exit;
2864*4882a593Smuzhiyun 	}
2865*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_pkt_offload_for_client(): offload ok, macid(%d), null_token(%d)\n",
2866*4882a593Smuzhiyun 		macid, null_token);
2867*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2868*4882a593Smuzhiyun exit:
2869*4882a593Smuzhiyun 	return status;
2870*4882a593Smuzhiyun }
2871*4882a593Smuzhiyun 
2872*4882a593Smuzhiyun 
_mcc_pkt_offload(struct phl_info_t * phl,struct rtw_phl_mcc_en_info * info)2873*4882a593Smuzhiyun enum rtw_phl_status _mcc_pkt_offload(struct phl_info_t *phl,
2874*4882a593Smuzhiyun 					struct rtw_phl_mcc_en_info *info)
2875*4882a593Smuzhiyun {
2876*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2877*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *mcc_role = NULL;
2878*4882a593Smuzhiyun 	u8 midx = 0;
2879*4882a593Smuzhiyun 
2880*4882a593Smuzhiyun 	for (midx = 0; midx < MCC_ROLE_NUM; midx++) {
2881*4882a593Smuzhiyun 		if (!(info->mrole_map & BIT(midx)))
2882*4882a593Smuzhiyun 			continue;
2883*4882a593Smuzhiyun 		mcc_role = &info->mcc_role[midx];
2884*4882a593Smuzhiyun 		if (_mcc_is_client_category(mcc_role->wrole)) {
2885*4882a593Smuzhiyun 			if (RTW_PHL_STATUS_SUCCESS !=
2886*4882a593Smuzhiyun 				_mcc_pkt_offload_for_client(phl,
2887*4882a593Smuzhiyun 							(u8)mcc_role->macid)) {
2888*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_pkt_offload_for_client(): mcc_role index(%d)\n",
2889*4882a593Smuzhiyun 					midx);
2890*4882a593Smuzhiyun 				goto exit;
2891*4882a593Smuzhiyun 			}
2892*4882a593Smuzhiyun 		}
2893*4882a593Smuzhiyun 	}
2894*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2895*4882a593Smuzhiyun exit:
2896*4882a593Smuzhiyun 	return status;
2897*4882a593Smuzhiyun }
2898*4882a593Smuzhiyun 
_mcc_update_2_clients_pattern(struct phl_info_t * phl,struct phl_mcc_info * ori_minfo,struct phl_mcc_info * new_minfo)2899*4882a593Smuzhiyun enum rtw_phl_status _mcc_update_2_clients_pattern(struct phl_info_t *phl,
2900*4882a593Smuzhiyun 				struct phl_mcc_info *ori_minfo,
2901*4882a593Smuzhiyun 				struct phl_mcc_info *new_minfo)
2902*4882a593Smuzhiyun {
2903*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2904*4882a593Smuzhiyun 
2905*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_fill_info_for_2_clients_mode(phl,
2906*4882a593Smuzhiyun 								new_minfo)) {
2907*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_2_clients_pattern(): fill info fail for 2clients mode\n");
2908*4882a593Smuzhiyun 		goto error;
2909*4882a593Smuzhiyun 	}
2910*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_change_pattern(phl->hal,
2911*4882a593Smuzhiyun 					&ori_minfo->en_info, &new_minfo->en_info,
2912*4882a593Smuzhiyun 					&new_minfo->bt_info)) {
2913*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_2_clients_pattern(): set duration fail\n");
2914*4882a593Smuzhiyun 		goto error;
2915*4882a593Smuzhiyun 	}
2916*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2917*4882a593Smuzhiyun 	goto exit;
2918*4882a593Smuzhiyun error:
2919*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_2_clients_pattern(): Update fail\n");
2920*4882a593Smuzhiyun exit:
2921*4882a593Smuzhiyun 	return status;
2922*4882a593Smuzhiyun }
2923*4882a593Smuzhiyun 
_mcc_update_ap_client_pattern(struct phl_info_t * phl,struct phl_mcc_info * ori_minfo,struct phl_mcc_info * new_minfo)2924*4882a593Smuzhiyun enum rtw_phl_status _mcc_update_ap_client_pattern(struct phl_info_t *phl,
2925*4882a593Smuzhiyun 		struct phl_mcc_info *ori_minfo, struct phl_mcc_info *new_minfo)
2926*4882a593Smuzhiyun {
2927*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2928*4882a593Smuzhiyun 
2929*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_fill_info_for_ap_client_mode(phl,
2930*4882a593Smuzhiyun 								new_minfo)) {
2931*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_ap_client_pattern(): fill info fail for ap client mode\n");
2932*4882a593Smuzhiyun 		goto error;
2933*4882a593Smuzhiyun 	}
2934*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_change_pattern(phl->hal,
2935*4882a593Smuzhiyun 					&ori_minfo->en_info, &new_minfo->en_info,
2936*4882a593Smuzhiyun 					&new_minfo->bt_info)) {
2937*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_ap_client_pattern(): set duration fail\n");
2938*4882a593Smuzhiyun 		goto error;
2939*4882a593Smuzhiyun 	}
2940*4882a593Smuzhiyun 	if ((new_minfo->en_info.sync_tsf_info.sync_en) &&
2941*4882a593Smuzhiyun 		(new_minfo->en_info.sync_tsf_info.offset !=
2942*4882a593Smuzhiyun 		ori_minfo->en_info.sync_tsf_info.offset)) {
2943*4882a593Smuzhiyun 		if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_sync_enable(phl->hal,
2944*4882a593Smuzhiyun 							&new_minfo->en_info)) {
2945*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_ap_client_pattern(): set tsf sync fail\n");
2946*4882a593Smuzhiyun 			goto error;
2947*4882a593Smuzhiyun 		}
2948*4882a593Smuzhiyun 	}
2949*4882a593Smuzhiyun 	_mcc_up_noa(phl, new_minfo);
2950*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2951*4882a593Smuzhiyun 	goto exit;
2952*4882a593Smuzhiyun error:
2953*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_ap_client_pattern(): Update fail\n");
2954*4882a593Smuzhiyun exit:
2955*4882a593Smuzhiyun 	return status;
2956*4882a593Smuzhiyun }
2957*4882a593Smuzhiyun 
_mcc_update_ap_bt_pattern(struct phl_info_t * phl,struct phl_mcc_info * ori_minfo,struct phl_mcc_info * new_minfo)2958*4882a593Smuzhiyun enum rtw_phl_status _mcc_update_ap_bt_pattern(struct phl_info_t *phl,
2959*4882a593Smuzhiyun 		struct phl_mcc_info *ori_minfo, struct phl_mcc_info *new_minfo)
2960*4882a593Smuzhiyun {
2961*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2962*4882a593Smuzhiyun 
2963*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_fill_info_for_ap_bt_mode(phl,
2964*4882a593Smuzhiyun 								new_minfo)) {
2965*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_ap_bt_pattern(): fill info fail for ap_bt\n");
2966*4882a593Smuzhiyun 		goto error;
2967*4882a593Smuzhiyun 	}
2968*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_change_pattern(phl->hal,
2969*4882a593Smuzhiyun 					&ori_minfo->en_info, &new_minfo->en_info,
2970*4882a593Smuzhiyun 					&new_minfo->bt_info)) {
2971*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_ap_bt_pattern(): set duration fail\n");
2972*4882a593Smuzhiyun 		goto error;
2973*4882a593Smuzhiyun 	}
2974*4882a593Smuzhiyun 	_mcc_up_noa(phl, new_minfo);
2975*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
2976*4882a593Smuzhiyun 	goto exit;
2977*4882a593Smuzhiyun error:
2978*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_update_ap_bt_pattern(): Update fail\n");
2979*4882a593Smuzhiyun exit:
2980*4882a593Smuzhiyun 	return status;
2981*4882a593Smuzhiyun }
2982*4882a593Smuzhiyun 
_mcc_duration_change(struct phl_info_t * phl,struct phl_mcc_info * minfo,struct phl_mcc_info * new_minfo)2983*4882a593Smuzhiyun enum rtw_phl_status _mcc_duration_change(struct phl_info_t *phl,
2984*4882a593Smuzhiyun 		struct phl_mcc_info *minfo, struct phl_mcc_info *new_minfo)
2985*4882a593Smuzhiyun {
2986*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
2987*4882a593Smuzhiyun 
2988*4882a593Smuzhiyun 	if (RTW_PHL_TDMRA_AP_CLIENT_WMODE == minfo->mcc_mode) {
2989*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != _mcc_update_ap_client_pattern(
2990*4882a593Smuzhiyun 					phl, minfo, new_minfo)) {
2991*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_duration_change(): update ap_client fail\n");
2992*4882a593Smuzhiyun 			goto exit;
2993*4882a593Smuzhiyun 		}
2994*4882a593Smuzhiyun 	} else if (RTW_PHL_TDMRA_2CLIENTS_WMODE == minfo->mcc_mode) {
2995*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != _mcc_update_2_clients_pattern(
2996*4882a593Smuzhiyun 							phl, minfo, new_minfo)) {
2997*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_duration_change(): update ap_client fail\n");
2998*4882a593Smuzhiyun 			goto exit;
2999*4882a593Smuzhiyun 		}
3000*4882a593Smuzhiyun 	} else if (RTW_PHL_TDMRA_AP_WMODE == minfo->mcc_mode) {
3001*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS != _mcc_update_ap_bt_pattern(
3002*4882a593Smuzhiyun 							phl, minfo, new_minfo)) {
3003*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_duration_change(): update ap_bt fail\n");
3004*4882a593Smuzhiyun 			goto exit;
3005*4882a593Smuzhiyun 		}
3006*4882a593Smuzhiyun 	} else {
3007*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_duration_change(): Undefined mcc_mode(%d)\n",
3008*4882a593Smuzhiyun 			minfo->mcc_mode);
3009*4882a593Smuzhiyun 		goto exit;
3010*4882a593Smuzhiyun 	}
3011*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_duration_change(): Update success\n");
3012*4882a593Smuzhiyun 	_os_mem_cpy(phl_to_drvpriv(phl), minfo, new_minfo,
3013*4882a593Smuzhiyun 			sizeof(struct phl_mcc_info));
3014*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3015*4882a593Smuzhiyun exit:
3016*4882a593Smuzhiyun 	return status;
3017*4882a593Smuzhiyun }
3018*4882a593Smuzhiyun 
_mcc_2_clients_tracking(struct phl_info_t * phl,struct phl_mcc_info * minfo)3019*4882a593Smuzhiyun void _mcc_2_clients_tracking(struct phl_info_t *phl,
3020*4882a593Smuzhiyun 				struct phl_mcc_info *minfo
3021*4882a593Smuzhiyun )
3022*4882a593Smuzhiyun {
3023*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3024*4882a593Smuzhiyun 	struct rtw_phl_mcc_pattern *m_pattern = NULL;
3025*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ref = NULL;
3026*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *role_ano = NULL;
3027*4882a593Smuzhiyun 	struct phl_mcc_info new_minfo = {0};
3028*4882a593Smuzhiyun 	u16 bcns_offset = 0, diff = 0, tol = 0;/*tolerance*/
3029*4882a593Smuzhiyun 	bool negative_sign = false;
3030*4882a593Smuzhiyun 
3031*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> _mcc_2_clients_tracking\n");
3032*4882a593Smuzhiyun 	_os_mem_cpy(phl_to_drvpriv(phl), &new_minfo, minfo,
3033*4882a593Smuzhiyun 			sizeof(struct phl_mcc_info));
3034*4882a593Smuzhiyun 	en_info = &new_minfo.en_info;
3035*4882a593Smuzhiyun 	m_pattern = &en_info->m_pattern;
3036*4882a593Smuzhiyun 	role_ref = get_ref_role(en_info);
3037*4882a593Smuzhiyun 	role_ano = (role_ref == &en_info->mcc_role[0]) ? &en_info->mcc_role[1] :
3038*4882a593Smuzhiyun 							&en_info->mcc_role[0];
3039*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_get_2_clients_bcn_offset(phl,
3040*4882a593Smuzhiyun 					&bcns_offset, role_ref, role_ano)) {
3041*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_2_clients_tracking(): Get bcn offset fail\n");
3042*4882a593Smuzhiyun 		goto exit;
3043*4882a593Smuzhiyun 	}
3044*4882a593Smuzhiyun 	if (bcns_offset > m_pattern->bcns_offset) {
3045*4882a593Smuzhiyun 		diff = bcns_offset - m_pattern->bcns_offset;
3046*4882a593Smuzhiyun 	} else {
3047*4882a593Smuzhiyun 		diff = m_pattern->bcns_offset - bcns_offset;
3048*4882a593Smuzhiyun 		negative_sign = true;
3049*4882a593Smuzhiyun 	}
3050*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_2_clients_tracking(): old bcns_offset(%d), new bcns_offset(%d)\n",
3051*4882a593Smuzhiyun 		m_pattern->bcns_offset, bcns_offset);
3052*4882a593Smuzhiyun 	_mcc_dump_pattern(m_pattern);
3053*4882a593Smuzhiyun 	_mcc_dump_ref_role_info(en_info);
3054*4882a593Smuzhiyun 	if (en_info->m_pattern.courtesy_i.c_en) {
3055*4882a593Smuzhiyun 		tol = CLIENTS_TRACKING_COURTESY_TH;
3056*4882a593Smuzhiyun 		goto decision;
3057*4882a593Smuzhiyun 	}
3058*4882a593Smuzhiyun 	if (en_info->mcc_intvl == WORSECASE_INTVL) {
3059*4882a593Smuzhiyun 		tol = CLIENTS_TRACKING_WORSECASE_TH;
3060*4882a593Smuzhiyun 		goto decision;
3061*4882a593Smuzhiyun 	}
3062*4882a593Smuzhiyun 	if (negative_sign) {
3063*4882a593Smuzhiyun 		if (m_pattern->tob_a <= EARLY_RX_BCN_T) {
3064*4882a593Smuzhiyun 			tol = CLIENTS_TRACKING_CRITICAL_POINT_TH;
3065*4882a593Smuzhiyun 		} else if (m_pattern->tob_a >= (2 * EARLY_RX_BCN_T)){
3066*4882a593Smuzhiyun 			tol = m_pattern->tob_a - ((3 * EARLY_RX_BCN_T) / 2);
3067*4882a593Smuzhiyun 		} else {
3068*4882a593Smuzhiyun 			tol = CLIENTS_TRACKING_TH;
3069*4882a593Smuzhiyun 		}
3070*4882a593Smuzhiyun 	} else {
3071*4882a593Smuzhiyun 		if (m_pattern->toa_a <= MIN_RX_BCN_T) {
3072*4882a593Smuzhiyun 			tol = CLIENTS_TRACKING_CRITICAL_POINT_TH;
3073*4882a593Smuzhiyun 		} else if (m_pattern->toa_a >= (2 * MIN_RX_BCN_T)){
3074*4882a593Smuzhiyun 			tol = m_pattern->toa_a - ((3 * MIN_RX_BCN_T) / 2);
3075*4882a593Smuzhiyun 		} else {
3076*4882a593Smuzhiyun 			tol = CLIENTS_TRACKING_TH;
3077*4882a593Smuzhiyun 		}
3078*4882a593Smuzhiyun 	}
3079*4882a593Smuzhiyun decision:
3080*4882a593Smuzhiyun 	if (diff < tol)
3081*4882a593Smuzhiyun 		goto exit;
3082*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_2_clients_tracking(): Need to update new 2clients pattern, negative_sign(%d), diff(%d), tolerance(%d), mcc_intvl(%d)\n",
3083*4882a593Smuzhiyun 		negative_sign, diff, tol, en_info->mcc_intvl);
3084*4882a593Smuzhiyun 	_mcc_reset_minfo(phl, &new_minfo, MINFO_RESET_BT_INFO |
3085*4882a593Smuzhiyun 						MINFO_RESET_PATTERN_INFO);
3086*4882a593Smuzhiyun 	/*fill original bt slot*/
3087*4882a593Smuzhiyun 	_mcc_fill_bt_dur(phl, &new_minfo);
3088*4882a593Smuzhiyun 	/*get original wifi time slot*/
3089*4882a593Smuzhiyun 	_mcc_fill_mcc_role_policy_info(phl, role_ref->wrole, role_ref);
3090*4882a593Smuzhiyun 	_mcc_fill_mcc_role_policy_info(phl, role_ano->wrole, role_ano);
3091*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_update_2_clients_pattern(phl,
3092*4882a593Smuzhiyun 							minfo, &new_minfo)) {
3093*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_2_clients_tracking(): update 2clients fail\n");
3094*4882a593Smuzhiyun 		goto exit;
3095*4882a593Smuzhiyun 	}
3096*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_2_clients_tracking(): update new pattern ok\n");
3097*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_2_clients_tracking(): old pattern:\n");
3098*4882a593Smuzhiyun 	_mcc_dump_pattern(&en_info->m_pattern);
3099*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "_mcc_2_clients_tracking(): new pattern:\n");
3100*4882a593Smuzhiyun 	_mcc_dump_pattern(&new_minfo.en_info.m_pattern);
3101*4882a593Smuzhiyun 	_os_mem_cpy(phl_to_drvpriv(phl), minfo, &new_minfo,
3102*4882a593Smuzhiyun 			sizeof(struct phl_mcc_info));
3103*4882a593Smuzhiyun exit:
3104*4882a593Smuzhiyun 	return;
3105*4882a593Smuzhiyun }
3106*4882a593Smuzhiyun 
rtw_phl_mcc_ap_bt_coex_enable(struct phl_info_t * phl,struct rtw_wifi_role_t * cur_role)3107*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_ap_bt_coex_enable(struct phl_info_t *phl,
3108*4882a593Smuzhiyun 				struct rtw_wifi_role_t *cur_role)
3109*4882a593Smuzhiyun {
3110*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3111*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3112*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3113*4882a593Smuzhiyun 	struct hw_band_ctl_t *band_ctrl = get_band_ctrl(phl, cur_role->hw_band);
3114*4882a593Smuzhiyun 
3115*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_ap_bt_coex_enable(): cur_role->type(%d)\n",
3116*4882a593Smuzhiyun 		cur_role->type);
3117*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3118*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): mcc is not init, please check code\n");
3119*4882a593Smuzhiyun 		goto exit;
3120*4882a593Smuzhiyun 	}
3121*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, cur_role->hw_band);
3122*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3123*4882a593Smuzhiyun 	if (MCC_NONE != minfo->state && MCC_STOP != minfo->state) {
3124*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): (MCC_NONE != minfo->state || MCC_STOP != minfo->state(%d)), please check code flow\n",
3125*4882a593Smuzhiyun 			minfo->state);
3126*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3127*4882a593Smuzhiyun 		goto exit;
3128*4882a593Smuzhiyun 	}
3129*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_CFG_EN_INFO);
3130*4882a593Smuzhiyun 	_mcc_reset_minfo(phl, minfo, (MINFO_RESET_EN_INFO | MINFO_RESET_MODE |
3131*4882a593Smuzhiyun 				MINFO_RESET_ROLE_MAP | MINFO_RESET_COEX_MODE |
3132*4882a593Smuzhiyun 				MINFO_RESET_BT_INFO));
3133*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_get_role_map(phl, band_ctrl,
3134*4882a593Smuzhiyun 							&minfo->role_map)) {
3135*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): Get role map failed\n");
3136*4882a593Smuzhiyun 		goto _cfg_info_fail;
3137*4882a593Smuzhiyun 	}
3138*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_transfer_mode(phl, minfo,
3139*4882a593Smuzhiyun 							minfo->role_map)) {
3140*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): transfer mcc mode failed\n");
3141*4882a593Smuzhiyun 		goto _cfg_info_fail;
3142*4882a593Smuzhiyun 	}
3143*4882a593Smuzhiyun 	if (RTW_PHL_TDMRA_AP_WMODE != minfo->mcc_mode) {
3144*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): error  wmode\n");
3145*4882a593Smuzhiyun 		_mcc_dump_mode(&minfo->mcc_mode);
3146*4882a593Smuzhiyun 		goto _cfg_info_fail;
3147*4882a593Smuzhiyun 	}
3148*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_fill_role_info(phl, en_info,
3149*4882a593Smuzhiyun 						minfo->role_map, cur_role)) {
3150*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): fill role info failed\n");
3151*4882a593Smuzhiyun 		goto _cfg_info_fail;
3152*4882a593Smuzhiyun 	}
3153*4882a593Smuzhiyun 	_mcc_fill_coex_mode(phl, minfo);
3154*4882a593Smuzhiyun 	_mcc_fill_bt_dur(phl, minfo);
3155*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_get_mrole_idx_by_wrole(minfo,
3156*4882a593Smuzhiyun 					cur_role, &en_info->ref_role_idx)) {
3157*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): fill ref_role idx failed\n");
3158*4882a593Smuzhiyun 		goto _cfg_info_fail;
3159*4882a593Smuzhiyun 	}
3160*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_fill_info_for_ap_bt_mode(phl, minfo)) {
3161*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): fill ref_role idx failed\n");
3162*4882a593Smuzhiyun 		goto _cfg_info_fail;
3163*4882a593Smuzhiyun 	}
3164*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_TRIGGER_FW_EN);
3165*4882a593Smuzhiyun 	if (rtw_hal_mcc_enable(phl->hal, en_info, &minfo->bt_info,
3166*4882a593Smuzhiyun 				minfo->mcc_mode) != RTW_HAL_STATUS_SUCCESS) {
3167*4882a593Smuzhiyun 		_mcc_set_state(minfo, MCC_FW_EN_FAIL);
3168*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_ap_bt_coex_enable(): Enable FW mcc Fail\n");
3169*4882a593Smuzhiyun 		goto exit;
3170*4882a593Smuzhiyun 	}
3171*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_RUNING);
3172*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ALWAYS_, "rtw_phl_mcc_ap_bt_coex_enable(): Enable FW mcc ok\n");
3173*4882a593Smuzhiyun 	_mcc_up_noa(phl, minfo);
3174*4882a593Smuzhiyun 	_mcc_dump_mcc_info(minfo);
3175*4882a593Smuzhiyun 	_mcc_up_fw_log_setting(phl, minfo);
3176*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3177*4882a593Smuzhiyun 	goto exit;
3178*4882a593Smuzhiyun _cfg_info_fail:
3179*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_NONE);
3180*4882a593Smuzhiyun exit:
3181*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ALWAYS_, "<<< rtw_phl_mcc_ap_bt_coex_enable():status(%d)\n",
3182*4882a593Smuzhiyun 		status);
3183*4882a593Smuzhiyun 	return status;
3184*4882a593Smuzhiyun }
3185*4882a593Smuzhiyun 
rtw_phl_mcc_go_bt_coex_disable(struct phl_info_t * phl,struct rtw_wifi_role_t * spec_role)3186*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_go_bt_coex_disable(struct phl_info_t *phl,
3187*4882a593Smuzhiyun 				struct rtw_wifi_role_t *spec_role)
3188*4882a593Smuzhiyun {
3189*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3190*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3191*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3192*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
3193*4882a593Smuzhiyun 
3194*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3195*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_go_bt_coex_disable(): mcc is not init, please check code\n");
3196*4882a593Smuzhiyun 		goto exit;
3197*4882a593Smuzhiyun 	}
3198*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, spec_role->hw_band);
3199*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3200*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state) {
3201*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_go_bt_coex_disable(): MCC_RUNING != m_info->state, please check code flow\n");
3202*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3203*4882a593Smuzhiyun 		goto exit;
3204*4882a593Smuzhiyun 	}
3205*4882a593Smuzhiyun 	if (NULL == (m_role = _mcc_get_mrole_by_wrole(minfo, spec_role))) {
3206*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_go_bt_coex_disable(): Can't get mrole, wrole id(%d), please check code flow\n",
3207*4882a593Smuzhiyun 			spec_role->id);
3208*4882a593Smuzhiyun 		goto exit;
3209*4882a593Smuzhiyun 	}
3210*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_TRIGGER_FW_DIS);
3211*4882a593Smuzhiyun 	if (rtw_hal_mcc_disable(phl->hal, m_role->group, m_role->macid,
3212*4882a593Smuzhiyun 				minfo->mcc_mode) != RTW_HAL_STATUS_SUCCESS) {
3213*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
3214*4882a593Smuzhiyun 		_mcc_set_state(minfo, MCC_FW_DIS_FAIL);
3215*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_,"rtw_phl_mcc_go_bt_coex_disable(): Disable FW mcc Fail\n");
3216*4882a593Smuzhiyun 		goto exit;
3217*4882a593Smuzhiyun 	}
3218*4882a593Smuzhiyun 	rtw_hal_sync_cur_ch(phl->hal, spec_role->hw_band, spec_role->chandef);
3219*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_STOP);
3220*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_go_bt_coex_disable(): Disable FW mcc ok\n");
3221*4882a593Smuzhiyun 	_mcc_clean_noa(phl, en_info);
3222*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3223*4882a593Smuzhiyun exit:
3224*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ALWAYS_, "<<< rtw_phl_mcc_go_bt_coex_disable(): status(%d)\n",
3225*4882a593Smuzhiyun 		status);
3226*4882a593Smuzhiyun 	return status;
3227*4882a593Smuzhiyun }
3228*4882a593Smuzhiyun 
rtw_phl_mcc_watchdog(struct phl_info_t * phl,u8 band_idx)3229*4882a593Smuzhiyun void rtw_phl_mcc_watchdog(struct phl_info_t *phl, u8 band_idx)
3230*4882a593Smuzhiyun {
3231*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3232*4882a593Smuzhiyun 
3233*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3234*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_watchdog(): mcc is not init, please check code\n");
3235*4882a593Smuzhiyun 		goto exit;
3236*4882a593Smuzhiyun 	}
3237*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, band_idx);
3238*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state)
3239*4882a593Smuzhiyun 		goto exit;
3240*4882a593Smuzhiyun 
3241*4882a593Smuzhiyun 	if (RTW_PHL_TDMRA_2CLIENTS_WMODE == minfo->mcc_mode)
3242*4882a593Smuzhiyun 		_mcc_2_clients_tracking(phl, minfo);
3243*4882a593Smuzhiyun 
3244*4882a593Smuzhiyun exit:
3245*4882a593Smuzhiyun 	return;
3246*4882a593Smuzhiyun }
3247*4882a593Smuzhiyun 
rtw_phl_mcc_duration_change(struct phl_info_t * phl,struct phl_tdmra_dur_change_info * info)3248*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_duration_change(struct phl_info_t *phl,
3249*4882a593Smuzhiyun 			struct phl_tdmra_dur_change_info *info)
3250*4882a593Smuzhiyun {
3251*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3252*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = get_mcc_info(phl, info->hw_band);
3253*4882a593Smuzhiyun 	struct phl_mcc_info new_minfo = {0};
3254*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *spec_mrole = NULL;
3255*4882a593Smuzhiyun 
3256*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_duration_change\n");
3257*4882a593Smuzhiyun 	_os_mem_cpy(phl_to_drvpriv(phl), &new_minfo, minfo,
3258*4882a593Smuzhiyun 			sizeof(struct phl_mcc_info));
3259*4882a593Smuzhiyun 	_mcc_set_unspecific_dur(&new_minfo);
3260*4882a593Smuzhiyun 	spec_mrole = _mcc_get_mrole_by_wrole(&new_minfo, info->role);
3261*4882a593Smuzhiyun 	if (NULL == spec_mrole) {
3262*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_duration_change(): Can't get mrole by wrole(%d), please check code flow\n",
3263*4882a593Smuzhiyun 			info->role->id);
3264*4882a593Smuzhiyun 		goto exit;
3265*4882a593Smuzhiyun 	}
3266*4882a593Smuzhiyun 	spec_mrole->policy.dur_info.dur = info->dur;
3267*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_duration_change(phl, minfo,
3268*4882a593Smuzhiyun 								&new_minfo)) {
3269*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_duration_change(): Change fail\n");
3270*4882a593Smuzhiyun 		goto exit;
3271*4882a593Smuzhiyun 	}
3272*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_duration_change(): Change success\n");
3273*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3274*4882a593Smuzhiyun 	_mcc_dump_mcc_info(&new_minfo);
3275*4882a593Smuzhiyun exit:
3276*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< rtw_phl_mcc_duration_change\n");
3277*4882a593Smuzhiyun 	return status;
3278*4882a593Smuzhiyun }
3279*4882a593Smuzhiyun 
rtw_phl_mcc_bt_duration_change(struct phl_info_t * phl,struct phl_tdmra_dur_change_info * info)3280*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_bt_duration_change(struct phl_info_t *phl,
3281*4882a593Smuzhiyun 				struct phl_tdmra_dur_change_info *info)
3282*4882a593Smuzhiyun {
3283*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3284*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = get_mcc_info(phl, info->hw_band);
3285*4882a593Smuzhiyun 	struct phl_mcc_info new_minfo = {0};
3286*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3287*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *mrole = NULL;
3288*4882a593Smuzhiyun 	u8 midx = 0;
3289*4882a593Smuzhiyun 	bool exist_2g = false;
3290*4882a593Smuzhiyun 
3291*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_bt_duration_change(): dur(%d)\n",
3292*4882a593Smuzhiyun 		info->dur);
3293*4882a593Smuzhiyun 	if (info->dur == minfo->bt_info.bt_dur) {
3294*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_SUCCESS;
3295*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "rtw_phl_mcc_bt_duration_change(): no change of bt slot(%d), skip it\n",
3296*4882a593Smuzhiyun 			info->dur);
3297*4882a593Smuzhiyun 		goto exit;
3298*4882a593Smuzhiyun 	}
3299*4882a593Smuzhiyun 	_os_mem_cpy(phl_to_drvpriv(phl), &new_minfo, minfo,
3300*4882a593Smuzhiyun 			sizeof(struct phl_mcc_info));
3301*4882a593Smuzhiyun 	en_info = &new_minfo.en_info;
3302*4882a593Smuzhiyun 	_mcc_reset_minfo(phl, &new_minfo, MINFO_RESET_BT_INFO |
3303*4882a593Smuzhiyun 						MINFO_RESET_PATTERN_INFO);
3304*4882a593Smuzhiyun 	_mcc_fill_bt_dur(phl, &new_minfo);
3305*4882a593Smuzhiyun 	/*fill original wifi time slot*/
3306*4882a593Smuzhiyun 	for (midx = 0; midx < en_info->mrole_num; midx++) {
3307*4882a593Smuzhiyun 		if (!(en_info->mrole_map & BIT(midx)))
3308*4882a593Smuzhiyun 			continue;
3309*4882a593Smuzhiyun 		mrole = &en_info->mcc_role[midx];
3310*4882a593Smuzhiyun 		_mcc_fill_mcc_role_policy_info(phl, mrole->wrole, mrole);
3311*4882a593Smuzhiyun 		if (mrole->chandef->band == BAND_ON_24G)
3312*4882a593Smuzhiyun 			exist_2g = true;
3313*4882a593Smuzhiyun 	}
3314*4882a593Smuzhiyun 	if (false == exist_2g) {
3315*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_SUCCESS;
3316*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "rtw_phl_mcc_bt_duration_change(): All 5G, Don't care BT duration\n");
3317*4882a593Smuzhiyun 		goto exit;
3318*4882a593Smuzhiyun 	}
3319*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_duration_change(phl, minfo,
3320*4882a593Smuzhiyun 								&new_minfo)) {
3321*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_bt_duration_change(): Change fail\n");
3322*4882a593Smuzhiyun 		goto exit;
3323*4882a593Smuzhiyun 	}
3324*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_bt_duration_change(): Change success\n");
3325*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3326*4882a593Smuzhiyun 	_mcc_dump_mcc_info(&new_minfo);
3327*4882a593Smuzhiyun exit:
3328*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< rtw_phl_mcc_bt_duration_change(): status(%d)\n",
3329*4882a593Smuzhiyun 		status);
3330*4882a593Smuzhiyun 	return status;
3331*4882a593Smuzhiyun }
3332*4882a593Smuzhiyun 
rtw_phl_mcc_dur_lim_change(struct phl_info_t * phl,struct rtw_wifi_role_t * wrole,struct phl_mcc_dur_lim_req_info * lim_req)3333*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_dur_lim_change(struct phl_info_t *phl,
3334*4882a593Smuzhiyun 				struct rtw_wifi_role_t *wrole,
3335*4882a593Smuzhiyun 				struct phl_mcc_dur_lim_req_info *lim_req)
3336*4882a593Smuzhiyun {
3337*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3338*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3339*4882a593Smuzhiyun 	struct phl_mcc_info new_minfo = {0};
3340*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3341*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *spec_mrole = NULL;
3342*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *mrole = NULL;
3343*4882a593Smuzhiyun 	u8 midx = 0;
3344*4882a593Smuzhiyun 
3345*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_dur_lim_change()\n");
3346*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "_mcc_fill_dur_lim_info(): dur_req: tag(%d), enable(%d), start_t_h(0x%08x), start_t_l(0x%08x), dur(%d), intvl(%d)\n",
3347*4882a593Smuzhiyun 		lim_req->tag, lim_req->enable, lim_req->start_t_h,
3348*4882a593Smuzhiyun 		lim_req->start_t_l, lim_req->dur, lim_req->intvl);
3349*4882a593Smuzhiyun 
3350*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3351*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_dur_lim_change(): mcc is not init, please check code\n");
3352*4882a593Smuzhiyun 		goto exit;
3353*4882a593Smuzhiyun 	}
3354*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, wrole->hw_band);
3355*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state) {
3356*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_dur_lim_change(): MCC_RUNING != minfo->state, , please check code flow\n");
3357*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3358*4882a593Smuzhiyun 		goto exit;
3359*4882a593Smuzhiyun 	}
3360*4882a593Smuzhiyun 	_os_mem_cpy(phl_to_drvpriv(phl), &new_minfo, minfo,
3361*4882a593Smuzhiyun 			sizeof(struct phl_mcc_info));
3362*4882a593Smuzhiyun 	spec_mrole = _mcc_get_mrole_by_wrole(&new_minfo, wrole);
3363*4882a593Smuzhiyun 	if (NULL == spec_mrole) {
3364*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_dur_lim_change(): Can't get mrole by wrole(%d), please check code flow\n",
3365*4882a593Smuzhiyun 			wrole->id);
3366*4882a593Smuzhiyun 		goto exit;
3367*4882a593Smuzhiyun 	}
3368*4882a593Smuzhiyun 	en_info = &new_minfo.en_info;
3369*4882a593Smuzhiyun 	/*fill original bt slot*/
3370*4882a593Smuzhiyun 	_mcc_reset_minfo(phl, &new_minfo, MINFO_RESET_BT_INFO |
3371*4882a593Smuzhiyun 						MINFO_RESET_PATTERN_INFO);
3372*4882a593Smuzhiyun 	_mcc_fill_bt_dur(phl, &new_minfo);
3373*4882a593Smuzhiyun 	/*fill original wifi time slot*/
3374*4882a593Smuzhiyun 	for (midx = 0; midx < en_info->mrole_num; midx++) {
3375*4882a593Smuzhiyun 		if (!(en_info->mrole_map & BIT(midx)))
3376*4882a593Smuzhiyun 			continue;
3377*4882a593Smuzhiyun 		mrole = &en_info->mcc_role[midx];
3378*4882a593Smuzhiyun 		_mcc_fill_mcc_role_policy_info(phl, mrole->wrole, mrole);
3379*4882a593Smuzhiyun 	}
3380*4882a593Smuzhiyun 	_mcc_fill_dur_lim_info(phl, spec_mrole, lim_req);
3381*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_duration_change(phl, minfo,
3382*4882a593Smuzhiyun 								&new_minfo)) {
3383*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_dur_lim_change(): Change fail\n");
3384*4882a593Smuzhiyun 		goto exit;
3385*4882a593Smuzhiyun 	}
3386*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_dur_lim_change(): Change success\n");
3387*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3388*4882a593Smuzhiyun exit:
3389*4882a593Smuzhiyun 	return status;
3390*4882a593Smuzhiyun }
3391*4882a593Smuzhiyun 
rtw_phl_mcc_sta_entry_change(struct phl_info_t * phl,struct rtw_wifi_role_t * wrole)3392*4882a593Smuzhiyun void rtw_phl_mcc_sta_entry_change(struct phl_info_t *phl,
3393*4882a593Smuzhiyun 					struct rtw_wifi_role_t *wrole)
3394*4882a593Smuzhiyun {
3395*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3396*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *mrole = NULL;
3397*4882a593Smuzhiyun 
3398*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3399*4882a593Smuzhiyun 		goto exit;
3400*4882a593Smuzhiyun 	}
3401*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, wrole->hw_band);
3402*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state) {
3403*4882a593Smuzhiyun 		goto exit;
3404*4882a593Smuzhiyun 	}
3405*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, ">>> rtw_phl_mcc_sta_entry_change\n");
3406*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, wrole->hw_band);
3407*4882a593Smuzhiyun 	if (NULL == (mrole = _mcc_get_mrole_by_wrole(minfo, wrole))) {
3408*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_sta_entry_change(): Can't get mrole, wrole id(%d), please check code flow\n",
3409*4882a593Smuzhiyun 			wrole->id);
3410*4882a593Smuzhiyun 		goto exit;
3411*4882a593Smuzhiyun 	}
3412*4882a593Smuzhiyun 	_mcc_fill_macid_bitmap_by_role(phl, mrole);
3413*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_update_macid_bitmap(
3414*4882a593Smuzhiyun 					phl->hal, mrole->group,
3415*4882a593Smuzhiyun 					mrole->macid, &mrole->used_macid)) {
3416*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_sta_entry_change(): Update macid map fail\n");
3417*4882a593Smuzhiyun 		goto exit;
3418*4882a593Smuzhiyun 	}
3419*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_notify_mcc_macid(phl->hal,
3420*4882a593Smuzhiyun 	                                                       mrole,
3421*4882a593Smuzhiyun 	                                                       minfo->mcc_mode)) {
3422*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_sta_entry_change(): Notify macid map fail\n");
3423*4882a593Smuzhiyun 	}
3424*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_sta_entry_change(): Update macid map ok\n");
3425*4882a593Smuzhiyun 	_mcc_dump_mcc_info(minfo);
3426*4882a593Smuzhiyun exit:
3427*4882a593Smuzhiyun 	return;
3428*4882a593Smuzhiyun }
3429*4882a593Smuzhiyun 
phl_mcc_client_link_notify_for_ap(struct phl_info_t * phl,struct rtw_wifi_role_t * wrole,enum role_state state)3430*4882a593Smuzhiyun void phl_mcc_client_link_notify_for_ap(struct phl_info_t *phl,
3431*4882a593Smuzhiyun 			struct rtw_wifi_role_t *wrole, enum role_state state)
3432*4882a593Smuzhiyun {
3433*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3434*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *mrole = NULL;
3435*4882a593Smuzhiyun 
3436*4882a593Smuzhiyun 	if (state != PHL_ROLE_MSTS_STA_CONN_START &&
3437*4882a593Smuzhiyun 		state != PHL_ROLE_MSTS_STA_DIS_CONN)
3438*4882a593Smuzhiyun 		goto exit;
3439*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3440*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "%s(): mcc is not init, please check code\n",
3441*4882a593Smuzhiyun 			__func__);
3442*4882a593Smuzhiyun 		goto exit;
3443*4882a593Smuzhiyun 	}
3444*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, wrole->hw_band);
3445*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state) {
3446*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "%s(): MCC_RUNING != minfo->state\n",
3447*4882a593Smuzhiyun 			__func__);
3448*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3449*4882a593Smuzhiyun 		goto exit;
3450*4882a593Smuzhiyun 	}
3451*4882a593Smuzhiyun 	if (NULL == (mrole = _mcc_get_mrole_by_wrole(minfo, wrole))) {
3452*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "%s(): Can't get mrole, wrole id(%d), please check code flow\n",
3453*4882a593Smuzhiyun 			__func__, wrole->id);
3454*4882a593Smuzhiyun 		goto exit;
3455*4882a593Smuzhiyun 	}
3456*4882a593Smuzhiyun 	_mcc_fill_macid_bitmap_by_role(phl, mrole);
3457*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_mcc_update_macid_bitmap(
3458*4882a593Smuzhiyun 					phl->hal, mrole->group,
3459*4882a593Smuzhiyun 					mrole->macid, &mrole->used_macid)) {
3460*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "%s(): Update macid map fail\n",
3461*4882a593Smuzhiyun 			__func__);
3462*4882a593Smuzhiyun 		goto exit;
3463*4882a593Smuzhiyun 	}
3464*4882a593Smuzhiyun 	if (RTW_HAL_STATUS_SUCCESS != rtw_hal_notify_mcc_macid(phl->hal,
3465*4882a593Smuzhiyun 	                                                       mrole,
3466*4882a593Smuzhiyun 	                                                       minfo->mcc_mode)) {
3467*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_client_link_notify_for_ap(): Notify macid map fail\n");
3468*4882a593Smuzhiyun 	}
3469*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "%s(): Update macid map ok\n",
3470*4882a593Smuzhiyun 		__func__);
3471*4882a593Smuzhiyun 	_mcc_dump_mcc_info(minfo);
3472*4882a593Smuzhiyun exit:
3473*4882a593Smuzhiyun 	return;
3474*4882a593Smuzhiyun }
3475*4882a593Smuzhiyun 
rtw_phl_mcc_inprogress(struct phl_info_t * phl,u8 band_idx)3476*4882a593Smuzhiyun bool rtw_phl_mcc_inprogress(struct phl_info_t *phl, u8 band_idx)
3477*4882a593Smuzhiyun {
3478*4882a593Smuzhiyun 	bool ret = false;
3479*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3480*4882a593Smuzhiyun 
3481*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3482*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_inprogress(): mcc is not init, please check code\n");
3483*4882a593Smuzhiyun 		goto exit;
3484*4882a593Smuzhiyun 	}
3485*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, band_idx);
3486*4882a593Smuzhiyun 	if (MCC_TRIGGER_FW_EN == minfo->state || MCC_RUNING == minfo->state ||
3487*4882a593Smuzhiyun 		MCC_TRIGGER_FW_DIS == minfo->state ||
3488*4882a593Smuzhiyun 		MCC_FW_DIS_FAIL == minfo->state) {
3489*4882a593Smuzhiyun 		ret = true;
3490*4882a593Smuzhiyun 	}
3491*4882a593Smuzhiyun exit:
3492*4882a593Smuzhiyun 	return ret;
3493*4882a593Smuzhiyun }
3494*4882a593Smuzhiyun 
_is_mcc_sts_err(struct phl_info_t * phl,u8 band_idx)3495*4882a593Smuzhiyun static bool _is_mcc_sts_err(struct phl_info_t *phl, u8 band_idx)
3496*4882a593Smuzhiyun {
3497*4882a593Smuzhiyun 	bool ret = false;
3498*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3499*4882a593Smuzhiyun 
3500*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3501*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_,
3502*4882a593Smuzhiyun 			"%s(): mcc is not init, please check code\n",
3503*4882a593Smuzhiyun 			__func__);
3504*4882a593Smuzhiyun 		goto exit;
3505*4882a593Smuzhiyun 	}
3506*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, band_idx);
3507*4882a593Smuzhiyun 	if (MCC_FW_DIS_FAIL == minfo->state ||
3508*4882a593Smuzhiyun 		MCC_FW_EN_FAIL == minfo->state) {
3509*4882a593Smuzhiyun 		ret = true;
3510*4882a593Smuzhiyun 	}
3511*4882a593Smuzhiyun exit:
3512*4882a593Smuzhiyun 	return ret;
3513*4882a593Smuzhiyun }
3514*4882a593Smuzhiyun 
rtw_phl_mcc_reset(struct phl_info_t * phl,u8 band_idx)3515*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_reset(struct phl_info_t *phl,
3516*4882a593Smuzhiyun 					u8 band_idx)
3517*4882a593Smuzhiyun {
3518*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3519*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3520*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3521*4882a593Smuzhiyun 
3522*4882a593Smuzhiyun 	FUNCIN();
3523*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3524*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_,
3525*4882a593Smuzhiyun 			"%s(): mcc is not init, please check code\n",
3526*4882a593Smuzhiyun 			__func__);
3527*4882a593Smuzhiyun 		goto exit;
3528*4882a593Smuzhiyun 	}
3529*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, band_idx);
3530*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3531*4882a593Smuzhiyun 
3532*4882a593Smuzhiyun 	/* Reset mcc */
3533*4882a593Smuzhiyun 	rtw_hal_mcc_reset(phl->hal, en_info->group, minfo->mcc_mode);
3534*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_,
3535*4882a593Smuzhiyun 		"%s(): reset mcc group(%d) complete\n",
3536*4882a593Smuzhiyun 		__func__, en_info->group);
3537*4882a593Smuzhiyun 	/* Reset state */
3538*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_NONE);
3539*4882a593Smuzhiyun 
3540*4882a593Smuzhiyun 	if (minfo->mcc_mode == RTW_PHL_TDMRA_AP_CLIENT_WMODE ||
3541*4882a593Smuzhiyun 		minfo->mcc_mode == RTW_PHL_TDMRA_AP_WMODE)
3542*4882a593Smuzhiyun 		_mcc_clean_noa(phl, en_info);
3543*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3544*4882a593Smuzhiyun exit:
3545*4882a593Smuzhiyun 	return status;
3546*4882a593Smuzhiyun }
3547*4882a593Smuzhiyun 
rtw_phl_mcc_recovery(struct phl_info_t * phl,u8 band_idx)3548*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_recovery(struct phl_info_t *phl,
3549*4882a593Smuzhiyun 					u8 band_idx)
3550*4882a593Smuzhiyun {
3551*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_SUCCESS;
3552*4882a593Smuzhiyun 
3553*4882a593Smuzhiyun 	if (_is_mcc_sts_err(phl, band_idx)) {
3554*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_,
3555*4882a593Smuzhiyun 			"%s: err status detected, try to reset mcc.\n",
3556*4882a593Smuzhiyun 			__func__);
3557*4882a593Smuzhiyun 		rtw_phl_mcc_reset(phl, band_idx);
3558*4882a593Smuzhiyun 	}
3559*4882a593Smuzhiyun 
3560*4882a593Smuzhiyun 	return status;
3561*4882a593Smuzhiyun }
3562*4882a593Smuzhiyun 
3563*4882a593Smuzhiyun /* Enable Fw MCC
3564*4882a593Smuzhiyun  * @cur_role: the role in the current ch.
3565*4882a593Smuzhiyun  */
rtw_phl_mcc_enable(struct phl_info_t * phl,struct rtw_wifi_role_t * cur_role)3566*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_enable(struct phl_info_t *phl,
3567*4882a593Smuzhiyun 					struct rtw_wifi_role_t *cur_role)
3568*4882a593Smuzhiyun {
3569*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3570*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3571*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3572*4882a593Smuzhiyun 	struct hw_band_ctl_t *band_ctrl = get_band_ctrl(phl, cur_role->hw_band);
3573*4882a593Smuzhiyun 	u8 role_map = 0;
3574*4882a593Smuzhiyun 
3575*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_enable(): cur_role->type(%d)\n",
3576*4882a593Smuzhiyun 		cur_role->type);
3577*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3578*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): mcc is not init, please check code\n");
3579*4882a593Smuzhiyun 		goto exit;
3580*4882a593Smuzhiyun 	}
3581*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, cur_role->hw_band);
3582*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3583*4882a593Smuzhiyun 	if (MCC_NONE != minfo->state && MCC_STOP != minfo->state) {
3584*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): (MCC_NONE != minfo->state || MCC_STOP != minfo->state(%d)), please check code flow\n",
3585*4882a593Smuzhiyun 			minfo->state);
3586*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3587*4882a593Smuzhiyun 		goto exit;
3588*4882a593Smuzhiyun 	}
3589*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_CFG_EN_INFO);
3590*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_get_role_map(phl, band_ctrl,
3591*4882a593Smuzhiyun 							&role_map)) {
3592*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): Get role map failed\n");
3593*4882a593Smuzhiyun 		goto _cfg_info_fail;
3594*4882a593Smuzhiyun 	}
3595*4882a593Smuzhiyun 	_mcc_reset_minfo(phl, minfo, (MINFO_RESET_EN_INFO | MINFO_RESET_MODE |
3596*4882a593Smuzhiyun 				MINFO_RESET_ROLE_MAP | MINFO_RESET_COEX_MODE |
3597*4882a593Smuzhiyun 				MINFO_RESET_BT_INFO));
3598*4882a593Smuzhiyun 	minfo->role_map = role_map;
3599*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_transfer_mode(phl, minfo,
3600*4882a593Smuzhiyun 							role_map)) {
3601*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): transfer mcc mode failed\n");
3602*4882a593Smuzhiyun 		goto _cfg_info_fail;
3603*4882a593Smuzhiyun 	}
3604*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_fill_role_info(phl, en_info,
3605*4882a593Smuzhiyun 							role_map, cur_role)) {
3606*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): fill role info failed\n");
3607*4882a593Smuzhiyun 		goto _cfg_info_fail;
3608*4882a593Smuzhiyun 	}
3609*4882a593Smuzhiyun 	_mcc_fill_coex_mode(phl, minfo);
3610*4882a593Smuzhiyun 	_mcc_fill_bt_dur(phl, minfo);
3611*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_get_mrole_idx_by_wrole(minfo,
3612*4882a593Smuzhiyun 					cur_role, &en_info->ref_role_idx)) {
3613*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): fill ref_role idx failed\n");
3614*4882a593Smuzhiyun 		goto _cfg_info_fail;
3615*4882a593Smuzhiyun 	}
3616*4882a593Smuzhiyun 	if (minfo->mcc_mode == RTW_PHL_TDMRA_AP_CLIENT_WMODE) {
3617*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS !=
3618*4882a593Smuzhiyun 			_mcc_fill_info_for_ap_client_mode(phl, minfo)) {
3619*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): fill info failed for ap_client mode\n");
3620*4882a593Smuzhiyun 			goto _cfg_info_fail;
3621*4882a593Smuzhiyun 		}
3622*4882a593Smuzhiyun 	} else if (minfo->mcc_mode == RTW_PHL_TDMRA_2CLIENTS_WMODE){
3623*4882a593Smuzhiyun 		if (RTW_PHL_STATUS_SUCCESS !=
3624*4882a593Smuzhiyun 			_mcc_fill_info_for_2_clients_mode(phl, minfo)) {
3625*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): fill info failed for 2clients mode\n");
3626*4882a593Smuzhiyun 			goto _cfg_info_fail;
3627*4882a593Smuzhiyun 		}
3628*4882a593Smuzhiyun 	} else {
3629*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): Undefined mcc_mode(%d)\n",
3630*4882a593Smuzhiyun 			minfo->mcc_mode);
3631*4882a593Smuzhiyun 		goto _cfg_info_fail;
3632*4882a593Smuzhiyun 	}
3633*4882a593Smuzhiyun 	_mcc_dump_mcc_info(minfo);
3634*4882a593Smuzhiyun 	if (RTW_PHL_STATUS_SUCCESS != _mcc_pkt_offload(phl, en_info)) {
3635*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): pkt offload Fail\n");
3636*4882a593Smuzhiyun 		goto _cfg_info_fail;
3637*4882a593Smuzhiyun 	}
3638*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_TRIGGER_FW_EN);
3639*4882a593Smuzhiyun 	if (rtw_hal_mcc_enable(phl->hal, en_info, &minfo->bt_info,
3640*4882a593Smuzhiyun 				minfo->mcc_mode) != RTW_HAL_STATUS_SUCCESS) {
3641*4882a593Smuzhiyun 		_mcc_set_state(minfo, MCC_FW_EN_FAIL);
3642*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_enable(): Enable FW mcc Fail\n");
3643*4882a593Smuzhiyun 		goto exit;
3644*4882a593Smuzhiyun 	}
3645*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_RUNING);
3646*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ALWAYS_, "rtw_phl_mcc_enable(): Enable FW mcc ok\n");
3647*4882a593Smuzhiyun 	if (minfo->mcc_mode == RTW_PHL_TDMRA_AP_CLIENT_WMODE)
3648*4882a593Smuzhiyun 		_mcc_up_noa(phl, minfo);
3649*4882a593Smuzhiyun 	_mcc_dump_mcc_info(minfo);
3650*4882a593Smuzhiyun 	_mcc_up_fw_log_setting(phl, minfo);
3651*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3652*4882a593Smuzhiyun 	goto exit;
3653*4882a593Smuzhiyun _cfg_info_fail:
3654*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_NONE);
3655*4882a593Smuzhiyun exit:
3656*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "<<< rtw_phl_mcc_enable():status(%d)\n",
3657*4882a593Smuzhiyun 		status);
3658*4882a593Smuzhiyun 	return status;
3659*4882a593Smuzhiyun }
3660*4882a593Smuzhiyun 
3661*4882a593Smuzhiyun /*
3662*4882a593Smuzhiyun  * Stop fw mcc
3663*4882a593Smuzhiyun  * @ spec_role: You want to fw switch ch to the specific ch of the role when fw stop mcc
3664*4882a593Smuzhiyun  */
rtw_phl_mcc_disable(struct phl_info_t * phl,struct rtw_wifi_role_t * spec_role)3665*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_disable(struct phl_info_t *phl,
3666*4882a593Smuzhiyun 					struct rtw_wifi_role_t *spec_role)
3667*4882a593Smuzhiyun {
3668*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3669*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3670*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3671*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
3672*4882a593Smuzhiyun 
3673*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_disable()\n");
3674*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3675*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_disable(): mcc is not init, please check code\n");
3676*4882a593Smuzhiyun 		goto exit;
3677*4882a593Smuzhiyun 	}
3678*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, spec_role->hw_band);
3679*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3680*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state) {
3681*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_disable(): MCC_RUNING != m_info->state, please check code flow\n");
3682*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3683*4882a593Smuzhiyun 		goto exit;
3684*4882a593Smuzhiyun 	}
3685*4882a593Smuzhiyun 	if (NULL == (m_role = _mcc_get_mrole_by_wrole(minfo, spec_role))) {
3686*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_disable(): Can't get mrole, wrole id(%d), please check code flow\n",
3687*4882a593Smuzhiyun 			spec_role->id);
3688*4882a593Smuzhiyun 		goto exit;
3689*4882a593Smuzhiyun 	}
3690*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_TRIGGER_FW_DIS);
3691*4882a593Smuzhiyun 	if (rtw_hal_mcc_disable(phl->hal, m_role->group, m_role->macid,
3692*4882a593Smuzhiyun 				minfo->mcc_mode) != RTW_HAL_STATUS_SUCCESS) {
3693*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
3694*4882a593Smuzhiyun 		_mcc_set_state(minfo, MCC_FW_DIS_FAIL);
3695*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_,"rtw_phl_mcc_disable(): Disable FW mcc Fail\n");
3696*4882a593Smuzhiyun 		goto exit;
3697*4882a593Smuzhiyun 	}
3698*4882a593Smuzhiyun 	rtw_hal_sync_cur_ch(phl->hal, spec_role->hw_band, spec_role->chandef);
3699*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_STOP);
3700*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_disable(): Disable FW mcc ok\n");
3701*4882a593Smuzhiyun 	if (minfo->mcc_mode == RTW_PHL_TDMRA_AP_CLIENT_WMODE)
3702*4882a593Smuzhiyun 		_mcc_clean_noa(phl, en_info);
3703*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3704*4882a593Smuzhiyun exit:
3705*4882a593Smuzhiyun 	return status;
3706*4882a593Smuzhiyun }
3707*4882a593Smuzhiyun 
3708*4882a593Smuzhiyun 
rtw_phl_tdmra_duration_change(struct phl_info_t * phl,struct phl_tdmra_dur_change_info * info)3709*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_tdmra_duration_change(struct phl_info_t *phl,
3710*4882a593Smuzhiyun 			struct phl_tdmra_dur_change_info *info)
3711*4882a593Smuzhiyun {
3712*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3713*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3714*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3715*4882a593Smuzhiyun 
3716*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_tdmra_duration_change()\n");
3717*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3718*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_duration_change(): mcc is not init, please check code\n");
3719*4882a593Smuzhiyun 		goto exit;
3720*4882a593Smuzhiyun 	}
3721*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, info->hw_band);
3722*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3723*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state) {
3724*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_duration_change(): MCC_RUNING != m_info->state, please check code flow\n");
3725*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3726*4882a593Smuzhiyun 		goto exit;
3727*4882a593Smuzhiyun 	}
3728*4882a593Smuzhiyun 	if (true == info->bt_role) {
3729*4882a593Smuzhiyun 		status = rtw_phl_mcc_bt_duration_change(phl, info);
3730*4882a593Smuzhiyun 	} else {
3731*4882a593Smuzhiyun 		status = rtw_phl_mcc_duration_change(phl, info);
3732*4882a593Smuzhiyun 	}
3733*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< rtw_phl_tdmra_duration_change(): status(%d)\n",
3734*4882a593Smuzhiyun 		status);
3735*4882a593Smuzhiyun exit:
3736*4882a593Smuzhiyun 	return status;
3737*4882a593Smuzhiyun }
3738*4882a593Smuzhiyun 
rtw_phl_tdmra_enable(struct phl_info_t * phl,struct rtw_wifi_role_t * cur_role)3739*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_tdmra_enable(struct phl_info_t *phl,
3740*4882a593Smuzhiyun 				struct rtw_wifi_role_t *cur_role)
3741*4882a593Smuzhiyun {
3742*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3743*4882a593Smuzhiyun 	struct hw_band_ctl_t *band_ctrl = get_band_ctrl(phl, cur_role->hw_band);
3744*4882a593Smuzhiyun 	struct mr_info *cur_info = &band_ctrl->cur_info;
3745*4882a593Smuzhiyun 	u8 chanctx_num = 0;
3746*4882a593Smuzhiyun 
3747*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_tdmra_enable\n");
3748*4882a593Smuzhiyun 	chanctx_num = (u8)phl_mr_get_chanctx_num(phl, band_ctrl);
3749*4882a593Smuzhiyun 	if (2 == chanctx_num) {
3750*4882a593Smuzhiyun 		status = rtw_phl_mcc_enable(phl, cur_role);
3751*4882a593Smuzhiyun 	} else if (1 == chanctx_num) {
3752*4882a593Smuzhiyun 		if ((1 == cur_info->ap_num || 1 == cur_info->p2p_go_num) &&
3753*4882a593Smuzhiyun 		   (cur_info->ld_sta_num == 0 || cur_info->lg_sta_num == 0)) {
3754*4882a593Smuzhiyun 			status = rtw_phl_mcc_ap_bt_coex_enable(phl, cur_role);
3755*4882a593Smuzhiyun 		} else {
3756*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_enable(): Not support this type\n");
3757*4882a593Smuzhiyun 			PHL_DUMP_MR_EX(phl);
3758*4882a593Smuzhiyun 		}
3759*4882a593Smuzhiyun 	} else {
3760*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_enable(): Not support for chanctx_num(%d)\n",
3761*4882a593Smuzhiyun 			chanctx_num);
3762*4882a593Smuzhiyun 	}
3763*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< rtw_phl_tdmra_enable(): status(%d)\n",
3764*4882a593Smuzhiyun 		status);
3765*4882a593Smuzhiyun 	return status;
3766*4882a593Smuzhiyun }
3767*4882a593Smuzhiyun 
3768*4882a593Smuzhiyun /*
3769*4882a593Smuzhiyun  * Stop tdmra
3770*4882a593Smuzhiyun  * @ spec_role: You want to fw switch ch to the specific ch of the role when fw stop tdma
3771*4882a593Smuzhiyun  */
rtw_phl_tdmra_disable(struct phl_info_t * phl,struct rtw_wifi_role_t * spec_role)3772*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_tdmra_disable(struct phl_info_t *phl,
3773*4882a593Smuzhiyun 				struct rtw_wifi_role_t *spec_role)
3774*4882a593Smuzhiyun {
3775*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3776*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3777*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3778*4882a593Smuzhiyun 	struct rtw_phl_mcc_role *m_role = NULL;
3779*4882a593Smuzhiyun 
3780*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_tdmra_disable()\n");
3781*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3782*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_disable(): mcc is not init, please check code\n");
3783*4882a593Smuzhiyun 		goto exit;
3784*4882a593Smuzhiyun 	}
3785*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, spec_role->hw_band);
3786*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3787*4882a593Smuzhiyun 	if (MCC_RUNING != minfo->state) {
3788*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_disable(): MCC_RUNING != m_info->state, please check code flow\n");
3789*4882a593Smuzhiyun 		_mcc_dump_state(&minfo->state);
3790*4882a593Smuzhiyun 		goto exit;
3791*4882a593Smuzhiyun 	}
3792*4882a593Smuzhiyun 	if (NULL == (m_role = _mcc_get_mrole_by_wrole(minfo, spec_role))) {
3793*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_disable(): Can't get mrole, wrole id(%d), please check code flow\n",
3794*4882a593Smuzhiyun 			spec_role->id);
3795*4882a593Smuzhiyun 		#ifdef RTW_WKARD_TDMRA_AUTO_GET_STAY_ROLE
3796*4882a593Smuzhiyun 		m_role = get_ref_role(en_info);
3797*4882a593Smuzhiyun 		if (m_role == NULL) {
3798*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "%s(): Can't get mrole from ref_mrole, please check code flow\n",
3799*4882a593Smuzhiyun 				__func__);
3800*4882a593Smuzhiyun 			goto exit;
3801*4882a593Smuzhiyun 		} else {
3802*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "%s(): Workaround get mrore from ref_mrole\n",
3803*4882a593Smuzhiyun 				__func__);
3804*4882a593Smuzhiyun 		}
3805*4882a593Smuzhiyun 		#else
3806*4882a593Smuzhiyun 		goto exit;
3807*4882a593Smuzhiyun 		#endif /* RTW_WKARD_TDMRA_AUTO_GET_STAY_ROLE */
3808*4882a593Smuzhiyun 	}
3809*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_TRIGGER_FW_DIS);
3810*4882a593Smuzhiyun 	if (rtw_hal_mcc_disable(phl->hal, m_role->group, m_role->macid,
3811*4882a593Smuzhiyun 				minfo->mcc_mode) != RTW_HAL_STATUS_SUCCESS) {
3812*4882a593Smuzhiyun 		status = RTW_PHL_STATUS_FAILURE;
3813*4882a593Smuzhiyun 		_mcc_set_state(minfo, MCC_FW_DIS_FAIL);
3814*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_,"rtw_phl_tdmra_disable(): Disable FW mcc Fail\n");
3815*4882a593Smuzhiyun 		goto exit;
3816*4882a593Smuzhiyun 	}
3817*4882a593Smuzhiyun 	rtw_hal_sync_cur_ch(phl->hal, m_role->wrole->hw_band, *m_role->chandef);
3818*4882a593Smuzhiyun 	_mcc_set_state(minfo, MCC_STOP);
3819*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_tdmra_disable(): Disable FW mcc ok\n");
3820*4882a593Smuzhiyun 	if (minfo->mcc_mode == RTW_PHL_TDMRA_AP_CLIENT_WMODE ||
3821*4882a593Smuzhiyun 		minfo->mcc_mode == RTW_PHL_TDMRA_AP_WMODE)
3822*4882a593Smuzhiyun 		_mcc_clean_noa(phl, en_info);
3823*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3824*4882a593Smuzhiyun exit:
3825*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "<<< rtw_phl_tdmra_disable(): status(%d)\n",
3826*4882a593Smuzhiyun 		status);
3827*4882a593Smuzhiyun 	return status;
3828*4882a593Smuzhiyun }
3829*4882a593Smuzhiyun 
rtw_phl_mcc_init_ops(struct phl_info_t * phl,struct rtw_phl_mcc_ops * ops)3830*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_init_ops(struct phl_info_t *phl, struct rtw_phl_mcc_ops *ops)
3831*4882a593Smuzhiyun {
3832*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3833*4882a593Smuzhiyun 	struct phl_com_mcc_info *com_info = NULL;
3834*4882a593Smuzhiyun 
3835*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3836*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_init_ops(): mcc is not init, please check code\n");
3837*4882a593Smuzhiyun 		goto exit;
3838*4882a593Smuzhiyun 	}
3839*4882a593Smuzhiyun 	com_info = phl_to_com_mcc_info(phl);
3840*4882a593Smuzhiyun 	com_info->ops.priv = ops->priv;
3841*4882a593Smuzhiyun 	com_info->ops.mcc_update_noa = ops->mcc_update_noa;
3842*4882a593Smuzhiyun 	com_info->ops.mcc_get_setting = ops->mcc_get_setting;
3843*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "rtw_phl_mcc_init_ops(): init ok\n");
3844*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3845*4882a593Smuzhiyun exit:
3846*4882a593Smuzhiyun 	return status;
3847*4882a593Smuzhiyun }
3848*4882a593Smuzhiyun 
rtw_phl_mcc_init(struct phl_info_t * phl)3849*4882a593Smuzhiyun enum rtw_phl_status rtw_phl_mcc_init(struct phl_info_t *phl)
3850*4882a593Smuzhiyun {
3851*4882a593Smuzhiyun 	enum rtw_phl_status status = RTW_PHL_STATUS_FAILURE;
3852*4882a593Smuzhiyun 	struct rtw_phl_com_t *phl_com = phl->phl_com;
3853*4882a593Smuzhiyun 	void *drv = phl_to_drvpriv(phl);
3854*4882a593Smuzhiyun 	struct mr_ctl_t *mr_ctl = phlcom_to_mr_ctrl(phl_com);
3855*4882a593Smuzhiyun 	struct hw_band_ctl_t *band_ctrl = NULL;
3856*4882a593Smuzhiyun 	u8 band_idx = 0;
3857*4882a593Smuzhiyun 
3858*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_init()\n");
3859*4882a593Smuzhiyun 	set_mcc_init_state(phl, false);
3860*4882a593Smuzhiyun 	if (mr_ctl->com_mcc == NULL) {
3861*4882a593Smuzhiyun 		mr_ctl->com_mcc = _os_mem_alloc(drv, sizeof(struct phl_com_mcc_info));
3862*4882a593Smuzhiyun 		if (mr_ctl->com_mcc != NULL) {
3863*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "rtw_phl_mcc_init(): Allocate phl_com_mcc_info\n");
3864*4882a593Smuzhiyun 		} else {
3865*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_init(): Allocate phl_com_mcc_info Fail\n");
3866*4882a593Smuzhiyun 			goto deinit;
3867*4882a593Smuzhiyun 		}
3868*4882a593Smuzhiyun 	}
3869*4882a593Smuzhiyun 	for (band_idx = 0; band_idx < MAX_BAND_NUM; band_idx++) {
3870*4882a593Smuzhiyun 		band_ctrl = &mr_ctl->band_ctrl[band_idx];
3871*4882a593Smuzhiyun 		if (band_ctrl->mcc_info == NULL) {
3872*4882a593Smuzhiyun 			band_ctrl->mcc_info = _os_mem_alloc(drv,
3873*4882a593Smuzhiyun 						sizeof(struct phl_mcc_info));
3874*4882a593Smuzhiyun 			if (band_ctrl->mcc_info != NULL) {
3875*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "rtw_phl_mcc_init(): Allocate mcc_info for HW Band(%d)\n",
3876*4882a593Smuzhiyun 					band_idx);
3877*4882a593Smuzhiyun 			} else {
3878*4882a593Smuzhiyun 				PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_init(): Allocate mcc_info fail for HW Band(%d)\n",
3879*4882a593Smuzhiyun 					band_idx);
3880*4882a593Smuzhiyun 				goto deinit;
3881*4882a593Smuzhiyun 			}
3882*4882a593Smuzhiyun 		}
3883*4882a593Smuzhiyun 	}
3884*4882a593Smuzhiyun 	set_mcc_init_state(phl, true);
3885*4882a593Smuzhiyun 	status = RTW_PHL_STATUS_SUCCESS;
3886*4882a593Smuzhiyun 	goto exit;
3887*4882a593Smuzhiyun deinit:
3888*4882a593Smuzhiyun 	rtw_phl_mcc_deinit(phl);
3889*4882a593Smuzhiyun exit:
3890*4882a593Smuzhiyun 	return status;
3891*4882a593Smuzhiyun }
3892*4882a593Smuzhiyun 
rtw_phl_mcc_deinit(struct phl_info_t * phl)3893*4882a593Smuzhiyun void rtw_phl_mcc_deinit(struct phl_info_t *phl)
3894*4882a593Smuzhiyun {
3895*4882a593Smuzhiyun 	struct rtw_phl_com_t *phl_com = phl->phl_com;
3896*4882a593Smuzhiyun 	void *drv = phl_to_drvpriv(phl);
3897*4882a593Smuzhiyun 	struct phl_com_mcc_info *com_info = phl_to_com_mcc_info(phl);
3898*4882a593Smuzhiyun 	struct mr_ctl_t *mr_ctl = phlcom_to_mr_ctrl(phl_com);
3899*4882a593Smuzhiyun 	struct hw_band_ctl_t *band_ctrl = NULL;
3900*4882a593Smuzhiyun 	u8 band_idx = 0;
3901*4882a593Smuzhiyun 
3902*4882a593Smuzhiyun 	PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, ">>> rtw_phl_mcc_deinit()\n");
3903*4882a593Smuzhiyun 	if (com_info != NULL) {
3904*4882a593Smuzhiyun 		_os_mem_free(drv, com_info, sizeof(struct phl_com_mcc_info));
3905*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "rtw_phl_mcc_deinit(): Free phl_com_mcc_info\n");
3906*4882a593Smuzhiyun 	}
3907*4882a593Smuzhiyun 	for (band_idx = 0; band_idx < MAX_BAND_NUM; band_idx++) {
3908*4882a593Smuzhiyun 		band_ctrl = &mr_ctl->band_ctrl[band_idx];
3909*4882a593Smuzhiyun 		if (band_ctrl->mcc_info != NULL) {
3910*4882a593Smuzhiyun 			_os_mem_free(drv, band_ctrl->mcc_info,
3911*4882a593Smuzhiyun 						sizeof(struct phl_mcc_info));
3912*4882a593Smuzhiyun 			PHL_TRACE(COMP_PHL_MCC, _PHL_INFO_, "rtw_phl_mcc_deinit(): Free phl_mcc_info, HwBand(%d)\n",
3913*4882a593Smuzhiyun 				band_idx);
3914*4882a593Smuzhiyun 		}
3915*4882a593Smuzhiyun 	}
3916*4882a593Smuzhiyun 	set_mcc_init_state(phl, false);
3917*4882a593Smuzhiyun }
3918*4882a593Smuzhiyun 
rtw_phl_mcc_get_dbg_info(struct phl_info_t * phl,u8 band_idx,enum rtw_phl_mcc_dbg_type type,void * info)3919*4882a593Smuzhiyun bool rtw_phl_mcc_get_dbg_info(struct phl_info_t *phl, u8 band_idx,
3920*4882a593Smuzhiyun 				enum rtw_phl_mcc_dbg_type type, void *info)
3921*4882a593Smuzhiyun {
3922*4882a593Smuzhiyun 	bool get_ok = false;
3923*4882a593Smuzhiyun 	struct phl_mcc_info *minfo = NULL;
3924*4882a593Smuzhiyun 	struct rtw_phl_mcc_en_info *en_info = NULL;
3925*4882a593Smuzhiyun 
3926*4882a593Smuzhiyun 	if (!is_mcc_init(phl)) {
3927*4882a593Smuzhiyun 		PHL_TRACE(COMP_PHL_MCC, _PHL_ERR_, "rtw_phl_mcc_get_dbg_info(): mcc is not init, please check code\n");
3928*4882a593Smuzhiyun 		goto exit;
3929*4882a593Smuzhiyun 	}
3930*4882a593Smuzhiyun 	minfo = get_mcc_info(phl, band_idx);
3931*4882a593Smuzhiyun 	en_info = &minfo->en_info;
3932*4882a593Smuzhiyun 
3933*4882a593Smuzhiyun 	if (MCC_DBG_STATE == type) {
3934*4882a593Smuzhiyun 		*(enum rtw_phl_mcc_state *)info = minfo->state;
3935*4882a593Smuzhiyun 	} else if (MCC_DBG_OP_MODE == type) {
3936*4882a593Smuzhiyun 		*(enum rtw_phl_tdmra_wmode *)info = minfo->mcc_mode;
3937*4882a593Smuzhiyun 	} else if (MCC_DBG_COEX_MODE == type) {
3938*4882a593Smuzhiyun 		*(enum rtw_phl_mcc_coex_mode *)info = minfo->coex_mode;
3939*4882a593Smuzhiyun 	} else if (MCC_DBG_BT_INFO == type) {
3940*4882a593Smuzhiyun 		_os_mem_cpy(phl_to_drvpriv(phl), info, &minfo->bt_info,
3941*4882a593Smuzhiyun 				sizeof(struct rtw_phl_mcc_bt_info));
3942*4882a593Smuzhiyun 	} else if (MCC_DBG_EN_INFO == type) {
3943*4882a593Smuzhiyun 		_os_mem_cpy(phl_to_drvpriv(phl), info, en_info,
3944*4882a593Smuzhiyun 				sizeof(struct rtw_phl_mcc_en_info));
3945*4882a593Smuzhiyun 	} else {
3946*4882a593Smuzhiyun 		goto exit;
3947*4882a593Smuzhiyun 	}
3948*4882a593Smuzhiyun 	get_ok = true;
3949*4882a593Smuzhiyun 
3950*4882a593Smuzhiyun exit:
3951*4882a593Smuzhiyun 	return get_ok;
3952*4882a593Smuzhiyun }
3953*4882a593Smuzhiyun 
3954*4882a593Smuzhiyun 
3955*4882a593Smuzhiyun #endif /* CONFIG_MCC_SUPPORT */
3956