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
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64#include <net/mac80211.h>
65#include "fw-api.h"
66#include "mvm.h"
67
68
69u8 iwl_mvm_get_channel_width(struct cfg80211_chan_def *chandef)
70{
71 switch (chandef->width) {
72 case NL80211_CHAN_WIDTH_20_NOHT:
73 case NL80211_CHAN_WIDTH_20:
74 return PHY_VHT_CHANNEL_MODE20;
75 case NL80211_CHAN_WIDTH_40:
76 return PHY_VHT_CHANNEL_MODE40;
77 case NL80211_CHAN_WIDTH_80:
78 return PHY_VHT_CHANNEL_MODE80;
79 case NL80211_CHAN_WIDTH_160:
80 return PHY_VHT_CHANNEL_MODE160;
81 default:
82 WARN(1, "Invalid channel width=%u", chandef->width);
83 return PHY_VHT_CHANNEL_MODE20;
84 }
85}
86
87
88
89
90
91u8 iwl_mvm_get_ctrl_pos(struct cfg80211_chan_def *chandef)
92{
93 switch (chandef->chan->center_freq - chandef->center_freq1) {
94 case -70:
95 return PHY_VHT_CTRL_POS_4_BELOW;
96 case -50:
97 return PHY_VHT_CTRL_POS_3_BELOW;
98 case -30:
99 return PHY_VHT_CTRL_POS_2_BELOW;
100 case -10:
101 return PHY_VHT_CTRL_POS_1_BELOW;
102 case 10:
103 return PHY_VHT_CTRL_POS_1_ABOVE;
104 case 30:
105 return PHY_VHT_CTRL_POS_2_ABOVE;
106 case 50:
107 return PHY_VHT_CTRL_POS_3_ABOVE;
108 case 70:
109 return PHY_VHT_CTRL_POS_4_ABOVE;
110 default:
111 WARN(1, "Invalid channel definition");
112 case 0:
113
114
115
116
117
118 return PHY_VHT_CTRL_POS_1_BELOW;
119 }
120}
121
122
123
124
125static void iwl_mvm_phy_ctxt_cmd_hdr(struct iwl_mvm_phy_ctxt *ctxt,
126 struct iwl_phy_context_cmd *cmd,
127 u32 action, u32 apply_time)
128{
129 memset(cmd, 0, sizeof(struct iwl_phy_context_cmd));
130
131 cmd->id_and_color = cpu_to_le32(FW_CMD_ID_AND_COLOR(ctxt->id,
132 ctxt->color));
133 cmd->action = cpu_to_le32(action);
134 cmd->apply_time = cpu_to_le32(apply_time);
135}
136
137
138
139
140static void iwl_mvm_phy_ctxt_cmd_data(struct iwl_mvm *mvm,
141 struct iwl_phy_context_cmd *cmd,
142 struct cfg80211_chan_def *chandef,
143 u8 chains_static, u8 chains_dynamic)
144{
145 u8 active_cnt, idle_cnt;
146
147
148 cmd->ci.band = (chandef->chan->band == NL80211_BAND_2GHZ ?
149 PHY_BAND_24 : PHY_BAND_5);
150
151 cmd->ci.channel = chandef->chan->hw_value;
152 cmd->ci.width = iwl_mvm_get_channel_width(chandef);
153 cmd->ci.ctrl_pos = iwl_mvm_get_ctrl_pos(chandef);
154
155
156 idle_cnt = chains_static;
157 active_cnt = chains_dynamic;
158
159
160
161
162
163
164
165
166 if (active_cnt == 1 && iwl_mvm_rx_diversity_allowed(mvm)) {
167 idle_cnt = 2;
168 active_cnt = 2;
169 }
170
171 cmd->rxchain_info = cpu_to_le32(iwl_mvm_get_valid_rx_ant(mvm) <<
172 PHY_RX_CHAIN_VALID_POS);
173 cmd->rxchain_info |= cpu_to_le32(idle_cnt << PHY_RX_CHAIN_CNT_POS);
174 cmd->rxchain_info |= cpu_to_le32(active_cnt <<
175 PHY_RX_CHAIN_MIMO_CNT_POS);
176#ifdef CONFIG_IWLWIFI_DEBUGFS
177 if (unlikely(mvm->dbgfs_rx_phyinfo))
178 cmd->rxchain_info = cpu_to_le32(mvm->dbgfs_rx_phyinfo);
179#endif
180
181 cmd->txchain_info = cpu_to_le32(iwl_mvm_get_valid_tx_ant(mvm));
182}
183
184
185
186
187
188
189
190static int iwl_mvm_phy_ctxt_apply(struct iwl_mvm *mvm,
191 struct iwl_mvm_phy_ctxt *ctxt,
192 struct cfg80211_chan_def *chandef,
193 u8 chains_static, u8 chains_dynamic,
194 u32 action, u32 apply_time)
195{
196 struct iwl_phy_context_cmd cmd;
197 int ret;
198
199
200 iwl_mvm_phy_ctxt_cmd_hdr(ctxt, &cmd, action, apply_time);
201
202
203 iwl_mvm_phy_ctxt_cmd_data(mvm, &cmd, chandef,
204 chains_static, chains_dynamic);
205
206 ret = iwl_mvm_send_cmd_pdu(mvm, PHY_CONTEXT_CMD, 0,
207 sizeof(struct iwl_phy_context_cmd),
208 &cmd);
209 if (ret)
210 IWL_ERR(mvm, "PHY ctxt cmd error. ret=%d\n", ret);
211 return ret;
212}
213
214
215
216
217int iwl_mvm_phy_ctxt_add(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt,
218 struct cfg80211_chan_def *chandef,
219 u8 chains_static, u8 chains_dynamic)
220{
221 WARN_ON(!test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status) &&
222 ctxt->ref);
223 lockdep_assert_held(&mvm->mutex);
224
225 ctxt->channel = chandef->chan;
226
227 return iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
228 chains_static, chains_dynamic,
229 FW_CTXT_ACTION_ADD, 0);
230}
231
232
233
234
235
236void iwl_mvm_phy_ctxt_ref(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt)
237{
238 lockdep_assert_held(&mvm->mutex);
239 ctxt->ref++;
240}
241
242
243
244
245
246
247int iwl_mvm_phy_ctxt_changed(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt,
248 struct cfg80211_chan_def *chandef,
249 u8 chains_static, u8 chains_dynamic)
250{
251 enum iwl_ctxt_action action = FW_CTXT_ACTION_MODIFY;
252
253 lockdep_assert_held(&mvm->mutex);
254
255 if (fw_has_capa(&mvm->fw->ucode_capa,
256 IWL_UCODE_TLV_CAPA_BINDING_CDB_SUPPORT) &&
257 ctxt->channel->band != chandef->chan->band) {
258 int ret;
259
260
261 ret = iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
262 chains_static, chains_dynamic,
263 FW_CTXT_ACTION_REMOVE, 0);
264 if (ret)
265 return ret;
266
267
268 action = FW_CTXT_ACTION_ADD;
269 }
270
271 ctxt->channel = chandef->chan;
272 ctxt->width = chandef->width;
273 return iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
274 chains_static, chains_dynamic,
275 action, 0);
276}
277
278void iwl_mvm_phy_ctxt_unref(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt)
279{
280 lockdep_assert_held(&mvm->mutex);
281
282 if (WARN_ON_ONCE(!ctxt))
283 return;
284
285 ctxt->ref--;
286
287
288
289
290
291
292 if (ctxt->ref == 0) {
293 struct ieee80211_channel *chan;
294 struct cfg80211_chan_def chandef;
295
296 chan = &mvm->hw->wiphy->bands[NL80211_BAND_2GHZ]->channels[0];
297 cfg80211_chandef_create(&chandef, chan, NL80211_CHAN_NO_HT);
298 iwl_mvm_phy_ctxt_changed(mvm, ctxt, &chandef, 1, 1);
299 }
300}
301
302static void iwl_mvm_binding_iterator(void *_data, u8 *mac,
303 struct ieee80211_vif *vif)
304{
305 unsigned long *data = _data;
306 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
307
308 if (!mvmvif->phy_ctxt)
309 return;
310
311 if (vif->type == NL80211_IFTYPE_STATION ||
312 vif->type == NL80211_IFTYPE_AP)
313 __set_bit(mvmvif->phy_ctxt->id, data);
314}
315
316int iwl_mvm_phy_ctx_count(struct iwl_mvm *mvm)
317{
318 unsigned long phy_ctxt_counter = 0;
319
320 ieee80211_iterate_active_interfaces_atomic(mvm->hw,
321 IEEE80211_IFACE_ITER_NORMAL,
322 iwl_mvm_binding_iterator,
323 &phy_ctxt_counter);
324
325 return hweight8(phy_ctxt_counter);
326}
327