qcacld-3.0: mlo sap bss start for hdd layer

Implement mlo sap bss start for hdd layer.

Change-Id: Id2fc9c735573262d5502e1538851c9554c919a21
CRs-Fixed: 2973191

components/cmn_services/policy_mgr/inc/wlan_policy_mgr_api.h

@@ -3681,4 +3681,29 @@ QDF_STATUS policy_mgr_check_mon_concurrency(struct wlan_objmgr_psoc *psoc);
  */
 void policy_mgr_get_hw_dbs_max_bw(struct wlan_objmgr_psoc *psoc,
 				  struct dbs_bw *bw_dbs);
+
+#ifdef WLAN_FEATURE_11BE_MLO
+/**
+ * policy_mgr_is_mlo_sap_concurrency_allowed() - Check for mlo sap allowed
+ *                                               concurrency combination
+ * @psoc: PSOC object information
+ * @is_new_vdev_mlo: Is new vdev a mlo device or not
+ *
+ * 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 /* __WLAN_POLICY_MGR_API_H */

components/cmn_services/policy_mgr/src/wlan_policy_mgr_i.h

@@ -725,28 +725,4 @@ 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

@@ -80,6 +80,17 @@ void wlan_hdd_check_11be_support(struct hdd_beacon_data *beacon,
  */
 void hdd_update_wiphy_eht_cap(struct hdd_context *hdd_ctx,
 			      struct wma_tgt_cfg *cfg);
+
+/**
+ * wlan_hdd_get_mlo_link_id() - get link id and number of links
+ * @beacon: beacon IE buffer
+ * @link_id: link id to return
+ * @num_link: total links
+ *
+ * Return: None
+ */
+void wlan_hdd_get_mlo_link_id(struct hdd_beacon_data *beacon,
+			      uint8_t *link_id, uint8_t *num_link);
 #else
 static inline
 void hdd_update_tgt_eht_cap(struct hdd_context *hdd_ctx,

core/hdd/src/wlan_hdd_eht.c

@@ -37,6 +37,45 @@ void hdd_update_tgt_eht_cap(struct hdd_context *hdd_ctx,
 	sme_update_tgt_eht_cap(hdd_ctx->mac_handle, cfg, &eht_cap_ini);
 }
 
+void wlan_hdd_get_mlo_link_id(struct hdd_beacon_data *beacon,
+			      uint8_t *link_id, uint8_t *num_link)
+{
+	const uint8_t *ie;
+	uint8_t len;
+	uint8_t link_len;
+	*num_link = 0;
+
+	ie = wlan_get_ext_ie_ptr_from_ext_id(MLO_IE_OUI_TYPE, MLO_IE_OUI_SIZE,
+					     beacon->tail, beacon->tail_len);
+	if (ie) {
+		hdd_debug("find a mlo ie in beacon data");
+		*num_link = 1;
+		ie++; //WLAN_MAC_EID_EXT
+		len = *ie++; //length
+		ie++; //MLO_IE_OUI_TYPE
+		len--;
+		ie++; //Multi-Link Control field 2octets
+		ie++;
+		len--;
+		len--;
+		ie += QDF_MAC_ADDR_SIZE; //mld mac addr
+		len -= QDF_MAC_ADDR_SIZE;
+		*link_id = *ie++; //link id
+		len--;
+		while (len > 0) {
+			ie++; //sub element ID
+			len--;
+			link_len = *ie++; //length of sub element ID
+			len--;
+			ie += link_len;
+			len -= link_len;
+			(*num_link)++;
+		}
+	} else {
+		hdd_debug("there is no mlo ie in beacon data");
+	}
+}
+
 void wlan_hdd_check_11be_support(struct hdd_beacon_data *beacon,
 				 struct sap_config *config)
 {

core/hdd/src/wlan_hdd_hostapd.c

@@ -102,6 +102,9 @@
 #include "wlan_hdd_bootup_marker.h"
 #include "wlan_hdd_medium_assess.h"
 #include "wlan_hdd_scan.h"
+#ifdef WLAN_FEATURE_11BE_MLO
+#include <wlan_mlo_mgr_ap.h>
+#endif
 
 #define ACS_SCAN_EXPIRY_TIMEOUT_S 4
 
@@ -5198,6 +5201,69 @@ static void wlan_hdd_set_sap_mcc_chnl_avoid(struct hdd_context *hdd_ctx)
 }
 #endif
 
+#ifdef WLAN_FEATURE_11BE_MLO
+/**
+ * wlan_hdd_mlo_update() - handle mlo scenario for start bss
+ * @hdd_ctx: Pointer to hdd context
+ * @config: Pointer to sap config
+ * @adapter: Pointer to hostapd adapter
+ * @beacon: Pointer to beacon
+ *
+ * Return: QDF_STATUS
+ */
+static QDF_STATUS wlan_hdd_mlo_update(struct hdd_context *hdd_ctx,
+				      struct sap_config *config,
+				      struct hdd_adapter *adapter,
+				      struct hdd_beacon_data *beacon)
+{
+	uint8_t link_id = 0;
+	uint8_t num_link = 0;
+
+	if (config->SapHw_mode == eCSR_DOT11_MODE_11be ||
+	    config->SapHw_mode == eCSR_DOT11_MODE_11be_ONLY) {
+		wlan_hdd_get_mlo_link_id(beacon, &link_id, &num_link);
+		hdd_debug("MLO SAP vdev id %d, link id %d total link %d",
+			  adapter->vdev_id, link_id, num_link);
+		if (!num_link)
+			return QDF_STATUS_E_INVAL;
+		if (!mlo_ap_vdev_attach(adapter->vdev, link_id, num_link))
+			return QDF_STATUS_E_INVAL;
+	}
+
+	if (!policy_mgr_is_mlo_sap_concurrency_allowed(
+		hdd_ctx->psoc, wlan_vdev_mlme_is_mlo_ap(adapter->vdev))) {
+		hdd_err("MLO SAP concurrency check fails");
+		return QDF_STATUS_E_INVAL;
+	}
+
+	return QDF_STATUS_SUCCESS;
+}
+
+/**
+ * wlan_hdd_mlo_reset() - reset mlo configuration if start bss fails
+ * @adapter: Pointer to hostapd adapter
+ *
+ * Return: void
+ */
+static void wlan_hdd_mlo_reset(struct hdd_adapter *adapter)
+{
+	if (wlan_vdev_mlme_is_mlo_ap(adapter->vdev))
+		mlo_ap_vdev_detach(adapter->vdev);
+}
+#else
+static QDF_STATUS wlan_hdd_mlo_update(struct hdd_context *hdd_ctx,
+				      struct sap_config *config,
+				      struct hdd_adapter *adapter,
+				      struct hdd_beacon_data *beacon)
+{
+	return QDF_STATUS_SUCCESS;
+}
+
+static void wlan_hdd_mlo_reset(struct hdd_adapter *adapter)
+{
+}
+#endif
+
 /**
  * wlan_hdd_cfg80211_start_bss() - start bss
  * @adapter: Pointer to hostapd adapter
@@ -5729,6 +5795,11 @@ int wlan_hdd_cfg80211_start_bss(struct hdd_adapter *adapter,
 	if (!cds_is_sub_20_mhz_enabled())
 		wlan_hdd_set_sap_hwmode(adapter);
 
+	if (QDF_IS_STATUS_ERROR(wlan_hdd_mlo_update(hdd_ctx, config,
+						    adapter, beacon))) {
+		ret = -EINVAL;
+		goto error;
+	}
 	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");
@@ -5944,6 +6015,7 @@ int wlan_hdd_cfg80211_start_bss(struct hdd_adapter *adapter,
 	goto free;
 
 error:
+	wlan_hdd_mlo_reset(adapter);
 	/* Revert the indoor to passive marking if START BSS fails */
 	if (indoor_chnl_marking && adapter->device_mode == QDF_SAP_MODE) {
 		hdd_update_indoor_channel(hdd_ctx, false);

core/mac/inc/sir_api.h

@@ -4951,6 +4951,9 @@ struct he_capability {
 #define EHT_OP_OUI_TYPE "\xfe"
 #define EHT_OP_OUI_SIZE 1
 
+#define MLO_IE_OUI_TYPE "\x5e"
+#define MLO_IE_OUI_SIZE 1
+
 /**
  * struct eht_capability - to store 11be EHT capabilities
  * @phy_cap: EHT PHY capabilities