1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2009-2013  Realtek Corporation.*/
3 
4 #include "../wifi.h"
5 #include "reg.h"
6 #include "def.h"
7 #include "phy.h"
8 #include "rf.h"
9 #include "dm.h"
10 
11 static bool _rtl88e_phy_rf6052_config_parafile(struct ieee80211_hw *hw);
12 
rtl88e_phy_rf6052_set_bandwidth(struct ieee80211_hw * hw,u8 bandwidth)13 void rtl88e_phy_rf6052_set_bandwidth(struct ieee80211_hw *hw, u8 bandwidth)
14 {
15 	struct rtl_priv *rtlpriv = rtl_priv(hw);
16 	struct rtl_phy *rtlphy = &(rtlpriv->phy);
17 
18 	switch (bandwidth) {
19 	case HT_CHANNEL_WIDTH_20:
20 		rtlphy->rfreg_chnlval[0] = ((rtlphy->rfreg_chnlval[0] &
21 					     0xfffff3ff) | BIT(10) | BIT(11));
22 		rtl_set_rfreg(hw, RF90_PATH_A, RF_CHNLBW, RFREG_OFFSET_MASK,
23 			      rtlphy->rfreg_chnlval[0]);
24 		break;
25 	case HT_CHANNEL_WIDTH_20_40:
26 		rtlphy->rfreg_chnlval[0] = ((rtlphy->rfreg_chnlval[0] &
27 					     0xfffff3ff) | BIT(10));
28 		rtl_set_rfreg(hw, RF90_PATH_A, RF_CHNLBW, RFREG_OFFSET_MASK,
29 			      rtlphy->rfreg_chnlval[0]);
30 		break;
31 	default:
32 		pr_err("unknown bandwidth: %#X\n", bandwidth);
33 		break;
34 	}
35 }
36 
rtl88e_phy_rf6052_set_cck_txpower(struct ieee80211_hw * hw,u8 * ppowerlevel)37 void rtl88e_phy_rf6052_set_cck_txpower(struct ieee80211_hw *hw,
38 				       u8 *ppowerlevel)
39 {
40 	struct rtl_priv *rtlpriv = rtl_priv(hw);
41 	struct rtl_phy *rtlphy = &(rtlpriv->phy);
42 	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
43 	struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
44 	u32 tx_agc[2] = {0, 0}, tmpval;
45 	bool turbo_scanoff = false;
46 	u8 idx1, idx2;
47 	u8 *ptr;
48 	u8 direction;
49 	u32 pwrtrac_value;
50 
51 	if (rtlefuse->eeprom_regulatory != 0)
52 		turbo_scanoff = true;
53 
54 	if (mac->act_scanning) {
55 		tx_agc[RF90_PATH_A] = 0x3f3f3f3f;
56 		tx_agc[RF90_PATH_B] = 0x3f3f3f3f;
57 
58 		if (turbo_scanoff) {
59 			for (idx1 = RF90_PATH_A; idx1 <= RF90_PATH_B; idx1++) {
60 				tx_agc[idx1] = ppowerlevel[idx1] |
61 				    (ppowerlevel[idx1] << 8) |
62 				    (ppowerlevel[idx1] << 16) |
63 				    (ppowerlevel[idx1] << 24);
64 			}
65 		}
66 	} else {
67 		for (idx1 = RF90_PATH_A; idx1 <= RF90_PATH_B; idx1++) {
68 			tx_agc[idx1] = ppowerlevel[idx1] |
69 			    (ppowerlevel[idx1] << 8) |
70 			    (ppowerlevel[idx1] << 16) |
71 			    (ppowerlevel[idx1] << 24);
72 		}
73 
74 		if (rtlefuse->eeprom_regulatory == 0) {
75 			tmpval =
76 			    (rtlphy->mcs_txpwrlevel_origoffset[0][6]) +
77 			    (rtlphy->mcs_txpwrlevel_origoffset[0][7] <<
78 			     8);
79 			tx_agc[RF90_PATH_A] += tmpval;
80 
81 			tmpval = (rtlphy->mcs_txpwrlevel_origoffset[0][14]) +
82 			    (rtlphy->mcs_txpwrlevel_origoffset[0][15] <<
83 			     24);
84 			tx_agc[RF90_PATH_B] += tmpval;
85 		}
86 	}
87 
88 	for (idx1 = RF90_PATH_A; idx1 <= RF90_PATH_B; idx1++) {
89 		ptr = (u8 *)(&tx_agc[idx1]);
90 		for (idx2 = 0; idx2 < 4; idx2++) {
91 			if (*ptr > RF6052_MAX_TX_PWR)
92 				*ptr = RF6052_MAX_TX_PWR;
93 			ptr++;
94 		}
95 	}
96 	rtl88e_dm_txpower_track_adjust(hw, 1, &direction, &pwrtrac_value);
97 	if (direction == 1) {
98 		tx_agc[0] += pwrtrac_value;
99 		tx_agc[1] += pwrtrac_value;
100 	} else if (direction == 2) {
101 		tx_agc[0] -= pwrtrac_value;
102 		tx_agc[1] -= pwrtrac_value;
103 	}
104 	tmpval = tx_agc[RF90_PATH_A] & 0xff;
105 	rtl_set_bbreg(hw, RTXAGC_A_CCK1_MCS32, MASKBYTE1, tmpval);
106 
107 	RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
108 		"CCK PWR 1M (rf-A) = 0x%x (reg 0x%x)\n", tmpval,
109 		 RTXAGC_A_CCK1_MCS32);
110 
111 	tmpval = tx_agc[RF90_PATH_A] >> 8;
112 
113 	/*tmpval = tmpval & 0xff00ffff;*/
114 
115 	rtl_set_bbreg(hw, RTXAGC_B_CCK11_A_CCK2_11, 0xffffff00, tmpval);
116 
117 	RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
118 		"CCK PWR 2~11M (rf-A) = 0x%x (reg 0x%x)\n", tmpval,
119 		 RTXAGC_B_CCK11_A_CCK2_11);
120 
121 	tmpval = tx_agc[RF90_PATH_B] >> 24;
122 	rtl_set_bbreg(hw, RTXAGC_B_CCK11_A_CCK2_11, MASKBYTE0, tmpval);
123 
124 	RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
125 		"CCK PWR 11M (rf-B) = 0x%x (reg 0x%x)\n", tmpval,
126 		 RTXAGC_B_CCK11_A_CCK2_11);
127 
128 	tmpval = tx_agc[RF90_PATH_B] & 0x00ffffff;
129 	rtl_set_bbreg(hw, RTXAGC_B_CCK1_55_MCS32, 0xffffff00, tmpval);
130 
131 	RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
132 		"CCK PWR 1~5.5M (rf-B) = 0x%x (reg 0x%x)\n", tmpval,
133 		 RTXAGC_B_CCK1_55_MCS32);
134 }
135 
rtl88e_phy_get_power_base(struct ieee80211_hw * hw,u8 * ppowerlevel_ofdm,u8 * ppowerlevel_bw20,u8 * ppowerlevel_bw40,u8 channel,u32 * ofdmbase,u32 * mcsbase)136 static void rtl88e_phy_get_power_base(struct ieee80211_hw *hw,
137 				      u8 *ppowerlevel_ofdm,
138 				      u8 *ppowerlevel_bw20,
139 				      u8 *ppowerlevel_bw40, u8 channel,
140 				      u32 *ofdmbase, u32 *mcsbase)
141 {
142 	struct rtl_priv *rtlpriv = rtl_priv(hw);
143 	struct rtl_phy *rtlphy = &(rtlpriv->phy);
144 	u32 powerbase0, powerbase1;
145 	u8 i, powerlevel[2];
146 
147 	for (i = 0; i < 2; i++) {
148 		powerbase0 = ppowerlevel_ofdm[i];
149 
150 		powerbase0 = (powerbase0 << 24) | (powerbase0 << 16) |
151 		    (powerbase0 << 8) | powerbase0;
152 		*(ofdmbase + i) = powerbase0;
153 		RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
154 			" [OFDM power base index rf(%c) = 0x%x]\n",
155 			 ((i == 0) ? 'A' : 'B'), *(ofdmbase + i));
156 	}
157 
158 	for (i = 0; i < 2; i++) {
159 		if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20)
160 			powerlevel[i] = ppowerlevel_bw20[i];
161 		else
162 			powerlevel[i] = ppowerlevel_bw40[i];
163 
164 		powerbase1 = powerlevel[i];
165 		powerbase1 = (powerbase1 << 24) |
166 		    (powerbase1 << 16) | (powerbase1 << 8) | powerbase1;
167 
168 		*(mcsbase + i) = powerbase1;
169 
170 		RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
171 			" [MCS power base index rf(%c) = 0x%x]\n",
172 			 ((i == 0) ? 'A' : 'B'), *(mcsbase + i));
173 	}
174 }
175 
_rtl88e_get_txpower_writeval_by_regulatory(struct ieee80211_hw * hw,u8 channel,u8 index,u32 * powerbase0,u32 * powerbase1,u32 * p_outwriteval)176 static void _rtl88e_get_txpower_writeval_by_regulatory(struct ieee80211_hw *hw,
177 						       u8 channel, u8 index,
178 						       u32 *powerbase0,
179 						       u32 *powerbase1,
180 						       u32 *p_outwriteval)
181 {
182 	struct rtl_priv *rtlpriv = rtl_priv(hw);
183 	struct rtl_phy *rtlphy = &(rtlpriv->phy);
184 	struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
185 	u8 i, chnlgroup = 0, pwr_diff_limit[4], pwr_diff = 0, customer_pwr_diff;
186 	u32 writeval, customer_limit, rf;
187 
188 	for (rf = 0; rf < 2; rf++) {
189 		switch (rtlefuse->eeprom_regulatory) {
190 		case 0:
191 			chnlgroup = 0;
192 
193 			writeval =
194 			    rtlphy->mcs_txpwrlevel_origoffset
195 				[chnlgroup][index + (rf ? 8 : 0)]
196 			    + ((index < 2) ? powerbase0[rf] : powerbase1[rf]);
197 
198 			RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
199 				"RTK better performance, writeval(%c) = 0x%x\n",
200 				((rf == 0) ? 'A' : 'B'), writeval);
201 			break;
202 		case 1:
203 			if (rtlphy->pwrgroup_cnt == 1) {
204 				chnlgroup = 0;
205 			} else {
206 				if (channel < 3)
207 					chnlgroup = 0;
208 				else if (channel < 6)
209 					chnlgroup = 1;
210 				else if (channel < 9)
211 					chnlgroup = 2;
212 				else if (channel < 12)
213 					chnlgroup = 3;
214 				else if (channel < 14)
215 					chnlgroup = 4;
216 				else if (channel == 14)
217 					chnlgroup = 5;
218 			}
219 
220 			writeval =
221 			    rtlphy->mcs_txpwrlevel_origoffset[chnlgroup]
222 			    [index + (rf ? 8 : 0)] + ((index < 2) ?
223 						      powerbase0[rf] :
224 						      powerbase1[rf]);
225 
226 			RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
227 				"Realtek regulatory, 20MHz, writeval(%c) = 0x%x\n",
228 				 ((rf == 0) ? 'A' : 'B'), writeval);
229 
230 			break;
231 		case 2:
232 			writeval =
233 			    ((index < 2) ? powerbase0[rf] : powerbase1[rf]);
234 
235 			RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
236 				"Better regulatory, writeval(%c) = 0x%x\n",
237 				((rf == 0) ? 'A' : 'B'), writeval);
238 			break;
239 		case 3:
240 			chnlgroup = 0;
241 
242 			if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20_40) {
243 				RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
244 					"customer's limit, 40MHz rf(%c) = 0x%x\n",
245 					((rf == 0) ? 'A' : 'B'),
246 					rtlefuse->pwrgroup_ht40[rf][channel -
247 								    1]);
248 			} else {
249 				RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
250 					"customer's limit, 20MHz rf(%c) = 0x%x\n",
251 					((rf == 0) ? 'A' : 'B'),
252 					rtlefuse->pwrgroup_ht20[rf][channel -
253 								    1]);
254 			}
255 
256 			if (index < 2)
257 				pwr_diff =
258 				   rtlefuse->txpwr_legacyhtdiff[rf][channel-1];
259 			else if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20)
260 				pwr_diff =
261 					rtlefuse->txpwr_ht20diff[rf][channel-1];
262 
263 			if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20_40)
264 				customer_pwr_diff =
265 					rtlefuse->pwrgroup_ht40[rf][channel-1];
266 			else
267 				customer_pwr_diff =
268 					rtlefuse->pwrgroup_ht20[rf][channel-1];
269 
270 			if (pwr_diff > customer_pwr_diff)
271 				pwr_diff = 0;
272 			else
273 				pwr_diff = customer_pwr_diff - pwr_diff;
274 
275 			for (i = 0; i < 4; i++) {
276 				pwr_diff_limit[i] =
277 				    (u8)((rtlphy->mcs_txpwrlevel_origoffset
278 					  [chnlgroup][index +
279 					  (rf ? 8 : 0)] & (0x7f <<
280 					  (i * 8))) >> (i * 8));
281 
282 				if (pwr_diff_limit[i] > pwr_diff)
283 					pwr_diff_limit[i] = pwr_diff;
284 			}
285 
286 			customer_limit = (pwr_diff_limit[3] << 24) |
287 			    (pwr_diff_limit[2] << 16) |
288 			    (pwr_diff_limit[1] << 8) | (pwr_diff_limit[0]);
289 
290 			RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
291 				"Customer's limit rf(%c) = 0x%x\n",
292 				 ((rf == 0) ? 'A' : 'B'), customer_limit);
293 
294 			writeval = customer_limit +
295 			    ((index < 2) ? powerbase0[rf] : powerbase1[rf]);
296 
297 			RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
298 				"Customer, writeval rf(%c)= 0x%x\n",
299 				 ((rf == 0) ? 'A' : 'B'), writeval);
300 			break;
301 		default:
302 			chnlgroup = 0;
303 			writeval =
304 			    rtlphy->mcs_txpwrlevel_origoffset[chnlgroup]
305 			    [index + (rf ? 8 : 0)]
306 			    + ((index < 2) ? powerbase0[rf] : powerbase1[rf]);
307 
308 			RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
309 				"RTK better performance, writeval rf(%c) = 0x%x\n",
310 				 ((rf == 0) ? 'A' : 'B'), writeval);
311 			break;
312 		}
313 
314 		if (rtlpriv->dm.dynamic_txhighpower_lvl == TXHIGHPWRLEVEL_BT1)
315 			writeval = writeval - 0x06060606;
316 		else if (rtlpriv->dm.dynamic_txhighpower_lvl ==
317 			 TXHIGHPWRLEVEL_BT2)
318 			writeval = writeval - 0x0c0c0c0c;
319 		*(p_outwriteval + rf) = writeval;
320 	}
321 }
322 
_rtl88e_write_ofdm_power_reg(struct ieee80211_hw * hw,u8 index,u32 * value)323 static void _rtl88e_write_ofdm_power_reg(struct ieee80211_hw *hw,
324 					 u8 index, u32 *value)
325 {
326 	struct rtl_priv *rtlpriv = rtl_priv(hw);
327 	u16 regoffset_a[6] = {
328 		RTXAGC_A_RATE18_06, RTXAGC_A_RATE54_24,
329 		RTXAGC_A_MCS03_MCS00, RTXAGC_A_MCS07_MCS04,
330 		RTXAGC_A_MCS11_MCS08, RTXAGC_A_MCS15_MCS12
331 	};
332 	u16 regoffset_b[6] = {
333 		RTXAGC_B_RATE18_06, RTXAGC_B_RATE54_24,
334 		RTXAGC_B_MCS03_MCS00, RTXAGC_B_MCS07_MCS04,
335 		RTXAGC_B_MCS11_MCS08, RTXAGC_B_MCS15_MCS12
336 	};
337 	u8 i, rf, pwr_val[4];
338 	u32 writeval;
339 	u16 regoffset;
340 
341 	for (rf = 0; rf < 2; rf++) {
342 		writeval = value[rf];
343 		for (i = 0; i < 4; i++) {
344 			pwr_val[i] = (u8)((writeval & (0x7f <<
345 					   (i * 8))) >> (i * 8));
346 
347 			if (pwr_val[i] > RF6052_MAX_TX_PWR)
348 				pwr_val[i] = RF6052_MAX_TX_PWR;
349 		}
350 		writeval = (pwr_val[3] << 24) | (pwr_val[2] << 16) |
351 		    (pwr_val[1] << 8) | pwr_val[0];
352 
353 		if (rf == 0)
354 			regoffset = regoffset_a[index];
355 		else
356 			regoffset = regoffset_b[index];
357 		rtl_set_bbreg(hw, regoffset, MASKDWORD, writeval);
358 
359 		RTPRINT(rtlpriv, FPHY, PHY_TXPWR,
360 			"Set 0x%x = %08x\n", regoffset, writeval);
361 	}
362 }
363 
rtl88e_phy_rf6052_set_ofdm_txpower(struct ieee80211_hw * hw,u8 * ppowerlevel_ofdm,u8 * ppowerlevel_bw20,u8 * ppowerlevel_bw40,u8 channel)364 void rtl88e_phy_rf6052_set_ofdm_txpower(struct ieee80211_hw *hw,
365 					u8 *ppowerlevel_ofdm,
366 					u8 *ppowerlevel_bw20,
367 					u8 *ppowerlevel_bw40, u8 channel)
368 {
369 	u32 writeval[2], powerbase0[2], powerbase1[2];
370 	u8 index;
371 	u8 direction;
372 	u32 pwrtrac_value;
373 
374 	rtl88e_phy_get_power_base(hw, ppowerlevel_ofdm,
375 				  ppowerlevel_bw20, ppowerlevel_bw40,
376 				  channel, &powerbase0[0], &powerbase1[0]);
377 
378 	rtl88e_dm_txpower_track_adjust(hw, 1, &direction, &pwrtrac_value);
379 
380 	for (index = 0; index < 6; index++) {
381 		_rtl88e_get_txpower_writeval_by_regulatory(hw,
382 							   channel, index,
383 							   &powerbase0[0],
384 							   &powerbase1[0],
385 							   &writeval[0]);
386 		if (direction == 1) {
387 			writeval[0] += pwrtrac_value;
388 			writeval[1] += pwrtrac_value;
389 		} else if (direction == 2) {
390 			writeval[0] -= pwrtrac_value;
391 			writeval[1] -= pwrtrac_value;
392 		}
393 		_rtl88e_write_ofdm_power_reg(hw, index, &writeval[0]);
394 	}
395 }
396 
rtl88e_phy_rf6052_config(struct ieee80211_hw * hw)397 bool rtl88e_phy_rf6052_config(struct ieee80211_hw *hw)
398 {
399 	struct rtl_priv *rtlpriv = rtl_priv(hw);
400 	struct rtl_phy *rtlphy = &(rtlpriv->phy);
401 
402 	if (rtlphy->rf_type == RF_1T1R)
403 		rtlphy->num_total_rfpath = 1;
404 	else
405 		rtlphy->num_total_rfpath = 2;
406 
407 	return _rtl88e_phy_rf6052_config_parafile(hw);
408 }
409 
_rtl88e_phy_rf6052_config_parafile(struct ieee80211_hw * hw)410 static bool _rtl88e_phy_rf6052_config_parafile(struct ieee80211_hw *hw)
411 {
412 	struct rtl_priv *rtlpriv = rtl_priv(hw);
413 	struct rtl_phy *rtlphy = &rtlpriv->phy;
414 	u32 u4_regvalue = 0;
415 	u8 rfpath;
416 	bool rtstatus = true;
417 	struct bb_reg_def *pphyreg;
418 
419 	for (rfpath = 0; rfpath < rtlphy->num_total_rfpath; rfpath++) {
420 		pphyreg = &rtlphy->phyreg_def[rfpath];
421 
422 		switch (rfpath) {
423 		case RF90_PATH_A:
424 		case RF90_PATH_C:
425 			u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
426 						    BRFSI_RFENV);
427 			break;
428 		case RF90_PATH_B:
429 		case RF90_PATH_D:
430 			u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
431 						    BRFSI_RFENV << 16);
432 			break;
433 		}
434 
435 		rtl_set_bbreg(hw, pphyreg->rfintfe, BRFSI_RFENV << 16, 0x1);
436 		udelay(1);
437 
438 		rtl_set_bbreg(hw, pphyreg->rfintfo, BRFSI_RFENV, 0x1);
439 		udelay(1);
440 
441 		rtl_set_bbreg(hw, pphyreg->rfhssi_para2,
442 			      B3WIREADDREAALENGTH, 0x0);
443 		udelay(1);
444 
445 		rtl_set_bbreg(hw, pphyreg->rfhssi_para2, B3WIREDATALENGTH, 0x0);
446 		udelay(1);
447 
448 		switch (rfpath) {
449 		case RF90_PATH_A:
450 			rtstatus = rtl88e_phy_config_rf_with_headerfile(hw,
451 						(enum radio_path)rfpath);
452 			break;
453 		case RF90_PATH_B:
454 			rtstatus = rtl88e_phy_config_rf_with_headerfile(hw,
455 						(enum radio_path)rfpath);
456 			break;
457 		case RF90_PATH_C:
458 			break;
459 		case RF90_PATH_D:
460 			break;
461 		}
462 
463 		switch (rfpath) {
464 		case RF90_PATH_A:
465 		case RF90_PATH_C:
466 			rtl_set_bbreg(hw, pphyreg->rfintfs,
467 				      BRFSI_RFENV, u4_regvalue);
468 			break;
469 		case RF90_PATH_B:
470 		case RF90_PATH_D:
471 			rtl_set_bbreg(hw, pphyreg->rfintfs,
472 				      BRFSI_RFENV << 16, u4_regvalue);
473 			break;
474 		}
475 
476 		if (!rtstatus) {
477 			rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE,
478 				"Radio[%d] Fail!!\n", rfpath);
479 			return false;
480 		}
481 
482 	}
483 
484 	rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, "\n");
485 	return rtstatus;
486 }
487