qcacld-3.0: check 11be IE is configured or not from userspace

When starting SAP, If 11be IE is configured from userspace,
driver need check concurrency, update phymode as 11be and notify mlo mgr.

Change-Id: I22fdec5d978c91a8fc292af49462f045922254ae
CRs-Fixed: 2908938

components/cmn_services/policy_mgr/src/wlan_policy_mgr_get_set_utils.c

@@ -2460,6 +2460,57 @@ static bool policy_mgr_is_6g_channel_allowed(
 	return true;
 }
 
+#ifdef WLAN_FEATURE_11BE_MLO
+bool policy_mgr_is_mlo_sap_concurrency_allowed(struct wlan_objmgr_psoc *psoc,
+					       bool is_new_vdev_mlo)
+{
+	struct policy_mgr_psoc_priv_obj *pm_ctx;
+	uint32_t conn_index;
+	bool ret = false;
+	uint32_t mlo_sap_count = 0;
+	uint32_t non_mlo_sap_count = 0;
+	struct wlan_objmgr_vdev *vdev;
+	uint32_t vdev_id;
+
+	pm_ctx = policy_mgr_get_context(psoc);
+	if (!pm_ctx) {
+		policy_mgr_err("Invalid Context");
+		return ret;
+	}
+
+	qdf_mutex_acquire(&pm_ctx->qdf_conc_list_lock);
+	for (conn_index = 0; conn_index < MAX_NUMBER_OF_CONC_CONNECTIONS;
+		 conn_index++) {
+		if (pm_conc_connection_list[conn_index].in_use) {
+			vdev = wlan_objmgr_get_vdev_by_id_from_psoc(
+					psoc, vdev_id, WLAN_POLICY_MGR_ID);
+			if (!vdev) {
+				policy_mgr_err("vdev for vdev_id:%d is NULL",
+					       vdev_id);
+				qdf_mutex_release(&pm_ctx->qdf_conc_list_lock);
+				return ret;
+			}
+			if (wlan_vdev_mlme_is_mlo_sap(vdev))
+				mlo_sap_count++;
+			else
+				non_mlo_sap_count++;
+			wlan_objmgr_vdev_release_ref(vdev, WLAN_POLICY_MGR_ID);
+		}
+	}
+	qdf_mutex_release(&pm_ctx->qdf_conc_list_lock);
+
+	if (is_new_vdev_mlo)
+		mlo_sap_count++;
+	else
+		non_mlo_sap_count++;
+
+	if (!mlo_sap_count || !non_mlo_sap_count)
+		ret = true;
+
+	return ret;
+}
+#endif
+
 bool policy_mgr_is_concurrency_allowed(struct wlan_objmgr_psoc *psoc,
 				       enum policy_mgr_con_mode mode,
 				       uint32_t ch_freq,

components/cmn_services/policy_mgr/src/wlan_policy_mgr_i.h

@@ -725,4 +725,28 @@ bool policy_mgr_is_concurrency_allowed(struct wlan_objmgr_psoc *psoc,
 				       enum policy_mgr_con_mode mode,
 				       uint32_t ch_freq,
 				       enum hw_mode_bandwidth bw);
+
+#ifdef WLAN_FEATURE_11BE_MLO
+/**
+ * policy_mgr_is_mlo_sap_concurrency_allowed() - Check for mlo sap allowed
+ *                                               concurrency combination
+ * @psoc: PSOC object information
+ *
+ * When a new connection is about to come up check if current
+ * concurrency combination including the new connection is
+ * allowed or not. Currently no concurrency support for mlo sap
+ *
+ * Return: True if concurrency is supported, otherwise false.
+ */
+bool policy_mgr_is_mlo_sap_concurrency_allowed(struct wlan_objmgr_psoc *psoc,
+					       bool is_new_vdev_mlo);
+#else
+
+static inline bool policy_mgr_is_mlo_sap_concurrency_allowed(
+			struct wlan_objmgr_psoc *psoc,
+			bool is_new_vdev_mlo)
+{
+	return true;
+}
+#endif
 #endif

core/hdd/inc/wlan_hdd_eht.h

@@ -25,6 +25,11 @@
 #if !defined(WLAN_HDD_EHT_H)
 #define WLAN_HDD_EHT_H
 
+struct hdd_context;
+struct wma_tgt_cfg;
+struct hdd_beacon_data;
+struct sap_config;
+
 #ifdef WLAN_FEATURE_11BE
 /**
  * hdd_update_tgt_eht_cap() - Update EHT related capabilities
@@ -51,5 +56,24 @@ void hdd_update_tgt_eht_cap(struct hdd_context *hdd_ctx,
  */
 int hdd_update_eht_cap_in_cfg(struct hdd_context *hdd_ctx);
 
+/**
+ * wlan_hdd_check_11be_support() - check if beacon IE and update hw mode
+ * @beacon: beacon IE buffer
+ * @config: pointer to sap config
+ *
+ * Check if EHT cap IE is present in beacon IE, if present update hw mode
+ * to 11be.
+ *
+ * Return: None
+ */
+void wlan_hdd_check_11be_support(struct hdd_beacon_data *beacon,
+				 struct sap_config *config);
+#else
+
+static inline void wlan_hdd_check_11be_support(struct hdd_beacon_data *beacon,
+					       struct sap_config *config)
+{
+}
+
 #endif
 #endif /* if !defined(WLAN_HDD_EHT_H)*/

core/hdd/src/wlan_hdd_eht.c

@@ -24,9 +24,22 @@
 
 #include "wlan_hdd_main.h"
 #include "wlan_hdd_eht.h"
+#include "osif_sync.h"
+#include "wlan_utility.h"
 #include "wlan_mlme_ucfg_api.h"
 
 void hdd_update_tgt_eht_cap(struct hdd_context *hdd_ctx,
 			    struct wma_tgt_cfg *cfg)
 {
 }
+
+void wlan_hdd_check_11be_support(struct hdd_beacon_data *beacon,
+				 struct sap_config *config)
+{
+	const uint8_t *ie;
+
+	ie = wlan_get_ext_ie_ptr_from_ext_id(EHT_CAP_OUI_TYPE, EHT_CAP_OUI_SIZE,
+					     beacon->tail, beacon->tail_len);
+	if (ie)
+		config->SapHw_mode = eCSR_DOT11_MODE_11be;
+}

core/hdd/src/wlan_hdd_hostapd.c

@@ -74,6 +74,7 @@
 #include <qca_vendor.h>
 #include <cds_api.h>
 #include "wlan_hdd_he.h"
+#include "wlan_hdd_eht.h"
 #include "wlan_dfs_tgt_api.h"
 #include <wlan_reg_ucfg_api.h>
 #include "wlan_utility.h"
@@ -4532,6 +4533,8 @@ static void wlan_hdd_set_sap_hwmode(struct hdd_adapter *adapter)
 
 	wlan_hdd_check_11ax_support(beacon, config);
 
+	wlan_hdd_check_11be_support(beacon, config);
+
 	hdd_debug("SAP hw_mode: %d", config->SapHw_mode);
 }
 
@@ -5652,6 +5655,20 @@ int wlan_hdd_cfg80211_start_bss(struct hdd_adapter *adapter,
 	if (!cds_is_sub_20_mhz_enabled())
 		wlan_hdd_set_sap_hwmode(adapter);
 
+#ifdef WLAN_FEATURE_11BE_MLO
+	if (config->SapHw_mode == eCSR_DOT11_MODE_11be ||
+	    config->SapHw_mode == eCSR_DOT11_MODE_11be_ONLY) {
+		wlan_vdev_mlme_set_mlo_flag(adapter->vdev);
+		mlo_sap_update_with_config(); //TD
+	}
+
+	if (!policy_mgr_is_mlo_sap_concurrency_allowed(
+		hdd_ctx->psoc, wlan_vdev_mlme_is_mlo_sap(adapter->vdev))) {
+		hdd_err("MLO SAP concurrency check fails");
+		ret = -EINVAL;
+		goto error;
+	}
+#endif
 	status = ucfg_mlme_get_vht_for_24ghz(hdd_ctx->psoc, &bval);
 	if (QDF_IS_STATUS_ERROR(qdf_status))
 		hdd_err("Failed to get vht_for_24ghz");