xref: /aosp_15_r20/external/wpa_supplicant_8/src/common/ieee802_11_common.c (revision 03f9172ca588f91df233974f4258bab95191f931)

/*
 * IEEE 802.11 Common routines
 * Copyright (c) 2002-2019, Jouni Malinen <[email protected]>
 *
 * This software may be distributed under the terms of the BSD license.
 * See README for more details.
 */

#include "includes.h"

#include "common.h"
#include "defs.h"
#include "wpa_common.h"
#include "drivers/driver.h"
#include "qca-vendor.h"
#include "ieee802_11_defs.h"
#include "ieee802_11_common.h"


static int ieee802_11_parse_vendor_specific(const u8 *pos, size_t elen,
					    struct ieee802_11_elems *elems,
					    int show_errors)
{
	unsigned int oui;

	/* first 3 bytes in vendor specific information element are the IEEE
	 * OUI of the vendor. The following byte is used a vendor specific
	 * sub-type. */
	if (elen < 4) {
		if (show_errors) {
			wpa_printf(MSG_MSGDUMP, "short vendor specific "
				   "information element ignored (len=%lu)",
				   (unsigned long) elen);
		}
		return -1;
	}

	oui = WPA_GET_BE24(pos);
	switch (oui) {
	case OUI_MICROSOFT:
		/* Microsoft/Wi-Fi information elements are further typed and
		 * subtyped */
		switch (pos[3]) {
		case 1:
			/* Microsoft OUI (00:50:F2) with OUI Type 1:
			 * real WPA information element */
			elems->wpa_ie = pos;
			elems->wpa_ie_len = elen;
			break;
		case WMM_OUI_TYPE:
			/* WMM information element */
			if (elen < 5) {
				wpa_printf(MSG_MSGDUMP, "short WMM "
					   "information element ignored "
					   "(len=%lu)",
					   (unsigned long) elen);
				return -1;
			}
			switch (pos[4]) {
			case WMM_OUI_SUBTYPE_INFORMATION_ELEMENT:
			case WMM_OUI_SUBTYPE_PARAMETER_ELEMENT:
				/*
				 * Share same pointer since only one of these
				 * is used and they start with same data.
				 * Length field can be used to distinguish the
				 * IEs.
				 */
				elems->wmm = pos;
				elems->wmm_len = elen;
				break;
			case WMM_OUI_SUBTYPE_TSPEC_ELEMENT:
				elems->wmm_tspec = pos;
				elems->wmm_tspec_len = elen;
				break;
			default:
				wpa_printf(MSG_EXCESSIVE, "unknown WMM "
					   "information element ignored "
					   "(subtype=%d len=%lu)",
					   pos[4], (unsigned long) elen);
				return -1;
			}
			break;
		case 4:
			/* Wi-Fi Protected Setup (WPS) IE */
			elems->wps_ie = pos;
			elems->wps_ie_len = elen;
			break;
		default:
			wpa_printf(MSG_EXCESSIVE, "Unknown Microsoft "
				   "information element ignored "
				   "(type=%d len=%lu)",
				   pos[3], (unsigned long) elen);
			return -1;
		}
		break;

	case OUI_WFA:
		switch (pos[3]) {
		case P2P_OUI_TYPE:
			/* Wi-Fi Alliance - P2P IE */
			elems->p2p = pos;
			elems->p2p_len = elen;
			break;
		case WFD_OUI_TYPE:
			/* Wi-Fi Alliance - WFD IE */
			elems->wfd = pos;
			elems->wfd_len = elen;
			break;
		case HS20_INDICATION_OUI_TYPE:
			/* Hotspot 2.0 */
			elems->hs20 = pos;
			elems->hs20_len = elen;
			break;
		case HS20_OSEN_OUI_TYPE:
			/* Hotspot 2.0 OSEN */
			elems->osen = pos;
			elems->osen_len = elen;
			break;
		case MBO_OUI_TYPE:
			/* MBO-OCE */
			elems->mbo = pos;
			elems->mbo_len = elen;
			break;
		case HS20_ROAMING_CONS_SEL_OUI_TYPE:
			/* Hotspot 2.0 Roaming Consortium Selection */
			elems->roaming_cons_sel = pos;
			elems->roaming_cons_sel_len = elen;
			break;
		case MULTI_AP_OUI_TYPE:
			elems->multi_ap = pos;
			elems->multi_ap_len = elen;
			break;
		case OWE_OUI_TYPE:
			/* OWE Transition Mode element */
			break;
		case DPP_CC_OUI_TYPE:
			/* DPP Configurator Connectivity element */
			break;
		case SAE_PK_OUI_TYPE:
			elems->sae_pk = pos + 4;
			elems->sae_pk_len = elen - 4;
			break;
		case WFA_RSNE_OVERRIDE_OUI_TYPE:
			elems->rsne_override = pos;
			elems->rsne_override_len = elen;
			break;
		case WFA_RSNE_OVERRIDE_2_OUI_TYPE:
			elems->rsne_override_2 = pos;
			elems->rsne_override_2_len = elen;
			break;
		case WFA_RSN_SELECTION_OUI_TYPE:
			if (elen < 4 + 1) {
				wpa_printf(MSG_DEBUG,
					   "Too short RSN Selection element ignored");
				return -1;
			}
			elems->rsn_selection = pos + 4;
			elems->rsn_selection_len = elen - 4;
			break;
		case P2P2_OUI_TYPE:
			/* Wi-Fi Alliance - P2P2 IE */
			elems->p2p2_ie = pos;
			elems->p2p2_ie_len = elen;
			break;
		default:
			wpa_printf(MSG_MSGDUMP, "Unknown WFA "
				   "information element ignored "
				   "(type=%d len=%lu)",
				   pos[3], (unsigned long) elen);
			return -1;
		}
		break;

	case OUI_BROADCOM:
		switch (pos[3]) {
		case VENDOR_HT_CAPAB_OUI_TYPE:
			elems->vendor_ht_cap = pos;
			elems->vendor_ht_cap_len = elen;
			break;
		case VENDOR_VHT_TYPE:
			if (elen > 4 &&
			    (pos[4] == VENDOR_VHT_SUBTYPE ||
			     pos[4] == VENDOR_VHT_SUBTYPE2)) {
				elems->vendor_vht = pos;
				elems->vendor_vht_len = elen;
			} else
				return -1;
			break;
		default:
			wpa_printf(MSG_EXCESSIVE, "Unknown Broadcom "
				   "information element ignored "
				   "(type=%d len=%lu)",
				   pos[3], (unsigned long) elen);
			return -1;
		}
		break;

	case OUI_QCA:
		switch (pos[3]) {
		case QCA_VENDOR_ELEM_P2P_PREF_CHAN_LIST:
			elems->pref_freq_list = pos;
			elems->pref_freq_list_len = elen;
			break;
		default:
			wpa_printf(MSG_EXCESSIVE,
				   "Unknown QCA information element ignored (type=%d len=%lu)",
				   pos[3], (unsigned long) elen);
			return -1;
		}
		break;

	default:
		wpa_printf(MSG_EXCESSIVE, "unknown vendor specific "
			   "information element ignored (vendor OUI "
			   "%02x:%02x:%02x len=%lu)",
			   pos[0], pos[1], pos[2], (unsigned long) elen);
		return -1;
	}

	return 0;
}


static int ieee802_11_parse_mle(const u8 *pos, size_t elen, size_t **total_len,
				struct ieee802_11_elems *elems,
				int show_errors)
{
	u8 mle_type = pos[0] & MULTI_LINK_CONTROL_TYPE_MASK;

	switch (mle_type) {
	case MULTI_LINK_CONTROL_TYPE_BASIC:
		elems->basic_mle = pos;
		elems->basic_mle_len = elen;
		*total_len = &elems->basic_mle_len;
		break;
	case MULTI_LINK_CONTROL_TYPE_PROBE_REQ:
		elems->probe_req_mle = pos;
		elems->probe_req_mle_len = elen;
		*total_len = &elems->probe_req_mle_len;
		break;
	case MULTI_LINK_CONTROL_TYPE_RECONF:
		elems->reconf_mle = pos;
		elems->reconf_mle_len = elen;
		*total_len = &elems->reconf_mle_len;
		break;
	case MULTI_LINK_CONTROL_TYPE_TDLS:
		elems->tdls_mle = pos;
		elems->tdls_mle_len = elen;
		*total_len = &elems->tdls_mle_len;
		break;
	case MULTI_LINK_CONTROL_TYPE_PRIOR_ACCESS:
		elems->prior_access_mle = pos;
		elems->prior_access_mle_len = elen;
		*total_len = &elems->prior_access_mle_len;
		break;
	default:
		if (show_errors) {
			wpa_printf(MSG_MSGDUMP,
				   "Unknown Multi-Link element type %u",
				   mle_type);
		}
		return -1;
	}

	return 0;
}


static size_t ieee802_11_fragments_length(struct ieee802_11_elems *elems,
					  const u8 *start, size_t len)
{
	const struct element *elem;
	size_t frags_len = 0;

	for_each_element(elem, start, len) {
		if (elem->id != WLAN_EID_FRAGMENT)
			break;

		frags_len += elem->datalen + 2;
		elems->num_frag_elems++;
	}

	return frags_len;
}


static int ieee802_11_parse_extension(const u8 *pos, size_t elen,
				      struct ieee802_11_elems *elems,
				      const u8 *start, size_t len,
				      int show_errors)
{
	u8 ext_id;
	size_t *total_len = NULL;

	if (elen < 1) {
		if (show_errors) {
			wpa_printf(MSG_MSGDUMP,
				   "short information element (Ext)");
		}
		return -1;
	}

	ext_id = *pos++;
	elen--;

	switch (ext_id) {
	case WLAN_EID_EXT_ASSOC_DELAY_INFO:
		if (elen != 1)
			break;
		elems->assoc_delay_info = pos;
		break;
	case WLAN_EID_EXT_FILS_REQ_PARAMS:
		if (elen < 3)
			break;
		elems->fils_req_params = pos;
		elems->fils_req_params_len = elen;
		break;
	case WLAN_EID_EXT_FILS_KEY_CONFIRM:
		elems->fils_key_confirm = pos;
		elems->fils_key_confirm_len = elen;
		break;
	case WLAN_EID_EXT_FILS_SESSION:
		if (elen != FILS_SESSION_LEN)
			break;
		elems->fils_session = pos;
		break;
	case WLAN_EID_EXT_FILS_HLP_CONTAINER:
		if (elen < 2 * ETH_ALEN)
			break;
		elems->fils_hlp = pos;
		elems->fils_hlp_len = elen;
		total_len = &elems->fils_hlp_len;
		break;
	case WLAN_EID_EXT_FILS_IP_ADDR_ASSIGN:
		if (elen < 1)
			break;
		elems->fils_ip_addr_assign = pos;
		elems->fils_ip_addr_assign_len = elen;
		break;
	case WLAN_EID_EXT_KEY_DELIVERY:
		if (elen < WPA_KEY_RSC_LEN)
			break;
		elems->key_delivery = pos;
		elems->key_delivery_len = elen;
		break;
	case WLAN_EID_EXT_WRAPPED_DATA:
		elems->wrapped_data = pos;
		elems->wrapped_data_len = elen;
		total_len = &elems->wrapped_data_len;
		break;
	case WLAN_EID_EXT_FILS_PUBLIC_KEY:
		if (elen < 1)
			break;
		elems->fils_pk = pos;
		elems->fils_pk_len = elen;
		break;
	case WLAN_EID_EXT_FILS_NONCE:
		if (elen != FILS_NONCE_LEN)
			break;
		elems->fils_nonce = pos;
		break;
	case WLAN_EID_EXT_OWE_DH_PARAM:
		if (elen < 2)
			break;
		elems->owe_dh = pos;
		elems->owe_dh_len = elen;
		break;
	case WLAN_EID_EXT_PASSWORD_IDENTIFIER:
		elems->password_id = pos;
		elems->password_id_len = elen;
		break;
	case WLAN_EID_EXT_HE_CAPABILITIES:
		if (elen < HE_CAPABILITIES_IE_MIN_LEN)
			break;
		elems->he_capabilities = pos;
		elems->he_capabilities_len = elen;
		break;
	case WLAN_EID_EXT_HE_OPERATION:
		if (elen < HE_OPERATION_IE_MIN_LEN)
			break;
		elems->he_operation = pos;
		elems->he_operation_len = elen;
		break;
	case WLAN_EID_EXT_OCV_OCI:
		elems->oci = pos;
		elems->oci_len = elen;
		break;
	case WLAN_EID_EXT_SHORT_SSID_LIST:
		elems->short_ssid_list = pos;
		elems->short_ssid_list_len = elen;
		break;
	case WLAN_EID_EXT_HE_6GHZ_BAND_CAP:
		if (elen < sizeof(struct ieee80211_he_6ghz_band_cap))
			break;
		elems->he_6ghz_band_cap = pos;
		break;
	case WLAN_EID_EXT_PASN_PARAMS:
		elems->pasn_params = pos;
		elems->pasn_params_len = elen;
		break;
	case WLAN_EID_EXT_EHT_CAPABILITIES:
		if (elen < EHT_CAPABILITIES_IE_MIN_LEN)
			break;
		elems->eht_capabilities = pos;
		elems->eht_capabilities_len = elen;
		break;
	case WLAN_EID_EXT_EHT_OPERATION:
		if (elen < EHT_OPERATION_IE_MIN_LEN)
			break;
		elems->eht_operation = pos;
		elems->eht_operation_len = elen;
		break;
	case WLAN_EID_EXT_MULTI_LINK:
		if (elen < 2)
			break;
		if (ieee802_11_parse_mle(pos, elen, &total_len, elems,
					 show_errors))
			return -1;
		break;
	case WLAN_EID_EXT_KNOWN_BSSID:
		elems->mbssid_known_bss = pos;
		elems->mbssid_known_bss_len = elen;
		break;
	case WLAN_EID_EXT_PASN_ENCRYPTED_DATA:
		elems->pasn_encrypted_data = pos;
		elems->pasn_encrypted_data_len = elen;
		break;
	default:
		if (show_errors) {
			wpa_printf(MSG_MSGDUMP,
				   "IEEE 802.11 element parsing ignored unknown element extension (ext_id=%u elen=%u)",
				   ext_id, (unsigned int) elen);
		}
		return -1;
	}

	if (elen == 254 && total_len)
		*total_len += ieee802_11_fragments_length(
			elems, pos + elen, (start + len) - (pos + elen));

	return 0;
}


static ParseRes __ieee802_11_parse_elems(const u8 *start, size_t len,
					 struct ieee802_11_elems *elems,
					 int show_errors)
{
	const struct element *elem;
	int unknown = 0;

	if (!start)
		return ParseOK;

	for_each_element(elem, start, len) {
		u8 id = elem->id, elen = elem->datalen;
		const u8 *pos = elem->data;
		size_t *total_len = NULL;

		if (id == WLAN_EID_FRAGMENT && elems->num_frag_elems > 0) {
			elems->num_frag_elems--;
			continue;
		}
		elems->num_frag_elems = 0;

		switch (id) {
		case WLAN_EID_SSID:
			if (elen > SSID_MAX_LEN) {
				wpa_printf(MSG_DEBUG,
					   "Ignored too long SSID element (elen=%u)",
					   elen);
				break;
			}
			if (elems->ssid) {
				wpa_printf(MSG_MSGDUMP,
					   "Ignored duplicated SSID element");
				break;
			}
			elems->ssid = pos;
			elems->ssid_len = elen;
			break;
		case WLAN_EID_SUPP_RATES:
			elems->supp_rates = pos;
			elems->supp_rates_len = elen;
			break;
		case WLAN_EID_DS_PARAMS:
			if (elen < 1)
				break;
			elems->ds_params = pos;
			break;
		case WLAN_EID_CF_PARAMS:
		case WLAN_EID_TIM:
			break;
		case WLAN_EID_CHALLENGE:
			elems->challenge = pos;
			elems->challenge_len = elen;
			break;
		case WLAN_EID_ERP_INFO:
			if (elen < 1)
				break;
			elems->erp_info = pos;
			break;
		case WLAN_EID_EXT_SUPP_RATES:
			elems->ext_supp_rates = pos;
			elems->ext_supp_rates_len = elen;
			break;
		case WLAN_EID_VENDOR_SPECIFIC:
			if (ieee802_11_parse_vendor_specific(pos, elen,
							     elems,
							     show_errors))
				unknown++;
			break;
		case WLAN_EID_RSN:
			elems->rsn_ie = pos;
			elems->rsn_ie_len = elen;
			break;
		case WLAN_EID_RSNX:
			elems->rsnxe = pos;
			elems->rsnxe_len = elen;
			break;
		case WLAN_EID_PWR_CAPABILITY:
			if (elen < 2)
				break;
			elems->power_capab = pos;
			elems->power_capab_len = elen;
			break;
		case WLAN_EID_SUPPORTED_CHANNELS:
			elems->supp_channels = pos;
			elems->supp_channels_len = elen;
			break;
		case WLAN_EID_MOBILITY_DOMAIN:
			if (elen < sizeof(struct rsn_mdie))
				break;
			elems->mdie = pos;
			elems->mdie_len = elen;
			break;
		case WLAN_EID_FAST_BSS_TRANSITION:
			if (elen < sizeof(struct rsn_ftie))
				break;
			elems->ftie = pos;
			elems->ftie_len = elen;
			elems->fte_defrag_len = elen;
			total_len = &elems->fte_defrag_len;
			break;
		case WLAN_EID_TIMEOUT_INTERVAL:
			if (elen != 5)
				break;
			elems->timeout_int = pos;
			break;
		case WLAN_EID_HT_CAP:
			if (elen < sizeof(struct ieee80211_ht_capabilities))
				break;
			elems->ht_capabilities = pos;
			break;
		case WLAN_EID_HT_OPERATION:
			if (elen < sizeof(struct ieee80211_ht_operation))
				break;
			elems->ht_operation = pos;
			break;
		case WLAN_EID_MESH_CONFIG:
			elems->mesh_config = pos;
			elems->mesh_config_len = elen;
			break;
		case WLAN_EID_MESH_ID:
			elems->mesh_id = pos;
			elems->mesh_id_len = elen;
			break;
		case WLAN_EID_PEER_MGMT:
			elems->peer_mgmt = pos;
			elems->peer_mgmt_len = elen;
			break;
		case WLAN_EID_VHT_CAP:
			if (elen < sizeof(struct ieee80211_vht_capabilities))
				break;
			elems->vht_capabilities = pos;
			break;
		case WLAN_EID_VHT_OPERATION:
			if (elen < sizeof(struct ieee80211_vht_operation))
				break;
			elems->vht_operation = pos;
			break;
		case WLAN_EID_OPERATING_MODE_NOTIFICATION:
			if (elen != 1)
				break;
			elems->opmode_notif = pos;
			break;
		case WLAN_EID_LINK_ID:
			if (elen < 18)
				break;
			elems->link_id = pos;
			break;
		case WLAN_EID_INTERWORKING:
			elems->interworking = pos;
			elems->interworking_len = elen;
			break;
		case WLAN_EID_QOS_MAP_SET:
			if (elen < 16)
				break;
			elems->qos_map_set = pos;
			elems->qos_map_set_len = elen;
			break;
		case WLAN_EID_EXT_CAPAB:
			elems->ext_capab = pos;
			elems->ext_capab_len = elen;
			break;
		case WLAN_EID_BSS_MAX_IDLE_PERIOD:
			if (elen < 3)
				break;
			elems->bss_max_idle_period = pos;
			break;
		case WLAN_EID_SSID_LIST:
			elems->ssid_list = pos;
			elems->ssid_list_len = elen;
			break;
		case WLAN_EID_AMPE:
			elems->ampe = pos;
			elems->ampe_len = elen;
			break;
		case WLAN_EID_MIC:
			elems->mic = pos;
			elems->mic_len = elen;
			/* after mic everything is encrypted, so stop. */
			goto done;
		case WLAN_EID_MULTI_BAND:
			if (elems->mb_ies.nof_ies >= MAX_NOF_MB_IES_SUPPORTED) {
				wpa_printf(MSG_MSGDUMP,
					   "IEEE 802.11 element parse ignored MB IE (id=%d elen=%d)",
					   id, elen);
				break;
			}

			elems->mb_ies.ies[elems->mb_ies.nof_ies].ie = pos;
			elems->mb_ies.ies[elems->mb_ies.nof_ies].ie_len = elen;
			elems->mb_ies.nof_ies++;
			break;
		case WLAN_EID_SUPPORTED_OPERATING_CLASSES:
			elems->supp_op_classes = pos;
			elems->supp_op_classes_len = elen;
			break;
		case WLAN_EID_RRM_ENABLED_CAPABILITIES:
			elems->rrm_enabled = pos;
			elems->rrm_enabled_len = elen;
			break;
		case WLAN_EID_MULTIPLE_BSSID:
			if (elen < 1)
				break;
			elems->mbssid = pos;
			elems->mbssid_len = elen;
			break;
		case WLAN_EID_CAG_NUMBER:
			elems->cag_number = pos;
			elems->cag_number_len = elen;
			break;
		case WLAN_EID_AP_CSN:
			if (elen < 1)
				break;
			elems->ap_csn = pos;
			break;
		case WLAN_EID_FILS_INDICATION:
			if (elen < 2)
				break;
			elems->fils_indic = pos;
			elems->fils_indic_len = elen;
			break;
		case WLAN_EID_DILS:
			if (elen < 2)
				break;
			elems->dils = pos;
			elems->dils_len = elen;
			break;
		case WLAN_EID_S1G_CAPABILITIES:
			if (elen < 15)
				break;
			elems->s1g_capab = pos;
			break;
		case WLAN_EID_FRAGMENT:
			wpa_printf(MSG_MSGDUMP,
				   "Fragment without a valid last element - skip");

			break;
		case WLAN_EID_EXTENSION:
			if (ieee802_11_parse_extension(pos, elen, elems, start,
						       len, show_errors))
				unknown++;
			break;
		default:
			unknown++;
			if (!show_errors)
				break;
			wpa_printf(MSG_MSGDUMP, "IEEE 802.11 element parse "
				   "ignored unknown element (id=%d elen=%d)",
				   id, elen);
			break;
		}

		if (elen == 255 && total_len)
			*total_len += ieee802_11_fragments_length(
				elems, pos + elen,
				(start + len) - (pos + elen));

	}

	if (!for_each_element_completed(elem, start, len)) {
		if (show_errors) {
			wpa_printf(MSG_DEBUG,
				   "IEEE 802.11 element parse failed @%d",
				   (int) (start + len - (const u8 *) elem));
			wpa_hexdump(MSG_MSGDUMP, "IEs", start, len);
		}
		return ParseFailed;
	}

done:
	return unknown ? ParseUnknown : ParseOK;
}


/**
 * ieee802_11_parse_elems - Parse information elements in management frames
 * @start: Pointer to the start of IEs
 * @len: Length of IE buffer in octets
 * @elems: Data structure for parsed elements
 * @show_errors: Whether to show parsing errors in debug log
 * Returns: Parsing result
 */
ParseRes ieee802_11_parse_elems(const u8 *start, size_t len,
				struct ieee802_11_elems *elems,
				int show_errors)
{
	os_memset(elems, 0, sizeof(*elems));

	return __ieee802_11_parse_elems(start, len, elems, show_errors);
}


/**
 * ieee802_11_elems_clear_ids - Clear the data for the given element IDs
 * @ids: Array of element IDs for which data should be cleared.
 * @num: The number of entries in the array
 */
void ieee802_11_elems_clear_ids(struct ieee802_11_elems *elems,
				const u8 *ids, size_t num)
{
	size_t i;

	for (i = 0; i < num; i++) {
		switch (ids[i]) {
		case WLAN_EID_SSID:
			elems->ssid = NULL;
			elems->ssid_len = 0;
			break;
		case WLAN_EID_SUPP_RATES:
			elems->supp_rates = NULL;
			elems->supp_rates_len = 0;
			break;
		case WLAN_EID_DS_PARAMS:
			elems->ds_params = NULL;
			break;
		case WLAN_EID_CHALLENGE:
			elems->challenge = NULL;
			elems->challenge_len = 0;
			break;
		case WLAN_EID_ERP_INFO:
			elems->erp_info = NULL;
			break;
		case WLAN_EID_EXT_SUPP_RATES:
			elems->ext_supp_rates = NULL;
			elems->ext_supp_rates_len = 0;
			break;
		case WLAN_EID_RSN:
			elems->rsn_ie = NULL;
			elems->rsn_ie_len = 0;
			break;
		case WLAN_EID_RSNX:
			elems->rsnxe = NULL;
			elems->rsnxe_len = 0;
			break;
		case WLAN_EID_PWR_CAPABILITY:
			elems->power_capab = NULL;
			elems->power_capab_len = 0;
			break;
		case WLAN_EID_SUPPORTED_CHANNELS:
			elems->supp_channels = NULL;
			elems->supp_channels_len = 0;
			break;
		case WLAN_EID_MOBILITY_DOMAIN:
			elems->mdie = NULL;
			elems->mdie_len = 0;
			break;
		case WLAN_EID_FAST_BSS_TRANSITION:
			elems->ftie = NULL;
			elems->ftie_len = 0;
			break;
		case WLAN_EID_TIMEOUT_INTERVAL:
			elems->timeout_int = NULL;
			break;
		case WLAN_EID_HT_CAP:
			elems->ht_capabilities = NULL;
			break;
		case WLAN_EID_HT_OPERATION:
			elems->ht_operation = NULL;
			break;
		case WLAN_EID_MESH_CONFIG:
			elems->mesh_config = NULL;
			elems->mesh_config_len = 0;
			break;
		case WLAN_EID_MESH_ID:
			elems->mesh_id = NULL;
			elems->mesh_id_len = 0;
			break;
		case WLAN_EID_PEER_MGMT:
			elems->peer_mgmt = NULL;
			elems->peer_mgmt_len = 0;
			break;
		case WLAN_EID_VHT_CAP:
			elems->vht_capabilities = NULL;
			break;
		case WLAN_EID_VHT_OPERATION:
			elems->vht_operation = NULL;
			break;
		case WLAN_EID_OPERATING_MODE_NOTIFICATION:
			elems->opmode_notif = NULL;
			break;
		case WLAN_EID_LINK_ID:
			elems->link_id = NULL;
			break;
		case WLAN_EID_INTERWORKING:
			elems->interworking = NULL;
			elems->interworking_len = 0;
			break;
		case WLAN_EID_QOS_MAP_SET:
			elems->qos_map_set = NULL;
			elems->qos_map_set_len = 0;
			break;
		case WLAN_EID_EXT_CAPAB:
			elems->ext_capab = NULL;
			elems->ext_capab_len = 0;
			break;
		case WLAN_EID_BSS_MAX_IDLE_PERIOD:
			elems->bss_max_idle_period = NULL;
			break;
		case WLAN_EID_SSID_LIST:
			elems->ssid_list = NULL;
			elems->ssid_list_len = 0;
			break;
		case WLAN_EID_AMPE:
			elems->ampe = NULL;
			elems->ampe_len = 0;
			break;
		case WLAN_EID_MIC:
			elems->mic = NULL;
			elems->mic_len = 0;
			break;
		case WLAN_EID_MULTI_BAND:
			os_memset(&elems->mb_ies, 0, sizeof(elems->mb_ies));
			elems->mb_ies.nof_ies = 0;
			break;
		case WLAN_EID_SUPPORTED_OPERATING_CLASSES:
			elems->supp_op_classes = NULL;
			elems->supp_op_classes_len = 0;
			break;
		case WLAN_EID_RRM_ENABLED_CAPABILITIES:
			elems->rrm_enabled = NULL;
			elems->rrm_enabled_len = 0;
			break;
		case WLAN_EID_CAG_NUMBER:
			elems->cag_number = NULL;
			elems->cag_number_len = 0;
			break;
		case WLAN_EID_AP_CSN:
			elems->ap_csn = NULL;
			break;
		case WLAN_EID_FILS_INDICATION:
			elems->fils_indic = NULL;
			elems->fils_indic_len = 0;
			break;
		case WLAN_EID_DILS:
			elems->dils = NULL;
			elems->dils_len = 0;
			break;
		case WLAN_EID_S1G_CAPABILITIES:
			elems->s1g_capab = NULL;
			break;
		}
	}
}


/**
 * ieee802_11_elems_clear_ext_ids - Clear the data for the given element
 * extension IDs
 * @ids: Array of element extension IDs for which data should be cleared.
 * @num: The number of entries in the array
 */
void ieee802_11_elems_clear_ext_ids(struct ieee802_11_elems *elems,
				    const u8 *ids, size_t num)
{
	size_t i;

	for (i = 0; i < num; i++) {
		switch (ids[i]) {
		case WLAN_EID_EXT_ASSOC_DELAY_INFO:
			elems->assoc_delay_info = NULL;
			break;
		case WLAN_EID_EXT_FILS_REQ_PARAMS:
			elems->fils_req_params = NULL;
			elems->fils_req_params_len = 0;
			break;
		case WLAN_EID_EXT_FILS_KEY_CONFIRM:
			elems->fils_key_confirm = NULL;
			elems->fils_key_confirm_len = 0;
			break;
		case WLAN_EID_EXT_FILS_SESSION:
			elems->fils_session = NULL;
			break;
		case WLAN_EID_EXT_FILS_HLP_CONTAINER:
			elems->fils_hlp = NULL;
			elems->fils_hlp_len = 0;
			break;
		case WLAN_EID_EXT_FILS_IP_ADDR_ASSIGN:
			elems->fils_ip_addr_assign = NULL;
			elems->fils_ip_addr_assign_len = 0;
			break;
		case WLAN_EID_EXT_KEY_DELIVERY:
			elems->key_delivery = NULL;
			elems->key_delivery_len = 0;
			break;
		case WLAN_EID_EXT_WRAPPED_DATA:
			elems->wrapped_data = NULL;
			elems->wrapped_data_len = 0;
			break;
		case WLAN_EID_EXT_FILS_PUBLIC_KEY:
			elems->fils_pk = NULL;
			elems->fils_pk_len = 0;
			break;
		case WLAN_EID_EXT_FILS_NONCE:
			elems->fils_nonce = NULL;
			break;
		case WLAN_EID_EXT_OWE_DH_PARAM:
			elems->owe_dh = NULL;
			elems->owe_dh_len = 0;
			break;
		case WLAN_EID_EXT_PASSWORD_IDENTIFIER:
			elems->password_id = NULL;
			elems->password_id_len = 0;
			break;
		case WLAN_EID_EXT_HE_CAPABILITIES:
			elems->he_capabilities = NULL;
			elems->he_capabilities_len = 0;
			break;
		case WLAN_EID_EXT_HE_OPERATION:
			elems->he_operation = NULL;
			elems->he_operation_len = 0;
			break;
		case WLAN_EID_EXT_OCV_OCI:
			elems->oci = NULL;
			elems->oci_len = 0;
			break;
		case WLAN_EID_EXT_SHORT_SSID_LIST:
			elems->short_ssid_list = NULL;
			elems->short_ssid_list_len = 0;
			break;
		case WLAN_EID_EXT_HE_6GHZ_BAND_CAP:
			elems->he_6ghz_band_cap = NULL;
			break;
		case WLAN_EID_EXT_PASN_PARAMS:
			elems->pasn_params = NULL;
			elems->pasn_params_len = 0;
			break;
		case WLAN_EID_EXT_MULTI_LINK:
			elems->basic_mle = NULL;
			elems->probe_req_mle = NULL;
			elems->reconf_mle = NULL;
			elems->tdls_mle = NULL;
			elems->prior_access_mle = NULL;

			elems->basic_mle_len = 0;
			elems->probe_req_mle_len = 0;
			elems->reconf_mle_len = 0;
			elems->tdls_mle_len = 0;
			elems->prior_access_mle_len = 0;
			break;
		case WLAN_EID_EXT_EHT_CAPABILITIES:
			elems->eht_capabilities = NULL;
			elems->eht_capabilities_len = 0;
			break;
		case WLAN_EID_EXT_EHT_OPERATION:
			elems->eht_operation = NULL;
			elems->eht_operation_len = 0;
			break;
		}
	}
}


ParseRes ieee802_11_parse_link_assoc_req(const u8 *start, size_t len,
					 struct ieee802_11_elems *elems,
					 struct wpabuf *mlbuf,
					 u8 link_id, bool show_errors)
{
	const struct ieee80211_eht_ml *ml;
	const u8 *pos;
	ParseRes res = ParseFailed;

	pos = wpabuf_head(mlbuf);
	len = wpabuf_len(mlbuf);

	/* Must have control and common info length */
	if (len < sizeof(*ml) + 1 || len < sizeof(*ml) + pos[sizeof(*ml)])
		goto out;

	ml = (const struct ieee80211_eht_ml *) pos;

	/* As we are interested with the Per-STA profile, ignore other types */
	if ((le_to_host16(ml->ml_control) & MULTI_LINK_CONTROL_TYPE_MASK) !=
	     MULTI_LINK_CONTROL_TYPE_BASIC)
		goto out;

	/* Skip the common info */
	len -= sizeof(*ml) + pos[sizeof(*ml)];
	pos += sizeof(*ml) + pos[sizeof(*ml)];

	while (len > 2) {
		size_t sub_elem_len = *(pos + 1);
		size_t sta_info_len;
		u16 link_info_control;
		const u8 *non_inherit;

		wpa_printf(MSG_DEBUG,
			   "MLD: sub element: len=%zu, sub_elem_len=%zu",
			   len, sub_elem_len);

		if (2 + sub_elem_len > len) {
			if (show_errors)
				wpa_printf(MSG_DEBUG,
					   "MLD: error: len=%zu, sub_elem_len=%zu",
					   len, sub_elem_len);
			goto out;
		}

		if (*pos != 0) {
			pos += 2 + sub_elem_len;
			len -= 2 + sub_elem_len;
			continue;
		}

		if (sub_elem_len < 5) {
			if (show_errors)
				wpa_printf(MSG_DEBUG,
					   "MLD: error: sub_elem_len=%zu < 5",
					   sub_elem_len);
			goto out;
		}

		link_info_control = WPA_GET_LE16(pos + 2);
		if ((link_info_control & BASIC_MLE_STA_CTRL_LINK_ID_MASK) !=
		    link_id) {
			pos += 2 + sub_elem_len;
			len -= 2 + sub_elem_len;
			continue;
		}

		sta_info_len = *(pos + 4);
		if (sub_elem_len < sta_info_len + 3 || sta_info_len < 1) {
			if (show_errors)
				wpa_printf(MSG_DEBUG,
					   "MLD: error: sub_elem_len=%zu, sta_info_len=%zu",
					   sub_elem_len, sta_info_len);
			goto out;
		}

		pos += sta_info_len + 4;
		sub_elem_len -= sta_info_len + 2;

		if (sub_elem_len < 2) {
			if (show_errors)
				wpa_printf(MSG_DEBUG,
					   "MLD: missing capability info");
			goto out;
		}

		pos += 2;
		sub_elem_len -= 2;

		/* Handle non-inheritance */
		non_inherit = get_ie_ext(pos, sub_elem_len,
					 WLAN_EID_EXT_NON_INHERITANCE);
		if (non_inherit && non_inherit[1] > 1) {
			u8 non_inherit_len = non_inherit[1] - 1;

			/*
			 * Do not include the Non-Inheritance element when
			 * parsing below. It should be the last element in the
			 * subelement.
			 */
			if (3U + non_inherit_len > sub_elem_len)
				goto out;
			sub_elem_len -= 3 + non_inherit_len;

			/* Skip the ID, length and extension ID */
			non_inherit += 3;

			if (non_inherit_len < 1UL + non_inherit[0]) {
				if (show_errors)
					wpa_printf(MSG_DEBUG,
						   "MLD: Invalid inheritance");
				goto out;
			}

			ieee802_11_elems_clear_ids(elems, &non_inherit[1],
						   non_inherit[0]);

			non_inherit_len -= 1 + non_inherit[0];
			non_inherit += 1 + non_inherit[0];

			if (non_inherit_len < 1UL ||
			    non_inherit_len < 1UL + non_inherit[0]) {
				if (show_errors)
					wpa_printf(MSG_DEBUG,
						   "MLD: Invalid inheritance");
				goto out;
			}

			ieee802_11_elems_clear_ext_ids(elems, &non_inherit[1],
						       non_inherit[0]);
		}

		wpa_printf(MSG_DEBUG, "MLD: link: sub_elem_len=%zu",
			   sub_elem_len);

		if (sub_elem_len)
			res = __ieee802_11_parse_elems(pos, sub_elem_len,
						       elems, show_errors);
		else
			res = ParseOK;
		break;
	}

out:
	return res;
}


int ieee802_11_ie_count(const u8 *ies, size_t ies_len)
{
	const struct element *elem;
	int count = 0;

	if (ies == NULL)
		return 0;

	for_each_element(elem, ies, ies_len)
		count++;

	return count;
}


struct wpabuf * ieee802_11_vendor_ie_concat(const u8 *ies, size_t ies_len,
					    u32 oui_type)
{
	struct wpabuf *buf;
	const struct element *elem, *found = NULL;

	for_each_element_id(elem, WLAN_EID_VENDOR_SPECIFIC, ies, ies_len) {
		if (elem->datalen >= 4 &&
		    WPA_GET_BE32(elem->data) == oui_type) {
			found = elem;
			break;
		}
	}

	if (!found)
		return NULL; /* No specified vendor IE found */

	buf = wpabuf_alloc(ies_len);
	if (buf == NULL)
		return NULL;

	/*
	 * There may be multiple vendor IEs in the message, so need to
	 * concatenate their data fields.
	 */
	for_each_element_id(elem, WLAN_EID_VENDOR_SPECIFIC, ies, ies_len) {
		if (elem->datalen >= 4 && WPA_GET_BE32(elem->data) == oui_type)
			wpabuf_put_data(buf, elem->data + 4, elem->datalen - 4);
	}

	return buf;
}


const u8 * get_hdr_bssid(const struct ieee80211_hdr *hdr, size_t len)
{
	u16 fc, type, stype;

	/*
	 * PS-Poll frames are 16 bytes. All other frames are
	 * 24 bytes or longer.
	 */
	if (len < 16)
		return NULL;

	fc = le_to_host16(hdr->frame_control);
	type = WLAN_FC_GET_TYPE(fc);
	stype = WLAN_FC_GET_STYPE(fc);

	switch (type) {
	case WLAN_FC_TYPE_DATA:
		if (len < 24)
			return NULL;
		switch (fc & (WLAN_FC_FROMDS | WLAN_FC_TODS)) {
		case WLAN_FC_FROMDS | WLAN_FC_TODS:
		case WLAN_FC_TODS:
			return hdr->addr1;
		case WLAN_FC_FROMDS:
			return hdr->addr2;
		default:
			return NULL;
		}
	case WLAN_FC_TYPE_CTRL:
		if (stype != WLAN_FC_STYPE_PSPOLL)
			return NULL;
		return hdr->addr1;
	case WLAN_FC_TYPE_MGMT:
		if (len < 24)
			return NULL;
		return hdr->addr3;
	default:
		return NULL;
	}
}


int hostapd_config_wmm_ac(struct hostapd_wmm_ac_params wmm_ac_params[],
			  const char *name, const char *val)
{
	int num, v;
	const char *pos;
	struct hostapd_wmm_ac_params *ac;

	/* skip 'wme_ac_' or 'wmm_ac_' prefix */
	pos = name + 7;
	if (os_strncmp(pos, "be_", 3) == 0) {
		num = 0;
		pos += 3;
	} else if (os_strncmp(pos, "bk_", 3) == 0) {
		num = 1;
		pos += 3;
	} else if (os_strncmp(pos, "vi_", 3) == 0) {
		num = 2;
		pos += 3;
	} else if (os_strncmp(pos, "vo_", 3) == 0) {
		num = 3;
		pos += 3;
	} else {
		wpa_printf(MSG_ERROR, "Unknown WMM name '%s'", pos);
		return -1;
	}

	ac = &wmm_ac_params[num];

	if (os_strcmp(pos, "aifs") == 0) {
		v = atoi(val);
		if (v < 1 || v > 255) {
			wpa_printf(MSG_ERROR, "Invalid AIFS value %d", v);
			return -1;
		}
		ac->aifs = v;
	} else if (os_strcmp(pos, "cwmin") == 0) {
		v = atoi(val);
		if (v < 0 || v > 15) {
			wpa_printf(MSG_ERROR, "Invalid cwMin value %d", v);
			return -1;
		}
		ac->cwmin = v;
	} else if (os_strcmp(pos, "cwmax") == 0) {
		v = atoi(val);
		if (v < 0 || v > 15) {
			wpa_printf(MSG_ERROR, "Invalid cwMax value %d", v);
			return -1;
		}
		ac->cwmax = v;
	} else if (os_strcmp(pos, "txop_limit") == 0) {
		v = atoi(val);
		if (v < 0 || v > 0xffff) {
			wpa_printf(MSG_ERROR, "Invalid txop value %d", v);
			return -1;
		}
		ac->txop_limit = v;
	} else if (os_strcmp(pos, "acm") == 0) {
		v = atoi(val);
		if (v < 0 || v > 1) {
			wpa_printf(MSG_ERROR, "Invalid acm value %d", v);
			return -1;
		}
		ac->admission_control_mandatory = v;
	} else {
		wpa_printf(MSG_ERROR, "Unknown wmm_ac_ field '%s'", pos);
		return -1;
	}

	return 0;
}


/* convert floats with one decimal place to value*10 int, i.e.,
 * "1.5" will return 15
 */
static int hostapd_config_read_int10(const char *value)
{
	int i, d;
	char *pos;

	i = atoi(value);
	pos = os_strchr(value, '.');
	d = 0;
	if (pos) {
		pos++;
		if (*pos >= '0' && *pos <= '9')
			d = *pos - '0';
	}

	return i * 10 + d;
}


static int valid_cw(int cw)
{
	return (cw == 1 || cw == 3 || cw == 7 || cw == 15 || cw == 31 ||
		cw == 63 || cw == 127 || cw == 255 || cw == 511 || cw == 1023 ||
		cw == 2047 || cw == 4095 || cw == 8191 || cw == 16383 ||
		cw == 32767);
}


int hostapd_config_tx_queue(struct hostapd_tx_queue_params tx_queue[],
			    const char *name, const char *val)
{
	int num;
	const char *pos;
	struct hostapd_tx_queue_params *queue;

	/* skip 'tx_queue_' prefix */
	pos = name + 9;
	if (os_strncmp(pos, "data", 4) == 0 &&
	    pos[4] >= '0' && pos[4] <= '9' && pos[5] == '_') {
		num = pos[4] - '0';
		pos += 6;
	} else if (os_strncmp(pos, "after_beacon_", 13) == 0 ||
		   os_strncmp(pos, "beacon_", 7) == 0) {
		wpa_printf(MSG_INFO, "DEPRECATED: '%s' not used", name);
		return 0;
	} else {
		wpa_printf(MSG_ERROR, "Unknown tx_queue name '%s'", pos);
		return -1;
	}

	if (num >= NUM_TX_QUEUES) {
		/* for backwards compatibility, do not trigger failure */
		wpa_printf(MSG_INFO, "DEPRECATED: '%s' not used", name);
		return 0;
	}

	queue = &tx_queue[num];

	if (os_strcmp(pos, "aifs") == 0) {
		queue->aifs = atoi(val);
		if (queue->aifs < 0 || queue->aifs > 255) {
			wpa_printf(MSG_ERROR, "Invalid AIFS value %d",
				   queue->aifs);
			return -1;
		}
	} else if (os_strcmp(pos, "cwmin") == 0) {
		queue->cwmin = atoi(val);
		if (!valid_cw(queue->cwmin)) {
			wpa_printf(MSG_ERROR, "Invalid cwMin value %d",
				   queue->cwmin);
			return -1;
		}
	} else if (os_strcmp(pos, "cwmax") == 0) {
		queue->cwmax = atoi(val);
		if (!valid_cw(queue->cwmax)) {
			wpa_printf(MSG_ERROR, "Invalid cwMax value %d",
				   queue->cwmax);
			return -1;
		}
	} else if (os_strcmp(pos, "burst") == 0) {
		queue->burst = hostapd_config_read_int10(val);
	} else {
		wpa_printf(MSG_ERROR, "Unknown queue field '%s'", pos);
		return -1;
	}

	return 0;
}


enum hostapd_hw_mode ieee80211_freq_to_chan(int freq, u8 *channel)
{
	u8 op_class;

	return ieee80211_freq_to_channel_ext(freq, 0, CONF_OPER_CHWIDTH_USE_HT,
					     &op_class, channel);
}


/**
 * ieee80211_freq_to_channel_ext - Convert frequency into channel info
 * for HT40, VHT, and HE. DFS channels are not covered.
 * @freq: Frequency (MHz) to convert
 * @sec_channel: 0 = non-HT40, 1 = sec. channel above, -1 = sec. channel below
 * @chanwidth: VHT/EDMG/etc. channel width
 * @op_class: Buffer for returning operating class
 * @channel: Buffer for returning channel number
 * Returns: hw_mode on success, NUM_HOSTAPD_MODES on failure
 */
enum hostapd_hw_mode
ieee80211_freq_to_channel_ext(unsigned int freq, int sec_channel,
			      enum oper_chan_width chanwidth,
			      u8 *op_class, u8 *channel)
{
	u8 vht_opclass;

	/* TODO: more operating classes */

	if (sec_channel > 1 || sec_channel < -1)
		return NUM_HOSTAPD_MODES;

	if (freq >= 2412 && freq <= 2472) {
		if ((freq - 2407) % 5)
			return NUM_HOSTAPD_MODES;

		if (chanwidth)
			return NUM_HOSTAPD_MODES;

		/* 2.407 GHz, channels 1..13 */
		if (sec_channel == 1)
			*op_class = 83;
		else if (sec_channel == -1)
			*op_class = 84;
		else
			*op_class = 81;

		*channel = (freq - 2407) / 5;

		return HOSTAPD_MODE_IEEE80211G;
	}

	if (freq == 2484) {
		if (sec_channel || chanwidth)
			return NUM_HOSTAPD_MODES;

		*op_class = 82; /* channel 14 */
		*channel = 14;

		return HOSTAPD_MODE_IEEE80211B;
	}

	if (freq >= 4900 && freq < 5000) {
		if ((freq - 4000) % 5)
			return NUM_HOSTAPD_MODES;
		*channel = (freq - 4000) / 5;
		*op_class = 0; /* TODO */
		return HOSTAPD_MODE_IEEE80211A;
	}

	switch (chanwidth) {
	case CONF_OPER_CHWIDTH_80MHZ:
		vht_opclass = 128;
		break;
	case CONF_OPER_CHWIDTH_160MHZ:
		vht_opclass = 129;
		break;
	case CONF_OPER_CHWIDTH_80P80MHZ:
		vht_opclass = 130;
		break;
	default:
		vht_opclass = 0;
		break;
	}

	/* 5 GHz, channels 36..48 */
	if (freq >= 5180 && freq <= 5240) {
		if ((freq - 5000) % 5)
			return NUM_HOSTAPD_MODES;

		if (vht_opclass)
			*op_class = vht_opclass;
		else if (sec_channel == 1)
			*op_class = 116;
		else if (sec_channel == -1)
			*op_class = 117;
		else
			*op_class = 115;

		*channel = (freq - 5000) / 5;

		return HOSTAPD_MODE_IEEE80211A;
	}

	/* 5 GHz, channels 52..64 */
	if (freq >= 5260 && freq <= 5320) {
		if ((freq - 5000) % 5)
			return NUM_HOSTAPD_MODES;

		if (vht_opclass)
			*op_class = vht_opclass;
		else if (sec_channel == 1)
			*op_class = 119;
		else if (sec_channel == -1)
			*op_class = 120;
		else
			*op_class = 118;

		*channel = (freq - 5000) / 5;

		return HOSTAPD_MODE_IEEE80211A;
	}

	/* 5 GHz, channels 149..177 */
	if (freq >= 5745 && freq <= 5885) {
		if ((freq - 5000) % 5)
			return NUM_HOSTAPD_MODES;

		if (vht_opclass)
			*op_class = vht_opclass;
		else if (sec_channel == 1)
			*op_class = 126;
		else if (sec_channel == -1)
			*op_class = 127;
		else
			*op_class = 125;

		*channel = (freq - 5000) / 5;

		return HOSTAPD_MODE_IEEE80211A;
	}

	/* 5 GHz, channels 100..144 */
	if (freq >= 5500 && freq <= 5720) {
		if ((freq - 5000) % 5)
			return NUM_HOSTAPD_MODES;

		if (vht_opclass)
			*op_class = vht_opclass;
		else if (sec_channel == 1)
			*op_class = 122;
		else if (sec_channel == -1)
			*op_class = 123;
		else
			*op_class = 121;

		*channel = (freq - 5000) / 5;

		return HOSTAPD_MODE_IEEE80211A;
	}

	if (freq >= 5000 && freq < 5900) {
		if ((freq - 5000) % 5)
			return NUM_HOSTAPD_MODES;
		*channel = (freq - 5000) / 5;
		*op_class = 0; /* TODO */
		return HOSTAPD_MODE_IEEE80211A;
	}

	if (freq > 5950 && freq <= 7115) {
		if ((freq - 5950) % 5)
			return NUM_HOSTAPD_MODES;

		switch (chanwidth) {
		case CONF_OPER_CHWIDTH_80MHZ:
			*op_class = 133;
			break;
		case CONF_OPER_CHWIDTH_160MHZ:
			*op_class = 134;
			break;
		case CONF_OPER_CHWIDTH_80P80MHZ:
			*op_class = 135;
			break;
		case CONF_OPER_CHWIDTH_320MHZ:
			*op_class = 137;
			break;
		default:
			if (sec_channel)
				*op_class = 132;
			else
				*op_class = 131;
			break;
		}

		*channel = (freq - 5950) / 5;
		return HOSTAPD_MODE_IEEE80211A;
	}

	if (freq == 5935) {
		*op_class = 136;
		*channel = (freq - 5925) / 5;
		return HOSTAPD_MODE_IEEE80211A;
	}

	/* 56.16 GHz, channel 1..6 */
	if (freq >= 56160 + 2160 * 1 && freq <= 56160 + 2160 * 6) {
		if (sec_channel)
			return NUM_HOSTAPD_MODES;

		switch (chanwidth) {
		case CONF_OPER_CHWIDTH_USE_HT:
		case CONF_OPER_CHWIDTH_2160MHZ:
			*channel = (freq - 56160) / 2160;
			*op_class = 180;
			break;
		case CONF_OPER_CHWIDTH_4320MHZ:
			/* EDMG channels 9 - 13 */
			if (freq > 56160 + 2160 * 5)
				return NUM_HOSTAPD_MODES;

			*channel = (freq - 56160) / 2160 + 8;
			*op_class = 181;
			break;
		case CONF_OPER_CHWIDTH_6480MHZ:
			/* EDMG channels 17 - 20 */
			if (freq > 56160 + 2160 * 4)
				return NUM_HOSTAPD_MODES;

			*channel = (freq - 56160) / 2160 + 16;
			*op_class = 182;
			break;
		case CONF_OPER_CHWIDTH_8640MHZ:
			/* EDMG channels 25 - 27 */
			if (freq > 56160 + 2160 * 3)
				return NUM_HOSTAPD_MODES;

			*channel = (freq - 56160) / 2160 + 24;
			*op_class = 183;
			break;
		default:
			return NUM_HOSTAPD_MODES;
		}

		return HOSTAPD_MODE_IEEE80211AD;
	}

	return NUM_HOSTAPD_MODES;
}


int ieee80211_chaninfo_to_channel(unsigned int freq, enum chan_width chanwidth,
				  int sec_channel, u8 *op_class, u8 *channel)
{
	int cw = CHAN_WIDTH_UNKNOWN;

	switch (chanwidth) {
	case CHAN_WIDTH_UNKNOWN:
	case CHAN_WIDTH_20_NOHT:
	case CHAN_WIDTH_20:
	case CHAN_WIDTH_40:
		cw = CONF_OPER_CHWIDTH_USE_HT;
		break;
	case CHAN_WIDTH_80:
		cw = CONF_OPER_CHWIDTH_80MHZ;
		break;
	case CHAN_WIDTH_80P80:
		cw = CONF_OPER_CHWIDTH_80P80MHZ;
		break;
	case CHAN_WIDTH_160:
		cw = CONF_OPER_CHWIDTH_160MHZ;
		break;
	case CHAN_WIDTH_2160:
		cw = CONF_OPER_CHWIDTH_2160MHZ;
		break;
	case CHAN_WIDTH_4320:
		cw = CONF_OPER_CHWIDTH_4320MHZ;
		break;
	case CHAN_WIDTH_6480:
		cw = CONF_OPER_CHWIDTH_6480MHZ;
		break;
	case CHAN_WIDTH_8640:
		cw = CONF_OPER_CHWIDTH_8640MHZ;
		break;
	case CHAN_WIDTH_320:
		cw = CONF_OPER_CHWIDTH_320MHZ;
		break;
	}

	if (ieee80211_freq_to_channel_ext(freq, sec_channel, cw, op_class,
					  channel) == NUM_HOSTAPD_MODES) {
		wpa_printf(MSG_WARNING,
			   "Cannot determine operating class and channel (freq=%u chanwidth=%d sec_channel=%d)",
			   freq, chanwidth, sec_channel);
		return -1;
	}

	return 0;
}


static const char *const us_op_class_cc[] = {
	"US", "CA", NULL
};

static const char *const eu_op_class_cc[] = {
	"AL", "AM", "AT", "AZ", "BA", "BE", "BG", "BY", "CH", "CY", "CZ", "DE",
	"DK", "EE", "EL", "ES", "FI", "FR", "GE", "HR", "HU", "IE", "IS", "IT",
	"LI", "LT", "LU", "LV", "MD", "ME", "MK", "MT", "NL", "NO", "PL", "PT",
	"RO", "RS", "RU", "SE", "SI", "SK", "TR", "UA", "UK", NULL
};

static const char *const jp_op_class_cc[] = {
	"JP", NULL
};

static const char *const cn_op_class_cc[] = {
	"CN", NULL
};


static int country_match(const char *const cc[], const char *const country)
{
	int i;

	if (country == NULL)
		return 0;
	for (i = 0; cc[i]; i++) {
		if (cc[i][0] == country[0] && cc[i][1] == country[1])
			return 1;
	}

	return 0;
}


static int ieee80211_chan_to_freq_us(u8 op_class, u8 chan)
{
	switch (op_class) {
	case 12: /* channels 1..11 */
	case 32: /* channels 1..7; 40 MHz */
	case 33: /* channels 5..11; 40 MHz */
		if (chan < 1 || chan > 11)
			return -1;
		return 2407 + 5 * chan;
	case 1: /* channels 36,40,44,48 */
	case 2: /* channels 52,56,60,64; dfs */
	case 22: /* channels 36,44; 40 MHz */
	case 23: /* channels 52,60; 40 MHz */
	case 27: /* channels 40,48; 40 MHz */
	case 28: /* channels 56,64; 40 MHz */
		if (chan < 36 || chan > 64)
			return -1;
		return 5000 + 5 * chan;
	case 4: /* channels 100-144 */
	case 24: /* channels 100-140; 40 MHz */
		if (chan < 100 || chan > 144)
			return -1;
		return 5000 + 5 * chan;
	case 3: /* channels 149,153,157,161 */
	case 25: /* channels 149,157; 40 MHz */
	case 26: /* channels 149,157; 40 MHz */
	case 30: /* channels 153,161; 40 MHz */
	case 31: /* channels 153,161; 40 MHz */
		if (chan < 149 || chan > 161)
			return -1;
		return 5000 + 5 * chan;
	case 5: /* channels 149,153,157,161,165 */
		if (chan < 149 || chan > 165)
			return -1;
		return 5000 + 5 * chan;
	case 34: /* 60 GHz band, channels 1..8 */
		if (chan < 1 || chan > 8)
			return -1;
		return 56160 + 2160 * chan;
	case 37: /* 60 GHz band, EDMG CB2, channels 9..15 */
		if (chan < 9 || chan > 15)
			return -1;
		return 56160 + 2160 * (chan - 8);
	case 38: /* 60 GHz band, EDMG CB3, channels 17..22 */
		if (chan < 17 || chan > 22)
			return -1;
		return 56160 + 2160 * (chan - 16);
	case 39: /* 60 GHz band, EDMG CB4, channels 25..29 */
		if (chan < 25 || chan > 29)
			return -1;
		return 56160 + 2160 * (chan - 24);
	default:
		return -1;
	}
}


static int ieee80211_chan_to_freq_eu(u8 op_class, u8 chan)
{
	switch (op_class) {
	case 4: /* channels 1..13 */
	case 11: /* channels 1..9; 40 MHz */
	case 12: /* channels 5..13; 40 MHz */
		if (chan < 1 || chan > 13)
			return -1;
		return 2407 + 5 * chan;
	case 1: /* channels 36,40,44,48 */
	case 2: /* channels 52,56,60,64; dfs */
	case 5: /* channels 36,44; 40 MHz */
	case 6: /* channels 52,60; 40 MHz */
	case 8: /* channels 40,48; 40 MHz */
	case 9: /* channels 56,64; 40 MHz */
		if (chan < 36 || chan > 64)
			return -1;
		return 5000 + 5 * chan;
	case 3: /* channels 100-140 */
	case 7: /* channels 100-132; 40 MHz */
	case 10: /* channels 104-136; 40 MHz */
	case 16: /* channels 100-140 */
		if (chan < 100 || chan > 140)
			return -1;
		return 5000 + 5 * chan;
	case 17: /* channels 149,153,157,161,165,169 */
		if (chan < 149 || chan > 169)
			return -1;
		return 5000 + 5 * chan;
	case 18: /* 60 GHz band, channels 1..6 */
		if (chan < 1 || chan > 6)
			return -1;
		return 56160 + 2160 * chan;
	case 21: /* 60 GHz band, EDMG CB2, channels 9..11 */
		if (chan < 9 || chan > 11)
			return -1;
		return 56160 + 2160 * (chan - 8);
	case 22: /* 60 GHz band, EDMG CB3, channels 17..18 */
		if (chan < 17 || chan > 18)
			return -1;
		return 56160 + 2160 * (chan - 16);
	case 23: /* 60 GHz band, EDMG CB4, channels 25 */
		if (chan != 25)
			return -1;
		return 56160 + 2160 * (chan - 24);
	default:
		return -1;
	}
}


static int ieee80211_chan_to_freq_jp(u8 op_class, u8 chan)
{
	/* Table E-3 in IEEE Std 802.11-2020 - Operating classes in Japan */
	switch (op_class) {
	case 30: /* channels 1..13 */
	case 56: /* channels 1..9; 40 MHz */
	case 57: /* channels 5..13; 40 MHz */
		if (chan < 1 || chan > 13)
			return -1;
		return 2407 + 5 * chan;
	case 31: /* channel 14 */
		if (chan != 14)
			return -1;
		return 2414 + 5 * chan;
	case 1: /* channels 34,38,42,46(old) or 36,40,44,48 */
	case 32: /* channels 52,56,60,64 */
	case 33: /* channels 52,56,60,64 */
	case 36: /* channels 36,44; 40 MHz */
	case 37: /* channels 52,60; 40 MHz */
	case 38: /* channels 52,60; 40 MHz */
	case 41: /* channels 40,48; 40 MHz */
	case 42: /* channels 56,64; 40 MHz */
	case 43: /* channels 56,64; 40 MHz */
		if (chan < 34 || chan > 64)
			return -1;
		return 5000 + 5 * chan;
	case 34: /* channels 100-144 */
	case 35: /* reserved */
	case 39: /* channels 100-140; 40 MHz */
	case 40: /* reserved */
	case 44: /* channels 104-144; 40 MHz */
	case 45: /* reserved */
	case 58: /* channels 100-144 */
		if (chan < 100 || chan > 144)
			return -1;
		return 5000 + 5 * chan;
	case 59: /* 60 GHz band, channels 1..6 */
		if (chan < 1 || chan > 6)
			return -1;
		return 56160 + 2160 * chan;
	case 62: /* 60 GHz band, EDMG CB2, channels 9..11 */
		if (chan < 9 || chan > 11)
			return -1;
		return 56160 + 2160 * (chan - 8);
	case 63: /* 60 GHz band, EDMG CB3, channels 17..18 */
		if (chan < 17 || chan > 18)
			return -1;
		return 56160 + 2160 * (chan - 16);
	case 64: /* 60 GHz band, EDMG CB4, channel 25 */
		if (chan != 25)
			return -1;
		return 56160 + 2160 * (chan - 24);
	default:
		return -1;
	}
}


static int ieee80211_chan_to_freq_cn(u8 op_class, u8 chan)
{
	switch (op_class) {
	case 7: /* channels 1..13 */
	case 8: /* channels 1..9; 40 MHz */
	case 9: /* channels 5..13; 40 MHz */
		if (chan < 1 || chan > 13)
			return -1;
		return 2407 + 5 * chan;
	case 1: /* channels 36,40,44,48 */
	case 2: /* channels 52,56,60,64; dfs */
	case 4: /* channels 36,44; 40 MHz */
	case 5: /* channels 52,60; 40 MHz */
		if (chan < 36 || chan > 64)
			return -1;
		return 5000 + 5 * chan;
	case 3: /* channels 149,153,157,161,165 */
	case 6: /* channels 149,157; 40 MHz */
		if (chan < 149 || chan > 165)
			return -1;
		return 5000 + 5 * chan;
	default:
		return -1;
	}
}


static int ieee80211_chan_to_freq_global(u8 op_class, u8 chan)
{
	/* Table E-4 in IEEE Std 802.11-2020 - Global operating classes */
	switch (op_class) {
	case 81:
		/* channels 1..13 */
		if (chan < 1 || chan > 13)
			return -1;
		return 2407 + 5 * chan;
	case 82:
		/* channel 14 */
		if (chan != 14)
			return -1;
		return 2414 + 5 * chan;
	case 83: /* channels 1..9; 40 MHz */
	case 84: /* channels 5..13; 40 MHz */
		if (chan < 1 || chan > 13)
			return -1;
		return 2407 + 5 * chan;
	case 115: /* channels 36,40,44,48; indoor only */
	case 116: /* channels 36,44; 40 MHz; indoor only */
	case 117: /* channels 40,48; 40 MHz; indoor only */
	case 118: /* channels 52,56,60,64; dfs */
	case 119: /* channels 52,60; 40 MHz; dfs */
	case 120: /* channels 56,64; 40 MHz; dfs */
		if (chan < 36 || chan > 64)
			return -1;
		return 5000 + 5 * chan;
	case 121: /* channels 100-144 */
	case 122: /* channels 100-140; 40 MHz */
	case 123: /* channels 104-144; 40 MHz */
		if (chan < 100 || chan > 144)
			return -1;
		return 5000 + 5 * chan;
	case 124: /* channels 149,153,157,161 */
		if (chan < 149 || chan > 161)
			return -1;
		return 5000 + 5 * chan;
	case 125: /* channels 149,153,157,161,165,169,173,177 */
	case 126: /* channels 149,157,165,173; 40 MHz */
	case 127: /* channels 153,161,169,177; 40 MHz */
		if (chan < 149 || chan > 177)
			return -1;
		return 5000 + 5 * chan;
	case 128: /* center freqs 42, 58, 106, 122, 138, 155, 171; 80 MHz */
	case 130: /* center freqs 42, 58, 106, 122, 138, 155, 171; 80 MHz */
		if (chan < 36 || chan > 177)
			return -1;
		return 5000 + 5 * chan;
	case 129: /* center freqs 50, 114, 163; 160 MHz */
		if (chan < 36 || chan > 177)
			return -1;
		return 5000 + 5 * chan;
	case 131: /* UHB channels, 20 MHz: 1, 5, 9.. */
	case 132: /* UHB channels, 40 MHz: 3, 11, 19.. */
	case 133: /* UHB channels, 80 MHz: 7, 23, 39.. */
	case 134: /* UHB channels, 160 MHz: 15, 47, 79.. */
	case 135: /* UHB channels, 80+80 MHz: 7, 23, 39.. */
	case 137: /* UHB channels, 320 MHz: 31, 63, 95, 127, 159, 191 */
		if (chan < 1 || chan > 233)
			return -1;
		return 5950 + chan * 5;
	case 136: /* UHB channels, 20 MHz: 2 */
		if (chan == 2)
			return 5935;
		return -1;
	case 180: /* 60 GHz band, channels 1..8 */
		if (chan < 1 || chan > 8)
			return -1;
		return 56160 + 2160 * chan;
	case 181: /* 60 GHz band, EDMG CB2, channels 9..15 */
		if (chan < 9 || chan > 15)
			return -1;
		return 56160 + 2160 * (chan - 8);
	case 182: /* 60 GHz band, EDMG CB3, channels 17..22 */
		if (chan < 17 || chan > 22)
			return -1;
		return 56160 + 2160 * (chan - 16);
	case 183: /* 60 GHz band, EDMG CB4, channel 25..29 */
		if (chan < 25 || chan > 29)
			return -1;
		return 56160 + 2160 * (chan - 24);
	default:
		return -1;
	}
}

/**
 * ieee80211_chan_to_freq - Convert channel info to frequency
 * @country: Country code, if known; otherwise, global operating class is used
 * @op_class: Operating class
 * @chan: Channel number
 * Returns: Frequency in MHz or -1 if the specified channel is unknown
 */
int ieee80211_chan_to_freq(const char *country, u8 op_class, u8 chan)
{
	int freq;

	if (country_match(us_op_class_cc, country)) {
		freq = ieee80211_chan_to_freq_us(op_class, chan);
		if (freq > 0)
			return freq;
	}

	if (country_match(eu_op_class_cc, country)) {
		freq = ieee80211_chan_to_freq_eu(op_class, chan);
		if (freq > 0)
			return freq;
	}

	if (country_match(jp_op_class_cc, country)) {
		freq = ieee80211_chan_to_freq_jp(op_class, chan);
		if (freq > 0)
			return freq;
	}

	if (country_match(cn_op_class_cc, country)) {
		freq = ieee80211_chan_to_freq_cn(op_class, chan);
		if (freq > 0)
			return freq;
	}

	return ieee80211_chan_to_freq_global(op_class, chan);
}


int ieee80211_is_dfs(int freq, const struct hostapd_hw_modes *modes,
		     u16 num_modes)
{
	int i, j;

	if (!modes || !num_modes)
		return (freq >= 5260 && freq <= 5320) ||
			(freq >= 5500 && freq <= 5720);

	for (i = 0; i < num_modes; i++) {
		for (j = 0; j < modes[i].num_channels; j++) {
			if (modes[i].channels[j].freq == freq &&
			    (modes[i].channels[j].flag & HOSTAPD_CHAN_RADAR))
				return 1;
		}
	}

	return 0;
}


/*
 * 802.11-2020: Table E-4 - Global operating classes
 * DFS_50_100_Behavior: 118, 119, 120, 121, 122, 123
 */
int is_dfs_global_op_class(u8 op_class)
{
    return (op_class >= 118) && (op_class <= 123);
}


bool is_80plus_op_class(u8 op_class)
{
	/* Operating classes with "80+" behavior indication in Table E-4 */
	return op_class == 130 || op_class == 135;
}


static int is_11b(u8 rate)
{
	return rate == 0x02 || rate == 0x04 || rate == 0x0b || rate == 0x16
		|| rate == 0x82 || rate == 0x84 || rate == 0x8b || rate == 0x96;
}


int supp_rates_11b_only(struct ieee802_11_elems *elems)
{
	int num_11b = 0, num_others = 0;
	int i;

	if (elems->supp_rates == NULL && elems->ext_supp_rates == NULL)
		return 0;

	for (i = 0; elems->supp_rates && i < elems->supp_rates_len; i++) {
		if (is_11b(elems->supp_rates[i]))
			num_11b++;
		else
			num_others++;
	}

	for (i = 0; elems->ext_supp_rates && i < elems->ext_supp_rates_len;
	     i++) {
		if (is_11b(elems->ext_supp_rates[i]))
			num_11b++;
		else
			num_others++;
	}

	return num_11b > 0 && num_others == 0;
}


const char * fc2str(u16 fc)
{
	u16 stype = WLAN_FC_GET_STYPE(fc);
#define C2S(x) case x: return #x;

	switch (WLAN_FC_GET_TYPE(fc)) {
	case WLAN_FC_TYPE_MGMT:
		switch (stype) {
		C2S(WLAN_FC_STYPE_ASSOC_REQ)
		C2S(WLAN_FC_STYPE_ASSOC_RESP)
		C2S(WLAN_FC_STYPE_REASSOC_REQ)
		C2S(WLAN_FC_STYPE_REASSOC_RESP)
		C2S(WLAN_FC_STYPE_PROBE_REQ)
		C2S(WLAN_FC_STYPE_PROBE_RESP)
		C2S(WLAN_FC_STYPE_BEACON)
		C2S(WLAN_FC_STYPE_ATIM)
		C2S(WLAN_FC_STYPE_DISASSOC)
		C2S(WLAN_FC_STYPE_AUTH)
		C2S(WLAN_FC_STYPE_DEAUTH)
		C2S(WLAN_FC_STYPE_ACTION)
		}
		break;
	case WLAN_FC_TYPE_CTRL:
		switch (stype) {
		C2S(WLAN_FC_STYPE_PSPOLL)
		C2S(WLAN_FC_STYPE_RTS)
		C2S(WLAN_FC_STYPE_CTS)
		C2S(WLAN_FC_STYPE_ACK)
		C2S(WLAN_FC_STYPE_CFEND)
		C2S(WLAN_FC_STYPE_CFENDACK)
		}
		break;
	case WLAN_FC_TYPE_DATA:
		switch (stype) {
		C2S(WLAN_FC_STYPE_DATA)
		C2S(WLAN_FC_STYPE_DATA_CFACK)
		C2S(WLAN_FC_STYPE_DATA_CFPOLL)
		C2S(WLAN_FC_STYPE_DATA_CFACKPOLL)
		C2S(WLAN_FC_STYPE_NULLFUNC)
		C2S(WLAN_FC_STYPE_CFACK)
		C2S(WLAN_FC_STYPE_CFPOLL)
		C2S(WLAN_FC_STYPE_CFACKPOLL)
		C2S(WLAN_FC_STYPE_QOS_DATA)
		C2S(WLAN_FC_STYPE_QOS_DATA_CFACK)
		C2S(WLAN_FC_STYPE_QOS_DATA_CFPOLL)
		C2S(WLAN_FC_STYPE_QOS_DATA_CFACKPOLL)
		C2S(WLAN_FC_STYPE_QOS_NULL)
		C2S(WLAN_FC_STYPE_QOS_CFPOLL)
		C2S(WLAN_FC_STYPE_QOS_CFACKPOLL)
		}
		break;
	}
	return "WLAN_FC_TYPE_UNKNOWN";
#undef C2S
}


const char * reason2str(u16 reason)
{
#define R2S(r) case WLAN_REASON_ ## r: return #r;
	switch (reason) {
	R2S(UNSPECIFIED)
	R2S(PREV_AUTH_NOT_VALID)
	R2S(DEAUTH_LEAVING)
	R2S(DISASSOC_DUE_TO_INACTIVITY)
	R2S(DISASSOC_AP_BUSY)
	R2S(CLASS2_FRAME_FROM_NONAUTH_STA)
	R2S(CLASS3_FRAME_FROM_NONASSOC_STA)
	R2S(DISASSOC_STA_HAS_LEFT)
	R2S(STA_REQ_ASSOC_WITHOUT_AUTH)
	R2S(PWR_CAPABILITY_NOT_VALID)
	R2S(SUPPORTED_CHANNEL_NOT_VALID)
	R2S(BSS_TRANSITION_DISASSOC)
	R2S(INVALID_IE)
	R2S(MICHAEL_MIC_FAILURE)
	R2S(4WAY_HANDSHAKE_TIMEOUT)
	R2S(GROUP_KEY_UPDATE_TIMEOUT)
	R2S(IE_IN_4WAY_DIFFERS)
	R2S(GROUP_CIPHER_NOT_VALID)
	R2S(PAIRWISE_CIPHER_NOT_VALID)
	R2S(AKMP_NOT_VALID)
	R2S(UNSUPPORTED_RSN_IE_VERSION)
	R2S(INVALID_RSN_IE_CAPAB)
	R2S(IEEE_802_1X_AUTH_FAILED)
	R2S(CIPHER_SUITE_REJECTED)
	R2S(TDLS_TEARDOWN_UNREACHABLE)
	R2S(TDLS_TEARDOWN_UNSPECIFIED)
	R2S(SSP_REQUESTED_DISASSOC)
	R2S(NO_SSP_ROAMING_AGREEMENT)
	R2S(BAD_CIPHER_OR_AKM)
	R2S(NOT_AUTHORIZED_THIS_LOCATION)
	R2S(SERVICE_CHANGE_PRECLUDES_TS)
	R2S(UNSPECIFIED_QOS_REASON)
	R2S(NOT_ENOUGH_BANDWIDTH)
	R2S(DISASSOC_LOW_ACK)
	R2S(EXCEEDED_TXOP)
	R2S(STA_LEAVING)
	R2S(END_TS_BA_DLS)
	R2S(UNKNOWN_TS_BA)
	R2S(TIMEOUT)
	R2S(PEERKEY_MISMATCH)
	R2S(AUTHORIZED_ACCESS_LIMIT_REACHED)
	R2S(EXTERNAL_SERVICE_REQUIREMENTS)
	R2S(INVALID_FT_ACTION_FRAME_COUNT)
	R2S(INVALID_PMKID)
	R2S(INVALID_MDE)
	R2S(INVALID_FTE)
	R2S(MESH_PEERING_CANCELLED)
	R2S(MESH_MAX_PEERS)
	R2S(MESH_CONFIG_POLICY_VIOLATION)
	R2S(MESH_CLOSE_RCVD)
	R2S(MESH_MAX_RETRIES)
	R2S(MESH_CONFIRM_TIMEOUT)
	R2S(MESH_INVALID_GTK)
	R2S(MESH_INCONSISTENT_PARAMS)
	R2S(MESH_INVALID_SECURITY_CAP)
	R2S(MESH_PATH_ERROR_NO_PROXY_INFO)
	R2S(MESH_PATH_ERROR_NO_FORWARDING_INFO)
	R2S(MESH_PATH_ERROR_DEST_UNREACHABLE)
	R2S(MAC_ADDRESS_ALREADY_EXISTS_IN_MBSS)
	R2S(MESH_CHANNEL_SWITCH_REGULATORY_REQ)
	R2S(MESH_CHANNEL_SWITCH_UNSPECIFIED)
	}
	return "UNKNOWN";
#undef R2S
}


const char * status2str(u16 status)
{
#define S2S(s) case WLAN_STATUS_ ## s: return #s;
	switch (status) {
	S2S(SUCCESS)
	S2S(UNSPECIFIED_FAILURE)
	S2S(TDLS_WAKEUP_ALTERNATE)
	S2S(TDLS_WAKEUP_REJECT)
	S2S(SECURITY_DISABLED)
	S2S(UNACCEPTABLE_LIFETIME)
	S2S(NOT_IN_SAME_BSS)
	S2S(CAPS_UNSUPPORTED)
	S2S(REASSOC_NO_ASSOC)
	S2S(ASSOC_DENIED_UNSPEC)
	S2S(NOT_SUPPORTED_AUTH_ALG)
	S2S(UNKNOWN_AUTH_TRANSACTION)
	S2S(CHALLENGE_FAIL)
	S2S(AUTH_TIMEOUT)
	S2S(AP_UNABLE_TO_HANDLE_NEW_STA)
	S2S(ASSOC_DENIED_RATES)
	S2S(ASSOC_DENIED_NOSHORT)
	S2S(SPEC_MGMT_REQUIRED)
	S2S(PWR_CAPABILITY_NOT_VALID)
	S2S(SUPPORTED_CHANNEL_NOT_VALID)
	S2S(ASSOC_DENIED_NO_SHORT_SLOT_TIME)
	S2S(ASSOC_DENIED_NO_HT)
	S2S(R0KH_UNREACHABLE)
	S2S(ASSOC_DENIED_NO_PCO)
	S2S(ASSOC_REJECTED_TEMPORARILY)
	S2S(ROBUST_MGMT_FRAME_POLICY_VIOLATION)
	S2S(UNSPECIFIED_QOS_FAILURE)
	S2S(DENIED_INSUFFICIENT_BANDWIDTH)
	S2S(DENIED_POOR_CHANNEL_CONDITIONS)
	S2S(DENIED_QOS_NOT_SUPPORTED)
	S2S(REQUEST_DECLINED)
	S2S(INVALID_PARAMETERS)
	S2S(REJECTED_WITH_SUGGESTED_CHANGES)
	S2S(INVALID_IE)
	S2S(GROUP_CIPHER_NOT_VALID)
	S2S(PAIRWISE_CIPHER_NOT_VALID)
	S2S(AKMP_NOT_VALID)
	S2S(UNSUPPORTED_RSN_IE_VERSION)
	S2S(INVALID_RSN_IE_CAPAB)
	S2S(CIPHER_REJECTED_PER_POLICY)
	S2S(TS_NOT_CREATED)
	S2S(DIRECT_LINK_NOT_ALLOWED)
	S2S(DEST_STA_NOT_PRESENT)
	S2S(DEST_STA_NOT_QOS_STA)
	S2S(ASSOC_DENIED_LISTEN_INT_TOO_LARGE)
	S2S(INVALID_FT_ACTION_FRAME_COUNT)
	S2S(INVALID_PMKID)
	S2S(INVALID_MDIE)
	S2S(INVALID_FTIE)
	S2S(REQUESTED_TCLAS_NOT_SUPPORTED)
	S2S(INSUFFICIENT_TCLAS_PROCESSING_RESOURCES)
	S2S(TRY_ANOTHER_BSS)
	S2S(GAS_ADV_PROTO_NOT_SUPPORTED)
	S2S(NO_OUTSTANDING_GAS_REQ)
	S2S(GAS_RESP_NOT_RECEIVED)
	S2S(STA_TIMED_OUT_WAITING_FOR_GAS_RESP)
	S2S(GAS_RESP_LARGER_THAN_LIMIT)
	S2S(REQ_REFUSED_HOME)
	S2S(ADV_SRV_UNREACHABLE)
	S2S(REQ_REFUSED_SSPN)
	S2S(REQ_REFUSED_UNAUTH_ACCESS)
	S2S(INVALID_RSNIE)
	S2S(U_APSD_COEX_NOT_SUPPORTED)
	S2S(U_APSD_COEX_MODE_NOT_SUPPORTED)
	S2S(BAD_INTERVAL_WITH_U_APSD_COEX)
	S2S(ANTI_CLOGGING_TOKEN_REQ)
	S2S(FINITE_CYCLIC_GROUP_NOT_SUPPORTED)
	S2S(CANNOT_FIND_ALT_TBTT)
	S2S(TRANSMISSION_FAILURE)
	S2S(REQ_TCLAS_NOT_SUPPORTED)
	S2S(TCLAS_RESOURCES_EXCHAUSTED)
	S2S(REJECTED_WITH_SUGGESTED_BSS_TRANSITION)
	S2S(REJECT_WITH_SCHEDULE)
	S2S(REJECT_NO_WAKEUP_SPECIFIED)
	S2S(SUCCESS_POWER_SAVE_MODE)
	S2S(PENDING_ADMITTING_FST_SESSION)
	S2S(PERFORMING_FST_NOW)
	S2S(PENDING_GAP_IN_BA_WINDOW)
	S2S(REJECT_U_PID_SETTING)
	S2S(REFUSED_EXTERNAL_REASON)
	S2S(REFUSED_AP_OUT_OF_MEMORY)
	S2S(REJECTED_EMERGENCY_SERVICE_NOT_SUPPORTED)
	S2S(QUERY_RESP_OUTSTANDING)
	S2S(REJECT_DSE_BAND)
	S2S(TCLAS_PROCESSING_TERMINATED)
	S2S(TS_SCHEDULE_CONFLICT)
	S2S(DENIED_WITH_SUGGESTED_BAND_AND_CHANNEL)
	S2S(MCCAOP_RESERVATION_CONFLICT)
	S2S(MAF_LIMIT_EXCEEDED)
	S2S(MCCA_TRACK_LIMIT_EXCEEDED)
	S2S(DENIED_DUE_TO_SPECTRUM_MANAGEMENT)
	S2S(ASSOC_DENIED_NO_VHT)
	S2S(ENABLEMENT_DENIED)
	S2S(RESTRICTION_FROM_AUTHORIZED_GDB)
	S2S(AUTHORIZATION_DEENABLED)
	S2S(FILS_AUTHENTICATION_FAILURE)
	S2S(UNKNOWN_AUTHENTICATION_SERVER)
	S2S(UNKNOWN_PASSWORD_IDENTIFIER)
	S2S(DENIED_HE_NOT_SUPPORTED)
	S2S(SAE_HASH_TO_ELEMENT)
	S2S(SAE_PK)
	S2S(INVALID_PUBLIC_KEY)
	S2S(PASN_BASE_AKMP_FAILED)
	S2S(OCI_MISMATCH)
	}
	return "UNKNOWN";
#undef S2S
}


int mb_ies_info_by_ies(struct mb_ies_info *info, const u8 *ies_buf,
		       size_t ies_len)
{
	const struct element *elem;

	os_memset(info, 0, sizeof(*info));

	if (!ies_buf)
		return 0;

	for_each_element_id(elem, WLAN_EID_MULTI_BAND, ies_buf, ies_len) {
		if (info->nof_ies >= MAX_NOF_MB_IES_SUPPORTED)
			return 0;

		wpa_printf(MSG_DEBUG, "MB IE of %u bytes found",
			   elem->datalen + 2);
		info->ies[info->nof_ies].ie = elem->data;
		info->ies[info->nof_ies].ie_len = elem->datalen;
		info->nof_ies++;
	}

	if (!for_each_element_completed(elem, ies_buf, ies_len)) {
		wpa_hexdump(MSG_DEBUG, "Truncated IEs", ies_buf, ies_len);
		return -1;
	}

	return 0;
}


struct wpabuf * mb_ies_by_info(struct mb_ies_info *info)
{
	struct wpabuf *mb_ies = NULL;

	WPA_ASSERT(info != NULL);

	if (info->nof_ies) {
		u8 i;
		size_t mb_ies_size = 0;

		for (i = 0; i < info->nof_ies; i++)
			mb_ies_size += 2 + info->ies[i].ie_len;

		mb_ies = wpabuf_alloc(mb_ies_size);
		if (mb_ies) {
			for (i = 0; i < info->nof_ies; i++) {
				wpabuf_put_u8(mb_ies, WLAN_EID_MULTI_BAND);
				wpabuf_put_u8(mb_ies, info->ies[i].ie_len);
				wpabuf_put_data(mb_ies,
						info->ies[i].ie,
						info->ies[i].ie_len);
			}
		}
	}

	return mb_ies;
}


const struct oper_class_map global_op_class[] = {
	{ HOSTAPD_MODE_IEEE80211G, 81, 1, 13, 1, BW20, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211G, 82, 14, 14, 1, BW20, NO_P2P_SUPP },

	/* Do not enable HT40 on 2.4 GHz for P2P use for now */
	{ HOSTAPD_MODE_IEEE80211G, 83, 1, 9, 1, BW40PLUS, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211G, 84, 5, 13, 1, BW40MINUS, NO_P2P_SUPP },

	{ HOSTAPD_MODE_IEEE80211A, 115, 36, 48, 4, BW20, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 116, 36, 44, 8, BW40PLUS, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 117, 40, 48, 8, BW40MINUS, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 118, 52, 64, 4, BW20, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 119, 52, 60, 8, BW40PLUS, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 120, 56, 64, 8, BW40MINUS, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 121, 100, 144, 4, BW20, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 122, 100, 140, 8, BW40PLUS, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 123, 104, 144, 8, BW40MINUS, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 124, 149, 161, 4, BW20, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 125, 149, 177, 4, BW20, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 126, 149, 173, 8, BW40PLUS, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 127, 153, 177, 8, BW40MINUS, P2P_SUPP },

	/*
	 * IEEE Std 802.11ax-2021, Table E-4 actually talks about channel center
	 * frequency index for operation classes 128, 129, 130, 132, 133, 134,
	 * and 135, but currently use the lowest 20 MHz channel for simplicity
	 * (these center frequencies are not actual channels, which makes
	 * wpas_p2p_verify_channel() fail).
	 * Specially for the operation class 136, it is also defined to use the
	 * channel center frequency index value, but it happens to be a 20 MHz
	 * channel and the channel number in the channel set would match the
	 * value in for the frequency center.
	 *
	 * Operating class value pair 128 and 130 is used to describe a 80+80
	 * MHz channel on the 5 GHz band. 130 is identified with "80+", so this
	 * is encoded with two octets 130 and 128. Similarly, operating class
	 * value pair 133 and 135 is used to describe a 80+80 MHz channel on
	 * the 6 GHz band (135 being the one with "80+" indication). All other
	 * operating classes listed here are used as 1-octet values.
	 */
	{ HOSTAPD_MODE_IEEE80211A, 128, 36, 177, 4, BW80, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 129, 36, 177, 4, BW160, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 130, 36, 177, 4, BW80P80, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 131, 1, 233, 4, BW20, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 132, 1, 233, 8, BW40, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 133, 1, 233, 16, BW80, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 134, 1, 233, 32, BW160, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 135, 1, 233, 16, BW80P80, NO_P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211A, 136, 2, 2, 4, BW20, NO_P2P_SUPP },

	/* IEEE P802.11be/D5.0, Table E-4 (Global operating classes) */
	{ HOSTAPD_MODE_IEEE80211A, 137, 31, 191, 32, BW320, NO_P2P_SUPP },

	/*
	 * IEEE Std 802.11ad-2012 and P802.ay/D5.0 60 GHz operating classes.
	 * Class 180 has the legacy channels 1-6. Classes 181-183 include
	 * channels which implement channel bonding features.
	 */
	{ HOSTAPD_MODE_IEEE80211AD, 180, 1, 6, 1, BW2160, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211AD, 181, 9, 13, 1, BW4320, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211AD, 182, 17, 20, 1, BW6480, P2P_SUPP },
	{ HOSTAPD_MODE_IEEE80211AD, 183, 25, 27, 1, BW8640, P2P_SUPP },

	{ -1, 0, 0, 0, 0, BW20, NO_P2P_SUPP }
};


static enum phy_type ieee80211_phy_type_by_freq(int freq)
{
	enum hostapd_hw_mode hw_mode;
	u8 channel;

	hw_mode = ieee80211_freq_to_chan(freq, &channel);

	switch (hw_mode) {
	case HOSTAPD_MODE_IEEE80211A:
		return PHY_TYPE_OFDM;
	case HOSTAPD_MODE_IEEE80211B:
		return PHY_TYPE_HRDSSS;
	case HOSTAPD_MODE_IEEE80211G:
		return PHY_TYPE_ERP;
	case HOSTAPD_MODE_IEEE80211AD:
		return PHY_TYPE_DMG;
	default:
		return PHY_TYPE_UNSPECIFIED;
	};
}


/* ieee80211_get_phy_type - Derive the phy type by freq and bandwidth */
enum phy_type ieee80211_get_phy_type(int freq, int ht, int vht)
{
	if (vht)
		return PHY_TYPE_VHT;
	if (ht)
		return PHY_TYPE_HT;

	return ieee80211_phy_type_by_freq(freq);
}


size_t global_op_class_size = ARRAY_SIZE(global_op_class);


/**
 * get_ie - Fetch a specified information element from IEs buffer
 * @ies: Information elements buffer
 * @len: Information elements buffer length
 * @eid: Information element identifier (WLAN_EID_*)
 * Returns: Pointer to the information element (id field) or %NULL if not found
 *
 * This function returns the first matching information element in the IEs
 * buffer or %NULL in case the element is not found.
 */
const u8 * get_ie(const u8 *ies, size_t len, u8 eid)
{
	const struct element *elem;

	if (!ies)
		return NULL;

	for_each_element_id(elem, eid, ies, len)
		return &elem->id;

	return NULL;
}


/**
 * get_ie_ext - Fetch a specified extended information element from IEs buffer
 * @ies: Information elements buffer
 * @len: Information elements buffer length
 * @ext: Information element extension identifier (WLAN_EID_EXT_*)
 * Returns: Pointer to the information element (id field) or %NULL if not found
 *
 * This function returns the first matching information element in the IEs
 * buffer or %NULL in case the element is not found.
 */
const u8 * get_ie_ext(const u8 *ies, size_t len, u8 ext)
{
	const struct element *elem;

	if (!ies)
		return NULL;

	for_each_element_extid(elem, ext, ies, len)
		return &elem->id;

	return NULL;
}


const u8 * get_vendor_ie(const u8 *ies, size_t len, u32 vendor_type)
{
	const struct element *elem;

	for_each_element_id(elem, WLAN_EID_VENDOR_SPECIFIC, ies, len) {
		if (elem->datalen >= 4 &&
		    vendor_type == WPA_GET_BE32(elem->data))
			return &elem->id;
	}

	return NULL;
}


size_t mbo_add_ie(u8 *buf, size_t len, const u8 *attr, size_t attr_len)
{
	/*
	 * MBO IE requires 6 bytes without the attributes: EID (1), length (1),
	 * OUI (3), OUI type (1).
	 */
	if (len < 6 + attr_len) {
		wpa_printf(MSG_DEBUG,
			   "MBO: Not enough room in buffer for MBO IE: buf len = %zu, attr_len = %zu",
			   len, attr_len);
		return 0;
	}

	*buf++ = WLAN_EID_VENDOR_SPECIFIC;
	*buf++ = attr_len + 4;
	WPA_PUT_BE24(buf, OUI_WFA);
	buf += 3;
	*buf++ = MBO_OUI_TYPE;
	os_memcpy(buf, attr, attr_len);

	return 6 + attr_len;
}


u16 check_multi_ap_ie(const u8 *multi_ap_ie, size_t multi_ap_len,
		      struct multi_ap_params *multi_ap)
{
	const struct element *elem;
	bool ext_present = false;
	unsigned int vlan_id;

	os_memset(multi_ap, 0, sizeof(*multi_ap));

	/* Default profile is 1, when Multi-AP profile subelement is not
	 * present in the element. */
	multi_ap->profile = 1;

	for_each_element(elem, multi_ap_ie, multi_ap_len) {
		u8 id = elem->id, elen = elem->datalen;
		const u8 *pos = elem->data;

		switch (id) {
		case MULTI_AP_SUB_ELEM_TYPE:
			if (elen >= 1) {
				multi_ap->capability = *pos;
				ext_present = true;
			} else {
				wpa_printf(MSG_DEBUG,
					   "Multi-AP invalid Multi-AP subelement");
				return WLAN_STATUS_INVALID_IE;
			}
			break;
		case MULTI_AP_PROFILE_SUB_ELEM_TYPE:
			if (elen < 1) {
				wpa_printf(MSG_DEBUG,
					   "Multi-AP IE invalid Multi-AP profile subelement");
				return WLAN_STATUS_INVALID_IE;
			}

			multi_ap->profile = *pos;
			if (multi_ap->profile > MULTI_AP_PROFILE_MAX) {
				wpa_printf(MSG_DEBUG,
					   "Multi-AP IE with invalid profile 0x%02x",
					   multi_ap->profile);
				return WLAN_STATUS_ASSOC_DENIED_UNSPEC;
			}
			break;
		case MULTI_AP_VLAN_SUB_ELEM_TYPE:
			if (multi_ap->profile < MULTI_AP_PROFILE_2) {
				wpa_printf(MSG_DEBUG,
					   "Multi-AP IE invalid profile to read VLAN IE");
				return WLAN_STATUS_INVALID_IE;
			}
			if (elen < 2) {
				wpa_printf(MSG_DEBUG,
					   "Multi-AP IE invalid Multi-AP VLAN subelement");
				return WLAN_STATUS_INVALID_IE;
			}

			vlan_id = WPA_GET_LE16(pos);
			if (vlan_id < 1 || vlan_id > 4094) {
				wpa_printf(MSG_INFO,
					   "Multi-AP IE invalid Multi-AP VLAN ID %d",
					   vlan_id);
				return WLAN_STATUS_INVALID_IE;
			}
			multi_ap->vlanid = vlan_id;
			break;
		default:
			wpa_printf(MSG_DEBUG,
				   "Ignore unknown subelement %u in Multi-AP IE",
				   id);
			break;
		}
	}

	if (!for_each_element_completed(elem, multi_ap_ie, multi_ap_len)) {
		wpa_printf(MSG_DEBUG, "Multi AP IE parse failed @%d",
			   (int) (multi_ap_ie + multi_ap_len -
				  (const u8 *) elem));
		wpa_hexdump(MSG_MSGDUMP, "IEs", multi_ap_ie, multi_ap_len);
	}

	if (!ext_present) {
		wpa_printf(MSG_DEBUG,
			   "Multi-AP element without Multi-AP Extension subelement");
		return WLAN_STATUS_INVALID_IE;
	}

	return WLAN_STATUS_SUCCESS;
}


size_t add_multi_ap_ie(u8 *buf, size_t len,
		       const struct multi_ap_params *multi_ap)
{
	u8 *pos = buf;
	u8 *len_ptr;

	if (len < 6)
		return 0;

	*pos++ = WLAN_EID_VENDOR_SPECIFIC;
	len_ptr = pos; /* Length field to be set at the end */
	pos++;
	WPA_PUT_BE24(pos, OUI_WFA);
	pos += 3;
	*pos++ = MULTI_AP_OUI_TYPE;

	/* Multi-AP Extension subelement */
	if (buf + len - pos < 3)
		return 0;
	*pos++ = MULTI_AP_SUB_ELEM_TYPE;
	*pos++ = 1; /* len */
	*pos++ = multi_ap->capability;

	/* Add Multi-AP Profile subelement only for R2 or newer configuration */
	if (multi_ap->profile >= MULTI_AP_PROFILE_2) {
		if (buf + len - pos < 3)
			return 0;
		*pos++ = MULTI_AP_PROFILE_SUB_ELEM_TYPE;
		*pos++ = 1;
		*pos++ = multi_ap->profile;
	}

	/* Add Multi-AP Default 802.1Q Setting subelement only for backhaul BSS
	 */
	if (multi_ap->vlanid &&
	    multi_ap->profile >= MULTI_AP_PROFILE_2 &&
	    (multi_ap->capability & MULTI_AP_BACKHAUL_BSS)) {
		if (buf + len - pos < 4)
			return 0;
		*pos++ = MULTI_AP_VLAN_SUB_ELEM_TYPE;
		*pos++ = 2;
		WPA_PUT_LE16(pos, multi_ap->vlanid);
		pos += 2;
	}

	*len_ptr = pos - len_ptr - 1;

	return pos - buf;
}


static const struct country_op_class us_op_class[] = {
	{ 1, 115 },
	{ 2, 118 },
	{ 3, 124 },
	{ 4, 121 },
	{ 5, 125 },
	{ 12, 81 },
	{ 22, 116 },
	{ 23, 119 },
	{ 24, 122 },
	{ 25, 126 },
	{ 26, 126 },
	{ 27, 117 },
	{ 28, 120 },
	{ 29, 123 },
	{ 30, 127 },
	{ 31, 127 },
	{ 32, 83 },
	{ 33, 84 },
	{ 34, 180 },
};

static const struct country_op_class eu_op_class[] = {
	{ 1, 115 },
	{ 2, 118 },
	{ 3, 121 },
	{ 4, 81 },
	{ 5, 116 },
	{ 6, 119 },
	{ 7, 122 },
	{ 8, 117 },
	{ 9, 120 },
	{ 10, 123 },
	{ 11, 83 },
	{ 12, 84 },
	{ 17, 125 },
	{ 18, 180 },
};

static const struct country_op_class jp_op_class[] = {
	{ 1, 115 },
	{ 30, 81 },
	{ 31, 82 },
	{ 32, 118 },
	{ 33, 118 },
	{ 34, 121 },
	{ 35, 121 },
	{ 36, 116 },
	{ 37, 119 },
	{ 38, 119 },
	{ 39, 122 },
	{ 40, 122 },
	{ 41, 117 },
	{ 42, 120 },
	{ 43, 120 },
	{ 44, 123 },
	{ 45, 123 },
	{ 56, 83 },
	{ 57, 84 },
	{ 58, 121 },
	{ 59, 180 },
};

static const struct country_op_class cn_op_class[] = {
	{ 1, 115 },
	{ 2, 118 },
	{ 3, 125 },
	{ 4, 116 },
	{ 5, 119 },
	{ 6, 126 },
	{ 7, 81 },
	{ 8, 83 },
	{ 9, 84 },
};

static u8
global_op_class_from_country_array(u8 op_class, size_t array_size,
				   const struct country_op_class *country_array)
{
	size_t i;

	for (i = 0; i < array_size; i++) {
		if (country_array[i].country_op_class == op_class)
			return country_array[i].global_op_class;
	}

	return 0;
}


u8 country_to_global_op_class(const char *country, u8 op_class)
{
	const struct country_op_class *country_array;
	size_t size;
	u8 g_op_class;

	if (country_match(us_op_class_cc, country)) {
		country_array = us_op_class;
		size = ARRAY_SIZE(us_op_class);
	} else if (country_match(eu_op_class_cc, country)) {
		country_array = eu_op_class;
		size = ARRAY_SIZE(eu_op_class);
	} else if (country_match(jp_op_class_cc, country)) {
		country_array = jp_op_class;
		size = ARRAY_SIZE(jp_op_class);
	} else if (country_match(cn_op_class_cc, country)) {
		country_array = cn_op_class;
		size = ARRAY_SIZE(cn_op_class);
	} else {
		/*
		 * Countries that do not match any of the above countries use
		 * global operating classes
		 */
		return op_class;
	}

	g_op_class = global_op_class_from_country_array(op_class, size,
							country_array);

	/*
	 * If the given operating class did not match any of the country's
	 * operating classes, assume that global operating class is used.
	 */
	return g_op_class ? g_op_class : op_class;
}


const struct oper_class_map * get_oper_class(const char *country, u8 op_class)
{
	const struct oper_class_map *op;

	if (country)
		op_class = country_to_global_op_class(country, op_class);

	op = &global_op_class[0];
	while (op->op_class && op->op_class != op_class)
		op++;

	if (!op->op_class)
		return NULL;

	return op;
}


int oper_class_bw_to_int(const struct oper_class_map *map)
{
	switch (map->bw) {
	case BW20:
		return 20;
	case BW40:
	case BW40PLUS:
	case BW40MINUS:
		return 40;
	case BW80:
		return 80;
	case BW80P80:
	case BW160:
		return 160;
	case BW320:
		return 320;
	case BW2160:
		return 2160;
	default:
		return 0;
	}
}


int center_idx_to_bw_6ghz(u8 idx)
{
	/* Channel: 2 */
	if (idx == 2)
		return 0; /* 20 MHz */
	/* channels: 1, 5, 9, 13... */
	if ((idx & 0x3) == 0x1)
		return 0; /* 20 MHz */
	/* channels 3, 11, 19... */
	if ((idx & 0x7) == 0x3)
		return 1; /* 40 MHz */
	/* channels 7, 23, 39.. */
	if ((idx & 0xf) == 0x7)
		return 2; /* 80 MHz */
	/* channels 15, 47, 79...*/
	if ((idx & 0x1f) == 0xf)
		return 3; /* 160 MHz */
	/* channels 31, 63, 95, 127, 159, 191 */
	if ((idx & 0x1f) == 0x1f && idx < 192)
		return 4; /* 320 MHz */

	return -1;
}


bool is_6ghz_freq(int freq)
{
	if (freq < 5935 || freq > 7115)
		return false;

	if (freq == 5935)
		return true;

	if (center_idx_to_bw_6ghz((freq - 5950) / 5) < 0)
		return false;

	return true;
}


bool is_6ghz_op_class(u8 op_class)
{
	return op_class >= 131 && op_class <= 137;
}


bool is_6ghz_psc_frequency(int freq)
{
	int i;

	if (!is_6ghz_freq(freq) || freq == 5935)
		return false;
	if ((((freq - 5950) / 5) & 0x3) != 0x1)
		return false;

	i = (freq - 5950 + 55) % 80;
	if (i == 0)
		i = (freq - 5950 + 55) / 80;

	if (i >= 1 && i <= 15)
		return true;

	return false;
}


/**
 * get_6ghz_sec_channel - Get the relative position of the secondary channel
 * to the primary channel in 6 GHz
 * @channel: Primary channel to be checked for (in global op class 131)
 * Returns: 1 = secondary channel above, -1 = secondary channel below
 */

int get_6ghz_sec_channel(int channel)
{
	/*
	 * In the 6 GHz band, primary channels are numbered as 1, 5, 9, 13.., so
	 * the 40 MHz channels are formed with the channel pairs as (1,5),
	 * (9,13), (17,21)..
	 * The secondary channel for a given primary channel is below the
	 * primary channel for the channels 5, 13, 21.. and it is above the
	 * primary channel for the channels 1, 9, 17..
	 */

	if (((channel - 1) / 4) % 2)
		return -1;
	return 1;
}


bool is_same_band(int freq1, int freq2)
{
	if (IS_2P4GHZ(freq1) && IS_2P4GHZ(freq2))
		return true;

	if (IS_5GHZ(freq1) && IS_5GHZ(freq2))
		return true;

	if (is_6ghz_freq(freq1) && is_6ghz_freq(freq2))
		return true;

	return false;
}


int ieee802_11_parse_candidate_list(const char *pos, u8 *nei_rep,
				    size_t nei_rep_len)
{
	u8 *nei_pos = nei_rep;
	const char *end;

	/*
	 * BSS Transition Candidate List Entries - Neighbor Report elements
	 * neighbor=<BSSID>,<BSSID Information>,<Operating Class>,
	 * <Channel Number>,<PHY Type>[,<hexdump of Optional Subelements>]
	 */
	while (pos) {
		u8 *nei_start;
		long int val;
		char *endptr, *tmp;

		pos = os_strstr(pos, " neighbor=");
		if (!pos)
			break;
		if (nei_pos + 15 > nei_rep + nei_rep_len) {
			wpa_printf(MSG_DEBUG,
				   "Not enough room for additional neighbor");
			return -1;
		}
		pos += 10;

		nei_start = nei_pos;
		*nei_pos++ = WLAN_EID_NEIGHBOR_REPORT;
		nei_pos++; /* length to be filled in */

		if (hwaddr_aton(pos, nei_pos)) {
			wpa_printf(MSG_DEBUG, "Invalid BSSID");
			return -1;
		}
		nei_pos += ETH_ALEN;
		pos += 17;
		if (*pos != ',') {
			wpa_printf(MSG_DEBUG, "Missing BSSID Information");
			return -1;
		}
		pos++;

		val = strtol(pos, &endptr, 0);
		WPA_PUT_LE32(nei_pos, val);
		nei_pos += 4;
		if (*endptr != ',') {
			wpa_printf(MSG_DEBUG, "Missing Operating Class");
			return -1;
		}
		pos = endptr + 1;

		*nei_pos++ = atoi(pos); /* Operating Class */
		pos = os_strchr(pos, ',');
		if (pos == NULL) {
			wpa_printf(MSG_DEBUG, "Missing Channel Number");
			return -1;
		}
		pos++;

		*nei_pos++ = atoi(pos); /* Channel Number */
		pos = os_strchr(pos, ',');
		if (pos == NULL) {
			wpa_printf(MSG_DEBUG, "Missing PHY Type");
			return -1;
		}
		pos++;

		*nei_pos++ = atoi(pos); /* PHY Type */
		end = os_strchr(pos, ' ');
		tmp = os_strchr(pos, ',');
		if (tmp && (!end || tmp < end)) {
			/* Optional Subelements (hexdump) */
			size_t len;

			pos = tmp + 1;
			end = os_strchr(pos, ' ');
			if (end)
				len = end - pos;
			else
				len = os_strlen(pos);
			if (nei_pos + len / 2 > nei_rep + nei_rep_len) {
				wpa_printf(MSG_DEBUG,
					   "Not enough room for neighbor subelements");
				return -1;
			}
			if (len & 0x01 ||
			    hexstr2bin(pos, nei_pos, len / 2) < 0) {
				wpa_printf(MSG_DEBUG,
					   "Invalid neighbor subelement info");
				return -1;
			}
			nei_pos += len / 2;
			pos = end;
		}

		nei_start[1] = nei_pos - nei_start - 2;
	}

	return nei_pos - nei_rep;
}


int ieee802_11_ext_capab(const u8 *ie, unsigned int capab)
{
	if (!ie || ie[1] <= capab / 8)
		return 0;
	return !!(ie[2 + capab / 8] & BIT(capab % 8));
}


bool ieee802_11_rsnx_capab_len(const u8 *rsnxe, size_t rsnxe_len,
			       unsigned int capab)
{
	const u8 *end;
	size_t flen, i;
	u32 capabs = 0;

	if (!rsnxe || rsnxe_len == 0)
		return false;
	end = rsnxe + rsnxe_len;
	flen = (rsnxe[0] & 0x0f) + 1;
	if (rsnxe + flen > end)
		return false;
	if (flen > 4)
		flen = 4;
	for (i = 0; i < flen; i++)
		capabs |= rsnxe[i] << (8 * i);

	return !!(capabs & BIT(capab));
}


bool ieee802_11_rsnx_capab(const u8 *rsnxe, unsigned int capab)
{
	if (!rsnxe)
		return false;
	if (rsnxe[0] == WLAN_EID_VENDOR_SPECIFIC && rsnxe[1] >= 4 + 1)
		return ieee802_11_rsnx_capab_len(rsnxe + 2 + 4, rsnxe[1] - 4,
						 capab);
	return ieee802_11_rsnx_capab_len(rsnxe + 2, rsnxe[1], capab);
}


void hostapd_encode_edmg_chan(int edmg_enable, u8 edmg_channel,
			      int primary_channel,
			      struct ieee80211_edmg_config *edmg)
{
	if (!edmg_enable) {
		edmg->channels = 0;
		edmg->bw_config = 0;
		return;
	}

	/* Only EDMG CB1 and EDMG CB2 contiguous channels supported for now */
	switch (edmg_channel) {
	case EDMG_CHANNEL_9:
		edmg->channels = EDMG_CHANNEL_9_SUBCHANNELS;
		edmg->bw_config = EDMG_BW_CONFIG_5;
		return;
	case EDMG_CHANNEL_10:
		edmg->channels = EDMG_CHANNEL_10_SUBCHANNELS;
		edmg->bw_config = EDMG_BW_CONFIG_5;
		return;
	case EDMG_CHANNEL_11:
		edmg->channels = EDMG_CHANNEL_11_SUBCHANNELS;
		edmg->bw_config = EDMG_BW_CONFIG_5;
		return;
	case EDMG_CHANNEL_12:
		edmg->channels = EDMG_CHANNEL_12_SUBCHANNELS;
		edmg->bw_config = EDMG_BW_CONFIG_5;
		return;
	case EDMG_CHANNEL_13:
		edmg->channels = EDMG_CHANNEL_13_SUBCHANNELS;
		edmg->bw_config = EDMG_BW_CONFIG_5;
		return;
	default:
		if (primary_channel > 0 && primary_channel < 7) {
			edmg->channels = BIT(primary_channel - 1);
			edmg->bw_config = EDMG_BW_CONFIG_4;
		} else {
			edmg->channels = 0;
			edmg->bw_config = 0;
		}
		break;
	}
}


/* Check if the requested EDMG configuration is a subset of the allowed
 * EDMG configuration. */
int ieee802_edmg_is_allowed(struct ieee80211_edmg_config allowed,
			    struct ieee80211_edmg_config requested)
{
	/*
	 * The validation check if the requested EDMG configuration
	 * is a subset of the allowed EDMG configuration:
	 * 1. Check that the requested channels are part (set) of the allowed
	 * channels.
	 * 2. P802.11ay defines the values of bw_config between 4 and 15.
	 * (bw config % 4) will give us 4 groups inside bw_config definition,
	 * inside each group we can check the subset just by comparing the
	 * bw_config value.
	 * Between this 4 groups, there is no subset relation - as a result of
	 * the P802.11ay definition.
	 * bw_config defined by IEEE P802.11ay/D4.0, 9.4.2.251, Table 13.
	 */
	if (((requested.channels & allowed.channels) != requested.channels) ||
	    ((requested.bw_config % 4) > (allowed.bw_config % 4)) ||
	    requested.bw_config > allowed.bw_config)
		return 0;

	return 1;
}


int op_class_to_bandwidth(u8 op_class)
{
	switch (op_class) {
	case 81:
	case 82:
		return 20;
	case 83: /* channels 1..9; 40 MHz */
	case 84: /* channels 5..13; 40 MHz */
		return 40;
	case 115: /* channels 36,40,44,48; indoor only */
		return 20;
	case 116: /* channels 36,44; 40 MHz; indoor only */
	case 117: /* channels 40,48; 40 MHz; indoor only */
		return 40;
	case 118: /* channels 52,56,60,64; dfs */
		return 20;
	case 119: /* channels 52,60; 40 MHz; dfs */
	case 120: /* channels 56,64; 40 MHz; dfs */
		return 40;
	case 121: /* channels 100-144 */
		return 20;
	case 122: /* channels 100-140; 40 MHz */
	case 123: /* channels 104-144; 40 MHz */
		return 40;
	case 124: /* channels 149,153,157,161 */
	case 125: /* channels 149,153,157,161,165,169,173,177 */
		return 20;
	case 126: /* channels 149,157,161,165,169,173; 40 MHz */
	case 127: /* channels 153..177; 40 MHz */
		return 40;
	case 128: /* center freqs 42, 58, 106, 122, 138, 155, 171; 80 MHz */
		return 80;
	case 129: /* center freqs 50, 114, 163; 160 MHz */
		return 160;
	case 130: /* center freqs 42, 58, 106, 122, 138, 155, 171; 80+80 MHz */
		return 80;
	case 131: /* UHB channels, 20 MHz: 1, 5, 9.. */
		return 20;
	case 132: /* UHB channels, 40 MHz: 3, 11, 19.. */
		return 40;
	case 133: /* UHB channels, 80 MHz: 7, 23, 39.. */
		return 80;
	case 134: /* UHB channels, 160 MHz: 15, 47, 79.. */
	case 135: /* UHB channels, 80+80 MHz: 7, 23, 39.. */
		return 160;
	case 136: /* UHB channels, 20 MHz: 2 */
		return 20;
	case 137: /* UHB channels, 320 MHz: 31, 63, 95, 127, 159, 191 */
		return 320;
	case 180: /* 60 GHz band, channels 1..8 */
		return 2160;
	case 181: /* 60 GHz band, EDMG CB2, channels 9..15 */
		return 4320;
	case 182: /* 60 GHz band, EDMG CB3, channels 17..22 */
		return 6480;
	case 183: /* 60 GHz band, EDMG CB4, channel 25..29 */
		return 8640;
	default:
		return 20;
	}
}


enum oper_chan_width op_class_to_ch_width(u8 op_class)
{
	switch (op_class) {
	case 81:
	case 82:
		return CONF_OPER_CHWIDTH_USE_HT;
	case 83: /* channels 1..9; 40 MHz */
	case 84: /* channels 5..13; 40 MHz */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 115: /* channels 36,40,44,48; indoor only */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 116: /* channels 36,44; 40 MHz; indoor only */
	case 117: /* channels 40,48; 40 MHz; indoor only */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 118: /* channels 52,56,60,64; dfs */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 119: /* channels 52,60; 40 MHz; dfs */
	case 120: /* channels 56,64; 40 MHz; dfs */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 121: /* channels 100-144 */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 122: /* channels 100-140; 40 MHz */
	case 123: /* channels 104-144; 40 MHz */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 124: /* channels 149,153,157,161 */
	case 125: /* channels 149,153,157,161,165,169,171 */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 126: /* channels 149,157,165, 173; 40 MHz */
	case 127: /* channels 153,161,169,177; 40 MHz */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 128: /* center freqs 42, 58, 106, 122, 138, 155, 171; 80 MHz */
		return CONF_OPER_CHWIDTH_80MHZ;
	case 129: /* center freqs 50, 114, 163; 160 MHz */
		return CONF_OPER_CHWIDTH_160MHZ;
	case 130: /* center freqs 42, 58, 106, 122, 138, 155, 171; 80+80 MHz */
		return CONF_OPER_CHWIDTH_80P80MHZ;
	case 131: /* UHB channels, 20 MHz: 1, 5, 9.. */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 132: /* UHB channels, 40 MHz: 3, 11, 19.. */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 133: /* UHB channels, 80 MHz: 7, 23, 39.. */
		return CONF_OPER_CHWIDTH_80MHZ;
	case 134: /* UHB channels, 160 MHz: 15, 47, 79.. */
		return CONF_OPER_CHWIDTH_160MHZ;
	case 135: /* UHB channels, 80+80 MHz: 7, 23, 39.. */
		return CONF_OPER_CHWIDTH_80P80MHZ;
	case 136: /* UHB channels, 20 MHz: 2 */
		return CONF_OPER_CHWIDTH_USE_HT;
	case 137: /* UHB channels, 320 MHz: 31, 63, 95, 127, 159, 191 */
		return CONF_OPER_CHWIDTH_320MHZ;
	case 180: /* 60 GHz band, channels 1..8 */
		return CONF_OPER_CHWIDTH_2160MHZ;
	case 181: /* 60 GHz band, EDMG CB2, channels 9..15 */
		return CONF_OPER_CHWIDTH_4320MHZ;
	case 182: /* 60 GHz band, EDMG CB3, channels 17..22 */
		return CONF_OPER_CHWIDTH_6480MHZ;
	case 183: /* 60 GHz band, EDMG CB4, channel 25..29 */
		return CONF_OPER_CHWIDTH_8640MHZ;
	default:
		return CONF_OPER_CHWIDTH_USE_HT;
	}
}


/**
 * chwidth_freq2_to_ch_width - Determine channel width as enum oper_chan_width
 * @chwidth: Channel width integer
 * @freq2: Value for frequency 2. 0 is not used
 * Returns: enum oper_chan_width, -1 on failure
 */
int chwidth_freq2_to_ch_width(int chwidth, int freq2)
{
	if (freq2 < 0)
		return -1;
	if (freq2)
		return CONF_OPER_CHWIDTH_80P80MHZ;

	switch (chwidth) {
	case 0:
	case 20:
	case 40:
		return CONF_OPER_CHWIDTH_USE_HT;
	case 80:
		return CONF_OPER_CHWIDTH_80MHZ;
	case 160:
		return CONF_OPER_CHWIDTH_160MHZ;
	case 320:
		return CONF_OPER_CHWIDTH_320MHZ;
	default:
		wpa_printf(MSG_DEBUG, "Unknown max oper bandwidth: %d",
			   chwidth);
		return -1;
	}
}


struct wpabuf * ieee802_11_defrag(const u8 *data, size_t len, bool ext_elem)
{
	struct wpabuf *buf;
	const u8 *pos, *end = data + len;
	size_t min_defrag_len = ext_elem ? 255 : 256;

	if (!data || !len)
		return NULL;

	if (len < min_defrag_len)
		return wpabuf_alloc_copy(data, len);

	buf = wpabuf_alloc_copy(data, min_defrag_len - 1);
	if (!buf)
		return NULL;

	pos = &data[min_defrag_len - 1];
	len -= min_defrag_len - 1;
	while (len > 2 && pos[0] == WLAN_EID_FRAGMENT && pos[1]) {
		int ret;
		size_t elen = 2 + pos[1];

		if (elen > (size_t) (end - pos) || elen > len)
			break;
		ret = wpabuf_resize(&buf, pos[1]);
		if (ret < 0) {
			wpabuf_free(buf);
			return NULL;
		}

		/* Copy only the fragment data (without the EID and length) */
		wpabuf_put_data(buf, &pos[2], pos[1]);
		pos += elen;
		len -= elen;
	}

	return buf;
}


const u8 * get_ml_ie(const u8 *ies, size_t len, u8 type)
{
	const struct element *elem;

	if (!ies)
		return NULL;

	for_each_element_extid(elem, WLAN_EID_EXT_MULTI_LINK, ies, len) {
		if (elem->datalen >= 2 &&
		    (elem->data[1] & MULTI_LINK_CONTROL_TYPE_MASK) == type)
			return &elem->id;
	}

	return NULL;
}


const u8 * get_basic_mle_mld_addr(const u8 *buf, size_t len)
{
	const size_t mld_addr_pos =
		2 /* Control field */ +
		1 /* Common Info Length field */;
	const size_t fixed_len = mld_addr_pos +
		ETH_ALEN /* MLD MAC Address field */;

	if (len < fixed_len)
		return NULL;

	if ((buf[0] & MULTI_LINK_CONTROL_TYPE_MASK) !=
	    MULTI_LINK_CONTROL_TYPE_BASIC)
		return NULL;

	return &buf[mld_addr_pos];
}


/* Parse HT capabilities to get maximum number of supported spatial streams */
static int parse_ht_mcs_set_for_max_nss(
				struct ieee80211_ht_capabilities *htcaps,
				u8 parse_for_rx)
{
	int max_nss_rx = 1;
	if (htcaps == NULL)
		return max_nss_rx;
	int i;
	for (i = 4; i >= 1; i--) {
		if (htcaps->supported_mcs_set[i - 1] > 0) {
			max_nss_rx = i;
			break;
		}
	}
	if (parse_for_rx)
		return max_nss_rx;
	u8 supported_tx_mcs_set = htcaps->supported_mcs_set[12];
	u8 tx_mcs_set_defined = supported_tx_mcs_set & 0x1;
	u8 tx_rx_mcs_set_not_equal = (supported_tx_mcs_set >> 1) & 0x1;
	if (tx_mcs_set_defined && tx_rx_mcs_set_not_equal) {
		int max_nss_tx_field_value = (supported_tx_mcs_set >> 2) & 0x3;
		// The maximum number of Tx streams is 1 more than the field value.
		return max_nss_tx_field_value + 1;
	}
	return max_nss_rx;
}


/* Parse MCS map to get maximum number of supported spatial streams */
static int parse_mcs_map_for_max_nss (u16 mcs_map, int max_streams_allowed)
{
	int max_nss = 1;
	int i;
	for (i = max_streams_allowed; i >= 1; i--) {
		int stream_map = (mcs_map >> ((i - 1) * 2)) & 0x3;
		// 3 means unsupported
		if (stream_map != 3) {
			max_nss = i;
			break;
		}
	}
	return max_nss;
}


/* Parse capabilities IEs to get maximum number of supported spatial streams */
int get_max_nss_capability(struct ieee802_11_elems *elems, int parse_for_rx)
{
	int max_nss = 1;
	struct ieee80211_ht_capabilities *htcaps =
		(struct ieee80211_ht_capabilities *) elems->ht_capabilities;
	struct ieee80211_vht_capabilities *vhtcaps =
		(struct ieee80211_vht_capabilities *) elems->vht_capabilities;
	struct ieee80211_he_capabilities *hecaps =
		(struct ieee80211_he_capabilities *) elems->he_capabilities;
	if (htcaps) {
		int max_nss_ht = parse_ht_mcs_set_for_max_nss(htcaps, parse_for_rx);
		if (max_nss_ht > max_nss)
			max_nss = max_nss_ht;
	}
	le16 mcs_map;
	if (vhtcaps) {
		mcs_map = (parse_for_rx) ? vhtcaps->vht_supported_mcs_set.rx_map :
			vhtcaps->vht_supported_mcs_set.tx_map;
		int max_nss_vht = parse_mcs_map_for_max_nss(
			le_to_host16(mcs_map), VHT_RX_NSS_MAX_STREAMS);
		if (max_nss_vht > max_nss)
			max_nss = max_nss_vht;
	}
	if (hecaps) {
		mcs_map = (parse_for_rx) ? hecaps->he_basic_supported_mcs_set.rx_map :
			hecaps->he_basic_supported_mcs_set.tx_map;
		int max_nss_he = parse_mcs_map_for_max_nss(
			le_to_host16(mcs_map), HE_NSS_MAX_STREAMS);
		if (max_nss_he > max_nss)
			max_nss = max_nss_he;
	}
	return max_nss;
}


/* Parse VHT/HE capabilities IEs to get supported channel width */
struct supported_chan_width get_supported_channel_width(
				struct ieee802_11_elems *elems)
{
	struct supported_chan_width supported_width;
	supported_width.is_160_supported = 0;
	supported_width.is_80p80_supported = 0;
	supported_width.is_320_supported = 0;
	if (elems == NULL)
		return supported_width;

	struct ieee80211_vht_capabilities *vhtcaps =
		(struct ieee80211_vht_capabilities *) elems->vht_capabilities;
	struct ieee80211_he_capabilities *hecaps =
		(struct ieee80211_he_capabilities *) elems->he_capabilities;
	struct ieee80211_eht_capabilities *ehtcaps =
		(struct ieee80211_eht_capabilities *) elems->eht_capabilities;

	if (vhtcaps) {
		le32 vht_capabilities_info =
			le_to_host32(vhtcaps->vht_capabilities_info);
		if (vht_capabilities_info & VHT_CAP_SUPP_CHAN_WIDTH_160MHZ)
			supported_width.is_160_supported = 1;
		if (vht_capabilities_info & VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ)
			supported_width.is_80p80_supported = 1;
	}
	if (hecaps) {
		u8 channel_width_set =
        	hecaps->he_phy_capab_info[HE_PHYCAP_CHANNEL_WIDTH_SET_IDX];
		if (channel_width_set & HE_PHYCAP_CHANNEL_WIDTH_SET_160MHZ_IN_5G)
			supported_width.is_160_supported = 1;
		if (channel_width_set & HE_PHYCAP_CHANNEL_WIDTH_SET_80PLUS80MHZ_IN_5G)
			supported_width.is_80p80_supported = 1;
	}
	if (ehtcaps) {
		if (ehtcaps->phy_cap[EHT_PHYCAP_320MHZ_IN_6GHZ_SUPPORT_IDX] &
		    EHT_PHYCAP_320MHZ_IN_6GHZ_SUPPORT_MASK)
			supported_width.is_320_supported = 1;
	}
	wpa_printf(MSG_DEBUG,
		   " IE indicates 320 supported: %u, 160 supported: %u, 80+80 supported: %u",
		   supported_width.is_320_supported,
		   supported_width.is_160_supported,
		   supported_width.is_80p80_supported);
	return supported_width;
}


/*
 * Parse VHT operation info fields to get operation channel width
 * note that VHT operation info fields could come from VHT operation IE
 * or from HE operation IE
 */
static enum chan_width get_vht_operation_channel_width(
				struct ieee80211_vht_operation_info *vht_oper_info)
{
	enum chan_width channel_width = CHAN_WIDTH_UNKNOWN;
	u8 seg0, seg1;
	switch (vht_oper_info->vht_op_info_chwidth) {
	case 1:
		seg0 = vht_oper_info->vht_op_info_chan_center_freq_seg0_idx;
		seg1 = vht_oper_info->vht_op_info_chan_center_freq_seg1_idx;
		if (seg1 && abs(seg1 - seg0) == 8)
			channel_width = CHAN_WIDTH_160;
		else if (seg1)
			channel_width = CHAN_WIDTH_80P80;
		else
			channel_width = CHAN_WIDTH_80;
		break;
	case 2:
		channel_width = CHAN_WIDTH_160;
		break;
	case 3:
		channel_width = CHAN_WIDTH_80P80;
		break;
	default:
		break;
	}
	wpa_printf(MSG_DEBUG, " VHT operation CBW: %u", channel_width);
	return channel_width;
}


/* Parse 6GHz operation info fields to get operation channel width */
static enum chan_width get_6ghz_operation_channel_width(
				struct ieee80211_6ghz_operation_info * six_ghz_oper_info)
{
	enum chan_width channel_width = CHAN_WIDTH_UNKNOWN;
	u8 seg0, seg1;
	switch (six_ghz_oper_info->control & SIX_GHZ_CONTROL_CHANNEL_WIDTH_MASK) {
	case 0:
		channel_width = CHAN_WIDTH_20;
		break;
	case 1:
		channel_width = CHAN_WIDTH_40;
		break;
	case 2:
		channel_width = CHAN_WIDTH_80;
		break;
	case 3:
		seg0 = six_ghz_oper_info->chan_center_freq_seg0_idx;
		seg1 = six_ghz_oper_info->chan_center_freq_seg1_idx;
		if (abs(seg1 - seg0) == 8)
			channel_width = CHAN_WIDTH_160;
		else
			channel_width = CHAN_WIDTH_80P80;
		break;
	default:
		break;
	}
	wpa_printf(MSG_DEBUG, " 6GHz operation CBW: %u", channel_width);
	return channel_width;
}


/* Parse HE operation IE to get HE operation channel width */
static enum chan_width get_he_operation_channel_width(
				struct ieee80211_he_operation *he_oper,
				int he_oper_len)
{
	enum chan_width channel_width = CHAN_WIDTH_UNKNOWN;
	u8 is_6ghz_info_present =
		(he_oper->he_oper_params & HE_OPERATION_6GHZ_OPER_INFO) ? 1 : 0;
	u8 is_vht_info_present =
		(he_oper->he_oper_params & HE_OPERATION_VHT_OPER_INFO) ? 1 : 0;
	u8 is_cohosted_bss_present =
		(he_oper->he_oper_params & HE_OPERATION_COHOSTED_BSS) ? 1 : 0;
	int expected_len = HE_OPERATION_IE_MIN_LEN
		+ (is_6ghz_info_present ? HE_OPERATION_6GHZ_OPER_INFO_LEN : 0)
		+ (is_vht_info_present ? HE_OPERATION_VHT_OPER_INFO_LEN : 0)
		+ (is_cohosted_bss_present
		? HE_OPERATION_COHOSTED_BSSID_INDICATOR_LEN : 0);
	if (he_oper_len < expected_len)
		return channel_width;

	const u8 *he_oper_u8 = (const u8 *) he_oper;
	if (is_6ghz_info_present) {
		struct ieee80211_6ghz_operation_info *six_ghz_oper_info =
			(struct ieee80211_6ghz_operation_info *)
			(he_oper_u8 + HE_OPERATION_IE_MIN_LEN
			+ (is_vht_info_present ? HE_OPERATION_VHT_OPER_INFO_LEN : 0)
			+ (is_cohosted_bss_present
			? HE_OPERATION_COHOSTED_BSSID_INDICATOR_LEN : 0));
		channel_width = get_6ghz_operation_channel_width(six_ghz_oper_info);
	}
	if (channel_width == CHAN_WIDTH_UNKNOWN && is_vht_info_present) {
		struct ieee80211_vht_operation_info *vht_oper_info  =
			(struct ieee80211_vht_operation_info *)
			(he_oper_u8 + HE_OPERATION_IE_MIN_LEN);
		channel_width = get_vht_operation_channel_width(vht_oper_info);
	}
	wpa_printf(MSG_DEBUG, " HE operation CBW: %u", channel_width);
	return channel_width;
}


/* Parse EHT operation IE to get EHT operation channel width */
static enum chan_width get_eht_operation_channel_width(
				struct ieee80211_eht_operation *eht_oper,
				int eht_oper_len)
{
	enum chan_width channel_width = CHAN_WIDTH_UNKNOWN;
	if (!(eht_oper->oper_params & EHT_OPER_INFO_PRESENT) ||
	    eht_oper_len < (EHT_OPERATION_IE_MIN_LEN + EHT_OPER_INFO_MIN_LEN))
		return channel_width;

	switch (eht_oper->oper_info.control & EHT_OPER_CHANNEL_WIDTH_MASK) {
	case EHT_OPER_CHANNEL_WIDTH_20MHZ:
		channel_width = CHAN_WIDTH_20;
		break;
	case EHT_OPER_CHANNEL_WIDTH_40MHZ:
		channel_width = CHAN_WIDTH_40;
		break;
	case EHT_OPER_CHANNEL_WIDTH_80MHZ:
		channel_width = CHAN_WIDTH_80;
		break;
	case EHT_OPER_CHANNEL_WIDTH_160MHZ:
		channel_width = CHAN_WIDTH_160;
		break;
	case EHT_OPER_CHANNEL_WIDTH_320MHZ:
		channel_width = CHAN_WIDTH_320;
		break;
	default:
		break;
	}
	wpa_printf(MSG_DEBUG, " EHT operation CBW: %u", channel_width);
	return channel_width;
}


/* Parse HT/VHT/HE operation IEs to get operation channel width */
enum chan_width get_operation_channel_width(struct ieee802_11_elems *elems)
{
	enum chan_width channel_width = CHAN_WIDTH_UNKNOWN;
	if (elems == NULL)
		return channel_width;

	struct ieee80211_ht_operation *ht_oper =
	    (struct ieee80211_ht_operation *) elems->ht_operation;
	struct ieee80211_vht_operation_info *vht_oper_info =
	    (struct ieee80211_vht_operation_info *) elems->vht_operation;
	struct ieee80211_he_operation *he_oper =
	    (struct ieee80211_he_operation *) elems->he_operation;
	struct ieee80211_eht_operation *eht_oper =
	    (struct ieee80211_eht_operation *) elems->eht_operation;

	if (eht_oper)
		channel_width = get_eht_operation_channel_width(
			eht_oper, elems->eht_operation_len);

	if (channel_width == CHAN_WIDTH_UNKNOWN && he_oper)
		channel_width = get_he_operation_channel_width(
			he_oper, elems->he_operation_len);

	if (channel_width == CHAN_WIDTH_UNKNOWN && vht_oper_info)
		channel_width = get_vht_operation_channel_width(vht_oper_info);

	if (channel_width == CHAN_WIDTH_UNKNOWN && ht_oper) {
		u8 sec_chan_offset =
			ht_oper->ht_param & HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
		channel_width = (sec_chan_offset == 0) ? CHAN_WIDTH_20 : CHAN_WIDTH_40;
	}
	wpa_printf(MSG_DEBUG, " overall operation CBW: %u", channel_width);
	return channel_width;
}



/*
 * Get STA operation channel width from AP's operation channel width and
 *  STA's supported channel width
 */
enum chan_width get_sta_operation_chan_width(
				enum chan_width ap_operation_chan_width,
				struct supported_chan_width sta_supported_chan_width)
{
	if (ap_operation_chan_width == CHAN_WIDTH_320 &&
	    sta_supported_chan_width.is_320_supported)
		return CHAN_WIDTH_320;
	if (ap_operation_chan_width == CHAN_WIDTH_160 ||
	    ap_operation_chan_width == CHAN_WIDTH_320)
		return (sta_supported_chan_width.is_160_supported)
			? CHAN_WIDTH_160 : CHAN_WIDTH_80;
	if (ap_operation_chan_width == CHAN_WIDTH_80P80)
		return (sta_supported_chan_width.is_80p80_supported)
			? CHAN_WIDTH_80P80 : CHAN_WIDTH_80;
	return ap_operation_chan_width;
}


unsigned int is_ap_t2lm_negotiation_supported(const u8 *mle, size_t mle_len)
{
	u16 ml_control;
	u16 mld_capabilities;
	size_t offset =
		2 /* Multi Link Control */ +
		1 /* Common Info Length field */ +
		ETH_ALEN /* MLD MAC Address field */;

	if(!mle || mle_len < offset)
	    return 0;

	ml_control = WPA_GET_LE16(mle);
	wpa_printf(MSG_DEBUG, "%s: ML control field 0x%x", __func__, ml_control);

	if (!(ml_control & BASIC_MULTI_LINK_CTRL_PRES_MLD_CAPA)) {
	    wpa_printf(MSG_DEBUG, "MLD capabilities not present");
	    return 0;
	}

	if (ml_control & BASIC_MULTI_LINK_CTRL_PRES_LINK_ID)
	    offset++;

	if (ml_control & BASIC_MULTI_LINK_CTRL_PRES_BSS_PARAM_CH_COUNT)
	    offset++;

	if (ml_control & BASIC_MULTI_LINK_CTRL_PRES_MSD_INFO)
	    offset += 2;

	if (ml_control & BASIC_MULTI_LINK_CTRL_PRES_EML_CAPA)
	    offset += 2;

	if (mle_len < (offset + 2)) {
	    wpa_printf(MSG_ERROR, "Not suffcient length for MLD capabilities");
	    return 0;
	}

	mld_capabilities = WPA_GET_LE16(mle + offset);
	wpa_printf(MSG_DEBUG, "MLD capabilities 0x%x", mld_capabilities);
	if(!(mld_capabilities &
	     EHT_ML_MLD_CAPA_TID_TO_LINK_MAP_NEG_SUPP_MSK))
	    return 0;

	return 1;
}