|  | // 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 freq; | 
|  |  | 
|  | if (chandef->chan->center_freq == chan->center_freq) | 
|  | return true; | 
|  |  | 
|  | width = cfg80211_chandef_get_width(chandef); | 
|  | if (width <= 20) | 
|  | return false; | 
|  |  | 
|  | 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; | 
|  | bool dfs_offload; | 
|  |  | 
|  | dfs_offload = wiphy_ext_feature_isset(wiphy, | 
|  | NL80211_EXT_FEATURE_DFS_OFFLOAD); | 
|  |  | 
|  | 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) && | 
|  | !(c->dfs_state == NL80211_DFS_USABLE && dfs_offload)) | 
|  | 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); | 
|  | } | 
|  | } |