qcacld-3.0: set tx power changes for SAP if is in unsafe channel

Set tx power for SAP interface if it is unsafe channel and
if user sets restriction mask.
If interface unable to find safe channel and if restriction
mask is set then stop the SAP.

Change-Id: Ibdec18b9b749f18b1e9d704974f4cbaabbc4e613
CRs-Fixed: 3103307

core/hdd/inc/wlan_hdd_main.h

@@ -2061,6 +2061,9 @@ struct hdd_context {
 	uint16_t unsafe_channel_count;
 	uint16_t unsafe_channel_list[NUM_CHANNELS];
 #endif /* FEATURE_WLAN_CH_AVOID */
+#ifdef FEATURE_WLAN_CH_AVOID_EXT
+	uint8_t restriction_mask;
+#endif
 
 	uint8_t max_intf_count;
 #ifdef WLAN_FEATURE_LPSS

core/hdd/src/wlan_hdd_hostapd.c

@@ -127,6 +127,7 @@
 #else
 #define MAX_SAP_NUM_CONCURRENCY_WITH_NAN 1
 #endif
+#include "../../core/src/reg_priv_objs.h"
 
 #ifndef BSS_MEMBERSHIP_SELECTOR_HT_PHY
 #define BSS_MEMBERSHIP_SELECTOR_HT_PHY  127
@@ -3348,11 +3349,136 @@ int hdd_softap_set_channel_change(struct net_device *dev, int target_chan_freq,
 	return ret;
 }
 
+
+#if defined(FEATURE_WLAN_CH_AVOID) && defined(FEATURE_WLAN_CH_AVOID_EXT)
+/**
+ * wlan_hdd_get_sap_restriction_mask() - get restriction mask for sap
+ * after sap start
+ * @hdd_context: hdd context
+ *
+ * Return: Restriction mask
+ */
+static inline
+uint8_t wlan_hdd_get_sap_restriction_mask(struct hdd_context *hdd_ctx)
+{
+	return hdd_ctx->coex_avoid_freq_list.restriction_mask;
+}
+
+/**
+ * wlan_hdd_fetch_sap_restriction_mask() - fetch restriction mask for sap
+ * before sap start.
+ * @hdd_context: hdd context
+ * @sap_context: sap_conext
+ *
+ * Return: None
+ */
+static inline
+void wlan_hdd_fetch_sap_restriction_mask(struct hdd_context *hdd_ctx,
+					 struct sap_context *sap_ctx)
+{
+	sap_ctx->restriction_mask =
+		hdd_ctx->coex_avoid_freq_list.restriction_mask;
+}
+#else
+static inline
+uint8_t wlan_hdd_get_sap_restriction_mask(struct hdd_context *hdd_ctx)
+{
+	return -EINVAL;
+}
+
+static inline
+void wlan_hdd_fetch_sap_restriction_mask(struct hdd_context *hdd_ctx,
+					 struct sap_context *sap_ctx)
+{
+}
+#endif
+
+void hdd_stop_sap_set_tx_power(struct wlan_objmgr_psoc *psoc,
+			       struct hdd_adapter *adapter)
+{
+	struct wlan_objmgr_vdev *vdev =
+		hdd_objmgr_get_vdev_by_user(adapter, WLAN_OSIF_ID);
+	struct wlan_objmgr_pdev *pdev = wlan_vdev_get_pdev(vdev);
+	struct hdd_context *hdd_ctx = WLAN_HDD_GET_CTX(adapter);
+	struct qdf_mac_addr bssid;
+	struct wlan_regulatory_psoc_priv_obj *psoc_priv_obj;
+	int32_t set_tx_power, tx_power = 0;
+	struct sap_context *sap_ctx;
+	int8_t restriction_mask;
+	int ch_loop, unsafe_chan_count;
+	struct unsafe_ch_list *unsafe_ch_list;
+	uint32_t chan_freq;
+	bool is_valid_txpower = false;
+
+	hdd_objmgr_put_vdev_by_user(vdev, WLAN_OSIF_ID);
+
+	psoc_priv_obj = reg_get_psoc_obj(psoc);
+	if (!psoc_priv_obj) {
+		reg_err("reg psoc private obj is NULL");
+		return;
+	}
+
+	restriction_mask = wlan_hdd_get_sap_restriction_mask(hdd_ctx);
+	sap_ctx = WLAN_HDD_GET_SAP_CTX_PTR(adapter);
+	chan_freq = sap_ctx->chan_freq;
+	unsafe_ch_list = &psoc_priv_obj->unsafe_chan_list;
+
+	hdd_debug("Restriction_mask %d CSA reason %d ", restriction_mask,
+		  sap_ctx->csa_reason);
+
+	if (sap_ctx->csa_reason == CSA_REASON_UNSAFE_CHANNEL) {
+		if (restriction_mask == NL80211_IFTYPE_AP) {
+			schedule_work(&adapter->sap_stop_bss_work);
+		} else {
+			unsafe_chan_count = unsafe_ch_list->chan_cnt;
+			qdf_copy_macaddr(&bssid, &adapter->mac_addr);
+			set_tx_power =
+			wlan_reg_get_channel_reg_power_for_freq(pdev,
+								chan_freq);
+			for (ch_loop = 0; ch_loop < unsafe_chan_count;
+			     ch_loop++) {
+				if (unsafe_ch_list->chan_freq_list[ch_loop] ==
+				    chan_freq) {
+					tx_power =
+					unsafe_ch_list->txpower[ch_loop];
+					is_valid_txpower =
+					unsafe_ch_list->is_valid_txpower[ch_loop];
+					break;
+				}
+			}
+
+			if (is_valid_txpower)
+				set_tx_power = QDF_MIN(set_tx_power, tx_power);
+
+			if (QDF_STATUS_SUCCESS !=
+				sme_set_tx_power(hdd_ctx->mac_handle,
+						 adapter->vdev_id, bssid,
+						 adapter->device_mode,
+						 set_tx_power)) {
+				hdd_err("Setting tx power failed");
+			}
+		}
+	}
+}
+
 #ifdef FEATURE_WLAN_MCC_TO_SCC_SWITCH
-void hdd_sap_restart_with_channel_switch(struct hdd_adapter *ap_adapter,
-					uint32_t target_chan_freq,
-					uint32_t target_bw,
-					bool forced)
+/**
+ * hdd_sap_restart_with_channel_switch() - SAP channel change with E/CSA
+ * @wlan_objmgr_psoc: psoc common object
+ * @ap_adapter: HDD adapter
+ * @target_channel: Channel to which switch must happen
+ * @target_bw: Bandwidth of the target channel
+ * @forced: Force to switch channel, ignore SCC/MCC check
+ *
+ * Invokes the necessary API to perform channel switch for the SAP or GO
+ *
+ * Return: None
+ */
+void hdd_sap_restart_with_channel_switch(struct wlan_objmgr_psoc *psoc,
+					 struct hdd_adapter *ap_adapter,
+					 uint32_t target_chan_freq,
+					 uint32_t target_bw,
+					 bool forced)
 {
 	struct net_device *dev = ap_adapter->dev;
 	int ret;
@@ -3368,6 +3494,7 @@ void hdd_sap_restart_with_channel_switch(struct hdd_adapter *ap_adapter,
 					    target_bw, forced);
 	if (ret) {
 		hdd_err("channel switch failed");
+		hdd_stop_sap_set_tx_power(psoc, ap_adapter);
 		return;
 	}
 }
@@ -3384,7 +3511,7 @@ void hdd_sap_restart_chan_switch_cb(struct wlan_objmgr_psoc *psoc,
 		hdd_err("Adapter is NULL");
 		return;
 	}
-	hdd_sap_restart_with_channel_switch(ap_adapter,
+	hdd_sap_restart_with_channel_switch(psoc, ap_adapter,
 					    ch_freq,
 					    channel_bw, forced);
 }
@@ -3523,8 +3650,10 @@ QDF_STATUS wlan_hdd_get_channel_for_sap_restart(
 
 sap_restart:
 	if (!intf_ch_freq) {
+		hdd_debug("Unable to find safe channel, Hence stop the SAP or Set Tx power");
+		sap_context->csa_reason = csa_reason;
+		hdd_stop_sap_set_tx_power(psoc, ap_adapter);
 		wlansap_context_put(sap_context);
-		hdd_debug("interface channel is 0");
 		return QDF_STATUS_E_FAILURE;
 	} else {
 		sap_context->csa_reason = csa_reason;
@@ -5523,6 +5652,7 @@ int wlan_hdd_cfg80211_start_bss(struct hdd_adapter *adapter,
 	bool deliver_start_evt = true;
 	struct s_ext_cap *p_ext_cap;
 	enum reg_phymode reg_phy_mode, updated_phy_mode;
+	struct sap_context *sap_ctx;
 
 	hdd_enter();
 
@@ -6127,9 +6257,17 @@ int wlan_hdd_cfg80211_start_bss(struct hdd_adapter *adapter,
 	set_bit(SOFTAP_INIT_DONE, &adapter->event_flags);
 
 	qdf_event_reset(&hostapd_state->qdf_event);
-	status = wlansap_start_bss(
-		WLAN_HDD_GET_SAP_CTX_PTR(adapter),
-		sap_event_callback, config, adapter->dev);
+
+	sap_ctx = WLAN_HDD_GET_SAP_CTX_PTR(adapter);
+	if (!sap_ctx) {
+		ret = -EINVAL;
+		goto error;
+	}
+
+	wlan_hdd_fetch_sap_restriction_mask(hdd_ctx, sap_ctx);
+
+	status = wlansap_start_bss(sap_ctx, sap_event_callback, config,
+				   adapter->dev);
 	if (!QDF_IS_STATUS_SUCCESS(status)) {
 		mutex_unlock(&hdd_ctx->sap_lock);
 

core/hdd/src/wlan_hdd_hostapd.h

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2013-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  *
  * Permission to use, copy, modify, and/or distribute this software for
  * any purpose with or without fee is hereby granted, provided that the
@@ -60,10 +61,25 @@ int hdd_softap_set_channel_change(struct net_device *dev,
 					int target_chan_freq,
 					enum phy_ch_width target_bw,
 					bool forced);
+/**
+ * hdd_stop_sap_set_tx_power() - Function to set tx power
+ * for unsafe chanel if restriction bit mask is set else stop the SAP.
+ *
+ * @psoc: PSOC object information
+ * @vdev_id: vdev id
+ *
+ * This function set tx power/stop the SAP interface
+ *
+ * Return:
+ *
+ */
+void hdd_stop_sap_set_tx_power(struct wlan_objmgr_psoc *psoc,
+			       struct hdd_adapter *adapte);
 
 #ifdef FEATURE_WLAN_MCC_TO_SCC_SWITCH
 /**
  * hdd_sap_restart_with_channel_switch() - SAP channel change with E/CSA
+ * @wlan_objmgr_psoc: psoc common object
  * @ap_adapter: HDD adapter
  * @target_chan_freq: Channel frequency to which switch must happen
  * @target_bw: Bandwidth of the target channel
@@ -73,10 +89,11 @@ int hdd_softap_set_channel_change(struct net_device *dev,
  *
  * Return: None
  */
-void hdd_sap_restart_with_channel_switch(struct hdd_adapter *adapter,
-				uint32_t target_chan_freq,
-				uint32_t target_bw,
-				bool forced);
+void hdd_sap_restart_with_channel_switch(struct wlan_objmgr_psoc *psoc,
+					 struct hdd_adapter *adapter,
+					 uint32_t target_chan_freq,
+					 uint32_t target_bw,
+					 bool forced);
 /**
  * hdd_sap_restart_chan_switch_cb() - Function to restart SAP with
  * a different channel

core/hdd/src/wlan_hdd_main.c

@@ -12031,7 +12031,12 @@ void hdd_unsafe_channel_restart_sap(struct hdd_context *hdd_ctxt)
 					WLAN_HDD_GET_SAP_CTX_PTR(adapter));
 		}
 		if (!restart_freq) {
-			hdd_err("fail to restart SAP");
+			wlan_hdd_set_sap_csa_reason(hdd_ctxt->psoc,
+						    adapter->vdev_id,
+						    CSA_REASON_UNSAFE_CHANNEL);
+			hdd_err("Unable to find safe chan, Stop the SAP if restriction mask is set else stop SAP");
+				hdd_stop_sap_set_tx_power(hdd_ctxt->psoc,
+							  adapter);
 		} else {
 			/*
 			 * SAP restart due to unsafe channel. While

core/sap/src/sap_fsm.c

@@ -977,6 +977,20 @@ static bool sap_process_liberal_scc_for_go(struct sap_context *sap_context)
 }
 #endif
 
+#ifdef FEATURE_WLAN_CH_AVOID_EXT
+static inline
+uint8_t sap_get_restriction_mask(struct sap_context *sap_context)
+{
+	return sap_context->restriction_mask;
+}
+#else
+static inline
+uint8_t sap_get_restriction_mask(struct sap_context *sap_context)
+{
+	return -EINVAL;
+}
+#endif
+
 QDF_STATUS
 sap_validate_chan(struct sap_context *sap_context,
 		  bool pre_start_bss,
@@ -1123,6 +1137,14 @@ validation_done:
 	sap_debug("for configured channel, Ch_freq = %d",
 		  sap_context->chan_freq);
 
+	if (!policy_mgr_is_safe_channel(mac_ctx->psoc,
+					sap_context->chan_freq) &&
+	   (sap_get_restriction_mask(sap_context) ==
+	    NL80211_IFTYPE_AP)) {
+		sap_warn("Abort SAP start due to unsafe channel");
+		return QDF_STATUS_E_ABORTED;
+	}
+
 	if (check_for_connection_update) {
 		/* This wait happens in the hostapd context. The event
 		 * is set in the MC thread context.

core/sap/src/sap_internal.h

@@ -1,6 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
- * Copyright (c) 2021 Qualcomm Innovation Center, Inc. All rights reserved.
+ * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
  *
  * Permission to use, copy, modify, and/or distribute this software for
  * any purpose with or without fee is hereby granted, provided that the
@@ -244,6 +244,9 @@ struct sap_context {
 	bool is_forcescc_restart_required;
 #endif
 	qdf_freq_t candidate_freq;
+#ifdef FEATURE_WLAN_CH_AVOID_EXT
+	uint8_t restriction_mask;
+#endif
 };
 
 /*----------------------------------------------------------------------------