1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2009-2014  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 _rtl92ee_phy_rf6052_config_parafile(struct ieee80211_hw *hw);
12 
13 void rtl92ee_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 		rtl_set_rfreg(hw, RF90_PATH_B, RF_CHNLBW, RFREG_OFFSET_MASK,
25 			      rtlphy->rfreg_chnlval[0]);
26 		break;
27 	case HT_CHANNEL_WIDTH_20_40:
28 		rtlphy->rfreg_chnlval[0] = ((rtlphy->rfreg_chnlval[0] &
29 					     0xfffff3ff) | BIT(10));
30 		rtl_set_rfreg(hw, RF90_PATH_A, RF_CHNLBW, RFREG_OFFSET_MASK,
31 			      rtlphy->rfreg_chnlval[0]);
32 		rtl_set_rfreg(hw, RF90_PATH_B, RF_CHNLBW, RFREG_OFFSET_MASK,
33 			      rtlphy->rfreg_chnlval[0]);
34 		break;
35 	default:
36 		pr_err("unknown bandwidth: %#X\n", bandwidth);
37 		break;
38 	}
39 }
40 
41 bool rtl92ee_phy_rf6052_config(struct ieee80211_hw *hw)
42 {
43 	struct rtl_priv *rtlpriv = rtl_priv(hw);
44 	struct rtl_phy *rtlphy = &rtlpriv->phy;
45 
46 	if (rtlphy->rf_type == RF_1T1R)
47 		rtlphy->num_total_rfpath = 1;
48 	else
49 		rtlphy->num_total_rfpath = 2;
50 
51 	return _rtl92ee_phy_rf6052_config_parafile(hw);
52 }
53 
54 static bool _rtl92ee_phy_rf6052_config_parafile(struct ieee80211_hw *hw)
55 {
56 	struct rtl_priv *rtlpriv = rtl_priv(hw);
57 	struct rtl_phy *rtlphy = &rtlpriv->phy;
58 	u32 u4_regvalue = 0;
59 	u8 rfpath;
60 	bool rtstatus = true;
61 	struct bb_reg_def *pphyreg;
62 
63 	for (rfpath = 0; rfpath < rtlphy->num_total_rfpath; rfpath++) {
64 		pphyreg = &rtlphy->phyreg_def[rfpath];
65 
66 		switch (rfpath) {
67 		case RF90_PATH_A:
68 		case RF90_PATH_C:
69 			u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
70 						    BRFSI_RFENV);
71 			break;
72 		case RF90_PATH_B:
73 		case RF90_PATH_D:
74 			u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
75 						    BRFSI_RFENV << 16);
76 			break;
77 		}
78 
79 		rtl_set_bbreg(hw, pphyreg->rfintfe, BRFSI_RFENV << 16, 0x1);
80 		udelay(1);
81 
82 		rtl_set_bbreg(hw, pphyreg->rfintfo, BRFSI_RFENV, 0x1);
83 		udelay(1);
84 
85 		rtl_set_bbreg(hw, pphyreg->rfhssi_para2,
86 			      B3WIREADDREAALENGTH, 0x0);
87 		udelay(1);
88 
89 		rtl_set_bbreg(hw, pphyreg->rfhssi_para2, B3WIREDATALENGTH, 0x0);
90 		udelay(1);
91 
92 		switch (rfpath) {
93 		case RF90_PATH_A:
94 			rtstatus = rtl92ee_phy_config_rf_with_headerfile(hw,
95 						       (enum radio_path)rfpath);
96 			break;
97 		case RF90_PATH_B:
98 			rtstatus = rtl92ee_phy_config_rf_with_headerfile(hw,
99 						       (enum radio_path)rfpath);
100 			break;
101 		case RF90_PATH_C:
102 			break;
103 		case RF90_PATH_D:
104 			break;
105 		}
106 
107 		switch (rfpath) {
108 		case RF90_PATH_A:
109 		case RF90_PATH_C:
110 			rtl_set_bbreg(hw, pphyreg->rfintfs,
111 				      BRFSI_RFENV, u4_regvalue);
112 			break;
113 		case RF90_PATH_B:
114 		case RF90_PATH_D:
115 			rtl_set_bbreg(hw, pphyreg->rfintfs,
116 				      BRFSI_RFENV << 16, u4_regvalue);
117 			break;
118 		}
119 
120 		if (!rtstatus) {
121 			rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE,
122 				"Radio[%d] Fail!!\n", rfpath);
123 			return false;
124 		}
125 	}
126 
127 	rtl_dbg(rtlpriv, COMP_INIT, DBG_TRACE, "\n");
128 	return rtstatus;
129 }
130