161 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
			
		
		
	
	
			161 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
--- a/include/net/cfg80211.h
 | 
						|
+++ b/include/net/cfg80211.h
 | 
						|
@@ -2361,6 +2361,7 @@ struct cfg80211_qos_map {
 | 
						|
  *	(as advertised by the nl80211 feature flag.)
 | 
						|
  * @get_tx_power: store the current TX power into the dbm variable;
 | 
						|
  *	return 0 if successful
 | 
						|
+ * @set_antenna_gain: set antenna gain to reduce maximum tx power if necessary
 | 
						|
  *
 | 
						|
  * @set_wds_peer: set the WDS peer for a WDS interface
 | 
						|
  *
 | 
						|
@@ -2617,6 +2618,7 @@ struct cfg80211_ops {
 | 
						|
 				enum nl80211_tx_power_setting type, int mbm);
 | 
						|
 	int	(*get_tx_power)(struct wiphy *wiphy, struct wireless_dev *wdev,
 | 
						|
 				int *dbm);
 | 
						|
+	int	(*set_antenna_gain)(struct wiphy *wiphy, int dbi);
 | 
						|
 
 | 
						|
 	int	(*set_wds_peer)(struct wiphy *wiphy, struct net_device *dev,
 | 
						|
 				const u8 *addr);
 | 
						|
--- a/include/net/mac80211.h
 | 
						|
+++ b/include/net/mac80211.h
 | 
						|
@@ -1250,6 +1250,7 @@ enum ieee80211_smps_mode {
 | 
						|
  *
 | 
						|
  * @power_level: requested transmit power (in dBm), backward compatibility
 | 
						|
  *	value only that is set to the minimum of all interfaces
 | 
						|
+ * @max_antenna_gain: maximum antenna gain adjusted by user config (in dBi)
 | 
						|
  *
 | 
						|
  * @chandef: the channel definition to tune to
 | 
						|
  * @radar_enabled: whether radar detection is enabled
 | 
						|
@@ -1270,6 +1271,7 @@ enum ieee80211_smps_mode {
 | 
						|
 struct ieee80211_conf {
 | 
						|
 	u32 flags;
 | 
						|
 	int power_level, dynamic_ps_timeout;
 | 
						|
+	int max_antenna_gain;
 | 
						|
 
 | 
						|
 	u16 listen_interval;
 | 
						|
 	u8 ps_dtim_period;
 | 
						|
--- a/include/uapi/linux/nl80211.h
 | 
						|
+++ b/include/uapi/linux/nl80211.h
 | 
						|
@@ -1783,6 +1783,9 @@ enum nl80211_commands {
 | 
						|
  *	between scans. The scan plans are executed sequentially.
 | 
						|
  *	Each scan plan is a nested attribute of &enum nl80211_sched_scan_plan.
 | 
						|
  *
 | 
						|
+ * @NL80211_ATTR_WIPHY_ANTENNA_GAIN: Configured antenna gain. Used to reduce
 | 
						|
+ *	transmit power to stay within regulatory limits. u32, dBi.
 | 
						|
+ *
 | 
						|
  * @NUM_NL80211_ATTR: total number of nl80211_attrs available
 | 
						|
  * @NL80211_ATTR_MAX: highest attribute number currently defined
 | 
						|
  * @__NL80211_ATTR_AFTER_LAST: internal use
 | 
						|
@@ -2157,6 +2160,8 @@ enum nl80211_attrs {
 | 
						|
 	NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
 | 
						|
 	NL80211_ATTR_SCHED_SCAN_PLANS,
 | 
						|
 
 | 
						|
+	NL80211_ATTR_WIPHY_ANTENNA_GAIN,
 | 
						|
+
 | 
						|
 	/* add attributes here, update the policy in nl80211.c */
 | 
						|
 
 | 
						|
 	__NL80211_ATTR_AFTER_LAST,
 | 
						|
--- a/net/mac80211/cfg.c
 | 
						|
+++ b/net/mac80211/cfg.c
 | 
						|
@@ -2206,6 +2206,19 @@ static int ieee80211_get_tx_power(struct
 | 
						|
 	return 0;
 | 
						|
 }
 | 
						|
 
 | 
						|
+static int ieee80211_set_antenna_gain(struct wiphy *wiphy, int dbi)
 | 
						|
+{
 | 
						|
+	struct ieee80211_local *local = wiphy_priv(wiphy);
 | 
						|
+
 | 
						|
+	if (dbi < 0)
 | 
						|
+		return -EINVAL;
 | 
						|
+
 | 
						|
+	local->user_antenna_gain = dbi;
 | 
						|
+	ieee80211_hw_config(local, 0);
 | 
						|
+
 | 
						|
+	return 0;
 | 
						|
+}
 | 
						|
+
 | 
						|
 static int ieee80211_set_wds_peer(struct wiphy *wiphy, struct net_device *dev,
 | 
						|
 				  const u8 *addr)
 | 
						|
 {
 | 
						|
@@ -3849,6 +3862,7 @@ const struct cfg80211_ops mac80211_confi
 | 
						|
 	.set_wiphy_params = ieee80211_set_wiphy_params,
 | 
						|
 	.set_tx_power = ieee80211_set_tx_power,
 | 
						|
 	.get_tx_power = ieee80211_get_tx_power,
 | 
						|
+	.set_antenna_gain = ieee80211_set_antenna_gain,
 | 
						|
 	.set_wds_peer = ieee80211_set_wds_peer,
 | 
						|
 	.rfkill_poll = ieee80211_rfkill_poll,
 | 
						|
 	CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd)
 | 
						|
--- a/net/mac80211/ieee80211_i.h
 | 
						|
+++ b/net/mac80211/ieee80211_i.h
 | 
						|
@@ -1321,6 +1321,7 @@ struct ieee80211_local {
 | 
						|
 	int dynamic_ps_forced_timeout;
 | 
						|
 
 | 
						|
 	int user_power_level; /* in dBm, for all interfaces */
 | 
						|
+	int user_antenna_gain; /* in dBi */
 | 
						|
 
 | 
						|
 	enum ieee80211_smps_mode smps_mode;
 | 
						|
 
 | 
						|
--- a/net/mac80211/main.c
 | 
						|
+++ b/net/mac80211/main.c
 | 
						|
@@ -93,7 +93,7 @@ static u32 ieee80211_hw_conf_chan(struct
 | 
						|
 	struct ieee80211_sub_if_data *sdata;
 | 
						|
 	struct cfg80211_chan_def chandef = {};
 | 
						|
 	u32 changed = 0;
 | 
						|
-	int power;
 | 
						|
+	int power, max_power;
 | 
						|
 	u32 offchannel_flag;
 | 
						|
 
 | 
						|
 	offchannel_flag = local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
 | 
						|
@@ -150,6 +150,12 @@ static u32 ieee80211_hw_conf_chan(struct
 | 
						|
 	}
 | 
						|
 	rcu_read_unlock();
 | 
						|
 
 | 
						|
+	max_power = chandef.chan->max_reg_power;
 | 
						|
+	if (local->user_antenna_gain > 0) {
 | 
						|
+		max_power -= local->user_antenna_gain;
 | 
						|
+		power = min(power, max_power);
 | 
						|
+	}
 | 
						|
+
 | 
						|
 	if (local->hw.conf.power_level != power) {
 | 
						|
 		changed |= IEEE80211_CONF_CHANGE_POWER;
 | 
						|
 		local->hw.conf.power_level = power;
 | 
						|
@@ -580,6 +586,7 @@ struct ieee80211_hw *ieee80211_alloc_hw_
 | 
						|
 					 IEEE80211_RADIOTAP_MCS_HAVE_BW;
 | 
						|
 	local->hw.radiotap_vht_details = IEEE80211_RADIOTAP_VHT_KNOWN_GI |
 | 
						|
 					 IEEE80211_RADIOTAP_VHT_KNOWN_BANDWIDTH;
 | 
						|
+	local->user_antenna_gain = 0;
 | 
						|
 	local->hw.uapsd_queues = IEEE80211_DEFAULT_UAPSD_QUEUES;
 | 
						|
 	local->hw.uapsd_max_sp_len = IEEE80211_DEFAULT_MAX_SP_LEN;
 | 
						|
 	local->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
 | 
						|
--- a/net/wireless/nl80211.c
 | 
						|
+++ b/net/wireless/nl80211.c
 | 
						|
@@ -403,6 +403,7 @@ static const struct nla_policy nl80211_p
 | 
						|
 	[NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
 | 
						|
 	[NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
 | 
						|
 	[NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
 | 
						|
+	[NL80211_ATTR_WIPHY_ANTENNA_GAIN] = { .type = NLA_U32 },
 | 
						|
 };
 | 
						|
 
 | 
						|
 /* policy for the key attributes */
 | 
						|
@@ -2220,6 +2221,20 @@ static int nl80211_set_wiphy(struct sk_b
 | 
						|
 		if (result)
 | 
						|
 			return result;
 | 
						|
 	}
 | 
						|
+
 | 
						|
+	if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_GAIN]) {
 | 
						|
+		int idx, dbi = 0;
 | 
						|
+
 | 
						|
+		if (!rdev->ops->set_antenna_gain)
 | 
						|
+			return -EOPNOTSUPP;
 | 
						|
+
 | 
						|
+		idx = NL80211_ATTR_WIPHY_ANTENNA_GAIN;
 | 
						|
+		dbi = nla_get_u32(info->attrs[idx]);
 | 
						|
+
 | 
						|
+		result = rdev->ops->set_antenna_gain(&rdev->wiphy, dbi);
 | 
						|
+		if (result)
 | 
						|
+			return result;
 | 
						|
+	}
 | 
						|
 
 | 
						|
 	if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
 | 
						|
 	    info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
 |