1/*
2 * hostapd / Hardware feature query and different modes
3 * Copyright 2002-2003, Instant802 Networks, Inc.
4 * Copyright 2005-2006, Devicescape Software, Inc.
5 * Copyright (c) 2008-2012, Jouni Malinen <j@w1.fi>
6 *
7 * This software may be distributed under the terms of the BSD license.
8 * See README for more details.
9 */
10
11#include "utils/includes.h"
12
13#include "utils/common.h"
14#include "utils/eloop.h"
15#include "common/ieee802_11_defs.h"
16#include "common/ieee802_11_common.h"
17#include "common/wpa_ctrl.h"
18#include "common/hw_features_common.h"
19#include "hostapd.h"
20#include "ap_config.h"
21#include "ap_drv_ops.h"
22#include "acs.h"
23#include "ieee802_11.h"
24#include "beacon.h"
25#include "hw_features.h"
26
27
28void hostapd_free_hw_features(struct hostapd_hw_modes *hw_features,
29			      size_t num_hw_features)
30{
31	size_t i;
32
33	if (hw_features == NULL)
34		return;
35
36	for (i = 0; i < num_hw_features; i++) {
37		os_free(hw_features[i].channels);
38		os_free(hw_features[i].rates);
39	}
40
41	os_free(hw_features);
42}
43
44
45#ifndef CONFIG_NO_STDOUT_DEBUG
46static char * dfs_info(struct hostapd_channel_data *chan)
47{
48	static char info[256];
49	char *state;
50
51	switch (chan->flag & HOSTAPD_CHAN_DFS_MASK) {
52	case HOSTAPD_CHAN_DFS_UNKNOWN:
53		state = "unknown";
54		break;
55	case HOSTAPD_CHAN_DFS_USABLE:
56		state = "usable";
57		break;
58	case HOSTAPD_CHAN_DFS_UNAVAILABLE:
59		state = "unavailable";
60		break;
61	case HOSTAPD_CHAN_DFS_AVAILABLE:
62		state = "available";
63		break;
64	default:
65		return "";
66	}
67	os_snprintf(info, sizeof(info), " (DFS state = %s)", state);
68	info[sizeof(info) - 1] = '\0';
69
70	return info;
71}
72#endif /* CONFIG_NO_STDOUT_DEBUG */
73
74
75int hostapd_get_hw_features(struct hostapd_iface *iface)
76{
77	struct hostapd_data *hapd = iface->bss[0];
78	int i, j;
79	u16 num_modes, flags;
80	struct hostapd_hw_modes *modes;
81	u8 dfs_domain;
82
83	if (hostapd_drv_none(hapd))
84		return -1;
85	modes = hostapd_get_hw_feature_data(hapd, &num_modes, &flags,
86					    &dfs_domain);
87	if (modes == NULL) {
88		hostapd_logger(hapd, NULL, HOSTAPD_MODULE_IEEE80211,
89			       HOSTAPD_LEVEL_DEBUG,
90			       "Fetching hardware channel/rate support not "
91			       "supported.");
92		return -1;
93	}
94
95	iface->hw_flags = flags;
96	iface->dfs_domain = dfs_domain;
97
98	hostapd_free_hw_features(iface->hw_features, iface->num_hw_features);
99	iface->hw_features = modes;
100	iface->num_hw_features = num_modes;
101
102	for (i = 0; i < num_modes; i++) {
103		struct hostapd_hw_modes *feature = &modes[i];
104		int dfs_enabled = hapd->iconf->ieee80211h &&
105			(iface->drv_flags & WPA_DRIVER_FLAGS_RADAR);
106
107		/* set flag for channels we can use in current regulatory
108		 * domain */
109		for (j = 0; j < feature->num_channels; j++) {
110			int dfs = 0;
111
112			/*
113			 * Disable all channels that are marked not to allow
114			 * to initiate radiation (a.k.a. passive scan and no
115			 * IBSS).
116			 * Use radar channels only if the driver supports DFS.
117			 */
118			if ((feature->channels[j].flag &
119			     HOSTAPD_CHAN_RADAR) && dfs_enabled) {
120				dfs = 1;
121			} else if (((feature->channels[j].flag &
122				     HOSTAPD_CHAN_RADAR) &&
123				    !(iface->drv_flags &
124				      WPA_DRIVER_FLAGS_DFS_OFFLOAD)) ||
125				   (feature->channels[j].flag &
126				    HOSTAPD_CHAN_NO_IR)) {
127				feature->channels[j].flag |=
128					HOSTAPD_CHAN_DISABLED;
129			}
130
131			if (feature->channels[j].flag & HOSTAPD_CHAN_DISABLED)
132				continue;
133
134			wpa_printf(MSG_MSGDUMP, "Allowed channel: mode=%d "
135				   "chan=%d freq=%d MHz max_tx_power=%d dBm%s",
136				   feature->mode,
137				   feature->channels[j].chan,
138				   feature->channels[j].freq,
139				   feature->channels[j].max_tx_power,
140				   dfs ? dfs_info(&feature->channels[j]) : "");
141		}
142	}
143
144	return 0;
145}
146
147
148int hostapd_prepare_rates(struct hostapd_iface *iface,
149			  struct hostapd_hw_modes *mode)
150{
151	int i, num_basic_rates = 0;
152	int basic_rates_a[] = { 60, 120, 240, -1 };
153	int basic_rates_b[] = { 10, 20, -1 };
154	int basic_rates_g[] = { 10, 20, 55, 110, -1 };
155	int *basic_rates;
156
157	if (iface->conf->basic_rates)
158		basic_rates = iface->conf->basic_rates;
159	else switch (mode->mode) {
160	case HOSTAPD_MODE_IEEE80211A:
161		basic_rates = basic_rates_a;
162		break;
163	case HOSTAPD_MODE_IEEE80211B:
164		basic_rates = basic_rates_b;
165		break;
166	case HOSTAPD_MODE_IEEE80211G:
167		basic_rates = basic_rates_g;
168		break;
169	case HOSTAPD_MODE_IEEE80211AD:
170		return 0; /* No basic rates for 11ad */
171	default:
172		return -1;
173	}
174
175	i = 0;
176	while (basic_rates[i] >= 0)
177		i++;
178	if (i)
179		i++; /* -1 termination */
180	os_free(iface->basic_rates);
181	iface->basic_rates = os_malloc(i * sizeof(int));
182	if (iface->basic_rates)
183		os_memcpy(iface->basic_rates, basic_rates, i * sizeof(int));
184
185	os_free(iface->current_rates);
186	iface->num_rates = 0;
187
188	iface->current_rates =
189		os_calloc(mode->num_rates, sizeof(struct hostapd_rate_data));
190	if (!iface->current_rates) {
191		wpa_printf(MSG_ERROR, "Failed to allocate memory for rate "
192			   "table.");
193		return -1;
194	}
195
196	for (i = 0; i < mode->num_rates; i++) {
197		struct hostapd_rate_data *rate;
198
199		if (iface->conf->supported_rates &&
200		    !hostapd_rate_found(iface->conf->supported_rates,
201					mode->rates[i]))
202			continue;
203
204		rate = &iface->current_rates[iface->num_rates];
205		rate->rate = mode->rates[i];
206		if (hostapd_rate_found(basic_rates, rate->rate)) {
207			rate->flags |= HOSTAPD_RATE_BASIC;
208			num_basic_rates++;
209		}
210		wpa_printf(MSG_DEBUG, "RATE[%d] rate=%d flags=0x%x",
211			   iface->num_rates, rate->rate, rate->flags);
212		iface->num_rates++;
213	}
214
215	if ((iface->num_rates == 0 || num_basic_rates == 0) &&
216	    (!iface->conf->ieee80211n || !iface->conf->require_ht)) {
217		wpa_printf(MSG_ERROR, "No rates remaining in supported/basic "
218			   "rate sets (%d,%d).",
219			   iface->num_rates, num_basic_rates);
220		return -1;
221	}
222
223	return 0;
224}
225
226
227static int ieee80211n_allowed_ht40_channel_pair(struct hostapd_iface *iface)
228{
229	int pri_freq, sec_freq;
230	struct hostapd_channel_data *p_chan, *s_chan;
231
232	pri_freq = iface->freq;
233	sec_freq = pri_freq + iface->conf->secondary_channel * 20;
234
235	if (!iface->current_mode)
236		return 0;
237
238	p_chan = hw_get_channel_freq(iface->current_mode->mode, pri_freq, NULL,
239				     iface->hw_features,
240				     iface->num_hw_features);
241
242	s_chan = hw_get_channel_freq(iface->current_mode->mode, sec_freq, NULL,
243				     iface->hw_features,
244				     iface->num_hw_features);
245
246	return allowed_ht40_channel_pair(iface->current_mode->mode,
247					 p_chan, s_chan);
248}
249
250
251static void ieee80211n_switch_pri_sec(struct hostapd_iface *iface)
252{
253	if (iface->conf->secondary_channel > 0) {
254		iface->conf->channel += 4;
255		iface->freq += 20;
256		iface->conf->secondary_channel = -1;
257	} else {
258		iface->conf->channel -= 4;
259		iface->freq -= 20;
260		iface->conf->secondary_channel = 1;
261	}
262}
263
264
265static int ieee80211n_check_40mhz_5g(struct hostapd_iface *iface,
266				     struct wpa_scan_results *scan_res)
267{
268	unsigned int pri_freq, sec_freq;
269	int res;
270	struct hostapd_channel_data *pri_chan, *sec_chan;
271
272	pri_freq = iface->freq;
273	sec_freq = pri_freq + iface->conf->secondary_channel * 20;
274
275	if (!iface->current_mode)
276		return 0;
277	pri_chan = hw_get_channel_freq(iface->current_mode->mode, pri_freq,
278				       NULL, iface->hw_features,
279				       iface->num_hw_features);
280	sec_chan = hw_get_channel_freq(iface->current_mode->mode, sec_freq,
281				       NULL, iface->hw_features,
282				       iface->num_hw_features);
283
284	res = check_40mhz_5g(scan_res, pri_chan, sec_chan);
285
286	if (res == 2) {
287		if (iface->conf->no_pri_sec_switch) {
288			wpa_printf(MSG_DEBUG,
289				   "Cannot switch PRI/SEC channels due to local constraint");
290		} else {
291			ieee80211n_switch_pri_sec(iface);
292		}
293	}
294
295	return !!res;
296}
297
298
299static int ieee80211n_check_40mhz_2g4(struct hostapd_iface *iface,
300				      struct wpa_scan_results *scan_res)
301{
302	int pri_chan, sec_chan;
303
304	pri_chan = iface->conf->channel;
305	sec_chan = pri_chan + iface->conf->secondary_channel * 4;
306
307	return check_40mhz_2g4(iface->current_mode, scan_res, pri_chan,
308			       sec_chan);
309}
310
311
312static void ieee80211n_check_scan(struct hostapd_iface *iface)
313{
314	struct wpa_scan_results *scan_res;
315	int oper40;
316	int res = 0;
317
318	/* Check list of neighboring BSSes (from scan) to see whether 40 MHz is
319	 * allowed per IEEE Std 802.11-2012, 10.15.3.2 */
320
321	iface->scan_cb = NULL;
322
323	scan_res = hostapd_driver_get_scan_results(iface->bss[0]);
324	if (scan_res == NULL) {
325		hostapd_setup_interface_complete(iface, 1);
326		return;
327	}
328
329	if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211A)
330		oper40 = ieee80211n_check_40mhz_5g(iface, scan_res);
331	else
332		oper40 = ieee80211n_check_40mhz_2g4(iface, scan_res);
333	wpa_scan_results_free(scan_res);
334
335	iface->secondary_ch = iface->conf->secondary_channel;
336	if (!oper40) {
337		wpa_printf(MSG_INFO, "20/40 MHz operation not permitted on "
338			   "channel pri=%d sec=%d based on overlapping BSSes",
339			   iface->conf->channel,
340			   iface->conf->channel +
341			   iface->conf->secondary_channel * 4);
342		iface->conf->secondary_channel = 0;
343		if (iface->drv_flags & WPA_DRIVER_FLAGS_HT_2040_COEX) {
344			/*
345			 * TODO: Could consider scheduling another scan to check
346			 * if channel width can be changed if no coex reports
347			 * are received from associating stations.
348			 */
349		}
350	}
351
352#ifdef CONFIG_IEEE80211AX
353	if (iface->conf->secondary_channel &&
354	    iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G &&
355	    iface->conf->ieee80211ax) {
356		struct he_capabilities *he_cap;
357
358		he_cap = &iface->current_mode->he_capab[IEEE80211_MODE_AP];
359		if (!(he_cap->phy_cap[HE_PHYCAP_CHANNEL_WIDTH_SET_IDX] &
360		      HE_PHYCAP_CHANNEL_WIDTH_SET_40MHZ_IN_2G)) {
361			wpa_printf(MSG_DEBUG,
362				   "HE: 40 MHz channel width is not supported in 2.4 GHz; clear secondary channel configuration");
363			iface->conf->secondary_channel = 0;
364		}
365	}
366#endif /* CONFIG_IEEE80211AX */
367
368	if (iface->conf->secondary_channel)
369		res = ieee80211n_allowed_ht40_channel_pair(iface);
370	if (!res) {
371		iface->conf->secondary_channel = 0;
372		hostapd_set_oper_centr_freq_seg0_idx(iface->conf, 0);
373		hostapd_set_oper_centr_freq_seg1_idx(iface->conf, 0);
374		hostapd_set_oper_chwidth(iface->conf, CHANWIDTH_USE_HT);
375		res = 1;
376		wpa_printf(MSG_INFO, "Fallback to 20 MHz");
377	}
378
379	hostapd_setup_interface_complete(iface, !res);
380}
381
382
383static void ieee80211n_scan_channels_2g4(struct hostapd_iface *iface,
384					 struct wpa_driver_scan_params *params)
385{
386	/* Scan only the affected frequency range */
387	int pri_freq, sec_freq;
388	int affected_start, affected_end;
389	int i, pos;
390	struct hostapd_hw_modes *mode;
391
392	if (iface->current_mode == NULL)
393		return;
394
395	pri_freq = iface->freq;
396	if (iface->conf->secondary_channel > 0)
397		sec_freq = pri_freq + 20;
398	else
399		sec_freq = pri_freq - 20;
400	/*
401	 * Note: Need to find the PRI channel also in cases where the affected
402	 * channel is the SEC channel of a 40 MHz BSS, so need to include the
403	 * scanning coverage here to be 40 MHz from the center frequency.
404	 */
405	affected_start = (pri_freq + sec_freq) / 2 - 40;
406	affected_end = (pri_freq + sec_freq) / 2 + 40;
407	wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
408		   affected_start, affected_end);
409
410	mode = iface->current_mode;
411	params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
412	if (params->freqs == NULL)
413		return;
414	pos = 0;
415
416	for (i = 0; i < mode->num_channels; i++) {
417		struct hostapd_channel_data *chan = &mode->channels[i];
418		if (chan->flag & HOSTAPD_CHAN_DISABLED)
419			continue;
420		if (chan->freq < affected_start ||
421		    chan->freq > affected_end)
422			continue;
423		params->freqs[pos++] = chan->freq;
424	}
425}
426
427
428static void ieee80211n_scan_channels_5g(struct hostapd_iface *iface,
429					struct wpa_driver_scan_params *params)
430{
431	/* Scan only the affected frequency range */
432	int pri_freq;
433	int affected_start, affected_end;
434	int i, pos;
435	struct hostapd_hw_modes *mode;
436
437	if (iface->current_mode == NULL)
438		return;
439
440	pri_freq = iface->freq;
441	if (iface->conf->secondary_channel > 0) {
442		affected_start = pri_freq - 10;
443		affected_end = pri_freq + 30;
444	} else {
445		affected_start = pri_freq - 30;
446		affected_end = pri_freq + 10;
447	}
448	wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
449		   affected_start, affected_end);
450
451	mode = iface->current_mode;
452	params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
453	if (params->freqs == NULL)
454		return;
455	pos = 0;
456
457	for (i = 0; i < mode->num_channels; i++) {
458		struct hostapd_channel_data *chan = &mode->channels[i];
459		if (chan->flag & HOSTAPD_CHAN_DISABLED)
460			continue;
461		if (chan->freq < affected_start ||
462		    chan->freq > affected_end)
463			continue;
464		params->freqs[pos++] = chan->freq;
465	}
466}
467
468
469static void ap_ht40_scan_retry(void *eloop_data, void *user_data)
470{
471#define HT2040_COEX_SCAN_RETRY 15
472	struct hostapd_iface *iface = eloop_data;
473	struct wpa_driver_scan_params params;
474	int ret;
475
476	os_memset(&params, 0, sizeof(params));
477	if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)
478		ieee80211n_scan_channels_2g4(iface, &params);
479	else
480		ieee80211n_scan_channels_5g(iface, &params);
481
482	ret = hostapd_driver_scan(iface->bss[0], &params);
483	iface->num_ht40_scan_tries++;
484	os_free(params.freqs);
485
486	if (ret == -EBUSY &&
487	    iface->num_ht40_scan_tries < HT2040_COEX_SCAN_RETRY) {
488		wpa_printf(MSG_ERROR,
489			   "Failed to request a scan of neighboring BSSes ret=%d (%s) - try to scan again (attempt %d)",
490			   ret, strerror(-ret), iface->num_ht40_scan_tries);
491		eloop_register_timeout(1, 0, ap_ht40_scan_retry, iface, NULL);
492		return;
493	}
494
495	if (ret == 0) {
496		iface->scan_cb = ieee80211n_check_scan;
497		return;
498	}
499
500	wpa_printf(MSG_DEBUG,
501		   "Failed to request a scan in device, bringing up in HT20 mode");
502	iface->conf->secondary_channel = 0;
503	iface->conf->ht_capab &= ~HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET;
504	hostapd_setup_interface_complete(iface, 0);
505}
506
507
508void hostapd_stop_setup_timers(struct hostapd_iface *iface)
509{
510	eloop_cancel_timeout(ap_ht40_scan_retry, iface, NULL);
511}
512
513
514static int ieee80211n_check_40mhz(struct hostapd_iface *iface)
515{
516	struct wpa_driver_scan_params params;
517	int ret;
518
519	/* Check that HT40 is used and PRI / SEC switch is allowed */
520	if (!iface->conf->secondary_channel || iface->conf->no_pri_sec_switch)
521		return 0;
522
523	hostapd_set_state(iface, HAPD_IFACE_HT_SCAN);
524	wpa_printf(MSG_DEBUG, "Scan for neighboring BSSes prior to enabling "
525		   "40 MHz channel");
526	os_memset(&params, 0, sizeof(params));
527	if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)
528		ieee80211n_scan_channels_2g4(iface, &params);
529	else
530		ieee80211n_scan_channels_5g(iface, &params);
531
532	ret = hostapd_driver_scan(iface->bss[0], &params);
533	os_free(params.freqs);
534
535	if (ret == -EBUSY) {
536		wpa_printf(MSG_ERROR,
537			   "Failed to request a scan of neighboring BSSes ret=%d (%s) - try to scan again",
538			   ret, strerror(-ret));
539		iface->num_ht40_scan_tries = 1;
540		eloop_cancel_timeout(ap_ht40_scan_retry, iface, NULL);
541		eloop_register_timeout(1, 0, ap_ht40_scan_retry, iface, NULL);
542		return 1;
543	}
544
545	if (ret < 0) {
546		wpa_printf(MSG_ERROR,
547			   "Failed to request a scan of neighboring BSSes ret=%d (%s)",
548			   ret, strerror(-ret));
549		return -1;
550	}
551
552	iface->scan_cb = ieee80211n_check_scan;
553	return 1;
554}
555
556
557static int ieee80211n_supported_ht_capab(struct hostapd_iface *iface)
558{
559	u16 hw = iface->current_mode->ht_capab;
560	u16 conf = iface->conf->ht_capab;
561
562	if ((conf & HT_CAP_INFO_LDPC_CODING_CAP) &&
563	    !(hw & HT_CAP_INFO_LDPC_CODING_CAP)) {
564		wpa_printf(MSG_ERROR, "Driver does not support configured "
565			   "HT capability [LDPC]");
566		return 0;
567	}
568
569	/*
570	 * Driver ACS chosen channel may not be HT40 due to internal driver
571	 * restrictions.
572	 */
573	if (!iface->conf->acs && (conf & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET) &&
574	    !(hw & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET)) {
575		wpa_printf(MSG_ERROR, "Driver does not support configured "
576			   "HT capability [HT40*]");
577		return 0;
578	}
579
580	if ((conf & HT_CAP_INFO_GREEN_FIELD) &&
581	    !(hw & HT_CAP_INFO_GREEN_FIELD)) {
582		wpa_printf(MSG_ERROR, "Driver does not support configured "
583			   "HT capability [GF]");
584		return 0;
585	}
586
587	if ((conf & HT_CAP_INFO_SHORT_GI20MHZ) &&
588	    !(hw & HT_CAP_INFO_SHORT_GI20MHZ)) {
589		wpa_printf(MSG_ERROR, "Driver does not support configured "
590			   "HT capability [SHORT-GI-20]");
591		return 0;
592	}
593
594	if ((conf & HT_CAP_INFO_SHORT_GI40MHZ) &&
595	    !(hw & HT_CAP_INFO_SHORT_GI40MHZ)) {
596		wpa_printf(MSG_ERROR, "Driver does not support configured "
597			   "HT capability [SHORT-GI-40]");
598		return 0;
599	}
600
601	if ((conf & HT_CAP_INFO_TX_STBC) && !(hw & HT_CAP_INFO_TX_STBC)) {
602		wpa_printf(MSG_ERROR, "Driver does not support configured "
603			   "HT capability [TX-STBC]");
604		return 0;
605	}
606
607	if ((conf & HT_CAP_INFO_RX_STBC_MASK) >
608	    (hw & HT_CAP_INFO_RX_STBC_MASK)) {
609		wpa_printf(MSG_ERROR, "Driver does not support configured "
610			   "HT capability [RX-STBC*]");
611		return 0;
612	}
613
614	if ((conf & HT_CAP_INFO_DELAYED_BA) &&
615	    !(hw & HT_CAP_INFO_DELAYED_BA)) {
616		wpa_printf(MSG_ERROR, "Driver does not support configured "
617			   "HT capability [DELAYED-BA]");
618		return 0;
619	}
620
621	if ((conf & HT_CAP_INFO_MAX_AMSDU_SIZE) &&
622	    !(hw & HT_CAP_INFO_MAX_AMSDU_SIZE)) {
623		wpa_printf(MSG_ERROR, "Driver does not support configured "
624			   "HT capability [MAX-AMSDU-7935]");
625		return 0;
626	}
627
628	if ((conf & HT_CAP_INFO_DSSS_CCK40MHZ) &&
629	    !(hw & HT_CAP_INFO_DSSS_CCK40MHZ)) {
630		wpa_printf(MSG_ERROR, "Driver does not support configured "
631			   "HT capability [DSSS_CCK-40]");
632		return 0;
633	}
634
635	if ((conf & HT_CAP_INFO_LSIG_TXOP_PROTECT_SUPPORT) &&
636	    !(hw & HT_CAP_INFO_LSIG_TXOP_PROTECT_SUPPORT)) {
637		wpa_printf(MSG_ERROR, "Driver does not support configured "
638			   "HT capability [LSIG-TXOP-PROT]");
639		return 0;
640	}
641
642	return 1;
643}
644
645
646#ifdef CONFIG_IEEE80211AC
647static int ieee80211ac_supported_vht_capab(struct hostapd_iface *iface)
648{
649	struct hostapd_hw_modes *mode = iface->current_mode;
650	u32 hw = mode->vht_capab;
651	u32 conf = iface->conf->vht_capab;
652
653	wpa_printf(MSG_DEBUG, "hw vht capab: 0x%x, conf vht capab: 0x%x",
654		   hw, conf);
655
656	if (mode->mode == HOSTAPD_MODE_IEEE80211G &&
657	    iface->conf->bss[0]->vendor_vht &&
658	    mode->vht_capab == 0 && iface->hw_features) {
659		int i;
660
661		for (i = 0; i < iface->num_hw_features; i++) {
662			if (iface->hw_features[i].mode ==
663			    HOSTAPD_MODE_IEEE80211A) {
664				mode = &iface->hw_features[i];
665				hw = mode->vht_capab;
666				wpa_printf(MSG_DEBUG,
667					   "update hw vht capab based on 5 GHz band: 0x%x",
668					   hw);
669				break;
670			}
671		}
672	}
673
674	return ieee80211ac_cap_check(hw, conf);
675}
676#endif /* CONFIG_IEEE80211AC */
677
678
679#ifdef CONFIG_IEEE80211AX
680static int ieee80211ax_supported_he_capab(struct hostapd_iface *iface)
681{
682	return 1;
683}
684#endif /* CONFIG_IEEE80211AX */
685
686
687int hostapd_check_ht_capab(struct hostapd_iface *iface)
688{
689	int ret;
690
691	if (is_6ghz_freq(iface->freq))
692		return 0;
693	if (!iface->conf->ieee80211n)
694		return 0;
695
696	if (iface->current_mode->mode != HOSTAPD_MODE_IEEE80211B &&
697	    iface->current_mode->mode != HOSTAPD_MODE_IEEE80211G &&
698	    (iface->conf->ht_capab & HT_CAP_INFO_DSSS_CCK40MHZ)) {
699		wpa_printf(MSG_DEBUG,
700			   "Disable HT capability [DSSS_CCK-40] on 5 GHz band");
701		iface->conf->ht_capab &= ~HT_CAP_INFO_DSSS_CCK40MHZ;
702	}
703
704	if (!ieee80211n_supported_ht_capab(iface))
705		return -1;
706#ifdef CONFIG_IEEE80211AX
707	if (iface->conf->ieee80211ax &&
708	    !ieee80211ax_supported_he_capab(iface))
709		return -1;
710#endif /* CONFIG_IEEE80211AX */
711#ifdef CONFIG_IEEE80211AC
712	if (iface->conf->ieee80211ac &&
713	    !ieee80211ac_supported_vht_capab(iface))
714		return -1;
715#endif /* CONFIG_IEEE80211AC */
716	ret = ieee80211n_check_40mhz(iface);
717	if (ret)
718		return ret;
719	if (!ieee80211n_allowed_ht40_channel_pair(iface))
720		return -1;
721
722	return 0;
723}
724
725
726int hostapd_check_edmg_capab(struct hostapd_iface *iface)
727{
728	struct hostapd_hw_modes *mode = iface->hw_features;
729	struct ieee80211_edmg_config edmg;
730
731	if (!iface->conf->enable_edmg)
732		return 0;
733
734	hostapd_encode_edmg_chan(iface->conf->enable_edmg,
735				 iface->conf->edmg_channel,
736				 iface->conf->channel,
737				 &edmg);
738
739	if (mode->edmg.channels && ieee802_edmg_is_allowed(mode->edmg, edmg))
740		return 0;
741
742	wpa_printf(MSG_WARNING, "Requested EDMG configuration is not valid");
743	wpa_printf(MSG_INFO, "EDMG capab: channels 0x%x, bw_config %d",
744		   mode->edmg.channels, mode->edmg.bw_config);
745	wpa_printf(MSG_INFO,
746		   "Requested EDMG configuration: channels 0x%x, bw_config %d",
747		   edmg.channels, edmg.bw_config);
748	return -1;
749}
750
751
752int hostapd_check_he_6ghz_capab(struct hostapd_iface *iface)
753{
754#ifdef CONFIG_IEEE80211AX
755	struct he_capabilities *he_cap;
756	u16 hw;
757
758	if (!iface->current_mode || !is_6ghz_freq(iface->freq))
759		return 0;
760
761	he_cap = &iface->current_mode->he_capab[IEEE80211_MODE_AP];
762	hw = he_cap->he_6ghz_capa;
763	if (iface->conf->he_6ghz_max_mpdu >
764	    ((hw & HE_6GHZ_BAND_CAP_MAX_MPDU_LEN_MASK) >>
765	     HE_6GHZ_BAND_CAP_MAX_MPDU_LEN_SHIFT)) {
766		wpa_printf(MSG_ERROR,
767			   "The driver does not support the configured HE 6 GHz Max MPDU length");
768		return -1;
769	}
770
771	if (iface->conf->he_6ghz_max_ampdu_len_exp >
772	    ((hw & HE_6GHZ_BAND_CAP_MAX_AMPDU_LEN_EXP_MASK) >>
773	     HE_6GHZ_BAND_CAP_MAX_AMPDU_LEN_EXP_SHIFT)) {
774		wpa_printf(MSG_ERROR,
775			   "The driver does not support the configured HE 6 GHz Max AMPDU Length Exponent");
776		return -1;
777	}
778
779	if (iface->conf->he_6ghz_rx_ant_pat &&
780	    !(hw & HE_6GHZ_BAND_CAP_RX_ANTPAT_CONS)) {
781		wpa_printf(MSG_ERROR,
782			   "The driver does not support the configured HE 6 GHz Rx Antenna Pattern");
783		return -1;
784	}
785
786	if (iface->conf->he_6ghz_tx_ant_pat &&
787	    !(hw & HE_6GHZ_BAND_CAP_TX_ANTPAT_CONS)) {
788		wpa_printf(MSG_ERROR,
789			   "The driver does not support the configured HE 6 GHz Tx Antenna Pattern");
790		return -1;
791	}
792#endif /* CONFIG_IEEE80211AX */
793	return 0;
794}
795
796
797static int hostapd_is_usable_chan(struct hostapd_iface *iface,
798				  int frequency, int primary)
799{
800	struct hostapd_channel_data *chan;
801
802	if (!iface->current_mode)
803		return 0;
804
805	chan = hw_get_channel_freq(iface->current_mode->mode, frequency, NULL,
806				   iface->hw_features, iface->num_hw_features);
807	if (!chan)
808		return 0;
809
810	if ((primary && chan_pri_allowed(chan)) ||
811	    (!primary && !(chan->flag & HOSTAPD_CHAN_DISABLED)))
812		return 1;
813
814	wpa_printf(MSG_INFO,
815		   "Frequency %d (%s) not allowed for AP mode, flags: 0x%x%s%s",
816		   frequency, primary ? "primary" : "secondary",
817		   chan->flag,
818		   chan->flag & HOSTAPD_CHAN_NO_IR ? " NO-IR" : "",
819		   chan->flag & HOSTAPD_CHAN_RADAR ? " RADAR" : "");
820	return 0;
821}
822
823
824static int hostapd_is_usable_edmg(struct hostapd_iface *iface)
825{
826	int i, contiguous = 0;
827	int num_of_enabled = 0;
828	int max_contiguous = 0;
829	struct ieee80211_edmg_config edmg;
830	struct hostapd_channel_data *pri_chan;
831
832	if (!iface->conf->enable_edmg)
833		return 1;
834
835	if (!iface->current_mode)
836		return 0;
837	pri_chan = hw_get_channel_freq(iface->current_mode->mode,
838				       iface->freq, NULL,
839				       iface->hw_features,
840				       iface->num_hw_features);
841	if (!pri_chan)
842		return 0;
843	hostapd_encode_edmg_chan(iface->conf->enable_edmg,
844				 iface->conf->edmg_channel,
845				 pri_chan->chan,
846				 &edmg);
847	if (!(edmg.channels & BIT(pri_chan->chan - 1)))
848		return 0;
849
850	/* 60 GHz channels 1..6 */
851	for (i = 0; i < 6; i++) {
852		int freq = 56160 + 2160 * (i + 1);
853
854		if (edmg.channels & BIT(i)) {
855			contiguous++;
856			num_of_enabled++;
857		} else {
858			contiguous = 0;
859			continue;
860		}
861
862		/* P802.11ay defines that the total number of subfields
863		 * set to one does not exceed 4.
864		 */
865		if (num_of_enabled > 4)
866			return 0;
867
868		if (!hostapd_is_usable_chan(iface, freq, 1))
869			return 0;
870
871		if (contiguous > max_contiguous)
872			max_contiguous = contiguous;
873	}
874
875	/* Check if the EDMG configuration is valid under the limitations
876	 * of P802.11ay.
877	 */
878	/* check bw_config against contiguous EDMG channels */
879	switch (edmg.bw_config) {
880	case EDMG_BW_CONFIG_4:
881		if (!max_contiguous)
882			return 0;
883		break;
884	case EDMG_BW_CONFIG_5:
885		if (max_contiguous < 2)
886			return 0;
887		break;
888	default:
889		return 0;
890	}
891
892	return 1;
893}
894
895
896static int hostapd_is_usable_chans(struct hostapd_iface *iface)
897{
898	int secondary_freq;
899	struct hostapd_channel_data *pri_chan;
900
901	if (!iface->current_mode)
902		return 0;
903	pri_chan = hw_get_channel_freq(iface->current_mode->mode,
904				       iface->freq, NULL,
905				       iface->hw_features,
906				       iface->num_hw_features);
907	if (!pri_chan) {
908		wpa_printf(MSG_ERROR, "Primary frequency not present");
909		return 0;
910	}
911	if (!hostapd_is_usable_chan(iface, pri_chan->freq, 1)) {
912		wpa_printf(MSG_ERROR, "Primary frequency not allowed");
913		return 0;
914	}
915	if (!hostapd_is_usable_edmg(iface))
916		return 0;
917
918	if (!iface->conf->secondary_channel)
919		return 1;
920
921	if (hostapd_is_usable_chan(iface, iface->freq +
922				   iface->conf->secondary_channel * 20, 0)) {
923		if (iface->conf->secondary_channel == 1 &&
924		    (pri_chan->allowed_bw & HOSTAPD_CHAN_WIDTH_40P))
925			return 1;
926		if (iface->conf->secondary_channel == -1 &&
927		    (pri_chan->allowed_bw & HOSTAPD_CHAN_WIDTH_40M))
928			return 1;
929	}
930	if (!iface->conf->ht40_plus_minus_allowed)
931		return 0;
932
933	/* Both HT40+ and HT40- are set, pick a valid secondary channel */
934	secondary_freq = iface->freq + 20;
935	if (hostapd_is_usable_chan(iface, secondary_freq, 0) &&
936	    (pri_chan->allowed_bw & HOSTAPD_CHAN_WIDTH_40P)) {
937		iface->conf->secondary_channel = 1;
938		return 1;
939	}
940
941	secondary_freq = iface->freq - 20;
942	if (hostapd_is_usable_chan(iface, secondary_freq, 0) &&
943	    (pri_chan->allowed_bw & HOSTAPD_CHAN_WIDTH_40M)) {
944		iface->conf->secondary_channel = -1;
945		return 1;
946	}
947
948	return 0;
949}
950
951
952static void hostapd_determine_mode(struct hostapd_iface *iface)
953{
954	int i;
955	enum hostapd_hw_mode target_mode;
956
957	if (iface->current_mode ||
958	    iface->conf->hw_mode != HOSTAPD_MODE_IEEE80211ANY)
959		return;
960
961	if (iface->freq < 4000)
962		target_mode = HOSTAPD_MODE_IEEE80211G;
963	else if (iface->freq > 50000)
964		target_mode = HOSTAPD_MODE_IEEE80211AD;
965	else
966		target_mode = HOSTAPD_MODE_IEEE80211A;
967
968	for (i = 0; i < iface->num_hw_features; i++) {
969		struct hostapd_hw_modes *mode;
970
971		mode = &iface->hw_features[i];
972		if (mode->mode == target_mode) {
973			iface->current_mode = mode;
974			iface->conf->hw_mode = mode->mode;
975			break;
976		}
977	}
978
979	if (!iface->current_mode)
980		wpa_printf(MSG_ERROR, "ACS: Cannot decide mode");
981}
982
983
984static enum hostapd_chan_status
985hostapd_check_chans(struct hostapd_iface *iface)
986{
987	if (iface->freq) {
988		hostapd_determine_mode(iface);
989		if (hostapd_is_usable_chans(iface))
990			return HOSTAPD_CHAN_VALID;
991		else
992			return HOSTAPD_CHAN_INVALID;
993	}
994
995	/*
996	 * The user set channel=0 or channel=acs_survey
997	 * which is used to trigger ACS.
998	 */
999
1000	switch (acs_init(iface)) {
1001	case HOSTAPD_CHAN_ACS:
1002		return HOSTAPD_CHAN_ACS;
1003	case HOSTAPD_CHAN_VALID:
1004	case HOSTAPD_CHAN_INVALID:
1005	default:
1006		return HOSTAPD_CHAN_INVALID;
1007	}
1008}
1009
1010
1011static void hostapd_notify_bad_chans(struct hostapd_iface *iface)
1012{
1013	if (!iface->current_mode) {
1014		hostapd_logger(iface->bss[0], NULL, HOSTAPD_MODULE_IEEE80211,
1015			       HOSTAPD_LEVEL_WARNING,
1016			       "Hardware does not support configured mode");
1017		return;
1018	}
1019	hostapd_logger(iface->bss[0], NULL,
1020		       HOSTAPD_MODULE_IEEE80211,
1021		       HOSTAPD_LEVEL_WARNING,
1022		       "Configured channel (%d) or frequency (%d) (secondary_channel=%d) not found from the channel list of the current mode (%d) %s",
1023		       iface->conf->channel,
1024		       iface->freq, iface->conf->secondary_channel,
1025		       iface->current_mode->mode,
1026		       hostapd_hw_mode_txt(iface->current_mode->mode));
1027	hostapd_logger(iface->bss[0], NULL, HOSTAPD_MODULE_IEEE80211,
1028		       HOSTAPD_LEVEL_WARNING,
1029		       "Hardware does not support configured channel");
1030}
1031
1032
1033int hostapd_acs_completed(struct hostapd_iface *iface, int err)
1034{
1035	int ret = -1;
1036
1037	if (err)
1038		goto out;
1039
1040	switch (hostapd_check_chans(iface)) {
1041	case HOSTAPD_CHAN_VALID:
1042		wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO,
1043			ACS_EVENT_COMPLETED "freq=%d channel=%d",
1044			iface->freq, iface->conf->channel);
1045		break;
1046	case HOSTAPD_CHAN_ACS:
1047		wpa_printf(MSG_ERROR, "ACS error - reported complete, but no result available");
1048		wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, ACS_EVENT_FAILED);
1049		hostapd_notify_bad_chans(iface);
1050		goto out;
1051	case HOSTAPD_CHAN_INVALID:
1052	default:
1053		wpa_printf(MSG_ERROR, "ACS picked unusable channels");
1054		wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, ACS_EVENT_FAILED);
1055		hostapd_notify_bad_chans(iface);
1056		goto out;
1057	}
1058
1059	ret = hostapd_check_ht_capab(iface);
1060	if (ret < 0)
1061		goto out;
1062	if (ret == 1) {
1063		wpa_printf(MSG_DEBUG, "Interface initialization will be completed in a callback");
1064		return 0;
1065	}
1066
1067	ret = 0;
1068out:
1069	return hostapd_setup_interface_complete(iface, ret);
1070}
1071
1072
1073/**
1074 * hostapd_select_hw_mode - Select the hardware mode
1075 * @iface: Pointer to interface data.
1076 * Returns: 0 on success, < 0 on failure
1077 *
1078 * Sets up the hardware mode, channel, rates, and passive scanning
1079 * based on the configuration.
1080 */
1081int hostapd_select_hw_mode(struct hostapd_iface *iface)
1082{
1083	int i;
1084
1085	if (iface->num_hw_features < 1)
1086		return -1;
1087
1088	if ((iface->conf->hw_mode == HOSTAPD_MODE_IEEE80211G ||
1089	     iface->conf->ieee80211n || iface->conf->ieee80211ac ||
1090	     iface->conf->ieee80211ax) &&
1091	    iface->conf->channel == 14) {
1092		wpa_printf(MSG_INFO, "Disable OFDM/HT/VHT/HE on channel 14");
1093		iface->conf->hw_mode = HOSTAPD_MODE_IEEE80211B;
1094		iface->conf->ieee80211n = 0;
1095		iface->conf->ieee80211ac = 0;
1096		iface->conf->ieee80211ax = 0;
1097	}
1098
1099	iface->current_mode = NULL;
1100	for (i = 0; i < iface->num_hw_features; i++) {
1101		struct hostapd_hw_modes *mode = &iface->hw_features[i];
1102		int chan;
1103
1104		if (mode->mode == iface->conf->hw_mode) {
1105			if (iface->freq > 0 &&
1106			    !hw_mode_get_channel(mode, iface->freq, &chan))
1107				continue;
1108
1109			iface->current_mode = mode;
1110			break;
1111		}
1112	}
1113
1114	if (iface->current_mode == NULL) {
1115		if ((iface->drv_flags & WPA_DRIVER_FLAGS_ACS_OFFLOAD) &&
1116		    (iface->drv_flags & WPA_DRIVER_FLAGS_SUPPORT_HW_MODE_ANY)) {
1117			wpa_printf(MSG_DEBUG,
1118				   "Using offloaded hw_mode=any ACS");
1119		} else if (!(iface->drv_flags & WPA_DRIVER_FLAGS_ACS_OFFLOAD) &&
1120			   iface->conf->hw_mode == HOSTAPD_MODE_IEEE80211ANY) {
1121			wpa_printf(MSG_DEBUG,
1122				   "Using internal ACS for hw_mode=any");
1123		} else {
1124			wpa_printf(MSG_ERROR,
1125				   "Hardware does not support configured mode");
1126			hostapd_logger(iface->bss[0], NULL,
1127				       HOSTAPD_MODULE_IEEE80211,
1128				       HOSTAPD_LEVEL_WARNING,
1129				       "Hardware does not support configured mode (%d) (hw_mode in hostapd.conf)",
1130				       (int) iface->conf->hw_mode);
1131			return -2;
1132		}
1133	}
1134
1135	switch (hostapd_check_chans(iface)) {
1136	case HOSTAPD_CHAN_VALID:
1137		return 0;
1138	case HOSTAPD_CHAN_ACS: /* ACS will run and later complete */
1139		return 1;
1140	case HOSTAPD_CHAN_INVALID:
1141	default:
1142		hostapd_notify_bad_chans(iface);
1143		return -3;
1144	}
1145}
1146
1147
1148const char * hostapd_hw_mode_txt(int mode)
1149{
1150	switch (mode) {
1151	case HOSTAPD_MODE_IEEE80211A:
1152		return "IEEE 802.11a";
1153	case HOSTAPD_MODE_IEEE80211B:
1154		return "IEEE 802.11b";
1155	case HOSTAPD_MODE_IEEE80211G:
1156		return "IEEE 802.11g";
1157	case HOSTAPD_MODE_IEEE80211AD:
1158		return "IEEE 802.11ad";
1159	default:
1160		return "UNKNOWN";
1161	}
1162}
1163
1164
1165int hostapd_hw_get_freq(struct hostapd_data *hapd, int chan)
1166{
1167	return hw_get_freq(hapd->iface->current_mode, chan);
1168}
1169
1170
1171int hostapd_hw_get_channel(struct hostapd_data *hapd, int freq)
1172{
1173	int i, channel;
1174	struct hostapd_hw_modes *mode;
1175
1176	if (hapd->iface->current_mode) {
1177		channel = hw_get_chan(hapd->iface->current_mode->mode, freq,
1178				      hapd->iface->hw_features,
1179				      hapd->iface->num_hw_features);
1180		if (channel)
1181			return channel;
1182	}
1183
1184	/* Check other available modes since the channel list for the current
1185	 * mode did not include the specified frequency. */
1186	if (!hapd->iface->hw_features)
1187		return 0;
1188	for (i = 0; i < hapd->iface->num_hw_features; i++) {
1189		mode = &hapd->iface->hw_features[i];
1190		channel = hw_get_chan(mode->mode, freq,
1191				      hapd->iface->hw_features,
1192				      hapd->iface->num_hw_features);
1193		if (channel)
1194			return channel;
1195	}
1196	return 0;
1197}
1198
1199
1200int hostapd_hw_skip_mode(struct hostapd_iface *iface,
1201			 struct hostapd_hw_modes *mode)
1202{
1203	int i;
1204
1205	if (iface->current_mode)
1206		return mode != iface->current_mode;
1207	if (mode->mode != HOSTAPD_MODE_IEEE80211B)
1208		return 0;
1209	for (i = 0; i < iface->num_hw_features; i++) {
1210		if (iface->hw_features[i].mode == HOSTAPD_MODE_IEEE80211G)
1211			return 1;
1212	}
1213	return 0;
1214}
1215