xref: /freebsd/contrib/wpa/src/ap/dfs.c (revision a90b9d0159070121c221b966469c3e36d912bf82)
1 /*
2  * DFS - Dynamic Frequency Selection
3  * Copyright (c) 2002-2013, Jouni Malinen <j@w1.fi>
4  * Copyright (c) 2013-2017, Qualcomm Atheros, Inc.
5  *
6  * This software may be distributed under the terms of the BSD license.
7  * See README for more details.
8  */
9 
10 #include "utils/includes.h"
11 
12 #include "utils/common.h"
13 #include "common/ieee802_11_defs.h"
14 #include "common/hw_features_common.h"
15 #include "common/wpa_ctrl.h"
16 #include "hostapd.h"
17 #include "beacon.h"
18 #include "ap_drv_ops.h"
19 #include "drivers/driver.h"
20 #include "dfs.h"
21 
22 
23 enum dfs_channel_type {
24 	DFS_ANY_CHANNEL,
25 	DFS_AVAILABLE, /* non-radar or radar-available */
26 	DFS_NO_CAC_YET, /* radar-not-yet-available */
27 };
28 
29 static struct hostapd_channel_data *
30 dfs_downgrade_bandwidth(struct hostapd_iface *iface, int *secondary_channel,
31 			u8 *oper_centr_freq_seg0_idx,
32 			u8 *oper_centr_freq_seg1_idx,
33 			enum dfs_channel_type *channel_type);
34 
35 
dfs_use_radar_background(struct hostapd_iface * iface)36 static bool dfs_use_radar_background(struct hostapd_iface *iface)
37 {
38 	return (iface->drv_flags2 & WPA_DRIVER_FLAGS2_RADAR_BACKGROUND) &&
39 		iface->conf->enable_background_radar;
40 }
41 
42 
dfs_get_used_n_chans(struct hostapd_iface * iface,int * seg1)43 static int dfs_get_used_n_chans(struct hostapd_iface *iface, int *seg1)
44 {
45 	int n_chans = 1;
46 
47 	*seg1 = 0;
48 
49 	if (iface->conf->ieee80211n && iface->conf->secondary_channel)
50 		n_chans = 2;
51 
52 	if (iface->conf->ieee80211ac || iface->conf->ieee80211ax) {
53 		switch (hostapd_get_oper_chwidth(iface->conf)) {
54 		case CONF_OPER_CHWIDTH_USE_HT:
55 			break;
56 		case CONF_OPER_CHWIDTH_80MHZ:
57 			n_chans = 4;
58 			break;
59 		case CONF_OPER_CHWIDTH_160MHZ:
60 			n_chans = 8;
61 			break;
62 		case CONF_OPER_CHWIDTH_80P80MHZ:
63 			n_chans = 4;
64 			*seg1 = 4;
65 			break;
66 		default:
67 			break;
68 		}
69 	}
70 
71 	return n_chans;
72 }
73 
74 
75 /* dfs_channel_available: select new channel according to type parameter */
dfs_channel_available(struct hostapd_channel_data * chan,enum dfs_channel_type type)76 static int dfs_channel_available(struct hostapd_channel_data *chan,
77 				 enum dfs_channel_type type)
78 {
79 	if (type == DFS_NO_CAC_YET) {
80 		/* Select only radar channel where CAC has not been
81 		 * performed yet
82 		 */
83 		if ((chan->flag & HOSTAPD_CHAN_RADAR) &&
84 		    (chan->flag & HOSTAPD_CHAN_DFS_MASK) ==
85 		     HOSTAPD_CHAN_DFS_USABLE)
86 			return 1;
87 		return 0;
88 	}
89 
90 	/*
91 	 * When radar detection happens, CSA is performed. However, there's no
92 	 * time for CAC, so radar channels must be skipped when finding a new
93 	 * channel for CSA, unless they are available for immediate use.
94 	 */
95 	if (type == DFS_AVAILABLE && (chan->flag & HOSTAPD_CHAN_RADAR) &&
96 	    ((chan->flag & HOSTAPD_CHAN_DFS_MASK) !=
97 	     HOSTAPD_CHAN_DFS_AVAILABLE))
98 		return 0;
99 
100 	if (chan->flag & HOSTAPD_CHAN_DISABLED)
101 		return 0;
102 	if ((chan->flag & HOSTAPD_CHAN_RADAR) &&
103 	    ((chan->flag & HOSTAPD_CHAN_DFS_MASK) ==
104 	     HOSTAPD_CHAN_DFS_UNAVAILABLE))
105 		return 0;
106 	return 1;
107 }
108 
109 
dfs_is_chan_allowed(struct hostapd_channel_data * chan,int n_chans)110 static int dfs_is_chan_allowed(struct hostapd_channel_data *chan, int n_chans)
111 {
112 	/*
113 	 * The tables contain first valid channel number based on channel width.
114 	 * We will also choose this first channel as the control one.
115 	 */
116 	int allowed_40[] = { 36, 44, 52, 60, 100, 108, 116, 124, 132, 149, 157,
117 			     165, 173, 184, 192 };
118 	/*
119 	 * VHT80, valid channels based on center frequency:
120 	 * 42, 58, 106, 122, 138, 155, 171
121 	 */
122 	int allowed_80[] = { 36, 52, 100, 116, 132, 149, 165 };
123 	/*
124 	 * VHT160 valid channels based on center frequency:
125 	 * 50, 114, 163
126 	 */
127 	int allowed_160[] = { 36, 100, 149 };
128 	int *allowed = allowed_40;
129 	unsigned int i, allowed_no = 0;
130 
131 	switch (n_chans) {
132 	case 2:
133 		allowed = allowed_40;
134 		allowed_no = ARRAY_SIZE(allowed_40);
135 		break;
136 	case 4:
137 		allowed = allowed_80;
138 		allowed_no = ARRAY_SIZE(allowed_80);
139 		break;
140 	case 8:
141 		allowed = allowed_160;
142 		allowed_no = ARRAY_SIZE(allowed_160);
143 		break;
144 	default:
145 		wpa_printf(MSG_DEBUG, "Unknown width for %d channels", n_chans);
146 		break;
147 	}
148 
149 	for (i = 0; i < allowed_no; i++) {
150 		if (chan->chan == allowed[i])
151 			return 1;
152 	}
153 
154 	return 0;
155 }
156 
157 
158 static struct hostapd_channel_data *
dfs_get_chan_data(struct hostapd_hw_modes * mode,int freq,int first_chan_idx)159 dfs_get_chan_data(struct hostapd_hw_modes *mode, int freq, int first_chan_idx)
160 {
161 	int i;
162 
163 	for (i = first_chan_idx; i < mode->num_channels; i++) {
164 		if (mode->channels[i].freq == freq)
165 			return &mode->channels[i];
166 	}
167 
168 	return NULL;
169 }
170 
171 
dfs_chan_range_available(struct hostapd_hw_modes * mode,int first_chan_idx,int num_chans,enum dfs_channel_type type)172 static int dfs_chan_range_available(struct hostapd_hw_modes *mode,
173 				    int first_chan_idx, int num_chans,
174 				    enum dfs_channel_type type)
175 {
176 	struct hostapd_channel_data *first_chan, *chan;
177 	int i;
178 	u32 bw = num_chan_to_bw(num_chans);
179 
180 	if (first_chan_idx + num_chans > mode->num_channels) {
181 		wpa_printf(MSG_DEBUG,
182 			   "DFS: some channels in range not defined");
183 		return 0;
184 	}
185 
186 	first_chan = &mode->channels[first_chan_idx];
187 
188 	/* hostapd DFS implementation assumes the first channel as primary.
189 	 * If it's not allowed to use the first channel as primary, decline the
190 	 * whole channel range. */
191 	if (!chan_pri_allowed(first_chan)) {
192 		wpa_printf(MSG_DEBUG, "DFS: primary channel not allowed");
193 		return 0;
194 	}
195 
196 	for (i = 0; i < num_chans; i++) {
197 		chan = dfs_get_chan_data(mode, first_chan->freq + i * 20,
198 					 first_chan_idx);
199 		if (!chan) {
200 			wpa_printf(MSG_DEBUG, "DFS: no channel data for %d",
201 				   first_chan->freq + i * 20);
202 			return 0;
203 		}
204 
205 		/* HT 40 MHz secondary channel availability checked only for
206 		 * primary channel */
207 		if (!chan_bw_allowed(chan, bw, 1, !i)) {
208 			wpa_printf(MSG_DEBUG, "DFS: bw now allowed for %d",
209 				   first_chan->freq + i * 20);
210 			return 0;
211 		}
212 
213 		if (!dfs_channel_available(chan, type)) {
214 			wpa_printf(MSG_DEBUG, "DFS: channel not available %d",
215 				   first_chan->freq + i * 20);
216 			return 0;
217 		}
218 	}
219 
220 	return 1;
221 }
222 
223 
is_in_chanlist(struct hostapd_iface * iface,struct hostapd_channel_data * chan)224 static int is_in_chanlist(struct hostapd_iface *iface,
225 			  struct hostapd_channel_data *chan)
226 {
227 	if (!iface->conf->acs_ch_list.num)
228 		return 1;
229 
230 	return freq_range_list_includes(&iface->conf->acs_ch_list, chan->chan);
231 }
232 
233 
234 /*
235  * The function assumes HT40+ operation.
236  * Make sure to adjust the following variables after calling this:
237  *  - hapd->secondary_channel
238  *  - hapd->vht/he_oper_centr_freq_seg0_idx
239  *  - hapd->vht/he_oper_centr_freq_seg1_idx
240  */
dfs_find_channel(struct hostapd_iface * iface,struct hostapd_channel_data ** ret_chan,int idx,enum dfs_channel_type type)241 static int dfs_find_channel(struct hostapd_iface *iface,
242 			    struct hostapd_channel_data **ret_chan,
243 			    int idx, enum dfs_channel_type type)
244 {
245 	struct hostapd_hw_modes *mode;
246 	struct hostapd_channel_data *chan;
247 	int i, channel_idx = 0, n_chans, n_chans1;
248 
249 	mode = iface->current_mode;
250 	n_chans = dfs_get_used_n_chans(iface, &n_chans1);
251 
252 	wpa_printf(MSG_DEBUG, "DFS new chan checking %d channels", n_chans);
253 	for (i = 0; i < mode->num_channels; i++) {
254 		chan = &mode->channels[i];
255 
256 		/* Skip HT40/VHT incompatible channels */
257 		if (iface->conf->ieee80211n &&
258 		    iface->conf->secondary_channel &&
259 		    (!dfs_is_chan_allowed(chan, n_chans) ||
260 		     !(chan->allowed_bw & HOSTAPD_CHAN_WIDTH_40P))) {
261 			wpa_printf(MSG_DEBUG,
262 				   "DFS: channel %d (%d) is incompatible",
263 				   chan->freq, chan->chan);
264 			continue;
265 		}
266 
267 		/* Skip incompatible chandefs */
268 		if (!dfs_chan_range_available(mode, i, n_chans, type)) {
269 			wpa_printf(MSG_DEBUG,
270 				   "DFS: range not available for %d (%d)",
271 				   chan->freq, chan->chan);
272 			continue;
273 		}
274 
275 		if (!is_in_chanlist(iface, chan)) {
276 			wpa_printf(MSG_DEBUG,
277 				   "DFS: channel %d (%d) not in chanlist",
278 				   chan->freq, chan->chan);
279 			continue;
280 		}
281 
282 		if (chan->max_tx_power < iface->conf->min_tx_power)
283 			continue;
284 
285 		if ((chan->flag & HOSTAPD_CHAN_INDOOR_ONLY) &&
286 		    iface->conf->country[2] == 0x4f)
287 			continue;
288 
289 		if (ret_chan && idx == channel_idx) {
290 			wpa_printf(MSG_DEBUG, "Selected channel %d (%d)",
291 				   chan->freq, chan->chan);
292 			*ret_chan = chan;
293 			return idx;
294 		}
295 		wpa_printf(MSG_DEBUG, "Adding channel %d (%d)",
296 			   chan->freq, chan->chan);
297 		channel_idx++;
298 	}
299 	return channel_idx;
300 }
301 
302 
dfs_adjust_center_freq(struct hostapd_iface * iface,struct hostapd_channel_data * chan,int secondary_channel,int sec_chan_idx_80p80,u8 * oper_centr_freq_seg0_idx,u8 * oper_centr_freq_seg1_idx)303 static void dfs_adjust_center_freq(struct hostapd_iface *iface,
304 				   struct hostapd_channel_data *chan,
305 				   int secondary_channel,
306 				   int sec_chan_idx_80p80,
307 				   u8 *oper_centr_freq_seg0_idx,
308 				   u8 *oper_centr_freq_seg1_idx)
309 {
310 	if (!iface->conf->ieee80211ac && !iface->conf->ieee80211ax)
311 		return;
312 
313 	if (!chan)
314 		return;
315 
316 	*oper_centr_freq_seg1_idx = 0;
317 
318 	switch (hostapd_get_oper_chwidth(iface->conf)) {
319 	case CONF_OPER_CHWIDTH_USE_HT:
320 		if (secondary_channel == 1)
321 			*oper_centr_freq_seg0_idx = chan->chan + 2;
322 		else if (secondary_channel == -1)
323 			*oper_centr_freq_seg0_idx = chan->chan - 2;
324 		else
325 			*oper_centr_freq_seg0_idx = chan->chan;
326 		break;
327 	case CONF_OPER_CHWIDTH_80MHZ:
328 		*oper_centr_freq_seg0_idx = chan->chan + 6;
329 		break;
330 	case CONF_OPER_CHWIDTH_160MHZ:
331 		*oper_centr_freq_seg0_idx = chan->chan + 14;
332 		break;
333 	case CONF_OPER_CHWIDTH_80P80MHZ:
334 		*oper_centr_freq_seg0_idx = chan->chan + 6;
335 		*oper_centr_freq_seg1_idx = sec_chan_idx_80p80 + 6;
336 		break;
337 
338 	default:
339 		wpa_printf(MSG_INFO,
340 			   "DFS: Unsupported channel width configuration");
341 		*oper_centr_freq_seg0_idx = 0;
342 		break;
343 	}
344 
345 	wpa_printf(MSG_DEBUG, "DFS adjusting VHT center frequency: %d, %d",
346 		   *oper_centr_freq_seg0_idx,
347 		   *oper_centr_freq_seg1_idx);
348 }
349 
350 
351 /* Return start channel idx we will use for mode->channels[idx] */
dfs_get_start_chan_idx(struct hostapd_iface * iface,int * seg1_start)352 static int dfs_get_start_chan_idx(struct hostapd_iface *iface, int *seg1_start)
353 {
354 	struct hostapd_hw_modes *mode;
355 	struct hostapd_channel_data *chan;
356 	int channel_no = iface->conf->channel;
357 	int res = -1, i;
358 	int chan_seg1 = -1;
359 
360 	*seg1_start = -1;
361 
362 	/* HT40- */
363 	if (iface->conf->ieee80211n && iface->conf->secondary_channel == -1)
364 		channel_no -= 4;
365 
366 	/* VHT/HE/EHT */
367 	if (iface->conf->ieee80211ac || iface->conf->ieee80211ax ||
368 	    iface->conf->ieee80211be) {
369 		switch (hostapd_get_oper_chwidth(iface->conf)) {
370 		case CONF_OPER_CHWIDTH_USE_HT:
371 			break;
372 		case CONF_OPER_CHWIDTH_80MHZ:
373 			channel_no = hostapd_get_oper_centr_freq_seg0_idx(
374 				iface->conf) - 6;
375 			break;
376 		case CONF_OPER_CHWIDTH_160MHZ:
377 			channel_no = hostapd_get_oper_centr_freq_seg0_idx(
378 				iface->conf) - 14;
379 			break;
380 		case CONF_OPER_CHWIDTH_80P80MHZ:
381 			channel_no = hostapd_get_oper_centr_freq_seg0_idx(
382 				iface->conf) - 6;
383 			chan_seg1 = hostapd_get_oper_centr_freq_seg1_idx(
384 				iface->conf) - 6;
385 			break;
386 		case CONF_OPER_CHWIDTH_320MHZ:
387 			channel_no = hostapd_get_oper_centr_freq_seg0_idx(
388 				iface->conf) - 30;
389 			break;
390 		default:
391 			wpa_printf(MSG_INFO,
392 				   "DFS only EHT20/40/80/160/80+80/320 is supported now");
393 			channel_no = -1;
394 			break;
395 		}
396 	}
397 
398 	/* Get idx */
399 	mode = iface->current_mode;
400 	for (i = 0; i < mode->num_channels; i++) {
401 		chan = &mode->channels[i];
402 		if (chan->chan == channel_no) {
403 			res = i;
404 			break;
405 		}
406 	}
407 
408 	if (res != -1 && chan_seg1 > -1) {
409 		int found = 0;
410 
411 		/* Get idx for seg1 */
412 		mode = iface->current_mode;
413 		for (i = 0; i < mode->num_channels; i++) {
414 			chan = &mode->channels[i];
415 			if (chan->chan == chan_seg1) {
416 				*seg1_start = i;
417 				found = 1;
418 				break;
419 			}
420 		}
421 		if (!found)
422 			res = -1;
423 	}
424 
425 	if (res == -1) {
426 		wpa_printf(MSG_DEBUG,
427 			   "DFS chan_idx seems wrong; num-ch: %d ch-no: %d conf-ch-no: %d 11n: %d sec-ch: %d vht-oper-width: %d",
428 			   mode->num_channels, channel_no, iface->conf->channel,
429 			   iface->conf->ieee80211n,
430 			   iface->conf->secondary_channel,
431 			   hostapd_get_oper_chwidth(iface->conf));
432 
433 		for (i = 0; i < mode->num_channels; i++) {
434 			wpa_printf(MSG_DEBUG, "Available channel: %d",
435 				   mode->channels[i].chan);
436 		}
437 	}
438 
439 	return res;
440 }
441 
442 
443 /* At least one channel have radar flag */
dfs_check_chans_radar(struct hostapd_iface * iface,int start_chan_idx,int n_chans)444 static int dfs_check_chans_radar(struct hostapd_iface *iface,
445 				 int start_chan_idx, int n_chans)
446 {
447 	struct hostapd_channel_data *channel;
448 	struct hostapd_hw_modes *mode;
449 	int i, res = 0;
450 
451 	mode = iface->current_mode;
452 
453 	for (i = 0; i < n_chans; i++) {
454 		if (start_chan_idx + i >= mode->num_channels)
455 			break;
456 		channel = &mode->channels[start_chan_idx + i];
457 		if (channel->flag & HOSTAPD_CHAN_RADAR)
458 			res++;
459 	}
460 
461 	return res;
462 }
463 
464 
465 /* All channels available */
dfs_check_chans_available(struct hostapd_iface * iface,int start_chan_idx,int n_chans)466 static int dfs_check_chans_available(struct hostapd_iface *iface,
467 				     int start_chan_idx, int n_chans)
468 {
469 	struct hostapd_channel_data *channel;
470 	struct hostapd_hw_modes *mode;
471 	int i;
472 
473 	mode = iface->current_mode;
474 
475 	for (i = 0; i < n_chans; i++) {
476 		channel = &mode->channels[start_chan_idx + i];
477 
478 		if (channel->flag & HOSTAPD_CHAN_DISABLED)
479 			break;
480 
481 		if (!(channel->flag & HOSTAPD_CHAN_RADAR))
482 			continue;
483 
484 		if ((channel->flag & HOSTAPD_CHAN_DFS_MASK) !=
485 		    HOSTAPD_CHAN_DFS_AVAILABLE)
486 			break;
487 	}
488 
489 	return i == n_chans;
490 }
491 
492 
493 /* At least one channel unavailable */
dfs_check_chans_unavailable(struct hostapd_iface * iface,int start_chan_idx,int n_chans)494 static int dfs_check_chans_unavailable(struct hostapd_iface *iface,
495 				       int start_chan_idx,
496 				       int n_chans)
497 {
498 	struct hostapd_channel_data *channel;
499 	struct hostapd_hw_modes *mode;
500 	int i, res = 0;
501 
502 	mode = iface->current_mode;
503 
504 	for (i = 0; i < n_chans; i++) {
505 		channel = &mode->channels[start_chan_idx + i];
506 		if (channel->flag & HOSTAPD_CHAN_DISABLED)
507 			res++;
508 		if ((channel->flag & HOSTAPD_CHAN_DFS_MASK) ==
509 		    HOSTAPD_CHAN_DFS_UNAVAILABLE)
510 			res++;
511 	}
512 
513 	return res;
514 }
515 
516 
517 static struct hostapd_channel_data *
dfs_get_valid_channel(struct hostapd_iface * iface,int * secondary_channel,u8 * oper_centr_freq_seg0_idx,u8 * oper_centr_freq_seg1_idx,enum dfs_channel_type type)518 dfs_get_valid_channel(struct hostapd_iface *iface,
519 		      int *secondary_channel,
520 		      u8 *oper_centr_freq_seg0_idx,
521 		      u8 *oper_centr_freq_seg1_idx,
522 		      enum dfs_channel_type type)
523 {
524 	struct hostapd_hw_modes *mode;
525 	struct hostapd_channel_data *chan = NULL;
526 	struct hostapd_channel_data *chan2 = NULL;
527 	int num_available_chandefs;
528 	int chan_idx, chan_idx2;
529 	int sec_chan_idx_80p80 = -1;
530 	int i;
531 	u32 _rand;
532 
533 	wpa_printf(MSG_DEBUG, "DFS: Selecting random channel");
534 	*secondary_channel = 0;
535 	*oper_centr_freq_seg0_idx = 0;
536 	*oper_centr_freq_seg1_idx = 0;
537 
538 	if (iface->current_mode == NULL)
539 		return NULL;
540 
541 	mode = iface->current_mode;
542 	if (mode->mode != HOSTAPD_MODE_IEEE80211A)
543 		return NULL;
544 
545 	/* Get the count first */
546 	num_available_chandefs = dfs_find_channel(iface, NULL, 0, type);
547 	wpa_printf(MSG_DEBUG, "DFS: num_available_chandefs=%d",
548 		   num_available_chandefs);
549 	if (num_available_chandefs == 0)
550 		return NULL;
551 
552 	if (os_get_random((u8 *) &_rand, sizeof(_rand)) < 0)
553 		return NULL;
554 	chan_idx = _rand % num_available_chandefs;
555 	wpa_printf(MSG_DEBUG, "DFS: Picked random entry from the list: %d/%d",
556 		   chan_idx, num_available_chandefs);
557 	dfs_find_channel(iface, &chan, chan_idx, type);
558 	if (!chan) {
559 		wpa_printf(MSG_DEBUG, "DFS: no random channel found");
560 		return NULL;
561 	}
562 	wpa_printf(MSG_DEBUG, "DFS: got random channel %d (%d)",
563 		   chan->freq, chan->chan);
564 
565 	/* dfs_find_channel() calculations assume HT40+ */
566 	if (iface->conf->secondary_channel)
567 		*secondary_channel = 1;
568 	else
569 		*secondary_channel = 0;
570 
571 	/* Get secondary channel for HT80P80 */
572 	if (hostapd_get_oper_chwidth(iface->conf) ==
573 	    CONF_OPER_CHWIDTH_80P80MHZ) {
574 		if (num_available_chandefs <= 1) {
575 			wpa_printf(MSG_ERROR,
576 				   "only 1 valid chan, can't support 80+80");
577 			return NULL;
578 		}
579 
580 		/*
581 		 * Loop all channels except channel1 to find a valid channel2
582 		 * that is not adjacent to channel1.
583 		 */
584 		for (i = 0; i < num_available_chandefs - 1; i++) {
585 			/* start from chan_idx + 1, end when chan_idx - 1 */
586 			chan_idx2 = (chan_idx + 1 + i) % num_available_chandefs;
587 			dfs_find_channel(iface, &chan2, chan_idx2, type);
588 			if (chan2 && abs(chan2->chan - chan->chan) > 12) {
589 				/* two channels are not adjacent */
590 				sec_chan_idx_80p80 = chan2->chan;
591 				wpa_printf(MSG_DEBUG,
592 					   "DFS: got second chan: %d (%d)",
593 					   chan2->freq, chan2->chan);
594 				break;
595 			}
596 		}
597 
598 		/* Check if we got a valid secondary channel which is not
599 		 * adjacent to the first channel.
600 		 */
601 		if (sec_chan_idx_80p80 == -1) {
602 			wpa_printf(MSG_INFO,
603 				   "DFS: failed to get chan2 for 80+80");
604 			return NULL;
605 		}
606 	}
607 
608 	dfs_adjust_center_freq(iface, chan,
609 			       *secondary_channel,
610 			       sec_chan_idx_80p80,
611 			       oper_centr_freq_seg0_idx,
612 			       oper_centr_freq_seg1_idx);
613 
614 	return chan;
615 }
616 
617 
dfs_set_valid_channel(struct hostapd_iface * iface,int skip_radar)618 static int dfs_set_valid_channel(struct hostapd_iface *iface, int skip_radar)
619 {
620 	struct hostapd_channel_data *channel;
621 	u8 cf1 = 0, cf2 = 0;
622 	int sec = 0;
623 
624 	channel = dfs_get_valid_channel(iface, &sec, &cf1, &cf2,
625 					skip_radar ? DFS_AVAILABLE :
626 					DFS_ANY_CHANNEL);
627 	if (!channel) {
628 		wpa_printf(MSG_ERROR, "could not get valid channel");
629 		return -1;
630 	}
631 
632 	iface->freq = channel->freq;
633 	iface->conf->channel = channel->chan;
634 	iface->conf->secondary_channel = sec;
635 	hostapd_set_oper_centr_freq_seg0_idx(iface->conf, cf1);
636 	hostapd_set_oper_centr_freq_seg1_idx(iface->conf, cf2);
637 
638 	return 0;
639 }
640 
641 
set_dfs_state_freq(struct hostapd_iface * iface,int freq,u32 state)642 static int set_dfs_state_freq(struct hostapd_iface *iface, int freq, u32 state)
643 {
644 	struct hostapd_hw_modes *mode;
645 	struct hostapd_channel_data *chan = NULL;
646 	int i;
647 
648 	mode = iface->current_mode;
649 	if (mode == NULL)
650 		return 0;
651 
652 	wpa_printf(MSG_DEBUG, "set_dfs_state 0x%X for %d MHz", state, freq);
653 	for (i = 0; i < iface->current_mode->num_channels; i++) {
654 		chan = &iface->current_mode->channels[i];
655 		if (chan->freq == freq) {
656 			if (chan->flag & HOSTAPD_CHAN_RADAR) {
657 				chan->flag &= ~HOSTAPD_CHAN_DFS_MASK;
658 				chan->flag |= state;
659 				return 1; /* Channel found */
660 			}
661 		}
662 	}
663 	wpa_printf(MSG_WARNING, "Can't set DFS state for freq %d MHz", freq);
664 	return 0;
665 }
666 
667 
set_dfs_state(struct hostapd_iface * iface,int freq,int ht_enabled,int chan_offset,int chan_width,int cf1,int cf2,u32 state)668 static int set_dfs_state(struct hostapd_iface *iface, int freq, int ht_enabled,
669 			 int chan_offset, int chan_width, int cf1,
670 			 int cf2, u32 state)
671 {
672 	int n_chans = 1, i;
673 	struct hostapd_hw_modes *mode;
674 	int frequency = freq;
675 	int frequency2 = 0;
676 	int ret = 0;
677 
678 	mode = iface->current_mode;
679 	if (mode == NULL)
680 		return 0;
681 
682 	if (mode->mode != HOSTAPD_MODE_IEEE80211A) {
683 		wpa_printf(MSG_WARNING, "current_mode != IEEE80211A");
684 		return 0;
685 	}
686 
687 	/* Seems cf1 and chan_width is enough here */
688 	switch (chan_width) {
689 	case CHAN_WIDTH_20_NOHT:
690 	case CHAN_WIDTH_20:
691 		n_chans = 1;
692 		if (frequency == 0)
693 			frequency = cf1;
694 		break;
695 	case CHAN_WIDTH_40:
696 		n_chans = 2;
697 		frequency = cf1 - 10;
698 		break;
699 	case CHAN_WIDTH_80:
700 		n_chans = 4;
701 		frequency = cf1 - 30;
702 		break;
703 	case CHAN_WIDTH_80P80:
704 		n_chans = 4;
705 		frequency = cf1 - 30;
706 		frequency2 = cf2 - 30;
707 		break;
708 	case CHAN_WIDTH_160:
709 		n_chans = 8;
710 		frequency = cf1 - 70;
711 		break;
712 	default:
713 		wpa_printf(MSG_INFO, "DFS chan_width %d not supported",
714 			   chan_width);
715 		break;
716 	}
717 
718 	wpa_printf(MSG_DEBUG, "DFS freq: %dMHz, n_chans: %d", frequency,
719 		   n_chans);
720 	for (i = 0; i < n_chans; i++) {
721 		ret += set_dfs_state_freq(iface, frequency, state);
722 		frequency = frequency + 20;
723 
724 		if (chan_width == CHAN_WIDTH_80P80) {
725 			ret += set_dfs_state_freq(iface, frequency2, state);
726 			frequency2 = frequency2 + 20;
727 		}
728 	}
729 
730 	return ret;
731 }
732 
733 
dfs_are_channels_overlapped(struct hostapd_iface * iface,int freq,int chan_width,int cf1,int cf2)734 static int dfs_are_channels_overlapped(struct hostapd_iface *iface, int freq,
735 				       int chan_width, int cf1, int cf2)
736 {
737 	int start_chan_idx, start_chan_idx1;
738 	struct hostapd_hw_modes *mode;
739 	struct hostapd_channel_data *chan;
740 	int n_chans, n_chans1, i, j, frequency = freq, radar_n_chans = 1;
741 	u8 radar_chan;
742 	int res = 0;
743 
744 	/* Our configuration */
745 	mode = iface->current_mode;
746 	start_chan_idx = dfs_get_start_chan_idx(iface, &start_chan_idx1);
747 	n_chans = dfs_get_used_n_chans(iface, &n_chans1);
748 
749 	/* Check we are on DFS channel(s) */
750 	if (!dfs_check_chans_radar(iface, start_chan_idx, n_chans))
751 		return 0;
752 
753 	/* Reported via radar event */
754 	switch (chan_width) {
755 	case CHAN_WIDTH_20_NOHT:
756 	case CHAN_WIDTH_20:
757 		radar_n_chans = 1;
758 		if (frequency == 0)
759 			frequency = cf1;
760 		break;
761 	case CHAN_WIDTH_40:
762 		radar_n_chans = 2;
763 		frequency = cf1 - 10;
764 		break;
765 	case CHAN_WIDTH_80:
766 		radar_n_chans = 4;
767 		frequency = cf1 - 30;
768 		break;
769 	case CHAN_WIDTH_160:
770 		radar_n_chans = 8;
771 		frequency = cf1 - 70;
772 		break;
773 	default:
774 		wpa_printf(MSG_INFO, "DFS chan_width %d not supported",
775 			   chan_width);
776 		break;
777 	}
778 
779 	ieee80211_freq_to_chan(frequency, &radar_chan);
780 
781 	for (i = 0; i < n_chans; i++) {
782 		chan = &mode->channels[start_chan_idx + i];
783 		if (!(chan->flag & HOSTAPD_CHAN_RADAR))
784 			continue;
785 		for (j = 0; j < radar_n_chans; j++) {
786 			wpa_printf(MSG_DEBUG, "checking our: %d, radar: %d",
787 				   chan->chan, radar_chan + j * 4);
788 			if (chan->chan == radar_chan + j * 4)
789 				res++;
790 		}
791 	}
792 
793 	wpa_printf(MSG_DEBUG, "overlapped: %d", res);
794 
795 	return res;
796 }
797 
798 
dfs_get_cac_time(struct hostapd_iface * iface,int start_chan_idx,int n_chans)799 static unsigned int dfs_get_cac_time(struct hostapd_iface *iface,
800 				     int start_chan_idx, int n_chans)
801 {
802 	struct hostapd_channel_data *channel;
803 	struct hostapd_hw_modes *mode;
804 	int i;
805 	unsigned int cac_time_ms = 0;
806 
807 	mode = iface->current_mode;
808 
809 	for (i = 0; i < n_chans; i++) {
810 		if (start_chan_idx + i >= mode->num_channels)
811 			break;
812 		channel = &mode->channels[start_chan_idx + i];
813 		if (!(channel->flag & HOSTAPD_CHAN_RADAR))
814 			continue;
815 		if (channel->dfs_cac_ms > cac_time_ms)
816 			cac_time_ms = channel->dfs_cac_ms;
817 	}
818 
819 	return cac_time_ms;
820 }
821 
822 
823 /*
824  * Main DFS handler
825  * 1 - continue channel/ap setup
826  * 0 - channel/ap setup will be continued after CAC
827  * -1 - hit critical error
828  */
hostapd_handle_dfs(struct hostapd_iface * iface)829 int hostapd_handle_dfs(struct hostapd_iface *iface)
830 {
831 	int res, n_chans, n_chans1, start_chan_idx, start_chan_idx1;
832 	int skip_radar = 0;
833 
834 	if (is_6ghz_freq(iface->freq))
835 		return 1;
836 
837 	if (!iface->current_mode) {
838 		/*
839 		 * This can happen with drivers that do not provide mode
840 		 * information and as such, cannot really use hostapd for DFS.
841 		 */
842 		wpa_printf(MSG_DEBUG,
843 			   "DFS: No current_mode information - assume no need to perform DFS operations by hostapd");
844 		return 1;
845 	}
846 
847 	iface->cac_started = 0;
848 
849 	do {
850 		/* Get start (first) channel for current configuration */
851 		start_chan_idx = dfs_get_start_chan_idx(iface,
852 							&start_chan_idx1);
853 		if (start_chan_idx == -1)
854 			return -1;
855 
856 		/* Get number of used channels, depend on width */
857 		n_chans = dfs_get_used_n_chans(iface, &n_chans1);
858 
859 		/* Setup CAC time */
860 		iface->dfs_cac_ms = dfs_get_cac_time(iface, start_chan_idx,
861 						     n_chans);
862 
863 		/* Check if any of configured channels require DFS */
864 		res = dfs_check_chans_radar(iface, start_chan_idx, n_chans);
865 		wpa_printf(MSG_DEBUG,
866 			   "DFS %d channels required radar detection",
867 			   res);
868 		if (!res)
869 			return 1;
870 
871 		/* Check if all channels are DFS available */
872 		res = dfs_check_chans_available(iface, start_chan_idx, n_chans);
873 		wpa_printf(MSG_DEBUG,
874 			   "DFS all channels available, (SKIP CAC): %s",
875 			   res ? "yes" : "no");
876 		if (res)
877 			return 1;
878 
879 		/* Check if any of configured channels is unavailable */
880 		res = dfs_check_chans_unavailable(iface, start_chan_idx,
881 						  n_chans);
882 		wpa_printf(MSG_DEBUG, "DFS %d chans unavailable - choose other channel: %s",
883 			   res, res ? "yes": "no");
884 		if (res) {
885 			if (dfs_set_valid_channel(iface, skip_radar) < 0) {
886 				hostapd_set_state(iface, HAPD_IFACE_DFS);
887 				return 0;
888 			}
889 		}
890 	} while (res);
891 
892 	/* Finally start CAC */
893 	hostapd_set_state(iface, HAPD_IFACE_DFS);
894 	wpa_printf(MSG_DEBUG, "DFS start CAC on %d MHz%s", iface->freq,
895 		   dfs_use_radar_background(iface) ? " (background)" : "");
896 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_CAC_START
897 		"freq=%d chan=%d sec_chan=%d, width=%d, seg0=%d, seg1=%d, cac_time=%ds",
898 		iface->freq,
899 		iface->conf->channel, iface->conf->secondary_channel,
900 		hostapd_get_oper_chwidth(iface->conf),
901 		hostapd_get_oper_centr_freq_seg0_idx(iface->conf),
902 		hostapd_get_oper_centr_freq_seg1_idx(iface->conf),
903 		iface->dfs_cac_ms / 1000);
904 
905 	res = hostapd_start_dfs_cac(
906 		iface, iface->conf->hw_mode, iface->freq, iface->conf->channel,
907 		iface->conf->ieee80211n, iface->conf->ieee80211ac,
908 		iface->conf->ieee80211ax, iface->conf->ieee80211be,
909 		iface->conf->secondary_channel,
910 		hostapd_get_oper_chwidth(iface->conf),
911 		hostapd_get_oper_centr_freq_seg0_idx(iface->conf),
912 		hostapd_get_oper_centr_freq_seg1_idx(iface->conf),
913 		dfs_use_radar_background(iface));
914 
915 	if (res) {
916 		wpa_printf(MSG_ERROR, "DFS start_dfs_cac() failed, %d", res);
917 		return -1;
918 	}
919 
920 	if (dfs_use_radar_background(iface)) {
921 		/* Cache background radar parameters. */
922 		iface->radar_background.channel = iface->conf->channel;
923 		iface->radar_background.secondary_channel =
924 			iface->conf->secondary_channel;
925 		iface->radar_background.freq = iface->freq;
926 		iface->radar_background.centr_freq_seg0_idx =
927 			hostapd_get_oper_centr_freq_seg0_idx(iface->conf);
928 		iface->radar_background.centr_freq_seg1_idx =
929 			hostapd_get_oper_centr_freq_seg1_idx(iface->conf);
930 
931 		/*
932 		 * Let's select a random channel according to the
933 		 * regulations and perform CAC on dedicated radar chain.
934 		 */
935 		res = dfs_set_valid_channel(iface, 1);
936 		if (res < 0)
937 			return res;
938 
939 		iface->radar_background.temp_ch = 1;
940 		return 1;
941 	}
942 
943 	return 0;
944 }
945 
946 
hostapd_is_dfs_chan_available(struct hostapd_iface * iface)947 int hostapd_is_dfs_chan_available(struct hostapd_iface *iface)
948 {
949 	int n_chans, n_chans1, start_chan_idx, start_chan_idx1;
950 
951 	/* Get the start (first) channel for current configuration */
952 	start_chan_idx = dfs_get_start_chan_idx(iface, &start_chan_idx1);
953 	if (start_chan_idx < 0)
954 		return 0;
955 
956 	/* Get the number of used channels, depending on width */
957 	n_chans = dfs_get_used_n_chans(iface, &n_chans1);
958 
959 	/* Check if all channels are DFS available */
960 	return dfs_check_chans_available(iface, start_chan_idx, n_chans);
961 }
962 
963 
hostapd_dfs_request_channel_switch(struct hostapd_iface * iface,int channel,int freq,int secondary_channel,u8 current_vht_oper_chwidth,u8 oper_centr_freq_seg0_idx,u8 oper_centr_freq_seg1_idx)964 static int hostapd_dfs_request_channel_switch(struct hostapd_iface *iface,
965 					      int channel, int freq,
966 					      int secondary_channel,
967 					      u8 current_vht_oper_chwidth,
968 					      u8 oper_centr_freq_seg0_idx,
969 					      u8 oper_centr_freq_seg1_idx)
970 {
971 	struct hostapd_hw_modes *cmode = iface->current_mode;
972 	int ieee80211_mode = IEEE80211_MODE_AP, err;
973 	struct csa_settings csa_settings;
974 	u8 new_vht_oper_chwidth;
975 	unsigned int i;
976 	unsigned int num_err = 0;
977 
978 	wpa_printf(MSG_DEBUG, "DFS will switch to a new channel %d", channel);
979 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_NEW_CHANNEL
980 		"freq=%d chan=%d sec_chan=%d", freq, channel,
981 		secondary_channel);
982 
983 	new_vht_oper_chwidth = hostapd_get_oper_chwidth(iface->conf);
984 	hostapd_set_oper_chwidth(iface->conf, current_vht_oper_chwidth);
985 
986 	/* Setup CSA request */
987 	os_memset(&csa_settings, 0, sizeof(csa_settings));
988 	csa_settings.cs_count = 5;
989 	csa_settings.block_tx = 1;
990 	csa_settings.link_id = -1;
991 #ifdef CONFIG_IEEE80211BE
992 	if (iface->bss[0]->conf->mld_ap)
993 		csa_settings.link_id = iface->bss[0]->mld_link_id;
994 #endif /* CONFIG_IEEE80211BE */
995 #ifdef CONFIG_MESH
996 	if (iface->mconf)
997 		ieee80211_mode = IEEE80211_MODE_MESH;
998 #endif /* CONFIG_MESH */
999 	err = hostapd_set_freq_params(&csa_settings.freq_params,
1000 				      iface->conf->hw_mode,
1001 				      freq, channel,
1002 				      iface->conf->enable_edmg,
1003 				      iface->conf->edmg_channel,
1004 				      iface->conf->ieee80211n,
1005 				      iface->conf->ieee80211ac,
1006 				      iface->conf->ieee80211ax,
1007 				      iface->conf->ieee80211be,
1008 				      secondary_channel,
1009 				      new_vht_oper_chwidth,
1010 				      oper_centr_freq_seg0_idx,
1011 				      oper_centr_freq_seg1_idx,
1012 				      cmode->vht_capab,
1013 				      &cmode->he_capab[ieee80211_mode],
1014 				      &cmode->eht_capab[ieee80211_mode],
1015 				      hostapd_get_punct_bitmap(iface->bss[0]));
1016 
1017 	if (err) {
1018 		wpa_printf(MSG_ERROR,
1019 			   "DFS failed to calculate CSA freq params");
1020 		hostapd_disable_iface(iface);
1021 		return err;
1022 	}
1023 
1024 	for (i = 0; i < iface->num_bss; i++) {
1025 		err = hostapd_switch_channel(iface->bss[i], &csa_settings);
1026 		if (err)
1027 			num_err++;
1028 	}
1029 
1030 	if (num_err == iface->num_bss) {
1031 		wpa_printf(MSG_WARNING,
1032 			   "DFS failed to schedule CSA (%d) - trying fallback",
1033 			   err);
1034 		iface->freq = freq;
1035 		iface->conf->channel = channel;
1036 		iface->conf->secondary_channel = secondary_channel;
1037 		hostapd_set_oper_chwidth(iface->conf, new_vht_oper_chwidth);
1038 		hostapd_set_oper_centr_freq_seg0_idx(iface->conf,
1039 						     oper_centr_freq_seg0_idx);
1040 		hostapd_set_oper_centr_freq_seg1_idx(iface->conf,
1041 						     oper_centr_freq_seg1_idx);
1042 
1043 		hostapd_disable_iface(iface);
1044 		hostapd_enable_iface(iface);
1045 
1046 		return 0;
1047 	}
1048 
1049 	/* Channel configuration will be updated once CSA completes and
1050 	 * ch_switch_notify event is received */
1051 	wpa_printf(MSG_DEBUG, "DFS waiting channel switch event");
1052 
1053 	return 0;
1054 }
1055 
1056 
hostapd_dfs_update_background_chain(struct hostapd_iface * iface)1057 static void hostapd_dfs_update_background_chain(struct hostapd_iface *iface)
1058 {
1059 	int sec = 0;
1060 	enum dfs_channel_type channel_type = DFS_NO_CAC_YET;
1061 	struct hostapd_channel_data *channel;
1062 	u8 oper_centr_freq_seg0_idx = 0;
1063 	u8 oper_centr_freq_seg1_idx = 0;
1064 
1065 	/*
1066 	 * Allow selection of DFS channel in ETSI to comply with
1067 	 * uniform spreading.
1068 	 */
1069 	if (iface->dfs_domain == HOSTAPD_DFS_REGION_ETSI)
1070 		channel_type = DFS_ANY_CHANNEL;
1071 
1072 	channel = dfs_get_valid_channel(iface, &sec, &oper_centr_freq_seg0_idx,
1073 					&oper_centr_freq_seg1_idx,
1074 					channel_type);
1075 	if (!channel ||
1076 	    channel->chan == iface->conf->channel ||
1077 	    channel->chan == iface->radar_background.channel)
1078 		channel = dfs_downgrade_bandwidth(iface, &sec,
1079 						  &oper_centr_freq_seg0_idx,
1080 						  &oper_centr_freq_seg1_idx,
1081 						  &channel_type);
1082 	if (!channel ||
1083 	    hostapd_start_dfs_cac(iface, iface->conf->hw_mode,
1084 				  channel->freq, channel->chan,
1085 				  iface->conf->ieee80211n,
1086 				  iface->conf->ieee80211ac,
1087 				  iface->conf->ieee80211ax,
1088 				  iface->conf->ieee80211be,
1089 				  sec, hostapd_get_oper_chwidth(iface->conf),
1090 				  oper_centr_freq_seg0_idx,
1091 				  oper_centr_freq_seg1_idx, true)) {
1092 		wpa_printf(MSG_ERROR, "DFS failed to start CAC offchannel");
1093 		iface->radar_background.channel = -1;
1094 		return;
1095 	}
1096 
1097 	iface->radar_background.channel = channel->chan;
1098 	iface->radar_background.freq = channel->freq;
1099 	iface->radar_background.secondary_channel = sec;
1100 	iface->radar_background.centr_freq_seg0_idx = oper_centr_freq_seg0_idx;
1101 	iface->radar_background.centr_freq_seg1_idx = oper_centr_freq_seg1_idx;
1102 
1103 	wpa_printf(MSG_DEBUG,
1104 		   "%s: setting background chain to chan %d (%d MHz)",
1105 		   __func__, channel->chan, channel->freq);
1106 }
1107 
1108 
1109 static bool
hostapd_dfs_is_background_event(struct hostapd_iface * iface,int freq)1110 hostapd_dfs_is_background_event(struct hostapd_iface *iface, int freq)
1111 {
1112 	return dfs_use_radar_background(iface) &&
1113 		iface->radar_background.channel != -1 &&
1114 		iface->radar_background.freq == freq;
1115 }
1116 
1117 
1118 static int
hostapd_dfs_start_channel_switch_background(struct hostapd_iface * iface)1119 hostapd_dfs_start_channel_switch_background(struct hostapd_iface *iface)
1120 {
1121 	u8 current_vht_oper_chwidth = hostapd_get_oper_chwidth(iface->conf);
1122 
1123 	iface->conf->channel = iface->radar_background.channel;
1124 	iface->freq = iface->radar_background.freq;
1125 	iface->conf->secondary_channel =
1126 		iface->radar_background.secondary_channel;
1127 	hostapd_set_oper_centr_freq_seg0_idx(
1128 		iface->conf, iface->radar_background.centr_freq_seg0_idx);
1129 	hostapd_set_oper_centr_freq_seg1_idx(
1130 		iface->conf, iface->radar_background.centr_freq_seg1_idx);
1131 
1132 	hostapd_dfs_update_background_chain(iface);
1133 
1134 	return hostapd_dfs_request_channel_switch(
1135 		iface, iface->conf->channel, iface->freq,
1136 		iface->conf->secondary_channel, current_vht_oper_chwidth,
1137 		hostapd_get_oper_centr_freq_seg0_idx(iface->conf),
1138 		hostapd_get_oper_centr_freq_seg1_idx(iface->conf));
1139 }
1140 
1141 
hostapd_dfs_complete_cac(struct hostapd_iface * iface,int success,int freq,int ht_enabled,int chan_offset,int chan_width,int cf1,int cf2)1142 int hostapd_dfs_complete_cac(struct hostapd_iface *iface, int success, int freq,
1143 			     int ht_enabled, int chan_offset, int chan_width,
1144 			     int cf1, int cf2)
1145 {
1146 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_CAC_COMPLETED
1147 		"success=%d freq=%d ht_enabled=%d chan_offset=%d chan_width=%d cf1=%d cf2=%d radar_detected=%d",
1148 		success, freq, ht_enabled, chan_offset, chan_width, cf1, cf2,
1149 		iface->radar_detected);
1150 
1151 	if (success) {
1152 		/* Complete iface/ap configuration */
1153 		if (iface->drv_flags & WPA_DRIVER_FLAGS_DFS_OFFLOAD) {
1154 			/* Complete AP configuration for the first bring up. If
1155 			 * a radar was detected in this channel, interface setup
1156 			 * will be handled in
1157 			 * 1. hostapd_event_ch_switch() if switching to a
1158 			 *    non-DFS channel
1159 			 * 2. on next CAC complete event if switching to another
1160 			 *    DFS channel.
1161 			 */
1162 			if (iface->state != HAPD_IFACE_ENABLED &&
1163 			    !iface->radar_detected)
1164 				hostapd_setup_interface_complete(iface, 0);
1165 			else
1166 				iface->cac_started = 0;
1167 		} else {
1168 			set_dfs_state(iface, freq, ht_enabled, chan_offset,
1169 				      chan_width, cf1, cf2,
1170 				      HOSTAPD_CHAN_DFS_AVAILABLE);
1171 
1172 			/*
1173 			 * Radar event from background chain for the selected
1174 			 * channel. Perform CSA, move the main chain to the
1175 			 * selected channel and configure the background chain
1176 			 * to a new DFS channel.
1177 			 */
1178 			if (hostapd_dfs_is_background_event(iface, freq)) {
1179 				iface->radar_background.cac_started = 0;
1180 				if (!iface->radar_background.temp_ch)
1181 					return 0;
1182 
1183 				iface->radar_background.temp_ch = 0;
1184 				return hostapd_dfs_start_channel_switch_background(iface);
1185 			}
1186 
1187 			/*
1188 			 * Just mark the channel available when CAC completion
1189 			 * event is received in enabled state. CAC result could
1190 			 * have been propagated from another radio having the
1191 			 * same regulatory configuration. When CAC completion is
1192 			 * received during non-HAPD_IFACE_ENABLED state, make
1193 			 * sure the configured channel is available because this
1194 			 * CAC completion event could have been propagated from
1195 			 * another radio.
1196 			 */
1197 			if (iface->state != HAPD_IFACE_ENABLED &&
1198 			    hostapd_is_dfs_chan_available(iface)) {
1199 				hostapd_setup_interface_complete(iface, 0);
1200 				iface->cac_started = 0;
1201 			}
1202 		}
1203 	} else if (hostapd_dfs_is_background_event(iface, freq)) {
1204 		iface->radar_background.cac_started = 0;
1205 		hostapd_dfs_update_background_chain(iface);
1206 	}
1207 
1208 	iface->radar_detected = false;
1209 	return 0;
1210 }
1211 
1212 
hostapd_dfs_pre_cac_expired(struct hostapd_iface * iface,int freq,int ht_enabled,int chan_offset,int chan_width,int cf1,int cf2)1213 int hostapd_dfs_pre_cac_expired(struct hostapd_iface *iface, int freq,
1214 				int ht_enabled, int chan_offset, int chan_width,
1215 				int cf1, int cf2)
1216 {
1217 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_PRE_CAC_EXPIRED
1218 		"freq=%d ht_enabled=%d chan_offset=%d chan_width=%d cf1=%d cf2=%d",
1219 		freq, ht_enabled, chan_offset, chan_width, cf1, cf2);
1220 
1221 	/* Proceed only if DFS is not offloaded to the driver */
1222 	if (iface->drv_flags & WPA_DRIVER_FLAGS_DFS_OFFLOAD)
1223 		return 0;
1224 
1225 	set_dfs_state(iface, freq, ht_enabled, chan_offset, chan_width,
1226 		      cf1, cf2, HOSTAPD_CHAN_DFS_USABLE);
1227 
1228 	return 0;
1229 }
1230 
1231 
1232 static struct hostapd_channel_data *
dfs_downgrade_bandwidth(struct hostapd_iface * iface,int * secondary_channel,u8 * oper_centr_freq_seg0_idx,u8 * oper_centr_freq_seg1_idx,enum dfs_channel_type * channel_type)1233 dfs_downgrade_bandwidth(struct hostapd_iface *iface, int *secondary_channel,
1234 			u8 *oper_centr_freq_seg0_idx,
1235 			u8 *oper_centr_freq_seg1_idx,
1236 			enum dfs_channel_type *channel_type)
1237 {
1238 	struct hostapd_channel_data *channel;
1239 
1240 	for (;;) {
1241 		channel = dfs_get_valid_channel(iface, secondary_channel,
1242 						oper_centr_freq_seg0_idx,
1243 						oper_centr_freq_seg1_idx,
1244 						*channel_type);
1245 		if (channel) {
1246 			wpa_printf(MSG_DEBUG, "DFS: Selected channel: %d",
1247 				   channel->chan);
1248 			return channel;
1249 		}
1250 
1251 		if (*channel_type != DFS_ANY_CHANNEL) {
1252 			*channel_type = DFS_ANY_CHANNEL;
1253 		} else {
1254 			int oper_chwidth;
1255 
1256 			oper_chwidth = hostapd_get_oper_chwidth(iface->conf);
1257 			if (oper_chwidth == CONF_OPER_CHWIDTH_USE_HT)
1258 				break;
1259 			*channel_type = DFS_AVAILABLE;
1260 			hostapd_set_oper_chwidth(iface->conf, oper_chwidth - 1);
1261 		}
1262 	}
1263 
1264 	wpa_printf(MSG_INFO,
1265 		   "%s: no DFS channels left, waiting for NOP to finish",
1266 		   __func__);
1267 	return NULL;
1268 }
1269 
1270 
hostapd_dfs_start_channel_switch_cac(struct hostapd_iface * iface)1271 static int hostapd_dfs_start_channel_switch_cac(struct hostapd_iface *iface)
1272 {
1273 	struct hostapd_channel_data *channel;
1274 	int secondary_channel;
1275 	u8 oper_centr_freq_seg0_idx = 0;
1276 	u8 oper_centr_freq_seg1_idx = 0;
1277 	enum dfs_channel_type channel_type = DFS_ANY_CHANNEL;
1278 	int err = 1;
1279 
1280 	/* Radar detected during active CAC */
1281 	iface->cac_started = 0;
1282 	channel = dfs_get_valid_channel(iface, &secondary_channel,
1283 					&oper_centr_freq_seg0_idx,
1284 					&oper_centr_freq_seg1_idx,
1285 					channel_type);
1286 
1287 	if (!channel) {
1288 		channel = dfs_downgrade_bandwidth(iface, &secondary_channel,
1289 						  &oper_centr_freq_seg0_idx,
1290 						  &oper_centr_freq_seg1_idx,
1291 						  &channel_type);
1292 		if (!channel) {
1293 			wpa_printf(MSG_ERROR, "No valid channel available");
1294 			return err;
1295 		}
1296 	}
1297 
1298 	wpa_printf(MSG_DEBUG, "DFS will switch to a new channel %d",
1299 		   channel->chan);
1300 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_NEW_CHANNEL
1301 		"freq=%d chan=%d sec_chan=%d", channel->freq,
1302 		channel->chan, secondary_channel);
1303 
1304 	iface->freq = channel->freq;
1305 	iface->conf->channel = channel->chan;
1306 	iface->conf->secondary_channel = secondary_channel;
1307 	hostapd_set_oper_centr_freq_seg0_idx(iface->conf,
1308 					     oper_centr_freq_seg0_idx);
1309 	hostapd_set_oper_centr_freq_seg1_idx(iface->conf,
1310 					     oper_centr_freq_seg1_idx);
1311 	err = 0;
1312 
1313 	hostapd_setup_interface_complete(iface, err);
1314 	return err;
1315 }
1316 
1317 
1318 static int
hostapd_dfs_background_start_channel_switch(struct hostapd_iface * iface,int freq)1319 hostapd_dfs_background_start_channel_switch(struct hostapd_iface *iface,
1320 					    int freq)
1321 {
1322 	if (!dfs_use_radar_background(iface))
1323 		return -1; /* Background radar chain not supported. */
1324 
1325 	wpa_printf(MSG_DEBUG,
1326 		   "%s called (background CAC active: %s, CSA active: %s)",
1327 		   __func__, iface->radar_background.cac_started ? "yes" : "no",
1328 		   hostapd_csa_in_progress(iface) ? "yes" : "no");
1329 
1330 	/* Check if CSA in progress */
1331 	if (hostapd_csa_in_progress(iface))
1332 		return 0;
1333 
1334 	if (hostapd_dfs_is_background_event(iface, freq)) {
1335 		/*
1336 		 * Radar pattern is reported on the background chain.
1337 		 * Just select a new random channel according to the
1338 		 * regulations for monitoring.
1339 		 */
1340 		hostapd_dfs_update_background_chain(iface);
1341 		return 0;
1342 	}
1343 
1344 	/*
1345 	 * If background radar detection is supported and the radar channel
1346 	 * monitored by the background chain is available switch to it without
1347 	 * waiting for the CAC.
1348 	 */
1349 	if (iface->radar_background.channel == -1)
1350 		return -1; /* Background radar chain not available. */
1351 
1352 	if (iface->radar_background.cac_started) {
1353 		/*
1354 		 * Background channel not available yet. Perform CAC on the
1355 		 * main chain.
1356 		 */
1357 		iface->radar_background.temp_ch = 1;
1358 		return -1;
1359 	}
1360 
1361 	return hostapd_dfs_start_channel_switch_background(iface);
1362 }
1363 
1364 
hostapd_dfs_start_channel_switch(struct hostapd_iface * iface)1365 static int hostapd_dfs_start_channel_switch(struct hostapd_iface *iface)
1366 {
1367 	struct hostapd_channel_data *channel;
1368 	int secondary_channel;
1369 	u8 oper_centr_freq_seg0_idx;
1370 	u8 oper_centr_freq_seg1_idx;
1371 	enum dfs_channel_type channel_type = DFS_AVAILABLE;
1372 	u8 current_vht_oper_chwidth = hostapd_get_oper_chwidth(iface->conf);
1373 
1374 	wpa_printf(MSG_DEBUG, "%s called (CAC active: %s, CSA active: %s)",
1375 		   __func__, iface->cac_started ? "yes" : "no",
1376 		   hostapd_csa_in_progress(iface) ? "yes" : "no");
1377 
1378 	/* Check if CSA in progress */
1379 	if (hostapd_csa_in_progress(iface))
1380 		return 0;
1381 
1382 	/* Check if active CAC */
1383 	if (iface->cac_started)
1384 		return hostapd_dfs_start_channel_switch_cac(iface);
1385 
1386 	/*
1387 	 * Allow selection of DFS channel in ETSI to comply with
1388 	 * uniform spreading.
1389 	 */
1390 	if (iface->dfs_domain == HOSTAPD_DFS_REGION_ETSI)
1391 		channel_type = DFS_ANY_CHANNEL;
1392 
1393 	/* Perform channel switch/CSA */
1394 	channel = dfs_get_valid_channel(iface, &secondary_channel,
1395 					&oper_centr_freq_seg0_idx,
1396 					&oper_centr_freq_seg1_idx,
1397 					channel_type);
1398 
1399 	if (!channel) {
1400 		/*
1401 		 * If there is no channel to switch immediately to, check if
1402 		 * there is another channel where we can switch even if it
1403 		 * requires to perform a CAC first.
1404 		 */
1405 		channel_type = DFS_ANY_CHANNEL;
1406 		channel = dfs_downgrade_bandwidth(iface, &secondary_channel,
1407 						  &oper_centr_freq_seg0_idx,
1408 						  &oper_centr_freq_seg1_idx,
1409 						  &channel_type);
1410 		if (!channel) {
1411 			/*
1412 			 * Toggle interface state to enter DFS state
1413 			 * until NOP is finished.
1414 			 */
1415 			hostapd_disable_iface(iface);
1416 			hostapd_enable_iface(iface);
1417 			return 0;
1418 		}
1419 
1420 		if (channel_type == DFS_ANY_CHANNEL) {
1421 			iface->freq = channel->freq;
1422 			iface->conf->channel = channel->chan;
1423 			iface->conf->secondary_channel = secondary_channel;
1424 			hostapd_set_oper_centr_freq_seg0_idx(
1425 				iface->conf, oper_centr_freq_seg0_idx);
1426 			hostapd_set_oper_centr_freq_seg1_idx(
1427 				iface->conf, oper_centr_freq_seg1_idx);
1428 
1429 			hostapd_disable_iface(iface);
1430 			hostapd_enable_iface(iface);
1431 			return 0;
1432 		}
1433 	}
1434 
1435 	return hostapd_dfs_request_channel_switch(iface, channel->chan,
1436 						  channel->freq,
1437 						  secondary_channel,
1438 						  current_vht_oper_chwidth,
1439 						  oper_centr_freq_seg0_idx,
1440 						  oper_centr_freq_seg1_idx);
1441 }
1442 
1443 
hostapd_dfs_radar_detected(struct hostapd_iface * iface,int freq,int ht_enabled,int chan_offset,int chan_width,int cf1,int cf2)1444 int hostapd_dfs_radar_detected(struct hostapd_iface *iface, int freq,
1445 			       int ht_enabled, int chan_offset, int chan_width,
1446 			       int cf1, int cf2)
1447 {
1448 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_RADAR_DETECTED
1449 		"freq=%d ht_enabled=%d chan_offset=%d chan_width=%d cf1=%d cf2=%d",
1450 		freq, ht_enabled, chan_offset, chan_width, cf1, cf2);
1451 
1452 	iface->radar_detected = true;
1453 
1454 	/* Proceed only if DFS is not offloaded to the driver */
1455 	if (iface->drv_flags & WPA_DRIVER_FLAGS_DFS_OFFLOAD)
1456 		return 0;
1457 
1458 	if (!iface->conf->ieee80211h)
1459 		return 0;
1460 
1461 	/* mark radar frequency as invalid */
1462 	if (!set_dfs_state(iface, freq, ht_enabled, chan_offset, chan_width,
1463 			   cf1, cf2, HOSTAPD_CHAN_DFS_UNAVAILABLE))
1464 		return 0;
1465 
1466 	if (!hostapd_dfs_is_background_event(iface, freq)) {
1467 		/* Skip if reported radar event not overlapped our channels */
1468 		if (!dfs_are_channels_overlapped(iface, freq, chan_width,
1469 						 cf1, cf2))
1470 			return 0;
1471 	}
1472 
1473 	if (hostapd_dfs_background_start_channel_switch(iface, freq)) {
1474 		/* Radar detected while operating, switch the channel. */
1475 		return hostapd_dfs_start_channel_switch(iface);
1476 	}
1477 
1478 	return 0;
1479 }
1480 
1481 
hostapd_dfs_nop_finished(struct hostapd_iface * iface,int freq,int ht_enabled,int chan_offset,int chan_width,int cf1,int cf2)1482 int hostapd_dfs_nop_finished(struct hostapd_iface *iface, int freq,
1483 			     int ht_enabled, int chan_offset, int chan_width,
1484 			     int cf1, int cf2)
1485 {
1486 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_NOP_FINISHED
1487 		"freq=%d ht_enabled=%d chan_offset=%d chan_width=%d cf1=%d cf2=%d",
1488 		freq, ht_enabled, chan_offset, chan_width, cf1, cf2);
1489 
1490 	/* Proceed only if DFS is not offloaded to the driver */
1491 	if (iface->drv_flags & WPA_DRIVER_FLAGS_DFS_OFFLOAD)
1492 		return 0;
1493 
1494 	/* TODO add correct implementation here */
1495 	set_dfs_state(iface, freq, ht_enabled, chan_offset, chan_width,
1496 		      cf1, cf2, HOSTAPD_CHAN_DFS_USABLE);
1497 
1498 	if (iface->state == HAPD_IFACE_DFS && !iface->cac_started) {
1499 		/* Handle cases where all channels were initially unavailable */
1500 		hostapd_handle_dfs(iface);
1501 	} else if (dfs_use_radar_background(iface) &&
1502 		   iface->radar_background.channel == -1) {
1503 		/* Reset radar background chain if disabled */
1504 		hostapd_dfs_update_background_chain(iface);
1505 	}
1506 
1507 	return 0;
1508 }
1509 
1510 
hostapd_is_dfs_required(struct hostapd_iface * iface)1511 int hostapd_is_dfs_required(struct hostapd_iface *iface)
1512 {
1513 	int n_chans, n_chans1, start_chan_idx, start_chan_idx1, res;
1514 
1515 	if ((!(iface->drv_flags & WPA_DRIVER_FLAGS_DFS_OFFLOAD) &&
1516 	     !iface->conf->ieee80211h) ||
1517 	    !iface->current_mode ||
1518 	    iface->current_mode->mode != HOSTAPD_MODE_IEEE80211A)
1519 		return 0;
1520 
1521 	/* Get start (first) channel for current configuration */
1522 	start_chan_idx = dfs_get_start_chan_idx(iface, &start_chan_idx1);
1523 	if (start_chan_idx == -1)
1524 		return -1;
1525 
1526 	/* Get number of used channels, depend on width */
1527 	n_chans = dfs_get_used_n_chans(iface, &n_chans1);
1528 
1529 	/* Check if any of configured channels require DFS */
1530 	res = dfs_check_chans_radar(iface, start_chan_idx, n_chans);
1531 	if (res)
1532 		return res;
1533 	if (start_chan_idx1 >= 0 && n_chans1 > 0)
1534 		res = dfs_check_chans_radar(iface, start_chan_idx1, n_chans1);
1535 	return res;
1536 }
1537 
1538 
hostapd_dfs_start_cac(struct hostapd_iface * iface,int freq,int ht_enabled,int chan_offset,int chan_width,int cf1,int cf2)1539 int hostapd_dfs_start_cac(struct hostapd_iface *iface, int freq,
1540 			  int ht_enabled, int chan_offset, int chan_width,
1541 			  int cf1, int cf2)
1542 {
1543 	if (hostapd_dfs_is_background_event(iface, freq)) {
1544 		iface->radar_background.cac_started = 1;
1545 	} else {
1546 		/* This is called when the driver indicates that an offloaded
1547 		 * DFS has started CAC. radar_detected might be set for previous
1548 		 * DFS channel. Clear it for this new CAC process. */
1549 		hostapd_set_state(iface, HAPD_IFACE_DFS);
1550 		iface->cac_started = 1;
1551 
1552 		/* Clear radar_detected in case it is for the previous
1553 		 * frequency. Also remove disabled link's information in RNR
1554 		 * element from other links. */
1555 		iface->radar_detected = false;
1556 		if (iface->interfaces && iface->interfaces->count > 1)
1557 			ieee802_11_set_beacons(iface);
1558 	}
1559 	/* TODO: How to check CAC time for ETSI weather channels? */
1560 	iface->dfs_cac_ms = 60000;
1561 	wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, DFS_EVENT_CAC_START
1562 		"freq=%d chan=%d chan_offset=%d width=%d seg0=%d "
1563 		"seg1=%d cac_time=%ds%s",
1564 		freq, (freq - 5000) / 5, chan_offset, chan_width, cf1, cf2,
1565 		iface->dfs_cac_ms / 1000,
1566 		hostapd_dfs_is_background_event(iface, freq) ?
1567 		" (background)" : "");
1568 
1569 	os_get_reltime(&iface->dfs_cac_start);
1570 	return 0;
1571 }
1572 
1573 
1574 /*
1575  * Main DFS handler for offloaded case.
1576  * 2 - continue channel/AP setup for non-DFS channel
1577  * 1 - continue channel/AP setup for DFS channel
1578  * 0 - channel/AP setup will be continued after CAC
1579  * -1 - hit critical error
1580  */
hostapd_handle_dfs_offload(struct hostapd_iface * iface)1581 int hostapd_handle_dfs_offload(struct hostapd_iface *iface)
1582 {
1583 	int dfs_res;
1584 
1585 	wpa_printf(MSG_DEBUG, "%s: iface->cac_started: %d",
1586 		   __func__, iface->cac_started);
1587 
1588 	/*
1589 	 * If DFS has already been started, then we are being called from a
1590 	 * callback to continue AP/channel setup. Reset the CAC start flag and
1591 	 * return.
1592 	 */
1593 	if (iface->cac_started) {
1594 		wpa_printf(MSG_DEBUG, "%s: iface->cac_started: %d",
1595 			   __func__, iface->cac_started);
1596 		iface->cac_started = 0;
1597 		return 1;
1598 	}
1599 
1600 	dfs_res = hostapd_is_dfs_required(iface);
1601 	if (dfs_res > 0) {
1602 		wpa_printf(MSG_DEBUG,
1603 			   "%s: freq %d MHz requires DFS for %d chans",
1604 			   __func__, iface->freq, dfs_res);
1605 		return 0;
1606 	}
1607 
1608 	wpa_printf(MSG_DEBUG,
1609 		   "%s: freq %d MHz does not require DFS. Continue channel/AP setup",
1610 		   __func__, iface->freq);
1611 	return 2;
1612 }
1613 
1614 
hostapd_is_dfs_overlap(struct hostapd_iface * iface,enum chan_width width,int center_freq)1615 int hostapd_is_dfs_overlap(struct hostapd_iface *iface, enum chan_width width,
1616 			   int center_freq)
1617 {
1618 	struct hostapd_channel_data *chan;
1619 	struct hostapd_hw_modes *mode = iface->current_mode;
1620 	int half_width;
1621 	int res = 0;
1622 	int i;
1623 
1624 	if (!iface->conf->ieee80211h || !mode ||
1625 	    mode->mode != HOSTAPD_MODE_IEEE80211A)
1626 		return 0;
1627 
1628 	switch (width) {
1629 	case CHAN_WIDTH_20_NOHT:
1630 	case CHAN_WIDTH_20:
1631 		half_width = 10;
1632 		break;
1633 	case CHAN_WIDTH_40:
1634 		half_width = 20;
1635 		break;
1636 	case CHAN_WIDTH_80:
1637 	case CHAN_WIDTH_80P80:
1638 		half_width = 40;
1639 		break;
1640 	case CHAN_WIDTH_160:
1641 		half_width = 80;
1642 		break;
1643 	default:
1644 		wpa_printf(MSG_WARNING, "DFS chanwidth %d not supported",
1645 			   width);
1646 		return 0;
1647 	}
1648 
1649 	for (i = 0; i < mode->num_channels; i++) {
1650 		chan = &mode->channels[i];
1651 
1652 		if (!(chan->flag & HOSTAPD_CHAN_RADAR))
1653 			continue;
1654 
1655 		if ((chan->flag & HOSTAPD_CHAN_DFS_MASK) ==
1656 		    HOSTAPD_CHAN_DFS_AVAILABLE)
1657 			continue;
1658 
1659 		if (center_freq - chan->freq < half_width &&
1660 		    chan->freq - center_freq < half_width)
1661 			res++;
1662 	}
1663 
1664 	wpa_printf(MSG_DEBUG, "DFS CAC required: (%d, %d): in range: %s",
1665 		   center_freq - half_width, center_freq + half_width,
1666 		   res ? "yes" : "no");
1667 
1668 	return res;
1669 }
1670