1 | /* |
2 | * Copyright (c) 2014 Qualcomm Atheros, Inc. |
3 | * |
4 | * Permission to use, copy, modify, and/or distribute this software for any |
5 | * purpose with or without fee is hereby granted, provided that the above |
6 | * copyright notice and this permission notice appear in all copies. |
7 | * |
8 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
9 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
10 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
11 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
12 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
13 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
14 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
15 | */ |
16 | |
17 | #include "ath9k.h" |
18 | |
19 | /* Set/change channels. If the channel is really being changed, it's done |
20 | * by reseting the chip. To accomplish this we must first cleanup any pending |
21 | * DMA, then restart stuff. |
22 | */ |
23 | static int ath_set_channel(struct ath_softc *sc) |
24 | { |
25 | struct ath_hw *ah = sc->sc_ah; |
26 | struct ath_common *common = ath9k_hw_common(ah); |
27 | struct ieee80211_hw *hw = sc->hw; |
28 | struct ath9k_channel *hchan; |
29 | struct cfg80211_chan_def *chandef = &sc->cur_chan->chandef; |
30 | struct ieee80211_channel *chan = chandef->chan; |
31 | int pos = chan->hw_value; |
32 | unsigned long flags; |
33 | int old_pos = -1; |
34 | int r; |
35 | |
36 | if (test_bit(ATH_OP_INVALID, &common->op_flags)) |
37 | return -EIO; |
38 | |
39 | if (ah->curchan) |
40 | old_pos = ah->curchan - &ah->channels[0]; |
41 | |
42 | ath_dbg(common, CONFIG, "Set channel: %d MHz width: %d\n" , |
43 | chan->center_freq, chandef->width); |
44 | |
45 | /* update survey stats for the old channel before switching */ |
46 | spin_lock_irqsave(&common->cc_lock, flags); |
47 | ath_update_survey_stats(sc); |
48 | spin_unlock_irqrestore(lock: &common->cc_lock, flags); |
49 | |
50 | ath9k_cmn_get_channel(hw, ah, chandef); |
51 | |
52 | /* If the operating channel changes, change the survey in-use flags |
53 | * along with it. |
54 | * Reset the survey data for the new channel, unless we're switching |
55 | * back to the operating channel from an off-channel operation. |
56 | */ |
57 | if (!sc->cur_chan->offchannel && sc->cur_survey != &sc->survey[pos]) { |
58 | if (sc->cur_survey) |
59 | sc->cur_survey->filled &= ~SURVEY_INFO_IN_USE; |
60 | |
61 | sc->cur_survey = &sc->survey[pos]; |
62 | |
63 | memset(sc->cur_survey, 0, sizeof(struct survey_info)); |
64 | sc->cur_survey->filled |= SURVEY_INFO_IN_USE; |
65 | } else if (!(sc->survey[pos].filled & SURVEY_INFO_IN_USE)) { |
66 | memset(&sc->survey[pos], 0, sizeof(struct survey_info)); |
67 | } |
68 | |
69 | hchan = &sc->sc_ah->channels[pos]; |
70 | r = ath_reset(sc, hchan); |
71 | if (r) |
72 | return r; |
73 | |
74 | /* The most recent snapshot of channel->noisefloor for the old |
75 | * channel is only available after the hardware reset. Copy it to |
76 | * the survey stats now. |
77 | */ |
78 | if (old_pos >= 0) |
79 | ath_update_survey_nf(sc, channel: old_pos); |
80 | |
81 | /* Enable radar pulse detection if on a DFS channel. Spectral |
82 | * scanning and radar detection can not be used concurrently. |
83 | */ |
84 | if (hw->conf.radar_enabled) { |
85 | u32 rxfilter; |
86 | |
87 | rxfilter = ath9k_hw_getrxfilter(ah); |
88 | rxfilter |= ATH9K_RX_FILTER_PHYRADAR | |
89 | ATH9K_RX_FILTER_PHYERR; |
90 | ath9k_hw_setrxfilter(ah, bits: rxfilter); |
91 | ath_dbg(common, DFS, "DFS enabled at freq %d\n" , |
92 | chan->center_freq); |
93 | } else { |
94 | /* perform spectral scan if requested. */ |
95 | if (test_bit(ATH_OP_SCANNING, &common->op_flags) && |
96 | sc->spec_priv.spectral_mode == SPECTRAL_CHANSCAN) |
97 | ath9k_cmn_spectral_scan_trigger(common, spec_priv: &sc->spec_priv); |
98 | } |
99 | |
100 | return 0; |
101 | } |
102 | |
103 | void ath_chanctx_init(struct ath_softc *sc) |
104 | { |
105 | struct ath_chanctx *ctx; |
106 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
107 | struct ieee80211_supported_band *sband; |
108 | struct ieee80211_channel *chan; |
109 | int i, j; |
110 | |
111 | sband = &common->sbands[NL80211_BAND_2GHZ]; |
112 | if (!sband->n_channels) |
113 | sband = &common->sbands[NL80211_BAND_5GHZ]; |
114 | |
115 | chan = &sband->channels[0]; |
116 | for (i = 0; i < ATH9K_NUM_CHANCTX; i++) { |
117 | ctx = &sc->chanctx[i]; |
118 | cfg80211_chandef_create(chandef: &ctx->chandef, channel: chan, chantype: NL80211_CHAN_HT20); |
119 | INIT_LIST_HEAD(list: &ctx->vifs); |
120 | ctx->txpower = ATH_TXPOWER_MAX; |
121 | ctx->flush_timeout = HZ / 5; /* 200ms */ |
122 | for (j = 0; j < ARRAY_SIZE(ctx->acq); j++) { |
123 | INIT_LIST_HEAD(list: &ctx->acq[j].acq_new); |
124 | INIT_LIST_HEAD(list: &ctx->acq[j].acq_old); |
125 | spin_lock_init(&ctx->acq[j].lock); |
126 | } |
127 | } |
128 | } |
129 | |
130 | void ath_chanctx_set_channel(struct ath_softc *sc, struct ath_chanctx *ctx, |
131 | struct cfg80211_chan_def *chandef) |
132 | { |
133 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
134 | bool cur_chan; |
135 | |
136 | spin_lock_bh(lock: &sc->chan_lock); |
137 | if (chandef) |
138 | memcpy(&ctx->chandef, chandef, sizeof(*chandef)); |
139 | cur_chan = sc->cur_chan == ctx; |
140 | spin_unlock_bh(lock: &sc->chan_lock); |
141 | |
142 | if (!cur_chan) { |
143 | ath_dbg(common, CHAN_CTX, |
144 | "Current context differs from the new context\n" ); |
145 | return; |
146 | } |
147 | |
148 | ath_set_channel(sc); |
149 | } |
150 | |
151 | #ifdef CONFIG_ATH9K_CHANNEL_CONTEXT |
152 | |
153 | /*************/ |
154 | /* Utilities */ |
155 | /*************/ |
156 | |
157 | struct ath_chanctx* ath_is_go_chanctx_present(struct ath_softc *sc) |
158 | { |
159 | struct ath_chanctx *ctx; |
160 | struct ath_vif *avp; |
161 | struct ieee80211_vif *vif; |
162 | |
163 | spin_lock_bh(lock: &sc->chan_lock); |
164 | |
165 | ath_for_each_chanctx(sc, ctx) { |
166 | if (!ctx->active) |
167 | continue; |
168 | |
169 | list_for_each_entry(avp, &ctx->vifs, list) { |
170 | vif = avp->vif; |
171 | |
172 | if (ieee80211_vif_type_p2p(vif) == NL80211_IFTYPE_P2P_GO) { |
173 | spin_unlock_bh(lock: &sc->chan_lock); |
174 | return ctx; |
175 | } |
176 | } |
177 | } |
178 | |
179 | spin_unlock_bh(lock: &sc->chan_lock); |
180 | return NULL; |
181 | } |
182 | |
183 | /**********************************************************/ |
184 | /* Functions to handle the channel context state machine. */ |
185 | /**********************************************************/ |
186 | |
187 | static const char *offchannel_state_string(enum ath_offchannel_state state) |
188 | { |
189 | switch (state) { |
190 | case_rtn_string(ATH_OFFCHANNEL_IDLE); |
191 | case_rtn_string(ATH_OFFCHANNEL_PROBE_SEND); |
192 | case_rtn_string(ATH_OFFCHANNEL_PROBE_WAIT); |
193 | case_rtn_string(ATH_OFFCHANNEL_SUSPEND); |
194 | case_rtn_string(ATH_OFFCHANNEL_ROC_START); |
195 | case_rtn_string(ATH_OFFCHANNEL_ROC_WAIT); |
196 | case_rtn_string(ATH_OFFCHANNEL_ROC_DONE); |
197 | default: |
198 | return "unknown" ; |
199 | } |
200 | } |
201 | |
202 | static const char *chanctx_event_string(enum ath_chanctx_event ev) |
203 | { |
204 | switch (ev) { |
205 | case_rtn_string(ATH_CHANCTX_EVENT_BEACON_PREPARE); |
206 | case_rtn_string(ATH_CHANCTX_EVENT_BEACON_SENT); |
207 | case_rtn_string(ATH_CHANCTX_EVENT_TSF_TIMER); |
208 | case_rtn_string(ATH_CHANCTX_EVENT_BEACON_RECEIVED); |
209 | case_rtn_string(ATH_CHANCTX_EVENT_AUTHORIZED); |
210 | case_rtn_string(ATH_CHANCTX_EVENT_SWITCH); |
211 | case_rtn_string(ATH_CHANCTX_EVENT_ASSIGN); |
212 | case_rtn_string(ATH_CHANCTX_EVENT_UNASSIGN); |
213 | case_rtn_string(ATH_CHANCTX_EVENT_CHANGE); |
214 | case_rtn_string(ATH_CHANCTX_EVENT_ENABLE_MULTICHANNEL); |
215 | default: |
216 | return "unknown" ; |
217 | } |
218 | } |
219 | |
220 | static const char *chanctx_state_string(enum ath_chanctx_state state) |
221 | { |
222 | switch (state) { |
223 | case_rtn_string(ATH_CHANCTX_STATE_IDLE); |
224 | case_rtn_string(ATH_CHANCTX_STATE_WAIT_FOR_BEACON); |
225 | case_rtn_string(ATH_CHANCTX_STATE_WAIT_FOR_TIMER); |
226 | case_rtn_string(ATH_CHANCTX_STATE_SWITCH); |
227 | case_rtn_string(ATH_CHANCTX_STATE_FORCE_ACTIVE); |
228 | default: |
229 | return "unknown" ; |
230 | } |
231 | } |
232 | |
233 | static u32 chanctx_event_delta(struct ath_softc *sc) |
234 | { |
235 | u64 ms; |
236 | struct timespec64 ts, *old; |
237 | |
238 | ktime_get_raw_ts64(ts: &ts); |
239 | old = &sc->last_event_time; |
240 | ms = ts.tv_sec * 1000 + ts.tv_nsec / 1000000; |
241 | ms -= old->tv_sec * 1000 + old->tv_nsec / 1000000; |
242 | sc->last_event_time = ts; |
243 | |
244 | return (u32)ms; |
245 | } |
246 | |
247 | void ath_chanctx_check_active(struct ath_softc *sc, struct ath_chanctx *ctx) |
248 | { |
249 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
250 | struct ath_chanctx *ictx; |
251 | struct ath_vif *avp; |
252 | bool active = false; |
253 | u8 n_active = 0; |
254 | |
255 | if (!ctx) |
256 | return; |
257 | |
258 | if (ctx == &sc->offchannel.chan) { |
259 | spin_lock_bh(lock: &sc->chan_lock); |
260 | |
261 | if (likely(sc->sched.channel_switch_time)) |
262 | ctx->flush_timeout = |
263 | usecs_to_jiffies(u: sc->sched.channel_switch_time); |
264 | else |
265 | ctx->flush_timeout = |
266 | msecs_to_jiffies(m: 10); |
267 | |
268 | spin_unlock_bh(lock: &sc->chan_lock); |
269 | |
270 | /* |
271 | * There is no need to iterate over the |
272 | * active/assigned channel contexts if |
273 | * the current context is offchannel. |
274 | */ |
275 | return; |
276 | } |
277 | |
278 | ictx = ctx; |
279 | |
280 | list_for_each_entry(avp, &ctx->vifs, list) { |
281 | struct ieee80211_vif *vif = avp->vif; |
282 | |
283 | switch (vif->type) { |
284 | case NL80211_IFTYPE_P2P_CLIENT: |
285 | case NL80211_IFTYPE_STATION: |
286 | if (avp->assoc) |
287 | active = true; |
288 | break; |
289 | default: |
290 | active = true; |
291 | break; |
292 | } |
293 | } |
294 | ctx->active = active; |
295 | |
296 | ath_for_each_chanctx(sc, ctx) { |
297 | if (!ctx->assigned || list_empty(head: &ctx->vifs)) |
298 | continue; |
299 | n_active++; |
300 | } |
301 | |
302 | spin_lock_bh(lock: &sc->chan_lock); |
303 | |
304 | if (n_active <= 1) { |
305 | ictx->flush_timeout = HZ / 5; |
306 | clear_bit(nr: ATH_OP_MULTI_CHANNEL, addr: &common->op_flags); |
307 | spin_unlock_bh(lock: &sc->chan_lock); |
308 | return; |
309 | } |
310 | |
311 | ictx->flush_timeout = usecs_to_jiffies(u: sc->sched.channel_switch_time); |
312 | |
313 | if (test_and_set_bit(nr: ATH_OP_MULTI_CHANNEL, addr: &common->op_flags)) { |
314 | spin_unlock_bh(lock: &sc->chan_lock); |
315 | return; |
316 | } |
317 | |
318 | spin_unlock_bh(lock: &sc->chan_lock); |
319 | |
320 | if (ath9k_is_chanctx_enabled()) { |
321 | ath_chanctx_event(sc, NULL, |
322 | ev: ATH_CHANCTX_EVENT_ENABLE_MULTICHANNEL); |
323 | } |
324 | } |
325 | |
326 | static struct ath_chanctx * |
327 | ath_chanctx_get_next(struct ath_softc *sc, struct ath_chanctx *ctx) |
328 | { |
329 | int idx = ctx - &sc->chanctx[0]; |
330 | |
331 | return &sc->chanctx[!idx]; |
332 | } |
333 | |
334 | static void ath_chanctx_adjust_tbtt_delta(struct ath_softc *sc) |
335 | { |
336 | struct ath_chanctx *prev, *cur; |
337 | struct timespec64 ts; |
338 | u32 cur_tsf, prev_tsf, beacon_int; |
339 | s32 offset; |
340 | |
341 | beacon_int = TU_TO_USEC(sc->cur_chan->beacon.beacon_interval); |
342 | |
343 | cur = sc->cur_chan; |
344 | prev = ath_chanctx_get_next(sc, ctx: cur); |
345 | |
346 | if (!prev->switch_after_beacon) |
347 | return; |
348 | |
349 | ktime_get_raw_ts64(ts: &ts); |
350 | cur_tsf = (u32) cur->tsf_val + |
351 | ath9k_hw_get_tsf_offset(last: &cur->tsf_ts, cur: &ts); |
352 | |
353 | prev_tsf = prev->last_beacon - (u32) prev->tsf_val + cur_tsf; |
354 | prev_tsf -= ath9k_hw_get_tsf_offset(last: &prev->tsf_ts, cur: &ts); |
355 | |
356 | /* Adjust the TSF time of the AP chanctx to keep its beacons |
357 | * at half beacon interval offset relative to the STA chanctx. |
358 | */ |
359 | offset = cur_tsf - prev_tsf; |
360 | |
361 | /* Ignore stale data or spurious timestamps */ |
362 | if (offset < 0 || offset > 3 * beacon_int) |
363 | return; |
364 | |
365 | offset = beacon_int / 2 - (offset % beacon_int); |
366 | prev->tsf_val += offset; |
367 | } |
368 | |
369 | /* Configure the TSF based hardware timer for a channel switch. |
370 | * Also set up backup software timer, in case the gen timer fails. |
371 | * This could be caused by a hardware reset. |
372 | */ |
373 | static void ath_chanctx_setup_timer(struct ath_softc *sc, u32 tsf_time) |
374 | { |
375 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
376 | struct ath_hw *ah = sc->sc_ah; |
377 | unsigned long timeout; |
378 | |
379 | ath9k_hw_gen_timer_start(ah, timer: sc->p2p_ps_timer, timer_next: tsf_time, timer_period: 1000000); |
380 | tsf_time -= ath9k_hw_gettsf32(ah); |
381 | timeout = msecs_to_jiffies(m: tsf_time / 1000) + 1; |
382 | mod_timer(timer: &sc->sched.timer, expires: jiffies + timeout); |
383 | |
384 | ath_dbg(common, CHAN_CTX, |
385 | "Setup chanctx timer with timeout: %d (%d) ms\n" , |
386 | tsf_time / 1000, jiffies_to_msecs(timeout)); |
387 | } |
388 | |
389 | static void ath_chanctx_handle_bmiss(struct ath_softc *sc, |
390 | struct ath_chanctx *ctx, |
391 | struct ath_vif *avp) |
392 | { |
393 | /* |
394 | * Clear the extend_absence flag if it had been |
395 | * set during the previous beacon transmission, |
396 | * since we need to revert to the normal NoA |
397 | * schedule. |
398 | */ |
399 | if (ctx->active && sc->sched.extend_absence) { |
400 | avp->noa_duration = 0; |
401 | sc->sched.extend_absence = false; |
402 | } |
403 | |
404 | /* If at least two consecutive beacons were missed on the STA |
405 | * chanctx, stay on the STA channel for one extra beacon period, |
406 | * to resync the timer properly. |
407 | */ |
408 | if (ctx->active && sc->sched.beacon_miss >= 2) { |
409 | avp->noa_duration = 0; |
410 | sc->sched.extend_absence = true; |
411 | } |
412 | } |
413 | |
414 | static void ath_chanctx_offchannel_noa(struct ath_softc *sc, |
415 | struct ath_chanctx *ctx, |
416 | struct ath_vif *avp, |
417 | u32 tsf_time) |
418 | { |
419 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
420 | |
421 | avp->noa_index++; |
422 | avp->offchannel_start = tsf_time; |
423 | avp->offchannel_duration = sc->sched.offchannel_duration; |
424 | |
425 | ath_dbg(common, CHAN_CTX, |
426 | "offchannel noa_duration: %d, noa_start: %u, noa_index: %d\n" , |
427 | avp->offchannel_duration, |
428 | avp->offchannel_start, |
429 | avp->noa_index); |
430 | |
431 | /* |
432 | * When multiple contexts are active, the NoA |
433 | * has to be recalculated and advertised after |
434 | * an offchannel operation. |
435 | */ |
436 | if (ctx->active && avp->noa_duration) |
437 | avp->noa_duration = 0; |
438 | } |
439 | |
440 | static void ath_chanctx_set_periodic_noa(struct ath_softc *sc, |
441 | struct ath_vif *avp, |
442 | struct ath_beacon_config *cur_conf, |
443 | u32 tsf_time, |
444 | u32 beacon_int) |
445 | { |
446 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
447 | |
448 | avp->noa_index++; |
449 | avp->noa_start = tsf_time; |
450 | |
451 | if (sc->sched.extend_absence) |
452 | avp->noa_duration = (3 * beacon_int / 2) + |
453 | sc->sched.channel_switch_time; |
454 | else |
455 | avp->noa_duration = |
456 | TU_TO_USEC(cur_conf->beacon_interval) / 2 + |
457 | sc->sched.channel_switch_time; |
458 | |
459 | if (test_bit(ATH_OP_SCANNING, &common->op_flags) || |
460 | sc->sched.extend_absence) |
461 | avp->periodic_noa = false; |
462 | else |
463 | avp->periodic_noa = true; |
464 | |
465 | ath_dbg(common, CHAN_CTX, |
466 | "noa_duration: %d, noa_start: %u, noa_index: %d, periodic: %d\n" , |
467 | avp->noa_duration, |
468 | avp->noa_start, |
469 | avp->noa_index, |
470 | avp->periodic_noa); |
471 | } |
472 | |
473 | static void ath_chanctx_set_oneshot_noa(struct ath_softc *sc, |
474 | struct ath_vif *avp, |
475 | u32 tsf_time, |
476 | u32 duration) |
477 | { |
478 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
479 | |
480 | avp->noa_index++; |
481 | avp->noa_start = tsf_time; |
482 | avp->periodic_noa = false; |
483 | avp->oneshot_noa = true; |
484 | avp->noa_duration = duration + sc->sched.channel_switch_time; |
485 | |
486 | ath_dbg(common, CHAN_CTX, |
487 | "oneshot noa_duration: %d, noa_start: %u, noa_index: %d, periodic: %d\n" , |
488 | avp->noa_duration, |
489 | avp->noa_start, |
490 | avp->noa_index, |
491 | avp->periodic_noa); |
492 | } |
493 | |
494 | void ath_chanctx_event(struct ath_softc *sc, struct ieee80211_vif *vif, |
495 | enum ath_chanctx_event ev) |
496 | { |
497 | struct ath_hw *ah = sc->sc_ah; |
498 | struct ath_common *common = ath9k_hw_common(ah); |
499 | struct ath_beacon_config *cur_conf; |
500 | struct ath_vif *avp = NULL; |
501 | struct ath_chanctx *ctx; |
502 | u32 tsf_time; |
503 | u32 beacon_int; |
504 | |
505 | if (vif) |
506 | avp = (struct ath_vif *) vif->drv_priv; |
507 | |
508 | spin_lock_bh(lock: &sc->chan_lock); |
509 | |
510 | ath_dbg(common, CHAN_CTX, "cur_chan: %d MHz, event: %s, state: %s, delta: %u ms\n" , |
511 | sc->cur_chan->chandef.center_freq1, |
512 | chanctx_event_string(ev), |
513 | chanctx_state_string(sc->sched.state), |
514 | chanctx_event_delta(sc)); |
515 | |
516 | switch (ev) { |
517 | case ATH_CHANCTX_EVENT_BEACON_PREPARE: |
518 | if (avp->offchannel_duration) |
519 | avp->offchannel_duration = 0; |
520 | |
521 | if (avp->oneshot_noa) { |
522 | avp->noa_duration = 0; |
523 | avp->oneshot_noa = false; |
524 | |
525 | ath_dbg(common, CHAN_CTX, |
526 | "Clearing oneshot NoA\n" ); |
527 | } |
528 | |
529 | if (avp->chanctx != sc->cur_chan) { |
530 | ath_dbg(common, CHAN_CTX, |
531 | "Contexts differ, not preparing beacon\n" ); |
532 | break; |
533 | } |
534 | |
535 | if (sc->sched.offchannel_pending && !sc->sched.wait_switch) { |
536 | sc->sched.offchannel_pending = false; |
537 | sc->next_chan = &sc->offchannel.chan; |
538 | sc->sched.state = ATH_CHANCTX_STATE_WAIT_FOR_BEACON; |
539 | ath_dbg(common, CHAN_CTX, |
540 | "Setting offchannel_pending to false\n" ); |
541 | } |
542 | |
543 | ctx = ath_chanctx_get_next(sc, ctx: sc->cur_chan); |
544 | if (ctx->active && sc->sched.state == ATH_CHANCTX_STATE_IDLE) { |
545 | sc->next_chan = ctx; |
546 | sc->sched.state = ATH_CHANCTX_STATE_WAIT_FOR_BEACON; |
547 | ath_dbg(common, CHAN_CTX, |
548 | "Set next context, move chanctx state to WAIT_FOR_BEACON\n" ); |
549 | } |
550 | |
551 | /* if the timer missed its window, use the next interval */ |
552 | if (sc->sched.state == ATH_CHANCTX_STATE_WAIT_FOR_TIMER) { |
553 | sc->sched.state = ATH_CHANCTX_STATE_WAIT_FOR_BEACON; |
554 | ath_dbg(common, CHAN_CTX, |
555 | "Move chanctx state from WAIT_FOR_TIMER to WAIT_FOR_BEACON\n" ); |
556 | } |
557 | |
558 | if (sc->sched.mgd_prepare_tx) |
559 | sc->sched.state = ATH_CHANCTX_STATE_WAIT_FOR_BEACON; |
560 | |
561 | /* |
562 | * When a context becomes inactive, for example, |
563 | * disassociation of a station context, the NoA |
564 | * attribute needs to be removed from subsequent |
565 | * beacons. |
566 | */ |
567 | if (!ctx->active && avp->noa_duration && |
568 | sc->sched.state != ATH_CHANCTX_STATE_WAIT_FOR_BEACON) { |
569 | avp->noa_duration = 0; |
570 | avp->periodic_noa = false; |
571 | |
572 | ath_dbg(common, CHAN_CTX, |
573 | "Clearing NoA schedule\n" ); |
574 | } |
575 | |
576 | if (sc->sched.state != ATH_CHANCTX_STATE_WAIT_FOR_BEACON) |
577 | break; |
578 | |
579 | ath_dbg(common, CHAN_CTX, "Preparing beacon for vif: %pM\n" , vif->addr); |
580 | |
581 | sc->sched.beacon_pending = true; |
582 | sc->sched.next_tbtt = REG_READ(ah, AR_NEXT_TBTT_TIMER); |
583 | |
584 | cur_conf = &sc->cur_chan->beacon; |
585 | beacon_int = TU_TO_USEC(cur_conf->beacon_interval); |
586 | |
587 | /* defer channel switch by a quarter beacon interval */ |
588 | tsf_time = sc->sched.next_tbtt + beacon_int / 4; |
589 | sc->sched.switch_start_time = tsf_time; |
590 | sc->cur_chan->last_beacon = sc->sched.next_tbtt; |
591 | |
592 | /* |
593 | * If an offchannel switch is scheduled to happen after |
594 | * a beacon transmission, update the NoA with one-shot |
595 | * values and increment the index. |
596 | */ |
597 | if (sc->next_chan == &sc->offchannel.chan) { |
598 | ath_chanctx_offchannel_noa(sc, ctx, avp, tsf_time); |
599 | break; |
600 | } |
601 | |
602 | ath_chanctx_handle_bmiss(sc, ctx, avp); |
603 | |
604 | /* |
605 | * If a mgd_prepare_tx() has been called by mac80211, |
606 | * a one-shot NoA needs to be sent. This can happen |
607 | * with one or more active channel contexts - in both |
608 | * cases, a new NoA schedule has to be advertised. |
609 | */ |
610 | if (sc->sched.mgd_prepare_tx) { |
611 | ath_chanctx_set_oneshot_noa(sc, avp, tsf_time, |
612 | duration: jiffies_to_usecs(HZ / 5)); |
613 | break; |
614 | } |
615 | |
616 | /* Prevent wrap-around issues */ |
617 | if (avp->noa_duration && tsf_time - avp->noa_start > BIT(30)) |
618 | avp->noa_duration = 0; |
619 | |
620 | /* |
621 | * If multiple contexts are active, start periodic |
622 | * NoA and increment the index for the first |
623 | * announcement. |
624 | */ |
625 | if (ctx->active && |
626 | (!avp->noa_duration || sc->sched.force_noa_update)) |
627 | ath_chanctx_set_periodic_noa(sc, avp, cur_conf, |
628 | tsf_time, beacon_int); |
629 | |
630 | if (ctx->active && sc->sched.force_noa_update) |
631 | sc->sched.force_noa_update = false; |
632 | |
633 | break; |
634 | case ATH_CHANCTX_EVENT_BEACON_SENT: |
635 | if (!sc->sched.beacon_pending) { |
636 | ath_dbg(common, CHAN_CTX, |
637 | "No pending beacon\n" ); |
638 | break; |
639 | } |
640 | |
641 | sc->sched.beacon_pending = false; |
642 | |
643 | if (sc->sched.mgd_prepare_tx) { |
644 | sc->sched.mgd_prepare_tx = false; |
645 | complete(&sc->go_beacon); |
646 | ath_dbg(common, CHAN_CTX, |
647 | "Beacon sent, complete go_beacon\n" ); |
648 | break; |
649 | } |
650 | |
651 | if (sc->sched.state != ATH_CHANCTX_STATE_WAIT_FOR_BEACON) |
652 | break; |
653 | |
654 | ath_dbg(common, CHAN_CTX, |
655 | "Move chanctx state to WAIT_FOR_TIMER\n" ); |
656 | |
657 | sc->sched.state = ATH_CHANCTX_STATE_WAIT_FOR_TIMER; |
658 | ath_chanctx_setup_timer(sc, tsf_time: sc->sched.switch_start_time); |
659 | break; |
660 | case ATH_CHANCTX_EVENT_TSF_TIMER: |
661 | if (sc->sched.state != ATH_CHANCTX_STATE_WAIT_FOR_TIMER) |
662 | break; |
663 | |
664 | if (!sc->cur_chan->switch_after_beacon && |
665 | sc->sched.beacon_pending) |
666 | sc->sched.beacon_miss++; |
667 | |
668 | ath_dbg(common, CHAN_CTX, |
669 | "Move chanctx state to SWITCH\n" ); |
670 | |
671 | sc->sched.state = ATH_CHANCTX_STATE_SWITCH; |
672 | ieee80211_queue_work(hw: sc->hw, work: &sc->chanctx_work); |
673 | break; |
674 | case ATH_CHANCTX_EVENT_BEACON_RECEIVED: |
675 | if (!test_bit(ATH_OP_MULTI_CHANNEL, &common->op_flags) || |
676 | sc->cur_chan == &sc->offchannel.chan) |
677 | break; |
678 | |
679 | sc->sched.beacon_pending = false; |
680 | sc->sched.beacon_miss = 0; |
681 | |
682 | if (sc->sched.state == ATH_CHANCTX_STATE_FORCE_ACTIVE || |
683 | !sc->sched.beacon_adjust || |
684 | !sc->cur_chan->tsf_val) |
685 | break; |
686 | |
687 | ath_chanctx_adjust_tbtt_delta(sc); |
688 | |
689 | /* TSF time might have been updated by the incoming beacon, |
690 | * need update the channel switch timer to reflect the change. |
691 | */ |
692 | tsf_time = sc->sched.switch_start_time; |
693 | tsf_time -= (u32) sc->cur_chan->tsf_val + |
694 | ath9k_hw_get_tsf_offset(last: &sc->cur_chan->tsf_ts, NULL); |
695 | tsf_time += ath9k_hw_gettsf32(ah); |
696 | |
697 | sc->sched.beacon_adjust = false; |
698 | ath_chanctx_setup_timer(sc, tsf_time); |
699 | break; |
700 | case ATH_CHANCTX_EVENT_AUTHORIZED: |
701 | if (sc->sched.state != ATH_CHANCTX_STATE_FORCE_ACTIVE || |
702 | avp->chanctx != sc->cur_chan) |
703 | break; |
704 | |
705 | ath_dbg(common, CHAN_CTX, |
706 | "Move chanctx state from FORCE_ACTIVE to IDLE\n" ); |
707 | |
708 | sc->sched.state = ATH_CHANCTX_STATE_IDLE; |
709 | fallthrough; |
710 | case ATH_CHANCTX_EVENT_SWITCH: |
711 | if (!test_bit(ATH_OP_MULTI_CHANNEL, &common->op_flags) || |
712 | sc->sched.state == ATH_CHANCTX_STATE_FORCE_ACTIVE || |
713 | sc->cur_chan->switch_after_beacon || |
714 | sc->cur_chan == &sc->offchannel.chan) |
715 | break; |
716 | |
717 | /* If this is a station chanctx, stay active for a half |
718 | * beacon period (minus channel switch time) |
719 | */ |
720 | sc->next_chan = ath_chanctx_get_next(sc, ctx: sc->cur_chan); |
721 | cur_conf = &sc->cur_chan->beacon; |
722 | |
723 | ath_dbg(common, CHAN_CTX, |
724 | "Move chanctx state to WAIT_FOR_TIMER (event SWITCH)\n" ); |
725 | |
726 | sc->sched.state = ATH_CHANCTX_STATE_WAIT_FOR_TIMER; |
727 | sc->sched.wait_switch = false; |
728 | |
729 | tsf_time = TU_TO_USEC(cur_conf->beacon_interval) / 2; |
730 | |
731 | if (sc->sched.extend_absence) { |
732 | sc->sched.beacon_miss = 0; |
733 | tsf_time *= 3; |
734 | } |
735 | |
736 | tsf_time -= sc->sched.channel_switch_time; |
737 | tsf_time += ath9k_hw_gettsf32(ah: sc->sc_ah); |
738 | sc->sched.switch_start_time = tsf_time; |
739 | |
740 | ath_chanctx_setup_timer(sc, tsf_time); |
741 | sc->sched.beacon_pending = true; |
742 | sc->sched.beacon_adjust = true; |
743 | break; |
744 | case ATH_CHANCTX_EVENT_ENABLE_MULTICHANNEL: |
745 | if (sc->cur_chan == &sc->offchannel.chan || |
746 | sc->cur_chan->switch_after_beacon) |
747 | break; |
748 | |
749 | sc->next_chan = ath_chanctx_get_next(sc, ctx: sc->cur_chan); |
750 | ieee80211_queue_work(hw: sc->hw, work: &sc->chanctx_work); |
751 | break; |
752 | case ATH_CHANCTX_EVENT_UNASSIGN: |
753 | if (sc->cur_chan->assigned) { |
754 | if (sc->next_chan && !sc->next_chan->assigned && |
755 | sc->next_chan != &sc->offchannel.chan) |
756 | sc->sched.state = ATH_CHANCTX_STATE_IDLE; |
757 | break; |
758 | } |
759 | |
760 | ctx = ath_chanctx_get_next(sc, ctx: sc->cur_chan); |
761 | sc->sched.state = ATH_CHANCTX_STATE_IDLE; |
762 | if (!ctx->assigned) |
763 | break; |
764 | |
765 | sc->next_chan = ctx; |
766 | ieee80211_queue_work(hw: sc->hw, work: &sc->chanctx_work); |
767 | break; |
768 | case ATH_CHANCTX_EVENT_ASSIGN: |
769 | break; |
770 | case ATH_CHANCTX_EVENT_CHANGE: |
771 | break; |
772 | } |
773 | |
774 | spin_unlock_bh(lock: &sc->chan_lock); |
775 | } |
776 | |
777 | void ath_chanctx_beacon_sent_ev(struct ath_softc *sc, |
778 | enum ath_chanctx_event ev) |
779 | { |
780 | if (sc->sched.beacon_pending) |
781 | ath_chanctx_event(sc, NULL, ev); |
782 | } |
783 | |
784 | void ath_chanctx_beacon_recv_ev(struct ath_softc *sc, |
785 | enum ath_chanctx_event ev) |
786 | { |
787 | ath_chanctx_event(sc, NULL, ev); |
788 | } |
789 | |
790 | static int ath_scan_channel_duration(struct ath_softc *sc, |
791 | struct ieee80211_channel *chan) |
792 | { |
793 | struct cfg80211_scan_request *req = sc->offchannel.scan_req; |
794 | |
795 | if (!req->n_ssids || (chan->flags & IEEE80211_CHAN_NO_IR)) |
796 | return (HZ / 9); /* ~110 ms */ |
797 | |
798 | return (HZ / 16); /* ~60 ms */ |
799 | } |
800 | |
801 | static void ath_chanctx_switch(struct ath_softc *sc, struct ath_chanctx *ctx, |
802 | struct cfg80211_chan_def *chandef) |
803 | { |
804 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
805 | |
806 | spin_lock_bh(lock: &sc->chan_lock); |
807 | |
808 | if (test_bit(ATH_OP_MULTI_CHANNEL, &common->op_flags) && |
809 | (sc->cur_chan != ctx) && (ctx == &sc->offchannel.chan)) { |
810 | if (chandef) |
811 | ctx->chandef = *chandef; |
812 | |
813 | sc->sched.offchannel_pending = true; |
814 | sc->sched.wait_switch = true; |
815 | sc->sched.offchannel_duration = |
816 | jiffies_to_usecs(j: sc->offchannel.duration) + |
817 | sc->sched.channel_switch_time; |
818 | |
819 | spin_unlock_bh(lock: &sc->chan_lock); |
820 | ath_dbg(common, CHAN_CTX, |
821 | "Set offchannel_pending to true\n" ); |
822 | return; |
823 | } |
824 | |
825 | sc->next_chan = ctx; |
826 | if (chandef) { |
827 | ctx->chandef = *chandef; |
828 | ath_dbg(common, CHAN_CTX, |
829 | "Assigned next_chan to %d MHz\n" , chandef->center_freq1); |
830 | } |
831 | |
832 | if (sc->next_chan == &sc->offchannel.chan) { |
833 | sc->sched.offchannel_duration = |
834 | jiffies_to_usecs(j: sc->offchannel.duration) + |
835 | sc->sched.channel_switch_time; |
836 | |
837 | if (chandef) { |
838 | ath_dbg(common, CHAN_CTX, |
839 | "Offchannel duration for chan %d MHz : %u\n" , |
840 | chandef->center_freq1, |
841 | sc->sched.offchannel_duration); |
842 | } |
843 | } |
844 | spin_unlock_bh(lock: &sc->chan_lock); |
845 | ieee80211_queue_work(hw: sc->hw, work: &sc->chanctx_work); |
846 | } |
847 | |
848 | static void ath_chanctx_offchan_switch(struct ath_softc *sc, |
849 | struct ieee80211_channel *chan) |
850 | { |
851 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
852 | struct cfg80211_chan_def chandef; |
853 | |
854 | cfg80211_chandef_create(chandef: &chandef, channel: chan, chantype: NL80211_CHAN_NO_HT); |
855 | ath_dbg(common, CHAN_CTX, |
856 | "Channel definition created: %d MHz\n" , chandef.center_freq1); |
857 | |
858 | ath_chanctx_switch(sc, ctx: &sc->offchannel.chan, chandef: &chandef); |
859 | } |
860 | |
861 | static struct ath_chanctx *ath_chanctx_get_oper_chan(struct ath_softc *sc, |
862 | bool active) |
863 | { |
864 | struct ath_chanctx *ctx; |
865 | |
866 | ath_for_each_chanctx(sc, ctx) { |
867 | if (!ctx->assigned || list_empty(head: &ctx->vifs)) |
868 | continue; |
869 | if (active && !ctx->active) |
870 | continue; |
871 | |
872 | if (ctx->switch_after_beacon) |
873 | return ctx; |
874 | } |
875 | |
876 | return &sc->chanctx[0]; |
877 | } |
878 | |
879 | static void |
880 | ath_scan_next_channel(struct ath_softc *sc) |
881 | { |
882 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
883 | struct cfg80211_scan_request *req = sc->offchannel.scan_req; |
884 | struct ieee80211_channel *chan; |
885 | |
886 | if (sc->offchannel.scan_idx >= req->n_channels) { |
887 | ath_dbg(common, CHAN_CTX, |
888 | "Moving offchannel state to ATH_OFFCHANNEL_IDLE, " |
889 | "scan_idx: %d, n_channels: %d\n" , |
890 | sc->offchannel.scan_idx, |
891 | req->n_channels); |
892 | |
893 | sc->offchannel.state = ATH_OFFCHANNEL_IDLE; |
894 | ath_chanctx_switch(sc, ctx: ath_chanctx_get_oper_chan(sc, active: false), |
895 | NULL); |
896 | return; |
897 | } |
898 | |
899 | ath_dbg(common, CHAN_CTX, |
900 | "Moving offchannel state to ATH_OFFCHANNEL_PROBE_SEND, scan_idx: %d\n" , |
901 | sc->offchannel.scan_idx); |
902 | |
903 | chan = req->channels[sc->offchannel.scan_idx++]; |
904 | sc->offchannel.duration = ath_scan_channel_duration(sc, chan); |
905 | sc->offchannel.state = ATH_OFFCHANNEL_PROBE_SEND; |
906 | |
907 | ath_chanctx_offchan_switch(sc, chan); |
908 | } |
909 | |
910 | void ath_offchannel_next(struct ath_softc *sc) |
911 | { |
912 | struct ieee80211_vif *vif; |
913 | |
914 | if (sc->offchannel.scan_req) { |
915 | vif = sc->offchannel.scan_vif; |
916 | sc->offchannel.chan.txpower = vif->bss_conf.txpower; |
917 | ath_scan_next_channel(sc); |
918 | } else if (sc->offchannel.roc_vif) { |
919 | vif = sc->offchannel.roc_vif; |
920 | sc->offchannel.chan.txpower = vif->bss_conf.txpower; |
921 | sc->offchannel.duration = |
922 | msecs_to_jiffies(m: sc->offchannel.roc_duration); |
923 | sc->offchannel.state = ATH_OFFCHANNEL_ROC_START; |
924 | ath_chanctx_offchan_switch(sc, chan: sc->offchannel.roc_chan); |
925 | } else { |
926 | spin_lock_bh(lock: &sc->chan_lock); |
927 | sc->sched.offchannel_pending = false; |
928 | sc->sched.wait_switch = false; |
929 | spin_unlock_bh(lock: &sc->chan_lock); |
930 | |
931 | ath_chanctx_switch(sc, ctx: ath_chanctx_get_oper_chan(sc, active: false), |
932 | NULL); |
933 | sc->offchannel.state = ATH_OFFCHANNEL_IDLE; |
934 | if (sc->ps_idle) |
935 | ath_cancel_work(sc); |
936 | } |
937 | } |
938 | |
939 | void ath_roc_complete(struct ath_softc *sc, enum ath_roc_complete_reason reason) |
940 | { |
941 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
942 | |
943 | sc->offchannel.roc_vif = NULL; |
944 | sc->offchannel.roc_chan = NULL; |
945 | |
946 | switch (reason) { |
947 | case ATH_ROC_COMPLETE_ABORT: |
948 | ath_dbg(common, CHAN_CTX, "RoC aborted\n" ); |
949 | ieee80211_remain_on_channel_expired(hw: sc->hw); |
950 | break; |
951 | case ATH_ROC_COMPLETE_EXPIRE: |
952 | ath_dbg(common, CHAN_CTX, "RoC expired\n" ); |
953 | ieee80211_remain_on_channel_expired(hw: sc->hw); |
954 | break; |
955 | case ATH_ROC_COMPLETE_CANCEL: |
956 | ath_dbg(common, CHAN_CTX, "RoC canceled\n" ); |
957 | break; |
958 | } |
959 | |
960 | ath_offchannel_next(sc); |
961 | ath9k_ps_restore(sc); |
962 | } |
963 | |
964 | void ath_scan_complete(struct ath_softc *sc, bool abort) |
965 | { |
966 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
967 | struct cfg80211_scan_info info = { |
968 | .aborted = abort, |
969 | }; |
970 | |
971 | if (abort) |
972 | ath_dbg(common, CHAN_CTX, "HW scan aborted\n" ); |
973 | else |
974 | ath_dbg(common, CHAN_CTX, "HW scan complete\n" ); |
975 | |
976 | sc->offchannel.scan_req = NULL; |
977 | sc->offchannel.scan_vif = NULL; |
978 | sc->offchannel.state = ATH_OFFCHANNEL_IDLE; |
979 | ieee80211_scan_completed(hw: sc->hw, info: &info); |
980 | clear_bit(nr: ATH_OP_SCANNING, addr: &common->op_flags); |
981 | spin_lock_bh(lock: &sc->chan_lock); |
982 | if (test_bit(ATH_OP_MULTI_CHANNEL, &common->op_flags)) |
983 | sc->sched.force_noa_update = true; |
984 | spin_unlock_bh(lock: &sc->chan_lock); |
985 | ath_offchannel_next(sc); |
986 | ath9k_ps_restore(sc); |
987 | } |
988 | |
989 | static void ath_scan_send_probe(struct ath_softc *sc, |
990 | struct cfg80211_ssid *ssid) |
991 | { |
992 | struct cfg80211_scan_request *req = sc->offchannel.scan_req; |
993 | struct ieee80211_vif *vif = sc->offchannel.scan_vif; |
994 | struct ath_tx_control txctl = {}; |
995 | struct sk_buff *skb; |
996 | struct ieee80211_tx_info *info; |
997 | int band = sc->offchannel.chan.chandef.chan->band; |
998 | |
999 | skb = ieee80211_probereq_get(hw: sc->hw, src_addr: vif->addr, |
1000 | ssid: ssid->ssid, ssid_len: ssid->ssid_len, tailroom: req->ie_len); |
1001 | if (!skb) |
1002 | return; |
1003 | |
1004 | info = IEEE80211_SKB_CB(skb); |
1005 | if (req->no_cck) |
1006 | info->flags |= IEEE80211_TX_CTL_NO_CCK_RATE; |
1007 | |
1008 | if (req->ie_len) |
1009 | skb_put_data(skb, data: req->ie, len: req->ie_len); |
1010 | |
1011 | skb_set_queue_mapping(skb, queue_mapping: IEEE80211_AC_VO); |
1012 | |
1013 | if (!ieee80211_tx_prepare_skb(hw: sc->hw, vif, skb, band, NULL)) |
1014 | goto error; |
1015 | |
1016 | txctl.txq = sc->tx.txq_map[IEEE80211_AC_VO]; |
1017 | if (ath_tx_start(hw: sc->hw, skb, txctl: &txctl)) |
1018 | goto error; |
1019 | |
1020 | return; |
1021 | |
1022 | error: |
1023 | ieee80211_free_txskb(hw: sc->hw, skb); |
1024 | } |
1025 | |
1026 | static void ath_scan_channel_start(struct ath_softc *sc) |
1027 | { |
1028 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1029 | struct cfg80211_scan_request *req = sc->offchannel.scan_req; |
1030 | int i; |
1031 | |
1032 | if (!(sc->cur_chan->chandef.chan->flags & IEEE80211_CHAN_NO_IR) && |
1033 | req->n_ssids) { |
1034 | for (i = 0; i < req->n_ssids; i++) |
1035 | ath_scan_send_probe(sc, ssid: &req->ssids[i]); |
1036 | |
1037 | } |
1038 | |
1039 | ath_dbg(common, CHAN_CTX, |
1040 | "Moving offchannel state to ATH_OFFCHANNEL_PROBE_WAIT\n" ); |
1041 | |
1042 | sc->offchannel.state = ATH_OFFCHANNEL_PROBE_WAIT; |
1043 | mod_timer(timer: &sc->offchannel.timer, expires: jiffies + sc->offchannel.duration); |
1044 | } |
1045 | |
1046 | static void ath_chanctx_timer(struct timer_list *t) |
1047 | { |
1048 | struct ath_softc *sc = from_timer(sc, t, sched.timer); |
1049 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1050 | |
1051 | ath_dbg(common, CHAN_CTX, |
1052 | "Channel context timer invoked\n" ); |
1053 | |
1054 | ath_chanctx_event(sc, NULL, ev: ATH_CHANCTX_EVENT_TSF_TIMER); |
1055 | } |
1056 | |
1057 | static void ath_offchannel_timer(struct timer_list *t) |
1058 | { |
1059 | struct ath_softc *sc = from_timer(sc, t, offchannel.timer); |
1060 | struct ath_chanctx *ctx; |
1061 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1062 | |
1063 | ath_dbg(common, CHAN_CTX, "%s: offchannel state: %s\n" , |
1064 | __func__, offchannel_state_string(sc->offchannel.state)); |
1065 | |
1066 | switch (sc->offchannel.state) { |
1067 | case ATH_OFFCHANNEL_PROBE_WAIT: |
1068 | if (!sc->offchannel.scan_req) |
1069 | return; |
1070 | |
1071 | /* get first active channel context */ |
1072 | ctx = ath_chanctx_get_oper_chan(sc, active: true); |
1073 | if (ctx->active) { |
1074 | ath_dbg(common, CHAN_CTX, |
1075 | "Switch to oper/active context, " |
1076 | "move offchannel state to ATH_OFFCHANNEL_SUSPEND\n" ); |
1077 | |
1078 | sc->offchannel.state = ATH_OFFCHANNEL_SUSPEND; |
1079 | ath_chanctx_switch(sc, ctx, NULL); |
1080 | mod_timer(timer: &sc->offchannel.timer, expires: jiffies + HZ / 10); |
1081 | break; |
1082 | } |
1083 | fallthrough; |
1084 | case ATH_OFFCHANNEL_SUSPEND: |
1085 | if (!sc->offchannel.scan_req) |
1086 | return; |
1087 | |
1088 | ath_scan_next_channel(sc); |
1089 | break; |
1090 | case ATH_OFFCHANNEL_ROC_START: |
1091 | case ATH_OFFCHANNEL_ROC_WAIT: |
1092 | sc->offchannel.state = ATH_OFFCHANNEL_ROC_DONE; |
1093 | ath_roc_complete(sc, reason: ATH_ROC_COMPLETE_EXPIRE); |
1094 | break; |
1095 | default: |
1096 | break; |
1097 | } |
1098 | } |
1099 | |
1100 | static bool |
1101 | ath_chanctx_send_vif_ps_frame(struct ath_softc *sc, struct ath_vif *avp, |
1102 | bool powersave) |
1103 | { |
1104 | struct ieee80211_vif *vif = avp->vif; |
1105 | struct ieee80211_sta *sta = NULL; |
1106 | struct ieee80211_hdr_3addr *nullfunc; |
1107 | struct ath_tx_control txctl; |
1108 | struct sk_buff *skb; |
1109 | int band = sc->cur_chan->chandef.chan->band; |
1110 | |
1111 | switch (vif->type) { |
1112 | case NL80211_IFTYPE_STATION: |
1113 | if (!avp->assoc) |
1114 | return false; |
1115 | |
1116 | skb = ieee80211_nullfunc_get(hw: sc->hw, vif, link_id: -1, qos_ok: false); |
1117 | if (!skb) |
1118 | return false; |
1119 | |
1120 | nullfunc = (struct ieee80211_hdr_3addr *) skb->data; |
1121 | if (powersave) |
1122 | nullfunc->frame_control |= |
1123 | cpu_to_le16(IEEE80211_FCTL_PM); |
1124 | |
1125 | skb->priority = 7; |
1126 | skb_set_queue_mapping(skb, queue_mapping: IEEE80211_AC_VO); |
1127 | if (!ieee80211_tx_prepare_skb(hw: sc->hw, vif, skb, band, sta: &sta)) { |
1128 | dev_kfree_skb_any(skb); |
1129 | return false; |
1130 | } |
1131 | break; |
1132 | default: |
1133 | return false; |
1134 | } |
1135 | |
1136 | memset(&txctl, 0, sizeof(txctl)); |
1137 | txctl.txq = sc->tx.txq_map[IEEE80211_AC_VO]; |
1138 | txctl.sta = sta; |
1139 | if (ath_tx_start(hw: sc->hw, skb, txctl: &txctl)) { |
1140 | ieee80211_free_txskb(hw: sc->hw, skb); |
1141 | return false; |
1142 | } |
1143 | |
1144 | return true; |
1145 | } |
1146 | |
1147 | static bool |
1148 | ath_chanctx_send_ps_frame(struct ath_softc *sc, bool powersave) |
1149 | { |
1150 | struct ath_vif *avp; |
1151 | bool sent = false; |
1152 | |
1153 | rcu_read_lock(); |
1154 | list_for_each_entry(avp, &sc->cur_chan->vifs, list) { |
1155 | if (ath_chanctx_send_vif_ps_frame(sc, avp, powersave)) |
1156 | sent = true; |
1157 | } |
1158 | rcu_read_unlock(); |
1159 | |
1160 | return sent; |
1161 | } |
1162 | |
1163 | static bool ath_chanctx_defer_switch(struct ath_softc *sc) |
1164 | { |
1165 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1166 | |
1167 | if (sc->cur_chan == &sc->offchannel.chan) |
1168 | return false; |
1169 | |
1170 | switch (sc->sched.state) { |
1171 | case ATH_CHANCTX_STATE_SWITCH: |
1172 | return false; |
1173 | case ATH_CHANCTX_STATE_IDLE: |
1174 | if (!sc->cur_chan->switch_after_beacon) |
1175 | return false; |
1176 | |
1177 | ath_dbg(common, CHAN_CTX, |
1178 | "Defer switch, set chanctx state to WAIT_FOR_BEACON\n" ); |
1179 | |
1180 | sc->sched.state = ATH_CHANCTX_STATE_WAIT_FOR_BEACON; |
1181 | break; |
1182 | default: |
1183 | break; |
1184 | } |
1185 | |
1186 | return true; |
1187 | } |
1188 | |
1189 | static void ath_offchannel_channel_change(struct ath_softc *sc) |
1190 | { |
1191 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1192 | |
1193 | ath_dbg(common, CHAN_CTX, "%s: offchannel state: %s\n" , |
1194 | __func__, offchannel_state_string(sc->offchannel.state)); |
1195 | |
1196 | switch (sc->offchannel.state) { |
1197 | case ATH_OFFCHANNEL_PROBE_SEND: |
1198 | if (!sc->offchannel.scan_req) |
1199 | return; |
1200 | |
1201 | if (sc->cur_chan->chandef.chan != |
1202 | sc->offchannel.chan.chandef.chan) |
1203 | return; |
1204 | |
1205 | ath_scan_channel_start(sc); |
1206 | break; |
1207 | case ATH_OFFCHANNEL_IDLE: |
1208 | if (!sc->offchannel.scan_req) |
1209 | return; |
1210 | |
1211 | ath_scan_complete(sc, abort: false); |
1212 | break; |
1213 | case ATH_OFFCHANNEL_ROC_START: |
1214 | if (sc->cur_chan != &sc->offchannel.chan) |
1215 | break; |
1216 | |
1217 | sc->offchannel.state = ATH_OFFCHANNEL_ROC_WAIT; |
1218 | mod_timer(timer: &sc->offchannel.timer, |
1219 | expires: jiffies + sc->offchannel.duration); |
1220 | ieee80211_ready_on_channel(hw: sc->hw); |
1221 | break; |
1222 | case ATH_OFFCHANNEL_ROC_DONE: |
1223 | break; |
1224 | default: |
1225 | break; |
1226 | } |
1227 | } |
1228 | |
1229 | void ath_chanctx_set_next(struct ath_softc *sc, bool force) |
1230 | { |
1231 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1232 | struct ath_chanctx *old_ctx; |
1233 | struct timespec64 ts; |
1234 | bool measure_time = false; |
1235 | bool send_ps = false; |
1236 | bool queues_stopped = false; |
1237 | |
1238 | spin_lock_bh(lock: &sc->chan_lock); |
1239 | if (!sc->next_chan) { |
1240 | spin_unlock_bh(lock: &sc->chan_lock); |
1241 | return; |
1242 | } |
1243 | |
1244 | if (!force && ath_chanctx_defer_switch(sc)) { |
1245 | spin_unlock_bh(lock: &sc->chan_lock); |
1246 | return; |
1247 | } |
1248 | |
1249 | ath_dbg(common, CHAN_CTX, |
1250 | "%s: current: %d MHz, next: %d MHz\n" , |
1251 | __func__, |
1252 | sc->cur_chan->chandef.center_freq1, |
1253 | sc->next_chan->chandef.center_freq1); |
1254 | |
1255 | if (sc->cur_chan != sc->next_chan) { |
1256 | ath_dbg(common, CHAN_CTX, |
1257 | "Stopping current chanctx: %d\n" , |
1258 | sc->cur_chan->chandef.center_freq1); |
1259 | sc->cur_chan->stopped = true; |
1260 | spin_unlock_bh(lock: &sc->chan_lock); |
1261 | |
1262 | if (sc->next_chan == &sc->offchannel.chan) { |
1263 | ktime_get_raw_ts64(ts: &ts); |
1264 | measure_time = true; |
1265 | } |
1266 | |
1267 | ath9k_chanctx_stop_queues(sc, ctx: sc->cur_chan); |
1268 | queues_stopped = true; |
1269 | |
1270 | __ath9k_flush(hw: sc->hw, queues: ~0, drop: true, sw_pending: false, timeout_override: false); |
1271 | |
1272 | if (ath_chanctx_send_ps_frame(sc, powersave: true)) |
1273 | __ath9k_flush(hw: sc->hw, BIT(IEEE80211_AC_VO), |
1274 | drop: false, sw_pending: false, timeout_override: false); |
1275 | |
1276 | send_ps = true; |
1277 | spin_lock_bh(lock: &sc->chan_lock); |
1278 | |
1279 | if (sc->cur_chan != &sc->offchannel.chan) { |
1280 | ktime_get_raw_ts64(ts: &sc->cur_chan->tsf_ts); |
1281 | sc->cur_chan->tsf_val = ath9k_hw_gettsf64(ah: sc->sc_ah); |
1282 | } |
1283 | } |
1284 | old_ctx = sc->cur_chan; |
1285 | sc->cur_chan = sc->next_chan; |
1286 | sc->cur_chan->stopped = false; |
1287 | sc->next_chan = NULL; |
1288 | |
1289 | if (!sc->sched.offchannel_pending) |
1290 | sc->sched.offchannel_duration = 0; |
1291 | |
1292 | if (sc->sched.state != ATH_CHANCTX_STATE_FORCE_ACTIVE) |
1293 | sc->sched.state = ATH_CHANCTX_STATE_IDLE; |
1294 | |
1295 | spin_unlock_bh(lock: &sc->chan_lock); |
1296 | |
1297 | if (sc->sc_ah->chip_fullsleep || |
1298 | memcmp(p: &sc->cur_chandef, q: &sc->cur_chan->chandef, |
1299 | size: sizeof(sc->cur_chandef))) { |
1300 | ath_dbg(common, CHAN_CTX, |
1301 | "%s: Set channel %d MHz\n" , |
1302 | __func__, sc->cur_chan->chandef.center_freq1); |
1303 | ath_set_channel(sc); |
1304 | if (measure_time) |
1305 | sc->sched.channel_switch_time = |
1306 | ath9k_hw_get_tsf_offset(last: &ts, NULL); |
1307 | /* |
1308 | * A reset will ensure that all queues are woken up, |
1309 | * so there is no need to awaken them again. |
1310 | */ |
1311 | goto out; |
1312 | } |
1313 | |
1314 | if (queues_stopped) |
1315 | ath9k_chanctx_wake_queues(sc, ctx: old_ctx); |
1316 | out: |
1317 | if (send_ps) |
1318 | ath_chanctx_send_ps_frame(sc, powersave: false); |
1319 | |
1320 | ath_offchannel_channel_change(sc); |
1321 | ath_chanctx_event(sc, NULL, ev: ATH_CHANCTX_EVENT_SWITCH); |
1322 | } |
1323 | |
1324 | static void ath_chanctx_work(struct work_struct *work) |
1325 | { |
1326 | struct ath_softc *sc = container_of(work, struct ath_softc, |
1327 | chanctx_work); |
1328 | mutex_lock(&sc->mutex); |
1329 | ath_chanctx_set_next(sc, force: false); |
1330 | mutex_unlock(lock: &sc->mutex); |
1331 | } |
1332 | |
1333 | void ath9k_offchannel_init(struct ath_softc *sc) |
1334 | { |
1335 | struct ath_chanctx *ctx; |
1336 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1337 | struct ieee80211_supported_band *sband; |
1338 | struct ieee80211_channel *chan; |
1339 | int i; |
1340 | |
1341 | sband = &common->sbands[NL80211_BAND_2GHZ]; |
1342 | if (!sband->n_channels) |
1343 | sband = &common->sbands[NL80211_BAND_5GHZ]; |
1344 | |
1345 | chan = &sband->channels[0]; |
1346 | |
1347 | ctx = &sc->offchannel.chan; |
1348 | INIT_LIST_HEAD(list: &ctx->vifs); |
1349 | ctx->txpower = ATH_TXPOWER_MAX; |
1350 | cfg80211_chandef_create(chandef: &ctx->chandef, channel: chan, chantype: NL80211_CHAN_HT20); |
1351 | |
1352 | for (i = 0; i < ARRAY_SIZE(ctx->acq); i++) { |
1353 | INIT_LIST_HEAD(list: &ctx->acq[i].acq_new); |
1354 | INIT_LIST_HEAD(list: &ctx->acq[i].acq_old); |
1355 | spin_lock_init(&ctx->acq[i].lock); |
1356 | } |
1357 | |
1358 | sc->offchannel.chan.offchannel = true; |
1359 | } |
1360 | |
1361 | void ath9k_init_channel_context(struct ath_softc *sc) |
1362 | { |
1363 | INIT_WORK(&sc->chanctx_work, ath_chanctx_work); |
1364 | |
1365 | timer_setup(&sc->offchannel.timer, ath_offchannel_timer, 0); |
1366 | timer_setup(&sc->sched.timer, ath_chanctx_timer, 0); |
1367 | |
1368 | init_completion(x: &sc->go_beacon); |
1369 | } |
1370 | |
1371 | void ath9k_deinit_channel_context(struct ath_softc *sc) |
1372 | { |
1373 | cancel_work_sync(work: &sc->chanctx_work); |
1374 | } |
1375 | |
1376 | bool ath9k_is_chanctx_enabled(void) |
1377 | { |
1378 | return (ath9k_use_chanctx == 1); |
1379 | } |
1380 | |
1381 | /********************/ |
1382 | /* Queue management */ |
1383 | /********************/ |
1384 | |
1385 | void ath9k_chanctx_stop_queues(struct ath_softc *sc, struct ath_chanctx *ctx) |
1386 | { |
1387 | struct ath_hw *ah = sc->sc_ah; |
1388 | int i; |
1389 | |
1390 | if (ctx == &sc->offchannel.chan) { |
1391 | ieee80211_stop_queue(hw: sc->hw, |
1392 | queue: sc->hw->offchannel_tx_hw_queue); |
1393 | } else { |
1394 | for (i = 0; i < IEEE80211_NUM_ACS; i++) |
1395 | ieee80211_stop_queue(hw: sc->hw, |
1396 | queue: ctx->hw_queue_base + i); |
1397 | } |
1398 | |
1399 | if (ah->opmode == NL80211_IFTYPE_AP) |
1400 | ieee80211_stop_queue(hw: sc->hw, queue: sc->hw->queues - 2); |
1401 | } |
1402 | |
1403 | |
1404 | void ath9k_chanctx_wake_queues(struct ath_softc *sc, struct ath_chanctx *ctx) |
1405 | { |
1406 | struct ath_hw *ah = sc->sc_ah; |
1407 | int i; |
1408 | |
1409 | if (ctx == &sc->offchannel.chan) { |
1410 | ieee80211_wake_queue(hw: sc->hw, |
1411 | queue: sc->hw->offchannel_tx_hw_queue); |
1412 | } else { |
1413 | for (i = 0; i < IEEE80211_NUM_ACS; i++) |
1414 | ieee80211_wake_queue(hw: sc->hw, |
1415 | queue: ctx->hw_queue_base + i); |
1416 | } |
1417 | |
1418 | if (ah->opmode == NL80211_IFTYPE_AP) |
1419 | ieee80211_wake_queue(hw: sc->hw, queue: sc->hw->queues - 2); |
1420 | } |
1421 | |
1422 | /*****************/ |
1423 | /* P2P Powersave */ |
1424 | /*****************/ |
1425 | |
1426 | static void ath9k_update_p2p_ps_timer(struct ath_softc *sc, struct ath_vif *avp) |
1427 | { |
1428 | struct ath_common *common = ath9k_hw_common(ah: sc->sc_ah); |
1429 | struct ath_hw *ah = sc->sc_ah; |
1430 | u32 tsf, target_tsf; |
1431 | |
1432 | if (!avp || !avp->noa.has_next_tsf) |
1433 | return; |
1434 | |
1435 | ath9k_hw_gen_timer_stop(ah, timer: sc->p2p_ps_timer); |
1436 | |
1437 | tsf = ath9k_hw_gettsf32(ah: sc->sc_ah); |
1438 | |
1439 | target_tsf = avp->noa.next_tsf; |
1440 | if (!avp->noa.absent) |
1441 | target_tsf -= ATH_P2P_PS_STOP_TIME; |
1442 | else |
1443 | target_tsf += ATH_P2P_PS_STOP_TIME; |
1444 | |
1445 | if (target_tsf - tsf < ATH_P2P_PS_STOP_TIME) |
1446 | target_tsf = tsf + ATH_P2P_PS_STOP_TIME; |
1447 | |
1448 | ath_dbg(common, CHAN_CTX, "%s absent %d tsf 0x%08X next_tsf 0x%08X (%dms)\n" , |
1449 | __func__, avp->noa.absent, tsf, target_tsf, |
1450 | (target_tsf - tsf) / 1000); |
1451 | |
1452 | ath9k_hw_gen_timer_start(ah, timer: sc->p2p_ps_timer, timer_next: target_tsf, timer_period: 1000000); |
1453 | } |
1454 | |
1455 | static void ath9k_update_p2p_ps(struct ath_softc *sc, struct ieee80211_vif *vif) |
1456 | { |
1457 | struct ath_vif *avp = (void *)vif->drv_priv; |
1458 | u32 tsf; |
1459 | |
1460 | if (!sc->p2p_ps_timer) |
1461 | return; |
1462 | |
1463 | if (vif->type != NL80211_IFTYPE_STATION) |
1464 | return; |
1465 | |
1466 | sc->p2p_ps_vif = avp; |
1467 | |
1468 | if (sc->ps_flags & PS_BEACON_SYNC) |
1469 | return; |
1470 | |
1471 | tsf = ath9k_hw_gettsf32(ah: sc->sc_ah); |
1472 | ieee80211_parse_p2p_noa(attr: &vif->bss_conf.p2p_noa_attr, data: &avp->noa, tsf); |
1473 | ath9k_update_p2p_ps_timer(sc, avp); |
1474 | } |
1475 | |
1476 | static u8 ath9k_get_ctwin(struct ath_softc *sc, struct ath_vif *avp) |
1477 | { |
1478 | struct ath_beacon_config *cur_conf = &sc->cur_chan->beacon; |
1479 | u8 switch_time, ctwin; |
1480 | |
1481 | /* |
1482 | * Channel switch in multi-channel mode is deferred |
1483 | * by a quarter beacon interval when handling |
1484 | * ATH_CHANCTX_EVENT_BEACON_PREPARE, so the P2P-GO |
1485 | * interface is guaranteed to be discoverable |
1486 | * for that duration after a TBTT. |
1487 | */ |
1488 | switch_time = cur_conf->beacon_interval / 4; |
1489 | |
1490 | ctwin = avp->vif->bss_conf.p2p_noa_attr.oppps_ctwindow; |
1491 | if (ctwin && (ctwin < switch_time)) |
1492 | return ctwin; |
1493 | |
1494 | if (switch_time < P2P_DEFAULT_CTWIN) |
1495 | return 0; |
1496 | |
1497 | return P2P_DEFAULT_CTWIN; |
1498 | } |
1499 | |
1500 | void ath9k_beacon_add_noa(struct ath_softc *sc, struct ath_vif *avp, |
1501 | struct sk_buff *skb) |
1502 | { |
1503 | static const u8 noa_ie_hdr[] = { |
1504 | WLAN_EID_VENDOR_SPECIFIC, /* type */ |
1505 | 0, /* length */ |
1506 | 0x50, 0x6f, 0x9a, /* WFA OUI */ |
1507 | 0x09, /* P2P subtype */ |
1508 | 0x0c, /* Notice of Absence */ |
1509 | 0x00, /* LSB of little-endian len */ |
1510 | 0x00, /* MSB of little-endian len */ |
1511 | }; |
1512 | |
1513 | struct ieee80211_p2p_noa_attr *noa; |
1514 | int noa_len, noa_desc, i = 0; |
1515 | u8 *hdr; |
1516 | |
1517 | if (!avp->offchannel_duration && !avp->noa_duration) |
1518 | return; |
1519 | |
1520 | noa_desc = !!avp->offchannel_duration + !!avp->noa_duration; |
1521 | noa_len = 2 + sizeof(struct ieee80211_p2p_noa_desc) * noa_desc; |
1522 | |
1523 | hdr = skb_put_data(skb, data: noa_ie_hdr, len: sizeof(noa_ie_hdr)); |
1524 | hdr[1] = sizeof(noa_ie_hdr) + noa_len - 2; |
1525 | hdr[7] = noa_len; |
1526 | |
1527 | noa = skb_put_zero(skb, len: noa_len); |
1528 | |
1529 | noa->index = avp->noa_index; |
1530 | noa->oppps_ctwindow = ath9k_get_ctwin(sc, avp); |
1531 | if (noa->oppps_ctwindow) |
1532 | noa->oppps_ctwindow |= BIT(7); |
1533 | |
1534 | if (avp->noa_duration) { |
1535 | if (avp->periodic_noa) { |
1536 | u32 interval = TU_TO_USEC(sc->cur_chan->beacon.beacon_interval); |
1537 | noa->desc[i].count = 255; |
1538 | noa->desc[i].interval = cpu_to_le32(interval); |
1539 | } else { |
1540 | noa->desc[i].count = 1; |
1541 | } |
1542 | |
1543 | noa->desc[i].start_time = cpu_to_le32(avp->noa_start); |
1544 | noa->desc[i].duration = cpu_to_le32(avp->noa_duration); |
1545 | i++; |
1546 | } |
1547 | |
1548 | if (avp->offchannel_duration) { |
1549 | noa->desc[i].count = 1; |
1550 | noa->desc[i].start_time = cpu_to_le32(avp->offchannel_start); |
1551 | noa->desc[i].duration = cpu_to_le32(avp->offchannel_duration); |
1552 | } |
1553 | } |
1554 | |
1555 | void ath9k_p2p_ps_timer(void *priv) |
1556 | { |
1557 | struct ath_softc *sc = priv; |
1558 | struct ath_vif *avp = sc->p2p_ps_vif; |
1559 | struct ieee80211_vif *vif; |
1560 | struct ieee80211_sta *sta; |
1561 | struct ath_node *an; |
1562 | u32 tsf; |
1563 | |
1564 | del_timer_sync(timer: &sc->sched.timer); |
1565 | ath9k_hw_gen_timer_stop(ah: sc->sc_ah, timer: sc->p2p_ps_timer); |
1566 | ath_chanctx_event(sc, NULL, ev: ATH_CHANCTX_EVENT_TSF_TIMER); |
1567 | |
1568 | if (!avp || avp->chanctx != sc->cur_chan) |
1569 | return; |
1570 | |
1571 | tsf = ath9k_hw_gettsf32(ah: sc->sc_ah); |
1572 | if (!avp->noa.absent) |
1573 | tsf += ATH_P2P_PS_STOP_TIME; |
1574 | else |
1575 | tsf -= ATH_P2P_PS_STOP_TIME; |
1576 | |
1577 | if (!avp->noa.has_next_tsf || |
1578 | avp->noa.next_tsf - tsf > BIT(31)) |
1579 | ieee80211_update_p2p_noa(data: &avp->noa, tsf); |
1580 | |
1581 | ath9k_update_p2p_ps_timer(sc, avp); |
1582 | |
1583 | rcu_read_lock(); |
1584 | |
1585 | vif = avp->vif; |
1586 | sta = ieee80211_find_sta(vif, addr: avp->bssid); |
1587 | if (!sta) |
1588 | goto out; |
1589 | |
1590 | an = (void *) sta->drv_priv; |
1591 | if (an->sleeping == !!avp->noa.absent) |
1592 | goto out; |
1593 | |
1594 | an->sleeping = avp->noa.absent; |
1595 | if (an->sleeping) |
1596 | ath_tx_aggr_sleep(sta, sc, an); |
1597 | else |
1598 | ath_tx_aggr_wakeup(sc, an); |
1599 | |
1600 | out: |
1601 | rcu_read_unlock(); |
1602 | } |
1603 | |
1604 | void ath9k_p2p_bss_info_changed(struct ath_softc *sc, |
1605 | struct ieee80211_vif *vif) |
1606 | { |
1607 | unsigned long flags; |
1608 | |
1609 | spin_lock_bh(lock: &sc->sc_pcu_lock); |
1610 | spin_lock_irqsave(&sc->sc_pm_lock, flags); |
1611 | ath9k_update_p2p_ps(sc, vif); |
1612 | spin_unlock_irqrestore(lock: &sc->sc_pm_lock, flags); |
1613 | spin_unlock_bh(lock: &sc->sc_pcu_lock); |
1614 | } |
1615 | |
1616 | void ath9k_p2p_beacon_sync(struct ath_softc *sc) |
1617 | { |
1618 | if (sc->p2p_ps_vif) |
1619 | ath9k_update_p2p_ps(sc, vif: sc->p2p_ps_vif->vif); |
1620 | } |
1621 | |
1622 | void ath9k_p2p_remove_vif(struct ath_softc *sc, |
1623 | struct ieee80211_vif *vif) |
1624 | { |
1625 | struct ath_vif *avp = (void *)vif->drv_priv; |
1626 | |
1627 | spin_lock_bh(lock: &sc->sc_pcu_lock); |
1628 | if (avp == sc->p2p_ps_vif) { |
1629 | sc->p2p_ps_vif = NULL; |
1630 | ath9k_update_p2p_ps_timer(sc, NULL); |
1631 | } |
1632 | spin_unlock_bh(lock: &sc->sc_pcu_lock); |
1633 | } |
1634 | |
1635 | int ath9k_init_p2p(struct ath_softc *sc) |
1636 | { |
1637 | sc->p2p_ps_timer = ath_gen_timer_alloc(ah: sc->sc_ah, trigger: ath9k_p2p_ps_timer, |
1638 | NULL, arg: sc, AR_FIRST_NDP_TIMER); |
1639 | if (!sc->p2p_ps_timer) |
1640 | return -ENOMEM; |
1641 | |
1642 | return 0; |
1643 | } |
1644 | |
1645 | void ath9k_deinit_p2p(struct ath_softc *sc) |
1646 | { |
1647 | if (sc->p2p_ps_timer) |
1648 | ath_gen_timer_free(ah: sc->sc_ah, timer: sc->p2p_ps_timer); |
1649 | } |
1650 | |
1651 | #endif /* CONFIG_ATH9K_CHANNEL_CONTEXT */ |
1652 | |