Commit | Line | Data |
---|---|---|
d2912cb1 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
b203ffc3 JM |
2 | /* |
3 | * Off-channel operation helpers | |
4 | * | |
5 | * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
6 | * Copyright 2004, Instant802 Networks, Inc. | |
7 | * Copyright 2005, Devicescape Software, Inc. | |
8 | * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> | |
9 | * Copyright 2007, Michael Wu <flamingice@sourmilk.net> | |
10 | * Copyright 2009 Johannes Berg <johannes@sipsolutions.net> | |
c6968d4f | 11 | * Copyright (C) 2019, 2022-2023 Intel Corporation |
b203ffc3 | 12 | */ |
bc3b2d7f | 13 | #include <linux/export.h> |
b203ffc3 JM |
14 | #include <net/mac80211.h> |
15 | #include "ieee80211_i.h" | |
2eb278e0 | 16 | #include "driver-ops.h" |
b203ffc3 JM |
17 | |
18 | /* | |
b23b025f BG |
19 | * Tell our hardware to disable PS. |
20 | * Optionally inform AP that we will go to sleep so that it will buffer | |
21 | * the frames while we are doing off-channel work. This is optional | |
22 | * because we *may* be doing work on-operating channel, and want our | |
23 | * hardware unconditionally awake, but still let the AP send us normal frames. | |
b203ffc3 | 24 | */ |
559cef99 | 25 | static void ieee80211_offchannel_ps_enable(struct ieee80211_sub_if_data *sdata) |
b203ffc3 JM |
26 | { |
27 | struct ieee80211_local *local = sdata->local; | |
4730d597 | 28 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
dba0491f | 29 | bool offchannel_ps_enabled = false; |
b203ffc3 JM |
30 | |
31 | /* FIXME: what to do when local->pspolling is true? */ | |
32 | ||
33 | del_timer_sync(&local->dynamic_ps_timer); | |
3bc3c0d7 | 34 | del_timer_sync(&ifmgd->bcn_mon_timer); |
4730d597 LR |
35 | del_timer_sync(&ifmgd->conn_mon_timer); |
36 | ||
9fa659f9 | 37 | wiphy_work_cancel(local->hw.wiphy, &local->dynamic_ps_enable_work); |
b203ffc3 JM |
38 | |
39 | if (local->hw.conf.flags & IEEE80211_CONF_PS) { | |
dba0491f | 40 | offchannel_ps_enabled = true; |
b203ffc3 JM |
41 | local->hw.conf.flags &= ~IEEE80211_CONF_PS; |
42 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); | |
43 | } | |
44 | ||
dba0491f | 45 | if (!offchannel_ps_enabled || |
30686bf7 | 46 | !ieee80211_hw_check(&local->hw, PS_NULLFUNC_STACK)) |
b203ffc3 JM |
47 | /* |
48 | * If power save was enabled, no need to send a nullfunc | |
49 | * frame because AP knows that we are sleeping. But if the | |
50 | * hardware is creating the nullfunc frame for power save | |
51 | * status (ie. IEEE80211_HW_PS_NULLFUNC_STACK is not | |
52 | * enabled) and power save was enabled, the firmware just | |
53 | * sent a null frame with power save disabled. So we need | |
54 | * to send a new nullfunc frame to inform the AP that we | |
55 | * are again sleeping. | |
56 | */ | |
076cdcb1 | 57 | ieee80211_send_nullfunc(local, sdata, true); |
b203ffc3 JM |
58 | } |
59 | ||
dba0491f | 60 | /* inform AP that we are awake again */ |
b203ffc3 JM |
61 | static void ieee80211_offchannel_ps_disable(struct ieee80211_sub_if_data *sdata) |
62 | { | |
63 | struct ieee80211_local *local = sdata->local; | |
64 | ||
65 | if (!local->ps_sdata) | |
076cdcb1 | 66 | ieee80211_send_nullfunc(local, sdata, false); |
dba0491f | 67 | else if (local->hw.conf.dynamic_ps_timeout > 0) { |
b203ffc3 | 68 | /* |
dba0491f LP |
69 | * the dynamic_ps_timer had been running before leaving the |
70 | * operating channel, restart the timer now and send a nullfunc | |
71 | * frame to inform the AP that we are awake so that AP sends | |
72 | * the buffered packets (if any). | |
b203ffc3 | 73 | */ |
076cdcb1 | 74 | ieee80211_send_nullfunc(local, sdata, false); |
b203ffc3 JM |
75 | mod_timer(&local->dynamic_ps_timer, jiffies + |
76 | msecs_to_jiffies(local->hw.conf.dynamic_ps_timeout)); | |
77 | } | |
4730d597 | 78 | |
3bc3c0d7 | 79 | ieee80211_sta_reset_beacon_monitor(sdata); |
4730d597 | 80 | ieee80211_sta_reset_conn_monitor(sdata); |
b203ffc3 JM |
81 | } |
82 | ||
aacde9ee | 83 | void ieee80211_offchannel_stop_vifs(struct ieee80211_local *local) |
b203ffc3 JM |
84 | { |
85 | struct ieee80211_sub_if_data *sdata; | |
86 | ||
be0df01d JB |
87 | lockdep_assert_wiphy(local->hw.wiphy); |
88 | ||
0a44dfc0 | 89 | if (WARN_ON(!local->emulate_chanctx)) |
fe57d9f5 JB |
90 | return; |
91 | ||
b23b025f BG |
92 | /* |
93 | * notify the AP about us leaving the channel and stop all | |
94 | * STA interfaces. | |
95 | */ | |
6c17b77b | 96 | |
9c35d7d2 SF |
97 | /* |
98 | * Stop queues and transmit all frames queued by the driver | |
99 | * before sending nullfunc to enable powersave at the AP. | |
100 | */ | |
445ea4e8 | 101 | ieee80211_stop_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP, |
cca07b00 LC |
102 | IEEE80211_QUEUE_STOP_REASON_OFFCHANNEL, |
103 | false); | |
3b24f4c6 | 104 | ieee80211_flush_queues(local, NULL, false); |
6c17b77b | 105 | |
b203ffc3 JM |
106 | list_for_each_entry(sdata, &local->interfaces, list) { |
107 | if (!ieee80211_sdata_running(sdata)) | |
108 | continue; | |
109 | ||
708d50ed AB |
110 | if (sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE || |
111 | sdata->vif.type == NL80211_IFTYPE_NAN) | |
f142c6b9 JB |
112 | continue; |
113 | ||
b23b025f BG |
114 | if (sdata->vif.type != NL80211_IFTYPE_MONITOR) |
115 | set_bit(SDATA_STATE_OFFCHANNEL, &sdata->state); | |
116 | ||
117 | /* Check to see if we should disable beaconing. */ | |
d6a83228 JB |
118 | if (sdata->vif.bss_conf.enable_beacon) { |
119 | set_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, | |
120 | &sdata->state); | |
121 | sdata->vif.bss_conf.enable_beacon = false; | |
7b7090b4 | 122 | ieee80211_link_info_change_notify( |
d8675a63 JB |
123 | sdata, &sdata->deflink, |
124 | BSS_CHANGED_BEACON_ENABLED); | |
d6a83228 | 125 | } |
b203ffc3 | 126 | |
6c17b77b SF |
127 | if (sdata->vif.type == NL80211_IFTYPE_STATION && |
128 | sdata->u.mgd.associated) | |
129 | ieee80211_offchannel_ps_enable(sdata); | |
b203ffc3 | 130 | } |
b203ffc3 JM |
131 | } |
132 | ||
aacde9ee | 133 | void ieee80211_offchannel_return(struct ieee80211_local *local) |
b203ffc3 JM |
134 | { |
135 | struct ieee80211_sub_if_data *sdata; | |
136 | ||
be0df01d JB |
137 | lockdep_assert_wiphy(local->hw.wiphy); |
138 | ||
0a44dfc0 | 139 | if (WARN_ON(!local->emulate_chanctx)) |
fe57d9f5 JB |
140 | return; |
141 | ||
b203ffc3 | 142 | list_for_each_entry(sdata, &local->interfaces, list) { |
f142c6b9 JB |
143 | if (sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE) |
144 | continue; | |
145 | ||
f6e8cb72 EP |
146 | if (sdata->vif.type != NL80211_IFTYPE_MONITOR) |
147 | clear_bit(SDATA_STATE_OFFCHANNEL, &sdata->state); | |
148 | ||
b203ffc3 JM |
149 | if (!ieee80211_sdata_running(sdata)) |
150 | continue; | |
151 | ||
152 | /* Tell AP we're back */ | |
aacde9ee SG |
153 | if (sdata->vif.type == NL80211_IFTYPE_STATION && |
154 | sdata->u.mgd.associated) | |
155 | ieee80211_offchannel_ps_disable(sdata); | |
b203ffc3 | 156 | |
d6a83228 JB |
157 | if (test_and_clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, |
158 | &sdata->state)) { | |
159 | sdata->vif.bss_conf.enable_beacon = true; | |
7b7090b4 | 160 | ieee80211_link_info_change_notify( |
d8675a63 JB |
161 | sdata, &sdata->deflink, |
162 | BSS_CHANGED_BEACON_ENABLED); | |
d6a83228 | 163 | } |
b203ffc3 | 164 | } |
6c17b77b | 165 | |
445ea4e8 | 166 | ieee80211_wake_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP, |
cca07b00 LC |
167 | IEEE80211_QUEUE_STOP_REASON_OFFCHANNEL, |
168 | false); | |
b203ffc3 | 169 | } |
21f83589 | 170 | |
aaa016cc | 171 | static void ieee80211_roc_notify_destroy(struct ieee80211_roc_work *roc) |
2eb278e0 | 172 | { |
aaa016cc JB |
173 | /* was never transmitted */ |
174 | if (roc->frame) { | |
175 | cfg80211_mgmt_tx_status(&roc->sdata->wdev, roc->mgmt_tx_cookie, | |
176 | roc->frame->data, roc->frame->len, | |
177 | false, GFP_KERNEL); | |
178 | ieee80211_free_txskb(&roc->sdata->local->hw, roc->frame); | |
179 | } | |
180 | ||
181 | if (!roc->mgmt_tx_cookie) | |
182 | cfg80211_remain_on_channel_expired(&roc->sdata->wdev, | |
183 | roc->cookie, roc->chan, | |
184 | GFP_KERNEL); | |
ddb754aa JP |
185 | else |
186 | cfg80211_tx_mgmt_expired(&roc->sdata->wdev, | |
187 | roc->mgmt_tx_cookie, | |
188 | roc->chan, GFP_KERNEL); | |
aaa016cc JB |
189 | |
190 | list_del(&roc->list); | |
191 | kfree(roc); | |
192 | } | |
193 | ||
194 | static unsigned long ieee80211_end_finished_rocs(struct ieee80211_local *local, | |
195 | unsigned long now) | |
196 | { | |
197 | struct ieee80211_roc_work *roc, *tmp; | |
198 | long remaining_dur_min = LONG_MAX; | |
199 | ||
0cd8080e | 200 | lockdep_assert_wiphy(local->hw.wiphy); |
aaa016cc JB |
201 | |
202 | list_for_each_entry_safe(roc, tmp, &local->roc_list, list) { | |
203 | long remaining; | |
204 | ||
205 | if (!roc->started) | |
206 | break; | |
207 | ||
208 | remaining = roc->start_time + | |
209 | msecs_to_jiffies(roc->duration) - | |
210 | now; | |
211 | ||
1b894521 IP |
212 | /* In case of HW ROC, it is possible that the HW finished the |
213 | * ROC session before the actual requested time. In such a case | |
214 | * end the ROC session (disregarding the remaining time). | |
215 | */ | |
216 | if (roc->abort || roc->hw_begun || remaining <= 0) | |
aaa016cc JB |
217 | ieee80211_roc_notify_destroy(roc); |
218 | else | |
219 | remaining_dur_min = min(remaining_dur_min, remaining); | |
220 | } | |
221 | ||
222 | return remaining_dur_min; | |
223 | } | |
224 | ||
225 | static bool ieee80211_recalc_sw_work(struct ieee80211_local *local, | |
226 | unsigned long now) | |
227 | { | |
228 | long dur = ieee80211_end_finished_rocs(local, now); | |
229 | ||
230 | if (dur == LONG_MAX) | |
231 | return false; | |
232 | ||
97c19e42 | 233 | wiphy_delayed_work_queue(local->hw.wiphy, &local->roc_work, dur); |
aaa016cc JB |
234 | return true; |
235 | } | |
236 | ||
237 | static void ieee80211_handle_roc_started(struct ieee80211_roc_work *roc, | |
238 | unsigned long start_time) | |
239 | { | |
aaa016cc | 240 | if (WARN_ON(roc->notified)) |
2eb278e0 JB |
241 | return; |
242 | ||
aaa016cc JB |
243 | roc->start_time = start_time; |
244 | roc->started = true; | |
aaa016cc | 245 | |
2eb278e0 JB |
246 | if (roc->mgmt_tx_cookie) { |
247 | if (!WARN_ON(!roc->frame)) { | |
55de908a | 248 | ieee80211_tx_skb_tid_band(roc->sdata, roc->frame, 7, |
08aca29a | 249 | roc->chan->band); |
2eb278e0 JB |
250 | roc->frame = NULL; |
251 | } | |
252 | } else { | |
50febf6a | 253 | cfg80211_ready_on_channel(&roc->sdata->wdev, roc->cookie, |
42d97a59 JB |
254 | roc->chan, roc->req_duration, |
255 | GFP_KERNEL); | |
2eb278e0 JB |
256 | } |
257 | ||
258 | roc->notified = true; | |
259 | } | |
260 | ||
97c19e42 | 261 | static void ieee80211_hw_roc_start(struct wiphy *wiphy, struct wiphy_work *work) |
21f83589 JB |
262 | { |
263 | struct ieee80211_local *local = | |
264 | container_of(work, struct ieee80211_local, hw_roc_start); | |
aaa016cc | 265 | struct ieee80211_roc_work *roc; |
21f83589 | 266 | |
0cd8080e | 267 | lockdep_assert_wiphy(local->hw.wiphy); |
21f83589 | 268 | |
aaa016cc JB |
269 | list_for_each_entry(roc, &local->roc_list, list) { |
270 | if (!roc->started) | |
271 | break; | |
2eb278e0 | 272 | |
e6a8a3aa | 273 | roc->hw_begun = true; |
aaa016cc | 274 | ieee80211_handle_roc_started(roc, local->hw_roc_start_time); |
2eb278e0 | 275 | } |
21f83589 JB |
276 | } |
277 | ||
278 | void ieee80211_ready_on_channel(struct ieee80211_hw *hw) | |
279 | { | |
280 | struct ieee80211_local *local = hw_to_local(hw); | |
281 | ||
2eb278e0 JB |
282 | local->hw_roc_start_time = jiffies; |
283 | ||
21f83589 JB |
284 | trace_api_ready_on_channel(local); |
285 | ||
97c19e42 | 286 | wiphy_work_queue(hw->wiphy, &local->hw_roc_start); |
21f83589 JB |
287 | } |
288 | EXPORT_SYMBOL_GPL(ieee80211_ready_on_channel); | |
289 | ||
aaa016cc | 290 | static void _ieee80211_start_next_roc(struct ieee80211_local *local) |
21f83589 | 291 | { |
aaa016cc JB |
292 | struct ieee80211_roc_work *roc, *tmp; |
293 | enum ieee80211_roc_type type; | |
294 | u32 min_dur, max_dur; | |
21f83589 | 295 | |
0cd8080e | 296 | lockdep_assert_wiphy(local->hw.wiphy); |
21f83589 | 297 | |
aaa016cc | 298 | if (WARN_ON(list_empty(&local->roc_list))) |
21f83589 | 299 | return; |
21f83589 | 300 | |
2eb278e0 JB |
301 | roc = list_first_entry(&local->roc_list, struct ieee80211_roc_work, |
302 | list); | |
71ecfa18 | 303 | |
aaa016cc | 304 | if (WARN_ON(roc->started)) |
0f6b3f59 JB |
305 | return; |
306 | ||
aaa016cc JB |
307 | min_dur = roc->duration; |
308 | max_dur = roc->duration; | |
309 | type = roc->type; | |
71ecfa18 | 310 | |
aaa016cc JB |
311 | list_for_each_entry(tmp, &local->roc_list, list) { |
312 | if (tmp == roc) | |
313 | continue; | |
314 | if (tmp->sdata != roc->sdata || tmp->chan != roc->chan) | |
315 | break; | |
316 | max_dur = max(tmp->duration, max_dur); | |
317 | min_dur = min(tmp->duration, min_dur); | |
318 | type = max(tmp->type, type); | |
319 | } | |
2eb278e0 | 320 | |
aaa016cc JB |
321 | if (local->ops->remain_on_channel) { |
322 | int ret = drv_remain_on_channel(local, roc->sdata, roc->chan, | |
323 | max_dur, type); | |
2eb278e0 JB |
324 | |
325 | if (ret) { | |
326 | wiphy_warn(local->hw.wiphy, | |
327 | "failed to start next HW ROC (%d)\n", ret); | |
328 | /* | |
329 | * queue the work struct again to avoid recursion | |
330 | * when multiple failures occur | |
331 | */ | |
aaa016cc JB |
332 | list_for_each_entry(tmp, &local->roc_list, list) { |
333 | if (tmp->sdata != roc->sdata || | |
334 | tmp->chan != roc->chan) | |
335 | break; | |
336 | tmp->started = true; | |
337 | tmp->abort = true; | |
338 | } | |
97c19e42 | 339 | wiphy_work_queue(local->hw.wiphy, &local->hw_roc_done); |
aaa016cc | 340 | return; |
2eb278e0 | 341 | } |
b4b177a5 | 342 | |
aaa016cc JB |
343 | /* we'll notify about the start once the HW calls back */ |
344 | list_for_each_entry(tmp, &local->roc_list, list) { | |
345 | if (tmp->sdata != roc->sdata || tmp->chan != roc->chan) | |
346 | break; | |
347 | tmp->started = true; | |
348 | } | |
349 | } else { | |
b4b177a5 JB |
350 | /* If actually operating on the desired channel (with at least |
351 | * 20 MHz channel width) don't stop all the operations but still | |
352 | * treat it as though the ROC operation started properly, so | |
353 | * other ROC operations won't interfere with this one. | |
0a44dfc0 JB |
354 | * |
355 | * Note: scan can't run, tmp_channel is what we use, so this | |
356 | * must be the currently active channel. | |
b4b177a5 | 357 | */ |
0a44dfc0 JB |
358 | roc->on_channel = roc->chan == local->hw.conf.chandef.chan && |
359 | local->hw.conf.chandef.width != NL80211_CHAN_WIDTH_5 && | |
360 | local->hw.conf.chandef.width != NL80211_CHAN_WIDTH_10; | |
21f83589 | 361 | |
b4b177a5 | 362 | /* start this ROC */ |
2eb278e0 JB |
363 | ieee80211_recalc_idle(local); |
364 | ||
b4b177a5 JB |
365 | if (!roc->on_channel) { |
366 | ieee80211_offchannel_stop_vifs(local); | |
367 | ||
368 | local->tmp_channel = roc->chan; | |
0a44dfc0 | 369 | ieee80211_hw_conf_chan(local); |
b4b177a5 | 370 | } |
2eb278e0 | 371 | |
97c19e42 JB |
372 | wiphy_delayed_work_queue(local->hw.wiphy, &local->roc_work, |
373 | msecs_to_jiffies(min_dur)); | |
aaa016cc JB |
374 | |
375 | /* tell userspace or send frame(s) */ | |
376 | list_for_each_entry(tmp, &local->roc_list, list) { | |
377 | if (tmp->sdata != roc->sdata || tmp->chan != roc->chan) | |
378 | break; | |
379 | ||
380 | tmp->on_channel = roc->on_channel; | |
381 | ieee80211_handle_roc_started(tmp, jiffies); | |
382 | } | |
383 | } | |
384 | } | |
385 | ||
386 | void ieee80211_start_next_roc(struct ieee80211_local *local) | |
387 | { | |
388 | struct ieee80211_roc_work *roc; | |
389 | ||
0cd8080e | 390 | lockdep_assert_wiphy(local->hw.wiphy); |
aaa016cc JB |
391 | |
392 | if (list_empty(&local->roc_list)) { | |
393 | ieee80211_run_deferred_scan(local); | |
394 | return; | |
395 | } | |
396 | ||
470f4d61 EP |
397 | /* defer roc if driver is not started (i.e. during reconfig) */ |
398 | if (local->in_reconfig) | |
399 | return; | |
400 | ||
aaa016cc JB |
401 | roc = list_first_entry(&local->roc_list, struct ieee80211_roc_work, |
402 | list); | |
403 | ||
404 | if (WARN_ON_ONCE(roc->started)) | |
405 | return; | |
406 | ||
407 | if (local->ops->remain_on_channel) { | |
408 | _ieee80211_start_next_roc(local); | |
409 | } else { | |
410 | /* delay it a bit */ | |
97c19e42 JB |
411 | wiphy_delayed_work_queue(local->hw.wiphy, &local->roc_work, |
412 | round_jiffies_relative(HZ / 2)); | |
aaa016cc JB |
413 | } |
414 | } | |
415 | ||
416 | static void __ieee80211_roc_work(struct ieee80211_local *local) | |
417 | { | |
418 | struct ieee80211_roc_work *roc; | |
419 | bool on_channel; | |
420 | ||
0cd8080e | 421 | lockdep_assert_wiphy(local->hw.wiphy); |
aaa016cc JB |
422 | |
423 | if (WARN_ON(local->ops->remain_on_channel)) | |
424 | return; | |
2eb278e0 | 425 | |
aaa016cc JB |
426 | roc = list_first_entry_or_null(&local->roc_list, |
427 | struct ieee80211_roc_work, list); | |
428 | if (!roc) | |
429 | return; | |
2eb278e0 | 430 | |
aaa016cc | 431 | if (!roc->started) { |
0a44dfc0 | 432 | WARN_ON(!local->emulate_chanctx); |
aaa016cc | 433 | _ieee80211_start_next_roc(local); |
2eb278e0 | 434 | } else { |
b4b177a5 | 435 | on_channel = roc->on_channel; |
aaa016cc JB |
436 | if (ieee80211_recalc_sw_work(local, jiffies)) |
437 | return; | |
2eb278e0 | 438 | |
aaa016cc JB |
439 | /* careful - roc pointer became invalid during recalc */ |
440 | ||
441 | if (!on_channel) { | |
3b24f4c6 | 442 | ieee80211_flush_queues(local, NULL, false); |
2eb278e0 JB |
443 | |
444 | local->tmp_channel = NULL; | |
0a44dfc0 | 445 | ieee80211_hw_conf_chan(local); |
2eb278e0 | 446 | |
aacde9ee | 447 | ieee80211_offchannel_return(local); |
2eb278e0 JB |
448 | } |
449 | ||
450 | ieee80211_recalc_idle(local); | |
aaa016cc | 451 | ieee80211_start_next_roc(local); |
2eb278e0 | 452 | } |
aaa016cc | 453 | } |
2eb278e0 | 454 | |
97c19e42 | 455 | static void ieee80211_roc_work(struct wiphy *wiphy, struct wiphy_work *work) |
aaa016cc JB |
456 | { |
457 | struct ieee80211_local *local = | |
458 | container_of(work, struct ieee80211_local, roc_work.work); | |
459 | ||
0cd8080e JB |
460 | lockdep_assert_wiphy(local->hw.wiphy); |
461 | ||
aaa016cc | 462 | __ieee80211_roc_work(local); |
2eb278e0 JB |
463 | } |
464 | ||
97c19e42 | 465 | static void ieee80211_hw_roc_done(struct wiphy *wiphy, struct wiphy_work *work) |
2eb278e0 JB |
466 | { |
467 | struct ieee80211_local *local = | |
468 | container_of(work, struct ieee80211_local, hw_roc_done); | |
2eb278e0 | 469 | |
0cd8080e | 470 | lockdep_assert_wiphy(local->hw.wiphy); |
2eb278e0 | 471 | |
aaa016cc | 472 | ieee80211_end_finished_rocs(local, jiffies); |
2eb278e0 JB |
473 | |
474 | /* if there's another roc, start it now */ | |
475 | ieee80211_start_next_roc(local); | |
21f83589 JB |
476 | } |
477 | ||
478 | void ieee80211_remain_on_channel_expired(struct ieee80211_hw *hw) | |
479 | { | |
480 | struct ieee80211_local *local = hw_to_local(hw); | |
481 | ||
482 | trace_api_remain_on_channel_expired(local); | |
483 | ||
97c19e42 | 484 | wiphy_work_queue(hw->wiphy, &local->hw_roc_done); |
21f83589 JB |
485 | } |
486 | EXPORT_SYMBOL_GPL(ieee80211_remain_on_channel_expired); | |
487 | ||
aaa016cc JB |
488 | static bool |
489 | ieee80211_coalesce_hw_started_roc(struct ieee80211_local *local, | |
490 | struct ieee80211_roc_work *new_roc, | |
491 | struct ieee80211_roc_work *cur_roc) | |
a2fcfccb JB |
492 | { |
493 | unsigned long now = jiffies; | |
aaa016cc JB |
494 | unsigned long remaining; |
495 | ||
496 | if (WARN_ON(!cur_roc->started)) | |
497 | return false; | |
a2fcfccb | 498 | |
aaa016cc JB |
499 | /* if it was scheduled in the hardware, but not started yet, |
500 | * we can only combine if the older one had a longer duration | |
501 | */ | |
502 | if (!cur_roc->hw_begun && new_roc->duration > cur_roc->duration) | |
a2fcfccb JB |
503 | return false; |
504 | ||
aaa016cc JB |
505 | remaining = cur_roc->start_time + |
506 | msecs_to_jiffies(cur_roc->duration) - | |
507 | now; | |
508 | ||
a2fcfccb JB |
509 | /* if it doesn't fit entirely, schedule a new one */ |
510 | if (new_roc->duration > jiffies_to_msecs(remaining)) | |
511 | return false; | |
512 | ||
aaa016cc JB |
513 | /* add just after the current one so we combine their finish later */ |
514 | list_add(&new_roc->list, &cur_roc->list); | |
515 | ||
516 | /* if the existing one has already begun then let this one also | |
517 | * begin, otherwise they'll both be marked properly by the work | |
518 | * struct that runs once the driver notifies us of the beginning | |
519 | */ | |
e6a8a3aa JB |
520 | if (cur_roc->hw_begun) { |
521 | new_roc->hw_begun = true; | |
aaa016cc | 522 | ieee80211_handle_roc_started(new_roc, now); |
e6a8a3aa | 523 | } |
a2fcfccb | 524 | |
a2fcfccb JB |
525 | return true; |
526 | } | |
527 | ||
528 | static int ieee80211_start_roc_work(struct ieee80211_local *local, | |
529 | struct ieee80211_sub_if_data *sdata, | |
530 | struct ieee80211_channel *channel, | |
531 | unsigned int duration, u64 *cookie, | |
532 | struct sk_buff *txskb, | |
533 | enum ieee80211_roc_type type) | |
534 | { | |
535 | struct ieee80211_roc_work *roc, *tmp; | |
aaa016cc | 536 | bool queued = false, combine_started = true; |
a2fcfccb JB |
537 | int ret; |
538 | ||
0cd8080e | 539 | lockdep_assert_wiphy(local->hw.wiphy); |
a2fcfccb | 540 | |
b6011960 TP |
541 | if (channel->freq_offset) |
542 | /* this may work, but is untested */ | |
543 | return -EOPNOTSUPP; | |
544 | ||
0a44dfc0 | 545 | if (!local->emulate_chanctx && !local->ops->remain_on_channel) |
a2fcfccb JB |
546 | return -EOPNOTSUPP; |
547 | ||
548 | roc = kzalloc(sizeof(*roc), GFP_KERNEL); | |
549 | if (!roc) | |
550 | return -ENOMEM; | |
551 | ||
552 | /* | |
553 | * If the duration is zero, then the driver | |
554 | * wouldn't actually do anything. Set it to | |
555 | * 10 for now. | |
556 | * | |
557 | * TODO: cancel the off-channel operation | |
558 | * when we get the SKB's TX status and | |
559 | * the wait time was zero before. | |
560 | */ | |
561 | if (!duration) | |
562 | duration = 10; | |
563 | ||
564 | roc->chan = channel; | |
565 | roc->duration = duration; | |
566 | roc->req_duration = duration; | |
567 | roc->frame = txskb; | |
568 | roc->type = type; | |
569 | roc->sdata = sdata; | |
a2fcfccb JB |
570 | |
571 | /* | |
572 | * cookie is either the roc cookie (for normal roc) | |
573 | * or the SKB (for mgmt TX) | |
574 | */ | |
575 | if (!txskb) { | |
576 | roc->cookie = ieee80211_mgmt_tx_cookie(local); | |
577 | *cookie = roc->cookie; | |
578 | } else { | |
579 | roc->mgmt_tx_cookie = *cookie; | |
580 | } | |
581 | ||
aaa016cc JB |
582 | /* if there's no need to queue, handle it immediately */ |
583 | if (list_empty(&local->roc_list) && | |
584 | !local->scanning && !ieee80211_is_radar_required(local)) { | |
585 | /* if not HW assist, just queue & schedule work */ | |
586 | if (!local->ops->remain_on_channel) { | |
587 | list_add_tail(&roc->list, &local->roc_list); | |
97c19e42 JB |
588 | wiphy_delayed_work_queue(local->hw.wiphy, |
589 | &local->roc_work, 0); | |
aaa016cc JB |
590 | } else { |
591 | /* otherwise actually kick it off here | |
592 | * (for error handling) | |
593 | */ | |
594 | ret = drv_remain_on_channel(local, sdata, channel, | |
595 | duration, type); | |
596 | if (ret) { | |
597 | kfree(roc); | |
598 | return ret; | |
599 | } | |
600 | roc->started = true; | |
601 | list_add_tail(&roc->list, &local->roc_list); | |
602 | } | |
a2fcfccb | 603 | |
aaa016cc | 604 | return 0; |
a2fcfccb JB |
605 | } |
606 | ||
aaa016cc | 607 | /* otherwise handle queueing */ |
a2fcfccb | 608 | |
a2fcfccb JB |
609 | list_for_each_entry(tmp, &local->roc_list, list) { |
610 | if (tmp->chan != channel || tmp->sdata != sdata) | |
611 | continue; | |
612 | ||
613 | /* | |
aaa016cc JB |
614 | * Extend this ROC if possible: If it hasn't started, add |
615 | * just after the new one to combine. | |
a2fcfccb JB |
616 | */ |
617 | if (!tmp->started) { | |
aaa016cc | 618 | list_add(&roc->list, &tmp->list); |
a2fcfccb JB |
619 | queued = true; |
620 | break; | |
621 | } | |
622 | ||
aaa016cc JB |
623 | if (!combine_started) |
624 | continue; | |
a2fcfccb | 625 | |
aaa016cc JB |
626 | if (!local->ops->remain_on_channel) { |
627 | /* If there's no hardware remain-on-channel, and | |
628 | * doing so won't push us over the maximum r-o-c | |
629 | * we allow, then we can just add the new one to | |
630 | * the list and mark it as having started now. | |
631 | * If it would push over the limit, don't try to | |
632 | * combine with other started ones (that haven't | |
633 | * been running as long) but potentially sort it | |
634 | * with others that had the same fate. | |
a2fcfccb | 635 | */ |
aaa016cc JB |
636 | unsigned long now = jiffies; |
637 | u32 elapsed = jiffies_to_msecs(now - tmp->start_time); | |
638 | struct wiphy *wiphy = local->hw.wiphy; | |
639 | u32 max_roc = wiphy->max_remain_on_channel_duration; | |
a2fcfccb | 640 | |
aaa016cc JB |
641 | if (elapsed + roc->duration > max_roc) { |
642 | combine_started = false; | |
643 | continue; | |
644 | } | |
a2fcfccb | 645 | |
aaa016cc JB |
646 | list_add(&roc->list, &tmp->list); |
647 | queued = true; | |
648 | roc->on_channel = tmp->on_channel; | |
649 | ieee80211_handle_roc_started(roc, now); | |
e9db4557 | 650 | ieee80211_recalc_sw_work(local, now); |
aaa016cc | 651 | break; |
a2fcfccb | 652 | } |
aaa016cc JB |
653 | |
654 | queued = ieee80211_coalesce_hw_started_roc(local, roc, tmp); | |
655 | if (queued) | |
656 | break; | |
657 | /* if it wasn't queued, perhaps it can be combined with | |
658 | * another that also couldn't get combined previously, | |
659 | * but no need to check for already started ones, since | |
660 | * that can't work. | |
661 | */ | |
662 | combine_started = false; | |
a2fcfccb JB |
663 | } |
664 | ||
a2fcfccb JB |
665 | if (!queued) |
666 | list_add_tail(&roc->list, &local->roc_list); | |
667 | ||
668 | return 0; | |
669 | } | |
670 | ||
671 | int ieee80211_remain_on_channel(struct wiphy *wiphy, struct wireless_dev *wdev, | |
672 | struct ieee80211_channel *chan, | |
673 | unsigned int duration, u64 *cookie) | |
674 | { | |
675 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); | |
676 | struct ieee80211_local *local = sdata->local; | |
a2fcfccb | 677 | |
0cd8080e | 678 | lockdep_assert_wiphy(local->hw.wiphy); |
a2fcfccb | 679 | |
0cd8080e JB |
680 | return ieee80211_start_roc_work(local, sdata, chan, |
681 | duration, cookie, NULL, | |
682 | IEEE80211_ROC_TYPE_NORMAL); | |
a2fcfccb JB |
683 | } |
684 | ||
685 | static int ieee80211_cancel_roc(struct ieee80211_local *local, | |
686 | u64 cookie, bool mgmt_tx) | |
687 | { | |
688 | struct ieee80211_roc_work *roc, *tmp, *found = NULL; | |
689 | int ret; | |
690 | ||
0cd8080e JB |
691 | lockdep_assert_wiphy(local->hw.wiphy); |
692 | ||
7d37fcd4 JB |
693 | if (!cookie) |
694 | return -ENOENT; | |
695 | ||
97c19e42 | 696 | wiphy_work_flush(local->hw.wiphy, &local->hw_roc_start); |
6e46d8ce | 697 | |
a2fcfccb | 698 | list_for_each_entry_safe(roc, tmp, &local->roc_list, list) { |
a2fcfccb JB |
699 | if (!mgmt_tx && roc->cookie != cookie) |
700 | continue; | |
701 | else if (mgmt_tx && roc->mgmt_tx_cookie != cookie) | |
702 | continue; | |
703 | ||
704 | found = roc; | |
705 | break; | |
706 | } | |
707 | ||
708 | if (!found) { | |
a2fcfccb JB |
709 | return -ENOENT; |
710 | } | |
711 | ||
aaa016cc JB |
712 | if (!found->started) { |
713 | ieee80211_roc_notify_destroy(found); | |
714 | goto out_unlock; | |
715 | } | |
a2fcfccb JB |
716 | |
717 | if (local->ops->remain_on_channel) { | |
5db4c4b9 | 718 | ret = drv_cancel_remain_on_channel(local, roc->sdata); |
aaa016cc | 719 | if (WARN_ON_ONCE(ret)) { |
aaa016cc | 720 | return ret; |
a2fcfccb JB |
721 | } |
722 | ||
9ad08fb1 EG |
723 | /* |
724 | * We could be racing against the notification from the driver: | |
725 | * + driver is handling the notification on CPU0 | |
726 | * + user space is cancelling the remain on channel and | |
727 | * schedules the hw_roc_done worker. | |
728 | * | |
729 | * Now hw_roc_done might start to run after the next roc will | |
730 | * start and mac80211 will think that this second roc has | |
731 | * ended prematurely. | |
732 | * Cancel the work to make sure that all the pending workers | |
733 | * have completed execution. | |
734 | * Note that this assumes that by the time the driver returns | |
735 | * from drv_cancel_remain_on_channel, it has completed all | |
736 | * the processing of related notifications. | |
737 | */ | |
738 | wiphy_work_cancel(local->hw.wiphy, &local->hw_roc_done); | |
739 | ||
aaa016cc JB |
740 | /* TODO: |
741 | * if multiple items were combined here then we really shouldn't | |
742 | * cancel them all - we should wait for as much time as needed | |
743 | * for the longest remaining one, and only then cancel ... | |
744 | */ | |
745 | list_for_each_entry_safe(roc, tmp, &local->roc_list, list) { | |
746 | if (!roc->started) | |
747 | break; | |
748 | if (roc == found) | |
749 | found = NULL; | |
750 | ieee80211_roc_notify_destroy(roc); | |
751 | } | |
a2fcfccb | 752 | |
aaa016cc JB |
753 | /* that really must not happen - it was started */ |
754 | WARN_ON(found); | |
a2fcfccb | 755 | |
aaa016cc | 756 | ieee80211_start_next_roc(local); |
a2fcfccb | 757 | } else { |
aaa016cc | 758 | /* go through work struct to return to the operating channel */ |
a2fcfccb | 759 | found->abort = true; |
97c19e42 | 760 | wiphy_delayed_work_queue(local->hw.wiphy, &local->roc_work, 0); |
a2fcfccb JB |
761 | } |
762 | ||
aaa016cc | 763 | out_unlock: |
aaa016cc | 764 | |
a2fcfccb JB |
765 | return 0; |
766 | } | |
767 | ||
768 | int ieee80211_cancel_remain_on_channel(struct wiphy *wiphy, | |
769 | struct wireless_dev *wdev, u64 cookie) | |
770 | { | |
771 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); | |
772 | struct ieee80211_local *local = sdata->local; | |
773 | ||
774 | return ieee80211_cancel_roc(local, cookie, false); | |
775 | } | |
776 | ||
777 | int ieee80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, | |
778 | struct cfg80211_mgmt_tx_params *params, u64 *cookie) | |
779 | { | |
780 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); | |
781 | struct ieee80211_local *local = sdata->local; | |
5ee00dbd | 782 | struct sk_buff *skb; |
e1e68b14 | 783 | struct sta_info *sta = NULL; |
a2fcfccb JB |
784 | const struct ieee80211_mgmt *mgmt = (void *)params->buf; |
785 | bool need_offchan = false; | |
e1e68b14 JB |
786 | bool mlo_sta = false; |
787 | int link_id = -1; | |
a2fcfccb JB |
788 | u32 flags; |
789 | int ret; | |
790 | u8 *data; | |
791 | ||
0cd8080e JB |
792 | lockdep_assert_wiphy(local->hw.wiphy); |
793 | ||
a2fcfccb JB |
794 | if (params->dont_wait_for_ack) |
795 | flags = IEEE80211_TX_CTL_NO_ACK; | |
796 | else | |
797 | flags = IEEE80211_TX_INTFL_NL80211_FRAME_TX | | |
798 | IEEE80211_TX_CTL_REQ_TX_STATUS; | |
799 | ||
800 | if (params->no_cck) | |
801 | flags |= IEEE80211_TX_CTL_NO_CCK_RATE; | |
802 | ||
803 | switch (sdata->vif.type) { | |
804 | case NL80211_IFTYPE_ADHOC: | |
f276e20b | 805 | if (!sdata->vif.cfg.ibss_joined) |
a2fcfccb | 806 | need_offchan = true; |
a2fcfccb | 807 | #ifdef CONFIG_MAC80211_MESH |
fc0561dc | 808 | fallthrough; |
a2fcfccb JB |
809 | case NL80211_IFTYPE_MESH_POINT: |
810 | if (ieee80211_vif_is_mesh(&sdata->vif) && | |
811 | !sdata->u.mesh.mesh_id_len) | |
812 | need_offchan = true; | |
a2fcfccb | 813 | #endif |
fc0561dc | 814 | fallthrough; |
a2fcfccb JB |
815 | case NL80211_IFTYPE_AP: |
816 | case NL80211_IFTYPE_AP_VLAN: | |
817 | case NL80211_IFTYPE_P2P_GO: | |
818 | if (sdata->vif.type != NL80211_IFTYPE_ADHOC && | |
819 | !ieee80211_vif_is_mesh(&sdata->vif) && | |
bfd8403a | 820 | !sdata->bss->active) |
a2fcfccb | 821 | need_offchan = true; |
e1e68b14 JB |
822 | |
823 | rcu_read_lock(); | |
824 | sta = sta_info_get_bss(sdata, mgmt->da); | |
825 | mlo_sta = sta && sta->sta.mlo; | |
826 | ||
a2fcfccb JB |
827 | if (!ieee80211_is_action(mgmt->frame_control) || |
828 | mgmt->u.action.category == WLAN_CATEGORY_PUBLIC || | |
829 | mgmt->u.action.category == WLAN_CATEGORY_SELF_PROTECTED || | |
e1e68b14 JB |
830 | mgmt->u.action.category == WLAN_CATEGORY_SPECTRUM_MGMT) { |
831 | rcu_read_unlock(); | |
a2fcfccb | 832 | break; |
e1e68b14 JB |
833 | } |
834 | ||
835 | if (!sta) { | |
836 | rcu_read_unlock(); | |
a2fcfccb | 837 | return -ENOLINK; |
e1e68b14 JB |
838 | } |
839 | if (params->link_id >= 0 && | |
840 | !(sta->sta.valid_links & BIT(params->link_id))) { | |
841 | rcu_read_unlock(); | |
842 | return -ENOLINK; | |
843 | } | |
844 | link_id = params->link_id; | |
845 | rcu_read_unlock(); | |
a2fcfccb JB |
846 | break; |
847 | case NL80211_IFTYPE_STATION: | |
848 | case NL80211_IFTYPE_P2P_CLIENT: | |
a2fcfccb JB |
849 | if (!sdata->u.mgd.associated || |
850 | (params->offchan && params->wait && | |
851 | local->ops->remain_on_channel && | |
563fe446 | 852 | memcmp(sdata->vif.cfg.ap_addr, mgmt->bssid, ETH_ALEN))) { |
a2fcfccb | 853 | need_offchan = true; |
563fe446 IP |
854 | } else if (sdata->u.mgd.associated && |
855 | ether_addr_equal(sdata->vif.cfg.ap_addr, mgmt->da)) { | |
856 | sta = sta_info_get_bss(sdata, mgmt->da); | |
857 | mlo_sta = sta && sta->sta.mlo; | |
858 | } | |
a2fcfccb JB |
859 | break; |
860 | case NL80211_IFTYPE_P2P_DEVICE: | |
861 | need_offchan = true; | |
862 | break; | |
cb3b7d87 | 863 | case NL80211_IFTYPE_NAN: |
a2fcfccb JB |
864 | default: |
865 | return -EOPNOTSUPP; | |
866 | } | |
867 | ||
868 | /* configurations requiring offchan cannot work if no channel has been | |
869 | * specified | |
870 | */ | |
871 | if (need_offchan && !params->chan) | |
872 | return -EINVAL; | |
873 | ||
a2fcfccb | 874 | /* Check if the operating channel is the requested channel */ |
e1e68b14 JB |
875 | if (!params->chan && mlo_sta) { |
876 | need_offchan = false; | |
877 | } else if (!need_offchan) { | |
54283409 AO |
878 | struct ieee80211_chanctx_conf *chanctx_conf = NULL; |
879 | int i; | |
a2fcfccb JB |
880 | |
881 | rcu_read_lock(); | |
54283409 AO |
882 | /* Check all the links first */ |
883 | for (i = 0; i < ARRAY_SIZE(sdata->vif.link_conf); i++) { | |
d8675a63 JB |
884 | struct ieee80211_bss_conf *conf; |
885 | ||
886 | conf = rcu_dereference(sdata->vif.link_conf[i]); | |
887 | if (!conf) | |
54283409 AO |
888 | continue; |
889 | ||
d8675a63 | 890 | chanctx_conf = rcu_dereference(conf->chanctx_conf); |
54283409 AO |
891 | if (!chanctx_conf) |
892 | continue; | |
893 | ||
e1e68b14 JB |
894 | if (mlo_sta && params->chan == chanctx_conf->def.chan && |
895 | ether_addr_equal(sdata->vif.addr, mgmt->sa)) { | |
896 | link_id = i; | |
897 | break; | |
898 | } | |
899 | ||
b0d2d8f9 S |
900 | if (ether_addr_equal(conf->addr, mgmt->sa)) { |
901 | /* If userspace requested Tx on a specific link | |
902 | * use the same link id if the link bss is matching | |
903 | * the requested chan. | |
904 | */ | |
905 | if (sdata->vif.valid_links && | |
906 | params->link_id >= 0 && params->link_id == i && | |
907 | params->chan == chanctx_conf->def.chan) | |
908 | link_id = i; | |
909 | ||
54283409 | 910 | break; |
b0d2d8f9 | 911 | } |
54283409 AO |
912 | |
913 | chanctx_conf = NULL; | |
914 | } | |
a2fcfccb JB |
915 | |
916 | if (chanctx_conf) { | |
917 | need_offchan = params->chan && | |
918 | (params->chan != | |
919 | chanctx_conf->def.chan); | |
a2fcfccb JB |
920 | } else { |
921 | need_offchan = true; | |
922 | } | |
923 | rcu_read_unlock(); | |
924 | } | |
925 | ||
926 | if (need_offchan && !params->offchan) { | |
927 | ret = -EBUSY; | |
928 | goto out_unlock; | |
929 | } | |
930 | ||
931 | skb = dev_alloc_skb(local->hw.extra_tx_headroom + params->len); | |
932 | if (!skb) { | |
933 | ret = -ENOMEM; | |
934 | goto out_unlock; | |
935 | } | |
936 | skb_reserve(skb, local->hw.extra_tx_headroom); | |
937 | ||
59ae1d12 | 938 | data = skb_put_data(skb, params->buf, params->len); |
a2fcfccb JB |
939 | |
940 | /* Update CSA counters */ | |
d0a9123e | 941 | if (sdata->vif.bss_conf.csa_active && |
a2fcfccb JB |
942 | (sdata->vif.type == NL80211_IFTYPE_AP || |
943 | sdata->vif.type == NL80211_IFTYPE_MESH_POINT || | |
944 | sdata->vif.type == NL80211_IFTYPE_ADHOC) && | |
945 | params->n_csa_offsets) { | |
946 | int i; | |
947 | struct beacon_data *beacon = NULL; | |
948 | ||
949 | rcu_read_lock(); | |
950 | ||
951 | if (sdata->vif.type == NL80211_IFTYPE_AP) | |
bfd8403a | 952 | beacon = rcu_dereference(sdata->deflink.u.ap.beacon); |
a2fcfccb JB |
953 | else if (sdata->vif.type == NL80211_IFTYPE_ADHOC) |
954 | beacon = rcu_dereference(sdata->u.ibss.presp); | |
955 | else if (ieee80211_vif_is_mesh(&sdata->vif)) | |
956 | beacon = rcu_dereference(sdata->u.mesh.beacon); | |
957 | ||
958 | if (beacon) | |
959 | for (i = 0; i < params->n_csa_offsets; i++) | |
960 | data[params->csa_offsets[i]] = | |
8552a434 | 961 | beacon->cntdwn_current_counter; |
a2fcfccb JB |
962 | |
963 | rcu_read_unlock(); | |
964 | } | |
965 | ||
966 | IEEE80211_SKB_CB(skb)->flags = flags; | |
967 | ||
968 | skb->dev = sdata->dev; | |
969 | ||
970 | if (!params->dont_wait_for_ack) { | |
971 | /* make a copy to preserve the frame contents | |
972 | * in case of encryption. | |
973 | */ | |
5ee00dbd JB |
974 | ret = ieee80211_attach_ack_skb(local, skb, cookie, GFP_KERNEL); |
975 | if (ret) { | |
a2fcfccb JB |
976 | kfree_skb(skb); |
977 | goto out_unlock; | |
978 | } | |
979 | } else { | |
980 | /* Assign a dummy non-zero cookie, it's not sent to | |
981 | * userspace in this case but we rely on its value | |
982 | * internally in the need_offchan case to distinguish | |
983 | * mgmt-tx from remain-on-channel. | |
984 | */ | |
985 | *cookie = 0xffffffff; | |
986 | } | |
987 | ||
988 | if (!need_offchan) { | |
e1e68b14 | 989 | ieee80211_tx_skb_tid(sdata, skb, 7, link_id); |
a2fcfccb JB |
990 | ret = 0; |
991 | goto out_unlock; | |
992 | } | |
993 | ||
994 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_TX_OFFCHAN | | |
995 | IEEE80211_TX_INTFL_OFFCHAN_TX_OK; | |
996 | if (ieee80211_hw_check(&local->hw, QUEUE_CONTROL)) | |
997 | IEEE80211_SKB_CB(skb)->hw_queue = | |
998 | local->hw.offchannel_tx_hw_queue; | |
999 | ||
1000 | /* This will handle all kinds of coalescing and immediate TX */ | |
1001 | ret = ieee80211_start_roc_work(local, sdata, params->chan, | |
1002 | params->wait, cookie, skb, | |
1003 | IEEE80211_ROC_TYPE_MGMT_TX); | |
1004 | if (ret) | |
1005 | ieee80211_free_txskb(&local->hw, skb); | |
1006 | out_unlock: | |
a2fcfccb JB |
1007 | return ret; |
1008 | } | |
1009 | ||
1010 | int ieee80211_mgmt_tx_cancel_wait(struct wiphy *wiphy, | |
1011 | struct wireless_dev *wdev, u64 cookie) | |
1012 | { | |
1013 | struct ieee80211_local *local = wiphy_priv(wiphy); | |
1014 | ||
1015 | return ieee80211_cancel_roc(local, cookie, true); | |
1016 | } | |
1017 | ||
2eb278e0 | 1018 | void ieee80211_roc_setup(struct ieee80211_local *local) |
21f83589 | 1019 | { |
97c19e42 JB |
1020 | wiphy_work_init(&local->hw_roc_start, ieee80211_hw_roc_start); |
1021 | wiphy_work_init(&local->hw_roc_done, ieee80211_hw_roc_done); | |
1022 | wiphy_delayed_work_init(&local->roc_work, ieee80211_roc_work); | |
2eb278e0 JB |
1023 | INIT_LIST_HEAD(&local->roc_list); |
1024 | } | |
1025 | ||
c8f994ee JB |
1026 | void ieee80211_roc_purge(struct ieee80211_local *local, |
1027 | struct ieee80211_sub_if_data *sdata) | |
2eb278e0 | 1028 | { |
2eb278e0 | 1029 | struct ieee80211_roc_work *roc, *tmp; |
aaa016cc | 1030 | bool work_to_do = false; |
2eb278e0 | 1031 | |
0cd8080e JB |
1032 | lockdep_assert_wiphy(local->hw.wiphy); |
1033 | ||
2eb278e0 | 1034 | list_for_each_entry_safe(roc, tmp, &local->roc_list, list) { |
c8f994ee | 1035 | if (sdata && roc->sdata != sdata) |
2eb278e0 JB |
1036 | continue; |
1037 | ||
aaa016cc JB |
1038 | if (roc->started) { |
1039 | if (local->ops->remain_on_channel) { | |
1040 | /* can race, so ignore return value */ | |
c6968d4f | 1041 | drv_cancel_remain_on_channel(local, roc->sdata); |
aaa016cc JB |
1042 | ieee80211_roc_notify_destroy(roc); |
1043 | } else { | |
1044 | roc->abort = true; | |
1045 | work_to_do = true; | |
1046 | } | |
2eb278e0 | 1047 | } else { |
aaa016cc | 1048 | ieee80211_roc_notify_destroy(roc); |
2eb278e0 JB |
1049 | } |
1050 | } | |
aaa016cc JB |
1051 | if (work_to_do) |
1052 | __ieee80211_roc_work(local); | |
21f83589 | 1053 | } |