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
65#include "mvm.h"
66
67
68struct iwl_mvm_active_iface_iterator_data {
69 struct ieee80211_vif *ignore_vif;
70 u8 sta_vif_ap_sta_id;
71 enum iwl_sf_state sta_vif_state;
72 int num_active_macs;
73};
74
75
76
77
78
79static void iwl_mvm_bound_iface_iterator(void *_data, u8 *mac,
80 struct ieee80211_vif *vif)
81{
82 struct iwl_mvm_active_iface_iterator_data *data = _data;
83 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
84
85 if (vif == data->ignore_vif || !mvmvif->phy_ctxt ||
86 vif->type == NL80211_IFTYPE_P2P_DEVICE)
87 return;
88
89 data->num_active_macs++;
90
91 if (vif->type == NL80211_IFTYPE_STATION) {
92 data->sta_vif_ap_sta_id = mvmvif->ap_sta_id;
93 if (vif->bss_conf.assoc)
94 data->sta_vif_state = SF_FULL_ON;
95 else
96 data->sta_vif_state = SF_INIT_OFF;
97 }
98}
99
100
101
102
103
104static const
105__le32 sf_full_timeout_def[SF_NUM_SCENARIO][SF_NUM_TIMEOUT_TYPES] = {
106 {
107 cpu_to_le32(SF_SINGLE_UNICAST_AGING_TIMER_DEF),
108 cpu_to_le32(SF_SINGLE_UNICAST_IDLE_TIMER_DEF)
109 },
110 {
111 cpu_to_le32(SF_AGG_UNICAST_AGING_TIMER_DEF),
112 cpu_to_le32(SF_AGG_UNICAST_IDLE_TIMER_DEF)
113 },
114 {
115 cpu_to_le32(SF_MCAST_AGING_TIMER_DEF),
116 cpu_to_le32(SF_MCAST_IDLE_TIMER_DEF)
117 },
118 {
119 cpu_to_le32(SF_BA_AGING_TIMER_DEF),
120 cpu_to_le32(SF_BA_IDLE_TIMER_DEF)
121 },
122 {
123 cpu_to_le32(SF_TX_RE_AGING_TIMER_DEF),
124 cpu_to_le32(SF_TX_RE_IDLE_TIMER_DEF)
125 },
126};
127
128
129
130
131
132static const __le32 sf_full_timeout[SF_NUM_SCENARIO][SF_NUM_TIMEOUT_TYPES] = {
133 {
134 cpu_to_le32(SF_SINGLE_UNICAST_AGING_TIMER),
135 cpu_to_le32(SF_SINGLE_UNICAST_IDLE_TIMER)
136 },
137 {
138 cpu_to_le32(SF_AGG_UNICAST_AGING_TIMER),
139 cpu_to_le32(SF_AGG_UNICAST_IDLE_TIMER)
140 },
141 {
142 cpu_to_le32(SF_MCAST_AGING_TIMER),
143 cpu_to_le32(SF_MCAST_IDLE_TIMER)
144 },
145 {
146 cpu_to_le32(SF_BA_AGING_TIMER),
147 cpu_to_le32(SF_BA_IDLE_TIMER)
148 },
149 {
150 cpu_to_le32(SF_TX_RE_AGING_TIMER),
151 cpu_to_le32(SF_TX_RE_IDLE_TIMER)
152 },
153};
154
155static void iwl_mvm_fill_sf_command(struct iwl_mvm *mvm,
156 struct iwl_sf_cfg_cmd *sf_cmd,
157 struct ieee80211_sta *sta)
158{
159 int i, j, watermark;
160
161 sf_cmd->watermark[SF_LONG_DELAY_ON] = cpu_to_le32(SF_W_MARK_SCAN);
162
163
164
165
166
167 if (sta) {
168 if (sta->ht_cap.ht_supported || sta->vht_cap.vht_supported) {
169 switch (sta->rx_nss) {
170 case 1:
171 watermark = SF_W_MARK_SISO;
172 break;
173 case 2:
174 watermark = SF_W_MARK_MIMO2;
175 break;
176 default:
177 watermark = SF_W_MARK_MIMO3;
178 break;
179 }
180 } else {
181 watermark = SF_W_MARK_LEGACY;
182 }
183
184 } else {
185 watermark = SF_W_MARK_MIMO2;
186 }
187 sf_cmd->watermark[SF_FULL_ON] = cpu_to_le32(watermark);
188
189 for (i = 0; i < SF_NUM_SCENARIO; i++) {
190 for (j = 0; j < SF_NUM_TIMEOUT_TYPES; j++) {
191 sf_cmd->long_delay_timeouts[i][j] =
192 cpu_to_le32(SF_LONG_DELAY_AGING_TIMER);
193 }
194 }
195
196 if (sta) {
197 BUILD_BUG_ON(sizeof(sf_full_timeout) !=
198 sizeof(__le32) * SF_NUM_SCENARIO *
199 SF_NUM_TIMEOUT_TYPES);
200
201 memcpy(sf_cmd->full_on_timeouts, sf_full_timeout,
202 sizeof(sf_full_timeout));
203 } else {
204 BUILD_BUG_ON(sizeof(sf_full_timeout_def) !=
205 sizeof(__le32) * SF_NUM_SCENARIO *
206 SF_NUM_TIMEOUT_TYPES);
207
208 memcpy(sf_cmd->full_on_timeouts, sf_full_timeout_def,
209 sizeof(sf_full_timeout_def));
210 }
211
212}
213
214static int iwl_mvm_sf_config(struct iwl_mvm *mvm, u8 sta_id,
215 enum iwl_sf_state new_state)
216{
217 struct iwl_sf_cfg_cmd sf_cmd = {
218 .state = cpu_to_le32(new_state),
219 };
220 struct ieee80211_sta *sta;
221 int ret = 0;
222
223 if (mvm->cfg->disable_dummy_notification)
224 sf_cmd.state |= cpu_to_le32(SF_CFG_DUMMY_NOTIF_OFF);
225
226
227
228
229
230 if (new_state != SF_FULL_ON && mvm->sf_state == new_state)
231 return 0;
232
233 switch (new_state) {
234 case SF_UNINIT:
235 iwl_mvm_fill_sf_command(mvm, &sf_cmd, NULL);
236 break;
237 case SF_FULL_ON:
238 if (sta_id == IWL_MVM_INVALID_STA) {
239 IWL_ERR(mvm,
240 "No station: Cannot switch SF to FULL_ON\n");
241 return -EINVAL;
242 }
243 rcu_read_lock();
244 sta = rcu_dereference(mvm->fw_id_to_mac_id[sta_id]);
245 if (IS_ERR_OR_NULL(sta)) {
246 IWL_ERR(mvm, "Invalid station id\n");
247 rcu_read_unlock();
248 return -EINVAL;
249 }
250 iwl_mvm_fill_sf_command(mvm, &sf_cmd, sta);
251 rcu_read_unlock();
252 break;
253 case SF_INIT_OFF:
254 iwl_mvm_fill_sf_command(mvm, &sf_cmd, NULL);
255 break;
256 default:
257 WARN_ONCE(1, "Invalid state: %d. not sending Smart Fifo cmd\n",
258 new_state);
259 return -EINVAL;
260 }
261
262 ret = iwl_mvm_send_cmd_pdu(mvm, REPLY_SF_CFG_CMD, CMD_ASYNC,
263 sizeof(sf_cmd), &sf_cmd);
264 if (!ret)
265 mvm->sf_state = new_state;
266
267 return ret;
268}
269
270
271
272
273
274
275int iwl_mvm_sf_update(struct iwl_mvm *mvm, struct ieee80211_vif *changed_vif,
276 bool remove_vif)
277{
278 enum iwl_sf_state new_state;
279 u8 sta_id = IWL_MVM_INVALID_STA;
280 struct iwl_mvm_vif *mvmvif = NULL;
281 struct iwl_mvm_active_iface_iterator_data data = {
282 .ignore_vif = changed_vif,
283 .sta_vif_state = SF_UNINIT,
284 .sta_vif_ap_sta_id = IWL_MVM_INVALID_STA,
285 };
286
287
288
289
290
291 if (test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status) ||
292 (changed_vif && changed_vif->type == NL80211_IFTYPE_P2P_DEVICE))
293 return 0;
294
295 ieee80211_iterate_active_interfaces_atomic(mvm->hw,
296 IEEE80211_IFACE_ITER_NORMAL,
297 iwl_mvm_bound_iface_iterator,
298 &data);
299
300
301 if (changed_vif && !remove_vif)
302 data.num_active_macs++;
303
304 switch (data.num_active_macs) {
305 case 0:
306
307 new_state = SF_INIT_OFF;
308 break;
309 case 1:
310 if (remove_vif) {
311
312
313
314 new_state = data.sta_vif_state;
315 sta_id = data.sta_vif_ap_sta_id;
316 } else {
317 if (WARN_ON(!changed_vif))
318 return -EINVAL;
319 if (changed_vif->type != NL80211_IFTYPE_STATION) {
320 new_state = SF_UNINIT;
321 } else if (changed_vif->bss_conf.assoc &&
322 changed_vif->bss_conf.dtim_period) {
323 mvmvif = iwl_mvm_vif_from_mac80211(changed_vif);
324 sta_id = mvmvif->ap_sta_id;
325 new_state = SF_FULL_ON;
326 } else {
327 new_state = SF_INIT_OFF;
328 }
329 }
330 break;
331 default:
332
333 new_state = SF_UNINIT;
334 }
335 return iwl_mvm_sf_config(mvm, sta_id, new_state);
336}
337