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