| // SPDX-License-Identifier: GPL-2.0 | 
 | /* | 
 |  * This file contains helper code to handle channel | 
 |  * settings and keeping track of what is possible at | 
 |  * any point in time. | 
 |  * | 
 |  * Copyright 2009	Johannes Berg <johannes@sipsolutions.net> | 
 |  * Copyright 2013-2014  Intel Mobile Communications GmbH | 
 |  */ | 
 |  | 
 | #include <linux/export.h> | 
 | #include <net/cfg80211.h> | 
 | #include "core.h" | 
 | #include "rdev-ops.h" | 
 |  | 
 | void cfg80211_chandef_create(struct cfg80211_chan_def *chandef, | 
 | 			     struct ieee80211_channel *chan, | 
 | 			     enum nl80211_channel_type chan_type) | 
 | { | 
 | 	if (WARN_ON(!chan)) | 
 | 		return; | 
 |  | 
 | 	chandef->chan = chan; | 
 | 	chandef->center_freq2 = 0; | 
 |  | 
 | 	switch (chan_type) { | 
 | 	case NL80211_CHAN_NO_HT: | 
 | 		chandef->width = NL80211_CHAN_WIDTH_20_NOHT; | 
 | 		chandef->center_freq1 = chan->center_freq; | 
 | 		break; | 
 | 	case NL80211_CHAN_HT20: | 
 | 		chandef->width = NL80211_CHAN_WIDTH_20; | 
 | 		chandef->center_freq1 = chan->center_freq; | 
 | 		break; | 
 | 	case NL80211_CHAN_HT40PLUS: | 
 | 		chandef->width = NL80211_CHAN_WIDTH_40; | 
 | 		chandef->center_freq1 = chan->center_freq + 10; | 
 | 		break; | 
 | 	case NL80211_CHAN_HT40MINUS: | 
 | 		chandef->width = NL80211_CHAN_WIDTH_40; | 
 | 		chandef->center_freq1 = chan->center_freq - 10; | 
 | 		break; | 
 | 	default: | 
 | 		WARN_ON(1); | 
 | 	} | 
 | } | 
 | EXPORT_SYMBOL(cfg80211_chandef_create); | 
 |  | 
 | bool cfg80211_chandef_valid(const struct cfg80211_chan_def *chandef) | 
 | { | 
 | 	u32 control_freq; | 
 |  | 
 | 	if (!chandef->chan) | 
 | 		return false; | 
 |  | 
 | 	control_freq = chandef->chan->center_freq; | 
 |  | 
 | 	switch (chandef->width) { | 
 | 	case NL80211_CHAN_WIDTH_5: | 
 | 	case NL80211_CHAN_WIDTH_10: | 
 | 	case NL80211_CHAN_WIDTH_20: | 
 | 	case NL80211_CHAN_WIDTH_20_NOHT: | 
 | 		if (chandef->center_freq1 != control_freq) | 
 | 			return false; | 
 | 		if (chandef->center_freq2) | 
 | 			return false; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_40: | 
 | 		if (chandef->center_freq1 != control_freq + 10 && | 
 | 		    chandef->center_freq1 != control_freq - 10) | 
 | 			return false; | 
 | 		if (chandef->center_freq2) | 
 | 			return false; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_80P80: | 
 | 		if (chandef->center_freq1 != control_freq + 30 && | 
 | 		    chandef->center_freq1 != control_freq + 10 && | 
 | 		    chandef->center_freq1 != control_freq - 10 && | 
 | 		    chandef->center_freq1 != control_freq - 30) | 
 | 			return false; | 
 | 		if (!chandef->center_freq2) | 
 | 			return false; | 
 | 		/* adjacent is not allowed -- that's a 160 MHz channel */ | 
 | 		if (chandef->center_freq1 - chandef->center_freq2 == 80 || | 
 | 		    chandef->center_freq2 - chandef->center_freq1 == 80) | 
 | 			return false; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_80: | 
 | 		if (chandef->center_freq1 != control_freq + 30 && | 
 | 		    chandef->center_freq1 != control_freq + 10 && | 
 | 		    chandef->center_freq1 != control_freq - 10 && | 
 | 		    chandef->center_freq1 != control_freq - 30) | 
 | 			return false; | 
 | 		if (chandef->center_freq2) | 
 | 			return false; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_160: | 
 | 		if (chandef->center_freq1 != control_freq + 70 && | 
 | 		    chandef->center_freq1 != control_freq + 50 && | 
 | 		    chandef->center_freq1 != control_freq + 30 && | 
 | 		    chandef->center_freq1 != control_freq + 10 && | 
 | 		    chandef->center_freq1 != control_freq - 10 && | 
 | 		    chandef->center_freq1 != control_freq - 30 && | 
 | 		    chandef->center_freq1 != control_freq - 50 && | 
 | 		    chandef->center_freq1 != control_freq - 70) | 
 | 			return false; | 
 | 		if (chandef->center_freq2) | 
 | 			return false; | 
 | 		break; | 
 | 	default: | 
 | 		return false; | 
 | 	} | 
 |  | 
 | 	return true; | 
 | } | 
 | EXPORT_SYMBOL(cfg80211_chandef_valid); | 
 |  | 
 | static void chandef_primary_freqs(const struct cfg80211_chan_def *c, | 
 | 				  u32 *pri40, u32 *pri80) | 
 | { | 
 | 	int tmp; | 
 |  | 
 | 	switch (c->width) { | 
 | 	case NL80211_CHAN_WIDTH_40: | 
 | 		*pri40 = c->center_freq1; | 
 | 		*pri80 = 0; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_80: | 
 | 	case NL80211_CHAN_WIDTH_80P80: | 
 | 		*pri80 = c->center_freq1; | 
 | 		/* n_P20 */ | 
 | 		tmp = (30 + c->chan->center_freq - c->center_freq1)/20; | 
 | 		/* n_P40 */ | 
 | 		tmp /= 2; | 
 | 		/* freq_P40 */ | 
 | 		*pri40 = c->center_freq1 - 20 + 40 * tmp; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_160: | 
 | 		/* n_P20 */ | 
 | 		tmp = (70 + c->chan->center_freq - c->center_freq1)/20; | 
 | 		/* n_P40 */ | 
 | 		tmp /= 2; | 
 | 		/* freq_P40 */ | 
 | 		*pri40 = c->center_freq1 - 60 + 40 * tmp; | 
 | 		/* n_P80 */ | 
 | 		tmp /= 2; | 
 | 		*pri80 = c->center_freq1 - 40 + 80 * tmp; | 
 | 		break; | 
 | 	default: | 
 | 		WARN_ON_ONCE(1); | 
 | 	} | 
 | } | 
 |  | 
 | static int cfg80211_chandef_get_width(const struct cfg80211_chan_def *c) | 
 | { | 
 | 	int width; | 
 |  | 
 | 	switch (c->width) { | 
 | 	case NL80211_CHAN_WIDTH_5: | 
 | 		width = 5; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_10: | 
 | 		width = 10; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_20: | 
 | 	case NL80211_CHAN_WIDTH_20_NOHT: | 
 | 		width = 20; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_40: | 
 | 		width = 40; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_80P80: | 
 | 	case NL80211_CHAN_WIDTH_80: | 
 | 		width = 80; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_160: | 
 | 		width = 160; | 
 | 		break; | 
 | 	default: | 
 | 		WARN_ON_ONCE(1); | 
 | 		return -1; | 
 | 	} | 
 | 	return width; | 
 | } | 
 |  | 
 | const struct cfg80211_chan_def * | 
 | cfg80211_chandef_compatible(const struct cfg80211_chan_def *c1, | 
 | 			    const struct cfg80211_chan_def *c2) | 
 | { | 
 | 	u32 c1_pri40, c1_pri80, c2_pri40, c2_pri80; | 
 |  | 
 | 	/* If they are identical, return */ | 
 | 	if (cfg80211_chandef_identical(c1, c2)) | 
 | 		return c1; | 
 |  | 
 | 	/* otherwise, must have same control channel */ | 
 | 	if (c1->chan != c2->chan) | 
 | 		return NULL; | 
 |  | 
 | 	/* | 
 | 	 * If they have the same width, but aren't identical, | 
 | 	 * then they can't be compatible. | 
 | 	 */ | 
 | 	if (c1->width == c2->width) | 
 | 		return NULL; | 
 |  | 
 | 	/* | 
 | 	 * can't be compatible if one of them is 5 or 10 MHz, | 
 | 	 * but they don't have the same width. | 
 | 	 */ | 
 | 	if (c1->width == NL80211_CHAN_WIDTH_5 || | 
 | 	    c1->width == NL80211_CHAN_WIDTH_10 || | 
 | 	    c2->width == NL80211_CHAN_WIDTH_5 || | 
 | 	    c2->width == NL80211_CHAN_WIDTH_10) | 
 | 		return NULL; | 
 |  | 
 | 	if (c1->width == NL80211_CHAN_WIDTH_20_NOHT || | 
 | 	    c1->width == NL80211_CHAN_WIDTH_20) | 
 | 		return c2; | 
 |  | 
 | 	if (c2->width == NL80211_CHAN_WIDTH_20_NOHT || | 
 | 	    c2->width == NL80211_CHAN_WIDTH_20) | 
 | 		return c1; | 
 |  | 
 | 	chandef_primary_freqs(c1, &c1_pri40, &c1_pri80); | 
 | 	chandef_primary_freqs(c2, &c2_pri40, &c2_pri80); | 
 |  | 
 | 	if (c1_pri40 != c2_pri40) | 
 | 		return NULL; | 
 |  | 
 | 	WARN_ON(!c1_pri80 && !c2_pri80); | 
 | 	if (c1_pri80 && c2_pri80 && c1_pri80 != c2_pri80) | 
 | 		return NULL; | 
 |  | 
 | 	if (c1->width > c2->width) | 
 | 		return c1; | 
 | 	return c2; | 
 | } | 
 | EXPORT_SYMBOL(cfg80211_chandef_compatible); | 
 |  | 
 | static void cfg80211_set_chans_dfs_state(struct wiphy *wiphy, u32 center_freq, | 
 | 					 u32 bandwidth, | 
 | 					 enum nl80211_dfs_state dfs_state) | 
 | { | 
 | 	struct ieee80211_channel *c; | 
 | 	u32 freq; | 
 |  | 
 | 	for (freq = center_freq - bandwidth/2 + 10; | 
 | 	     freq <= center_freq + bandwidth/2 - 10; | 
 | 	     freq += 20) { | 
 | 		c = ieee80211_get_channel(wiphy, freq); | 
 | 		if (!c || !(c->flags & IEEE80211_CHAN_RADAR)) | 
 | 			continue; | 
 |  | 
 | 		c->dfs_state = dfs_state; | 
 | 		c->dfs_state_entered = jiffies; | 
 | 	} | 
 | } | 
 |  | 
 | void cfg80211_set_dfs_state(struct wiphy *wiphy, | 
 | 			    const struct cfg80211_chan_def *chandef, | 
 | 			    enum nl80211_dfs_state dfs_state) | 
 | { | 
 | 	int width; | 
 |  | 
 | 	if (WARN_ON(!cfg80211_chandef_valid(chandef))) | 
 | 		return; | 
 |  | 
 | 	width = cfg80211_chandef_get_width(chandef); | 
 | 	if (width < 0) | 
 | 		return; | 
 |  | 
 | 	cfg80211_set_chans_dfs_state(wiphy, chandef->center_freq1, | 
 | 				     width, dfs_state); | 
 |  | 
 | 	if (!chandef->center_freq2) | 
 | 		return; | 
 | 	cfg80211_set_chans_dfs_state(wiphy, chandef->center_freq2, | 
 | 				     width, dfs_state); | 
 | } | 
 |  | 
 | static u32 cfg80211_get_start_freq(u32 center_freq, | 
 | 				   u32 bandwidth) | 
 | { | 
 | 	u32 start_freq; | 
 |  | 
 | 	if (bandwidth <= 20) | 
 | 		start_freq = center_freq; | 
 | 	else | 
 | 		start_freq = center_freq - bandwidth/2 + 10; | 
 |  | 
 | 	return start_freq; | 
 | } | 
 |  | 
 | static u32 cfg80211_get_end_freq(u32 center_freq, | 
 | 				 u32 bandwidth) | 
 | { | 
 | 	u32 end_freq; | 
 |  | 
 | 	if (bandwidth <= 20) | 
 | 		end_freq = center_freq; | 
 | 	else | 
 | 		end_freq = center_freq + bandwidth/2 - 10; | 
 |  | 
 | 	return end_freq; | 
 | } | 
 |  | 
 | static int cfg80211_get_chans_dfs_required(struct wiphy *wiphy, | 
 | 					    u32 center_freq, | 
 | 					    u32 bandwidth) | 
 | { | 
 | 	struct ieee80211_channel *c; | 
 | 	u32 freq, start_freq, end_freq; | 
 |  | 
 | 	start_freq = cfg80211_get_start_freq(center_freq, bandwidth); | 
 | 	end_freq = cfg80211_get_end_freq(center_freq, bandwidth); | 
 |  | 
 | 	for (freq = start_freq; freq <= end_freq; freq += 20) { | 
 | 		c = ieee80211_get_channel(wiphy, freq); | 
 | 		if (!c) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (c->flags & IEEE80211_CHAN_RADAR) | 
 | 			return 1; | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 |  | 
 | int cfg80211_chandef_dfs_required(struct wiphy *wiphy, | 
 | 				  const struct cfg80211_chan_def *chandef, | 
 | 				  enum nl80211_iftype iftype) | 
 | { | 
 | 	int width; | 
 | 	int ret; | 
 |  | 
 | 	if (WARN_ON(!cfg80211_chandef_valid(chandef))) | 
 | 		return -EINVAL; | 
 |  | 
 | 	switch (iftype) { | 
 | 	case NL80211_IFTYPE_ADHOC: | 
 | 	case NL80211_IFTYPE_AP: | 
 | 	case NL80211_IFTYPE_P2P_GO: | 
 | 	case NL80211_IFTYPE_MESH_POINT: | 
 | 		width = cfg80211_chandef_get_width(chandef); | 
 | 		if (width < 0) | 
 | 			return -EINVAL; | 
 |  | 
 | 		ret = cfg80211_get_chans_dfs_required(wiphy, | 
 | 						      chandef->center_freq1, | 
 | 						      width); | 
 | 		if (ret < 0) | 
 | 			return ret; | 
 | 		else if (ret > 0) | 
 | 			return BIT(chandef->width); | 
 |  | 
 | 		if (!chandef->center_freq2) | 
 | 			return 0; | 
 |  | 
 | 		ret = cfg80211_get_chans_dfs_required(wiphy, | 
 | 						      chandef->center_freq2, | 
 | 						      width); | 
 | 		if (ret < 0) | 
 | 			return ret; | 
 | 		else if (ret > 0) | 
 | 			return BIT(chandef->width); | 
 |  | 
 | 		break; | 
 | 	case NL80211_IFTYPE_STATION: | 
 | 	case NL80211_IFTYPE_OCB: | 
 | 	case NL80211_IFTYPE_P2P_CLIENT: | 
 | 	case NL80211_IFTYPE_MONITOR: | 
 | 	case NL80211_IFTYPE_AP_VLAN: | 
 | 	case NL80211_IFTYPE_WDS: | 
 | 	case NL80211_IFTYPE_P2P_DEVICE: | 
 | 	case NL80211_IFTYPE_NAN: | 
 | 		break; | 
 | 	case NL80211_IFTYPE_UNSPECIFIED: | 
 | 	case NUM_NL80211_IFTYPES: | 
 | 		WARN_ON(1); | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL(cfg80211_chandef_dfs_required); | 
 |  | 
 | static int cfg80211_get_chans_dfs_usable(struct wiphy *wiphy, | 
 | 					 u32 center_freq, | 
 | 					 u32 bandwidth) | 
 | { | 
 | 	struct ieee80211_channel *c; | 
 | 	u32 freq, start_freq, end_freq; | 
 | 	int count = 0; | 
 |  | 
 | 	start_freq = cfg80211_get_start_freq(center_freq, bandwidth); | 
 | 	end_freq = cfg80211_get_end_freq(center_freq, bandwidth); | 
 |  | 
 | 	/* | 
 | 	 * Check entire range of channels for the bandwidth. | 
 | 	 * Check all channels are DFS channels (DFS_USABLE or | 
 | 	 * DFS_AVAILABLE). Return number of usable channels | 
 | 	 * (require CAC). Allow DFS and non-DFS channel mix. | 
 | 	 */ | 
 | 	for (freq = start_freq; freq <= end_freq; freq += 20) { | 
 | 		c = ieee80211_get_channel(wiphy, freq); | 
 | 		if (!c) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (c->flags & IEEE80211_CHAN_DISABLED) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (c->flags & IEEE80211_CHAN_RADAR) { | 
 | 			if (c->dfs_state == NL80211_DFS_UNAVAILABLE) | 
 | 				return -EINVAL; | 
 |  | 
 | 			if (c->dfs_state == NL80211_DFS_USABLE) | 
 | 				count++; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return count; | 
 | } | 
 |  | 
 | bool cfg80211_chandef_dfs_usable(struct wiphy *wiphy, | 
 | 				 const struct cfg80211_chan_def *chandef) | 
 | { | 
 | 	int width; | 
 | 	int r1, r2 = 0; | 
 |  | 
 | 	if (WARN_ON(!cfg80211_chandef_valid(chandef))) | 
 | 		return false; | 
 |  | 
 | 	width = cfg80211_chandef_get_width(chandef); | 
 | 	if (width < 0) | 
 | 		return false; | 
 |  | 
 | 	r1 = cfg80211_get_chans_dfs_usable(wiphy, chandef->center_freq1, | 
 | 					  width); | 
 |  | 
 | 	if (r1 < 0) | 
 | 		return false; | 
 |  | 
 | 	switch (chandef->width) { | 
 | 	case NL80211_CHAN_WIDTH_80P80: | 
 | 		WARN_ON(!chandef->center_freq2); | 
 | 		r2 = cfg80211_get_chans_dfs_usable(wiphy, | 
 | 						   chandef->center_freq2, | 
 | 						   width); | 
 | 		if (r2 < 0) | 
 | 			return false; | 
 | 		break; | 
 | 	default: | 
 | 		WARN_ON(chandef->center_freq2); | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	return (r1 + r2 > 0); | 
 | } | 
 |  | 
 | /* | 
 |  * Checks if center frequency of chan falls with in the bandwidth | 
 |  * range of chandef. | 
 |  */ | 
 | bool cfg80211_is_sub_chan(struct cfg80211_chan_def *chandef, | 
 | 			  struct ieee80211_channel *chan) | 
 | { | 
 | 	int width; | 
 | 	u32 cf_offset, freq; | 
 |  | 
 | 	if (chandef->chan->center_freq == chan->center_freq) | 
 | 		return true; | 
 |  | 
 | 	width = cfg80211_chandef_get_width(chandef); | 
 | 	if (width <= 20) | 
 | 		return false; | 
 |  | 
 | 	cf_offset = width / 2 - 10; | 
 |  | 
 | 	for (freq = chandef->center_freq1 - width / 2 + 10; | 
 | 	     freq <= chandef->center_freq1 + width / 2 - 10; freq += 20) { | 
 | 		if (chan->center_freq == freq) | 
 | 			return true; | 
 | 	} | 
 |  | 
 | 	if (!chandef->center_freq2) | 
 | 		return false; | 
 |  | 
 | 	for (freq = chandef->center_freq2 - width / 2 + 10; | 
 | 	     freq <= chandef->center_freq2 + width / 2 - 10; freq += 20) { | 
 | 		if (chan->center_freq == freq) | 
 | 			return true; | 
 | 	} | 
 |  | 
 | 	return false; | 
 | } | 
 |  | 
 | bool cfg80211_beaconing_iface_active(struct wireless_dev *wdev) | 
 | { | 
 | 	bool active = false; | 
 |  | 
 | 	ASSERT_WDEV_LOCK(wdev); | 
 |  | 
 | 	if (!wdev->chandef.chan) | 
 | 		return false; | 
 |  | 
 | 	switch (wdev->iftype) { | 
 | 	case NL80211_IFTYPE_AP: | 
 | 	case NL80211_IFTYPE_P2P_GO: | 
 | 		active = wdev->beacon_interval != 0; | 
 | 		break; | 
 | 	case NL80211_IFTYPE_ADHOC: | 
 | 		active = wdev->ssid_len != 0; | 
 | 		break; | 
 | 	case NL80211_IFTYPE_MESH_POINT: | 
 | 		active = wdev->mesh_id_len != 0; | 
 | 		break; | 
 | 	case NL80211_IFTYPE_STATION: | 
 | 	case NL80211_IFTYPE_OCB: | 
 | 	case NL80211_IFTYPE_P2P_CLIENT: | 
 | 	case NL80211_IFTYPE_MONITOR: | 
 | 	case NL80211_IFTYPE_AP_VLAN: | 
 | 	case NL80211_IFTYPE_WDS: | 
 | 	case NL80211_IFTYPE_P2P_DEVICE: | 
 | 	/* Can NAN type be considered as beaconing interface? */ | 
 | 	case NL80211_IFTYPE_NAN: | 
 | 		break; | 
 | 	case NL80211_IFTYPE_UNSPECIFIED: | 
 | 	case NUM_NL80211_IFTYPES: | 
 | 		WARN_ON(1); | 
 | 	} | 
 |  | 
 | 	return active; | 
 | } | 
 |  | 
 | static bool cfg80211_is_wiphy_oper_chan(struct wiphy *wiphy, | 
 | 					struct ieee80211_channel *chan) | 
 | { | 
 | 	struct wireless_dev *wdev; | 
 |  | 
 | 	list_for_each_entry(wdev, &wiphy->wdev_list, list) { | 
 | 		wdev_lock(wdev); | 
 | 		if (!cfg80211_beaconing_iface_active(wdev)) { | 
 | 			wdev_unlock(wdev); | 
 | 			continue; | 
 | 		} | 
 |  | 
 | 		if (cfg80211_is_sub_chan(&wdev->chandef, chan)) { | 
 | 			wdev_unlock(wdev); | 
 | 			return true; | 
 | 		} | 
 | 		wdev_unlock(wdev); | 
 | 	} | 
 |  | 
 | 	return false; | 
 | } | 
 |  | 
 | bool cfg80211_any_wiphy_oper_chan(struct wiphy *wiphy, | 
 | 				  struct ieee80211_channel *chan) | 
 | { | 
 | 	struct cfg80211_registered_device *rdev; | 
 |  | 
 | 	ASSERT_RTNL(); | 
 |  | 
 | 	if (!(chan->flags & IEEE80211_CHAN_RADAR)) | 
 | 		return false; | 
 |  | 
 | 	list_for_each_entry(rdev, &cfg80211_rdev_list, list) { | 
 | 		if (!reg_dfs_domain_same(wiphy, &rdev->wiphy)) | 
 | 			continue; | 
 |  | 
 | 		if (cfg80211_is_wiphy_oper_chan(&rdev->wiphy, chan)) | 
 | 			return true; | 
 | 	} | 
 |  | 
 | 	return false; | 
 | } | 
 |  | 
 | static bool cfg80211_get_chans_dfs_available(struct wiphy *wiphy, | 
 | 					     u32 center_freq, | 
 | 					     u32 bandwidth) | 
 | { | 
 | 	struct ieee80211_channel *c; | 
 | 	u32 freq, start_freq, end_freq; | 
 |  | 
 | 	start_freq = cfg80211_get_start_freq(center_freq, bandwidth); | 
 | 	end_freq = cfg80211_get_end_freq(center_freq, bandwidth); | 
 |  | 
 | 	/* | 
 | 	 * Check entire range of channels for the bandwidth. | 
 | 	 * If any channel in between is disabled or has not | 
 | 	 * had gone through CAC return false | 
 | 	 */ | 
 | 	for (freq = start_freq; freq <= end_freq; freq += 20) { | 
 | 		c = ieee80211_get_channel(wiphy, freq); | 
 | 		if (!c) | 
 | 			return false; | 
 |  | 
 | 		if (c->flags & IEEE80211_CHAN_DISABLED) | 
 | 			return false; | 
 |  | 
 | 		if ((c->flags & IEEE80211_CHAN_RADAR)  && | 
 | 		    (c->dfs_state != NL80211_DFS_AVAILABLE)) | 
 | 			return false; | 
 | 	} | 
 |  | 
 | 	return true; | 
 | } | 
 |  | 
 | static bool cfg80211_chandef_dfs_available(struct wiphy *wiphy, | 
 | 				const struct cfg80211_chan_def *chandef) | 
 | { | 
 | 	int width; | 
 | 	int r; | 
 |  | 
 | 	if (WARN_ON(!cfg80211_chandef_valid(chandef))) | 
 | 		return false; | 
 |  | 
 | 	width = cfg80211_chandef_get_width(chandef); | 
 | 	if (width < 0) | 
 | 		return false; | 
 |  | 
 | 	r = cfg80211_get_chans_dfs_available(wiphy, chandef->center_freq1, | 
 | 					     width); | 
 |  | 
 | 	/* If any of channels unavailable for cf1 just return */ | 
 | 	if (!r) | 
 | 		return r; | 
 |  | 
 | 	switch (chandef->width) { | 
 | 	case NL80211_CHAN_WIDTH_80P80: | 
 | 		WARN_ON(!chandef->center_freq2); | 
 | 		r = cfg80211_get_chans_dfs_available(wiphy, | 
 | 						     chandef->center_freq2, | 
 | 						     width); | 
 | 		break; | 
 | 	default: | 
 | 		WARN_ON(chandef->center_freq2); | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	return r; | 
 | } | 
 |  | 
 | static unsigned int cfg80211_get_chans_dfs_cac_time(struct wiphy *wiphy, | 
 | 						    u32 center_freq, | 
 | 						    u32 bandwidth) | 
 | { | 
 | 	struct ieee80211_channel *c; | 
 | 	u32 start_freq, end_freq, freq; | 
 | 	unsigned int dfs_cac_ms = 0; | 
 |  | 
 | 	start_freq = cfg80211_get_start_freq(center_freq, bandwidth); | 
 | 	end_freq = cfg80211_get_end_freq(center_freq, bandwidth); | 
 |  | 
 | 	for (freq = start_freq; freq <= end_freq; freq += 20) { | 
 | 		c = ieee80211_get_channel(wiphy, freq); | 
 | 		if (!c) | 
 | 			return 0; | 
 |  | 
 | 		if (c->flags & IEEE80211_CHAN_DISABLED) | 
 | 			return 0; | 
 |  | 
 | 		if (!(c->flags & IEEE80211_CHAN_RADAR)) | 
 | 			continue; | 
 |  | 
 | 		if (c->dfs_cac_ms > dfs_cac_ms) | 
 | 			dfs_cac_ms = c->dfs_cac_ms; | 
 | 	} | 
 |  | 
 | 	return dfs_cac_ms; | 
 | } | 
 |  | 
 | unsigned int | 
 | cfg80211_chandef_dfs_cac_time(struct wiphy *wiphy, | 
 | 			      const struct cfg80211_chan_def *chandef) | 
 | { | 
 | 	int width; | 
 | 	unsigned int t1 = 0, t2 = 0; | 
 |  | 
 | 	if (WARN_ON(!cfg80211_chandef_valid(chandef))) | 
 | 		return 0; | 
 |  | 
 | 	width = cfg80211_chandef_get_width(chandef); | 
 | 	if (width < 0) | 
 | 		return 0; | 
 |  | 
 | 	t1 = cfg80211_get_chans_dfs_cac_time(wiphy, | 
 | 					     chandef->center_freq1, | 
 | 					     width); | 
 |  | 
 | 	if (!chandef->center_freq2) | 
 | 		return t1; | 
 |  | 
 | 	t2 = cfg80211_get_chans_dfs_cac_time(wiphy, | 
 | 					     chandef->center_freq2, | 
 | 					     width); | 
 |  | 
 | 	return max(t1, t2); | 
 | } | 
 |  | 
 | static bool cfg80211_secondary_chans_ok(struct wiphy *wiphy, | 
 | 					u32 center_freq, u32 bandwidth, | 
 | 					u32 prohibited_flags) | 
 | { | 
 | 	struct ieee80211_channel *c; | 
 | 	u32 freq, start_freq, end_freq; | 
 |  | 
 | 	start_freq = cfg80211_get_start_freq(center_freq, bandwidth); | 
 | 	end_freq = cfg80211_get_end_freq(center_freq, bandwidth); | 
 |  | 
 | 	for (freq = start_freq; freq <= end_freq; freq += 20) { | 
 | 		c = ieee80211_get_channel(wiphy, freq); | 
 | 		if (!c || c->flags & prohibited_flags) | 
 | 			return false; | 
 | 	} | 
 |  | 
 | 	return true; | 
 | } | 
 |  | 
 | bool cfg80211_chandef_usable(struct wiphy *wiphy, | 
 | 			     const struct cfg80211_chan_def *chandef, | 
 | 			     u32 prohibited_flags) | 
 | { | 
 | 	struct ieee80211_sta_ht_cap *ht_cap; | 
 | 	struct ieee80211_sta_vht_cap *vht_cap; | 
 | 	u32 width, control_freq, cap; | 
 |  | 
 | 	if (WARN_ON(!cfg80211_chandef_valid(chandef))) | 
 | 		return false; | 
 |  | 
 | 	ht_cap = &wiphy->bands[chandef->chan->band]->ht_cap; | 
 | 	vht_cap = &wiphy->bands[chandef->chan->band]->vht_cap; | 
 |  | 
 | 	control_freq = chandef->chan->center_freq; | 
 |  | 
 | 	switch (chandef->width) { | 
 | 	case NL80211_CHAN_WIDTH_5: | 
 | 		width = 5; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_10: | 
 | 		prohibited_flags |= IEEE80211_CHAN_NO_10MHZ; | 
 | 		width = 10; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_20: | 
 | 		if (!ht_cap->ht_supported) | 
 | 			return false; | 
 | 	case NL80211_CHAN_WIDTH_20_NOHT: | 
 | 		prohibited_flags |= IEEE80211_CHAN_NO_20MHZ; | 
 | 		width = 20; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_40: | 
 | 		width = 40; | 
 | 		if (!ht_cap->ht_supported) | 
 | 			return false; | 
 | 		if (!(ht_cap->cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) || | 
 | 		    ht_cap->cap & IEEE80211_HT_CAP_40MHZ_INTOLERANT) | 
 | 			return false; | 
 | 		if (chandef->center_freq1 < control_freq && | 
 | 		    chandef->chan->flags & IEEE80211_CHAN_NO_HT40MINUS) | 
 | 			return false; | 
 | 		if (chandef->center_freq1 > control_freq && | 
 | 		    chandef->chan->flags & IEEE80211_CHAN_NO_HT40PLUS) | 
 | 			return false; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_80P80: | 
 | 		cap = vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK; | 
 | 		if (cap != IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) | 
 | 			return false; | 
 | 	case NL80211_CHAN_WIDTH_80: | 
 | 		if (!vht_cap->vht_supported) | 
 | 			return false; | 
 | 		prohibited_flags |= IEEE80211_CHAN_NO_80MHZ; | 
 | 		width = 80; | 
 | 		break; | 
 | 	case NL80211_CHAN_WIDTH_160: | 
 | 		if (!vht_cap->vht_supported) | 
 | 			return false; | 
 | 		cap = vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK; | 
 | 		if (cap != IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ && | 
 | 		    cap != IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) | 
 | 			return false; | 
 | 		prohibited_flags |= IEEE80211_CHAN_NO_160MHZ; | 
 | 		width = 160; | 
 | 		break; | 
 | 	default: | 
 | 		WARN_ON_ONCE(1); | 
 | 		return false; | 
 | 	} | 
 |  | 
 | 	/* | 
 | 	 * TODO: What if there are only certain 80/160/80+80 MHz channels | 
 | 	 *	 allowed by the driver, or only certain combinations? | 
 | 	 *	 For 40 MHz the driver can set the NO_HT40 flags, but for | 
 | 	 *	 80/160 MHz and in particular 80+80 MHz this isn't really | 
 | 	 *	 feasible and we only have NO_80MHZ/NO_160MHZ so far but | 
 | 	 *	 no way to cover 80+80 MHz or more complex restrictions. | 
 | 	 *	 Note that such restrictions also need to be advertised to | 
 | 	 *	 userspace, for example for P2P channel selection. | 
 | 	 */ | 
 |  | 
 | 	if (width > 20) | 
 | 		prohibited_flags |= IEEE80211_CHAN_NO_OFDM; | 
 |  | 
 | 	/* 5 and 10 MHz are only defined for the OFDM PHY */ | 
 | 	if (width < 20) | 
 | 		prohibited_flags |= IEEE80211_CHAN_NO_OFDM; | 
 |  | 
 |  | 
 | 	if (!cfg80211_secondary_chans_ok(wiphy, chandef->center_freq1, | 
 | 					 width, prohibited_flags)) | 
 | 		return false; | 
 |  | 
 | 	if (!chandef->center_freq2) | 
 | 		return true; | 
 | 	return cfg80211_secondary_chans_ok(wiphy, chandef->center_freq2, | 
 | 					   width, prohibited_flags); | 
 | } | 
 | EXPORT_SYMBOL(cfg80211_chandef_usable); | 
 |  | 
 | /* | 
 |  * Check if the channel can be used under permissive conditions mandated by | 
 |  * some regulatory bodies, i.e., the channel is marked with | 
 |  * IEEE80211_CHAN_IR_CONCURRENT and there is an additional station interface | 
 |  * associated to an AP on the same channel or on the same UNII band | 
 |  * (assuming that the AP is an authorized master). | 
 |  * In addition allow operation on a channel on which indoor operation is | 
 |  * allowed, iff we are currently operating in an indoor environment. | 
 |  */ | 
 | static bool cfg80211_ir_permissive_chan(struct wiphy *wiphy, | 
 | 					enum nl80211_iftype iftype, | 
 | 					struct ieee80211_channel *chan) | 
 | { | 
 | 	struct wireless_dev *wdev; | 
 | 	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); | 
 |  | 
 | 	ASSERT_RTNL(); | 
 |  | 
 | 	if (!IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) || | 
 | 	    !(wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR)) | 
 | 		return false; | 
 |  | 
 | 	/* only valid for GO and TDLS off-channel (station/p2p-CL) */ | 
 | 	if (iftype != NL80211_IFTYPE_P2P_GO && | 
 | 	    iftype != NL80211_IFTYPE_STATION && | 
 | 	    iftype != NL80211_IFTYPE_P2P_CLIENT) | 
 | 		return false; | 
 |  | 
 | 	if (regulatory_indoor_allowed() && | 
 | 	    (chan->flags & IEEE80211_CHAN_INDOOR_ONLY)) | 
 | 		return true; | 
 |  | 
 | 	if (!(chan->flags & IEEE80211_CHAN_IR_CONCURRENT)) | 
 | 		return false; | 
 |  | 
 | 	/* | 
 | 	 * Generally, it is possible to rely on another device/driver to allow | 
 | 	 * the IR concurrent relaxation, however, since the device can further | 
 | 	 * enforce the relaxation (by doing a similar verifications as this), | 
 | 	 * and thus fail the GO instantiation, consider only the interfaces of | 
 | 	 * the current registered device. | 
 | 	 */ | 
 | 	list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { | 
 | 		struct ieee80211_channel *other_chan = NULL; | 
 | 		int r1, r2; | 
 |  | 
 | 		wdev_lock(wdev); | 
 | 		if (wdev->iftype == NL80211_IFTYPE_STATION && | 
 | 		    wdev->current_bss) | 
 | 			other_chan = wdev->current_bss->pub.channel; | 
 |  | 
 | 		/* | 
 | 		 * If a GO already operates on the same GO_CONCURRENT channel, | 
 | 		 * this one (maybe the same one) can beacon as well. We allow | 
 | 		 * the operation even if the station we relied on with | 
 | 		 * GO_CONCURRENT is disconnected now. But then we must make sure | 
 | 		 * we're not outdoor on an indoor-only channel. | 
 | 		 */ | 
 | 		if (iftype == NL80211_IFTYPE_P2P_GO && | 
 | 		    wdev->iftype == NL80211_IFTYPE_P2P_GO && | 
 | 		    wdev->beacon_interval && | 
 | 		    !(chan->flags & IEEE80211_CHAN_INDOOR_ONLY)) | 
 | 			other_chan = wdev->chandef.chan; | 
 | 		wdev_unlock(wdev); | 
 |  | 
 | 		if (!other_chan) | 
 | 			continue; | 
 |  | 
 | 		if (chan == other_chan) | 
 | 			return true; | 
 |  | 
 | 		if (chan->band != NL80211_BAND_5GHZ) | 
 | 			continue; | 
 |  | 
 | 		r1 = cfg80211_get_unii(chan->center_freq); | 
 | 		r2 = cfg80211_get_unii(other_chan->center_freq); | 
 |  | 
 | 		if (r1 != -EINVAL && r1 == r2) { | 
 | 			/* | 
 | 			 * At some locations channels 149-165 are considered a | 
 | 			 * bundle, but at other locations, e.g., Indonesia, | 
 | 			 * channels 149-161 are considered a bundle while | 
 | 			 * channel 165 is left out and considered to be in a | 
 | 			 * different bundle. Thus, in case that there is a | 
 | 			 * station interface connected to an AP on channel 165, | 
 | 			 * it is assumed that channels 149-161 are allowed for | 
 | 			 * GO operations. However, having a station interface | 
 | 			 * connected to an AP on channels 149-161, does not | 
 | 			 * allow GO operation on channel 165. | 
 | 			 */ | 
 | 			if (chan->center_freq == 5825 && | 
 | 			    other_chan->center_freq != 5825) | 
 | 				continue; | 
 | 			return true; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return false; | 
 | } | 
 |  | 
 | static bool _cfg80211_reg_can_beacon(struct wiphy *wiphy, | 
 | 				     struct cfg80211_chan_def *chandef, | 
 | 				     enum nl80211_iftype iftype, | 
 | 				     bool check_no_ir) | 
 | { | 
 | 	bool res; | 
 | 	u32 prohibited_flags = IEEE80211_CHAN_DISABLED | | 
 | 			       IEEE80211_CHAN_RADAR; | 
 |  | 
 | 	trace_cfg80211_reg_can_beacon(wiphy, chandef, iftype, check_no_ir); | 
 |  | 
 | 	if (check_no_ir) | 
 | 		prohibited_flags |= IEEE80211_CHAN_NO_IR; | 
 |  | 
 | 	if (cfg80211_chandef_dfs_required(wiphy, chandef, iftype) > 0 && | 
 | 	    cfg80211_chandef_dfs_available(wiphy, chandef)) { | 
 | 		/* We can skip IEEE80211_CHAN_NO_IR if chandef dfs available */ | 
 | 		prohibited_flags = IEEE80211_CHAN_DISABLED; | 
 | 	} | 
 |  | 
 | 	res = cfg80211_chandef_usable(wiphy, chandef, prohibited_flags); | 
 |  | 
 | 	trace_cfg80211_return_bool(res); | 
 | 	return res; | 
 | } | 
 |  | 
 | bool cfg80211_reg_can_beacon(struct wiphy *wiphy, | 
 | 			     struct cfg80211_chan_def *chandef, | 
 | 			     enum nl80211_iftype iftype) | 
 | { | 
 | 	return _cfg80211_reg_can_beacon(wiphy, chandef, iftype, true); | 
 | } | 
 | EXPORT_SYMBOL(cfg80211_reg_can_beacon); | 
 |  | 
 | bool cfg80211_reg_can_beacon_relax(struct wiphy *wiphy, | 
 | 				   struct cfg80211_chan_def *chandef, | 
 | 				   enum nl80211_iftype iftype) | 
 | { | 
 | 	bool check_no_ir; | 
 |  | 
 | 	ASSERT_RTNL(); | 
 |  | 
 | 	/* | 
 | 	 * Under certain conditions suggested by some regulatory bodies a | 
 | 	 * GO/STA can IR on channels marked with IEEE80211_NO_IR. Set this flag | 
 | 	 * only if such relaxations are not enabled and the conditions are not | 
 | 	 * met. | 
 | 	 */ | 
 | 	check_no_ir = !cfg80211_ir_permissive_chan(wiphy, iftype, | 
 | 						   chandef->chan); | 
 |  | 
 | 	return _cfg80211_reg_can_beacon(wiphy, chandef, iftype, check_no_ir); | 
 | } | 
 | EXPORT_SYMBOL(cfg80211_reg_can_beacon_relax); | 
 |  | 
 | int cfg80211_set_monitor_channel(struct cfg80211_registered_device *rdev, | 
 | 				 struct cfg80211_chan_def *chandef) | 
 | { | 
 | 	if (!rdev->ops->set_monitor_channel) | 
 | 		return -EOPNOTSUPP; | 
 | 	if (!cfg80211_has_monitors_only(rdev)) | 
 | 		return -EBUSY; | 
 |  | 
 | 	return rdev_set_monitor_channel(rdev, chandef); | 
 | } | 
 |  | 
 | void | 
 | cfg80211_get_chan_state(struct wireless_dev *wdev, | 
 | 		        struct ieee80211_channel **chan, | 
 | 		        enum cfg80211_chan_mode *chanmode, | 
 | 		        u8 *radar_detect) | 
 | { | 
 | 	int ret; | 
 |  | 
 | 	*chan = NULL; | 
 | 	*chanmode = CHAN_MODE_UNDEFINED; | 
 |  | 
 | 	ASSERT_WDEV_LOCK(wdev); | 
 |  | 
 | 	if (wdev->netdev && !netif_running(wdev->netdev)) | 
 | 		return; | 
 |  | 
 | 	switch (wdev->iftype) { | 
 | 	case NL80211_IFTYPE_ADHOC: | 
 | 		if (wdev->current_bss) { | 
 | 			*chan = wdev->current_bss->pub.channel; | 
 | 			*chanmode = (wdev->ibss_fixed && | 
 | 				     !wdev->ibss_dfs_possible) | 
 | 				  ? CHAN_MODE_SHARED | 
 | 				  : CHAN_MODE_EXCLUSIVE; | 
 |  | 
 | 			/* consider worst-case - IBSS can try to return to the | 
 | 			 * original user-specified channel as creator */ | 
 | 			if (wdev->ibss_dfs_possible) | 
 | 				*radar_detect |= BIT(wdev->chandef.width); | 
 | 			return; | 
 | 		} | 
 | 		break; | 
 | 	case NL80211_IFTYPE_STATION: | 
 | 	case NL80211_IFTYPE_P2P_CLIENT: | 
 | 		if (wdev->current_bss) { | 
 | 			*chan = wdev->current_bss->pub.channel; | 
 | 			*chanmode = CHAN_MODE_SHARED; | 
 | 			return; | 
 | 		} | 
 | 		break; | 
 | 	case NL80211_IFTYPE_AP: | 
 | 	case NL80211_IFTYPE_P2P_GO: | 
 | 		if (wdev->cac_started) { | 
 | 			*chan = wdev->chandef.chan; | 
 | 			*chanmode = CHAN_MODE_SHARED; | 
 | 			*radar_detect |= BIT(wdev->chandef.width); | 
 | 		} else if (wdev->beacon_interval) { | 
 | 			*chan = wdev->chandef.chan; | 
 | 			*chanmode = CHAN_MODE_SHARED; | 
 |  | 
 | 			ret = cfg80211_chandef_dfs_required(wdev->wiphy, | 
 | 							    &wdev->chandef, | 
 | 							    wdev->iftype); | 
 | 			WARN_ON(ret < 0); | 
 | 			if (ret > 0) | 
 | 				*radar_detect |= BIT(wdev->chandef.width); | 
 | 		} | 
 | 		return; | 
 | 	case NL80211_IFTYPE_MESH_POINT: | 
 | 		if (wdev->mesh_id_len) { | 
 | 			*chan = wdev->chandef.chan; | 
 | 			*chanmode = CHAN_MODE_SHARED; | 
 |  | 
 | 			ret = cfg80211_chandef_dfs_required(wdev->wiphy, | 
 | 							    &wdev->chandef, | 
 | 							    wdev->iftype); | 
 | 			WARN_ON(ret < 0); | 
 | 			if (ret > 0) | 
 | 				*radar_detect |= BIT(wdev->chandef.width); | 
 | 		} | 
 | 		return; | 
 | 	case NL80211_IFTYPE_OCB: | 
 | 		if (wdev->chandef.chan) { | 
 | 			*chan = wdev->chandef.chan; | 
 | 			*chanmode = CHAN_MODE_SHARED; | 
 | 			return; | 
 | 		} | 
 | 		break; | 
 | 	case NL80211_IFTYPE_MONITOR: | 
 | 	case NL80211_IFTYPE_AP_VLAN: | 
 | 	case NL80211_IFTYPE_WDS: | 
 | 	case NL80211_IFTYPE_P2P_DEVICE: | 
 | 	case NL80211_IFTYPE_NAN: | 
 | 		/* these interface types don't really have a channel */ | 
 | 		return; | 
 | 	case NL80211_IFTYPE_UNSPECIFIED: | 
 | 	case NUM_NL80211_IFTYPES: | 
 | 		WARN_ON(1); | 
 | 	} | 
 | } |