1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include "../wifi.h"
27#include "reg.h"
28#include "def.h"
29#include "phy.h"
30#include "rf.h"
31#include "dm.h"
32
33static bool _rtl92ee_phy_rf6052_config_parafile(struct ieee80211_hw *hw);
34
35void rtl92ee_phy_rf6052_set_bandwidth(struct ieee80211_hw *hw, u8 bandwidth)
36{
37 struct rtl_priv *rtlpriv = rtl_priv(hw);
38 struct rtl_phy *rtlphy = &rtlpriv->phy;
39
40 switch (bandwidth) {
41 case HT_CHANNEL_WIDTH_20:
42 rtlphy->rfreg_chnlval[0] = ((rtlphy->rfreg_chnlval[0] &
43 0xfffff3ff) | BIT(10) | BIT(11));
44 rtl_set_rfreg(hw, RF90_PATH_A, RF_CHNLBW, RFREG_OFFSET_MASK,
45 rtlphy->rfreg_chnlval[0]);
46 rtl_set_rfreg(hw, RF90_PATH_B, RF_CHNLBW, RFREG_OFFSET_MASK,
47 rtlphy->rfreg_chnlval[0]);
48 break;
49 case HT_CHANNEL_WIDTH_20_40:
50 rtlphy->rfreg_chnlval[0] = ((rtlphy->rfreg_chnlval[0] &
51 0xfffff3ff) | BIT(10));
52 rtl_set_rfreg(hw, RF90_PATH_A, RF_CHNLBW, RFREG_OFFSET_MASK,
53 rtlphy->rfreg_chnlval[0]);
54 rtl_set_rfreg(hw, RF90_PATH_B, RF_CHNLBW, RFREG_OFFSET_MASK,
55 rtlphy->rfreg_chnlval[0]);
56 break;
57 default:
58 pr_err("unknown bandwidth: %#X\n", bandwidth);
59 break;
60 }
61}
62
63bool rtl92ee_phy_rf6052_config(struct ieee80211_hw *hw)
64{
65 struct rtl_priv *rtlpriv = rtl_priv(hw);
66 struct rtl_phy *rtlphy = &rtlpriv->phy;
67
68 if (rtlphy->rf_type == RF_1T1R)
69 rtlphy->num_total_rfpath = 1;
70 else
71 rtlphy->num_total_rfpath = 2;
72
73 return _rtl92ee_phy_rf6052_config_parafile(hw);
74}
75
76static bool _rtl92ee_phy_rf6052_config_parafile(struct ieee80211_hw *hw)
77{
78 struct rtl_priv *rtlpriv = rtl_priv(hw);
79 struct rtl_phy *rtlphy = &rtlpriv->phy;
80 u32 u4_regvalue = 0;
81 u8 rfpath;
82 bool rtstatus = true;
83 struct bb_reg_def *pphyreg;
84
85 for (rfpath = 0; rfpath < rtlphy->num_total_rfpath; rfpath++) {
86 pphyreg = &rtlphy->phyreg_def[rfpath];
87
88 switch (rfpath) {
89 case RF90_PATH_A:
90 case RF90_PATH_C:
91 u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
92 BRFSI_RFENV);
93 break;
94 case RF90_PATH_B:
95 case RF90_PATH_D:
96 u4_regvalue = rtl_get_bbreg(hw, pphyreg->rfintfs,
97 BRFSI_RFENV << 16);
98 break;
99 }
100
101 rtl_set_bbreg(hw, pphyreg->rfintfe, BRFSI_RFENV << 16, 0x1);
102 udelay(1);
103
104 rtl_set_bbreg(hw, pphyreg->rfintfo, BRFSI_RFENV, 0x1);
105 udelay(1);
106
107 rtl_set_bbreg(hw, pphyreg->rfhssi_para2,
108 B3WIREADDREAALENGTH, 0x0);
109 udelay(1);
110
111 rtl_set_bbreg(hw, pphyreg->rfhssi_para2, B3WIREDATALENGTH, 0x0);
112 udelay(1);
113
114 switch (rfpath) {
115 case RF90_PATH_A:
116 rtstatus = rtl92ee_phy_config_rf_with_headerfile(hw,
117 (enum radio_path)rfpath);
118 break;
119 case RF90_PATH_B:
120 rtstatus = rtl92ee_phy_config_rf_with_headerfile(hw,
121 (enum radio_path)rfpath);
122 break;
123 case RF90_PATH_C:
124 break;
125 case RF90_PATH_D:
126 break;
127 }
128
129 switch (rfpath) {
130 case RF90_PATH_A:
131 case RF90_PATH_C:
132 rtl_set_bbreg(hw, pphyreg->rfintfs,
133 BRFSI_RFENV, u4_regvalue);
134 break;
135 case RF90_PATH_B:
136 case RF90_PATH_D:
137 rtl_set_bbreg(hw, pphyreg->rfintfs,
138 BRFSI_RFENV << 16, u4_regvalue);
139 break;
140 }
141
142 if (!rtstatus) {
143 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE,
144 "Radio[%d] Fail!!\n", rfpath);
145 return false;
146 }
147 }
148
149 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, "\n");
150 return rtstatus;
151}
152
