qcacld-3.0: mlo sap stop

Implement mlo sap stop

Change-Id: I9cc5ecfd12ba8f0c85c44e7ba82ab57602511dca
CRs-Fixed: 2976426

core/mac/src/include/dph_global.h

@@ -202,6 +202,10 @@ typedef struct sDphHashNode {
 	 * end of the structure.
 	 */
 	struct sDphHashNode *next;
+#ifdef WLAN_FEATURE_11BE_MLO
+	bool recv_assoc_frm;
+	uint8_t mld_addr[QDF_MAC_ADDR_SIZE];
+#endif
 } tDphHashNode, *tpDphHashNode;
 
 #include "dph_hash_table.h"

core/mac/src/pe/lim/lim_mlo.c

@@ -26,6 +26,8 @@
 #include "sch_api.h"
 #include "lim_types.h"
 #include "wlan_mlo_mgr_ap.h"
+#include <wlan_mlo_mgr_peer.h>
+#include <lim_assoc_utils.h>
 
 /**
  * lim_send_mlo_ie_update - mlo ie is changed, populate new beacon template
@@ -122,3 +124,131 @@ void lim_get_mlo_vdev_list(struct pe_session *session, uint16_t *vdev_count,
 	mlo_ap_get_vdev_list(session->vdev, vdev_count,
 			     wlan_vdev_list);
 }
+
+void lim_mlo_notify_peer_disconn(struct pe_session *pe_session,
+				 tpDphHashNode sta_ds)
+{
+	struct wlan_objmgr_peer *peer;
+	struct mac_context *mac_ctx;
+
+	if (!pe_session) {
+		pe_err("pe session is null");
+		return;
+	}
+	if (!sta_ds) {
+		pe_err("sta ds is null");
+		return;
+	}
+	mac_ctx = pe_session->mac_ctx;
+	if (!mac_ctx) {
+		pe_err("mac context is null");
+		return;
+	}
+
+	peer = wlan_objmgr_get_peer_by_mac(mac_ctx->psoc,
+					   sta_ds->staAddr,
+					   WLAN_LEGACY_MAC_ID);
+	if (!peer) {
+		pe_err("peer is null");
+		return;
+	}
+
+	if (lim_is_mlo_conn(pe_session, sta_ds))
+		wlan_mlo_partner_peer_disconnect_notify(peer);
+
+	wlan_objmgr_peer_release_ref(peer, WLAN_LEGACY_MAC_ID);
+}
+
+void lim_mlo_cleanup_partner_peer(struct wlan_objmgr_peer *peer)
+{
+	struct mac_context *mac_ctx;
+	uint16_t aid;
+	tpDphHashNode sta_ds;
+	struct pe_session *pe_session;
+	tpSirAssocReq tmp_assoc_req;
+	struct wlan_objmgr_vdev *vdev;
+
+	mac_ctx = cds_get_context(QDF_MODULE_ID_PE);
+	if (!mac_ctx) {
+		pe_err("mac ctx is null");
+		return;
+	}
+
+	vdev = wlan_peer_get_vdev(peer);
+	if (!vdev) {
+		pe_err("vdev is null");
+		return;
+	}
+
+	pe_session = pe_find_session_by_vdev_id(
+			mac_ctx, vdev->vdev_objmgr.vdev_id);
+	if (!pe_session) {
+		pe_err("pe session is null");
+		return;
+	}
+
+	sta_ds = dph_lookup_hash_entry(mac_ctx, peer->macaddr, &aid,
+				       &pe_session->dph.dphHashTable);
+
+	if (!sta_ds) {
+		pe_err("sta ds is null");
+		return;
+	}
+
+	sta_ds->mlmStaContext.cleanupTrigger = eLIM_MLO_PARTNER_PEER;
+
+	lim_cleanup_rx_path(mac_ctx, sta_ds, pe_session, true);
+
+	if (pe_session->parsedAssocReq) {
+		tmp_assoc_req = pe_session->parsedAssocReq[sta_ds->assocId];
+		if (tmp_assoc_req) {
+			lim_free_assoc_req_frm_buf(tmp_assoc_req);
+			qdf_mem_free(tmp_assoc_req);
+			tmp_assoc_req = NULL;
+		}
+
+		pe_session->parsedAssocReq[sta_ds->assocId] = NULL;
+	}
+}
+
+void lim_mlo_set_mld_mac_peer(tpDphHashNode sta_ds,
+			      uint8_t peer_mld_addr[QDF_MAC_ADDR_SIZE])
+{
+	WLAN_ADDR_COPY(sta_ds->mld_addr, peer_mld_addr);
+}
+
+bool lim_is_mlo_conn(struct pe_session *session, tpDphHashNode sta_ds)
+{
+	if (!sta_ds) {
+		pe_err("sta ds is null");
+		return false;
+	}
+
+	if (!session) {
+		pe_err("session is null");
+		return false;
+	}
+
+	return sta_ds->mlmStaContext.eht_capable &&
+	       IS_DOT11_MODE_EHT(session->dot11mode);
+}
+
+void lim_set_mlo_recv_assoc(tpDphHashNode sta_ds, bool mlo_recv_assoc_frm)
+{
+	if (!sta_ds) {
+		pe_err("sta ds is null");
+		return;
+	}
+
+	sta_ds->recv_assoc_frm = mlo_recv_assoc_frm;
+}
+
+bool lim_is_mlo_recv_assoc(tpDphHashNode sta_ds)
+{
+	if (!sta_ds) {
+		pe_err("sta ds is null");
+		return false;
+	}
+
+	return sta_ds->recv_assoc_frm;
+}

core/mac/src/pe/lim/lim_mlo.h

@@ -78,5 +78,96 @@ struct pe_session *pe_find_partner_session_by_link_id(
  */
 void lim_get_mlo_vdev_list(struct pe_session *session, uint16_t *vdev_count,
 			   struct wlan_objmgr_vdev **wlan_vdev_list);
+
+/**
+ * lim_mlo_notify_peer_disconn - trigger mlo to delete partner peer
+ * @pe_session: pe session
+ * @sta_ds: Pointer to internal STA Datastructure
+ *
+ * Return: void
+ */
+void lim_mlo_notify_peer_disconn(struct pe_session *pe_session,
+				 tpDphHashNode sta_ds);
+
+/**
+ * lim_mlo_cleanup_partner_peer() - cleanup given peer which is partner peer
+ *                                  of mlo connection.
+ *
+ * This function is triggered from mlo mgr.
+ *
+ * @peer: pointer to peer to be cleanup
+ *
+ * Return: void
+ */
+void lim_mlo_cleanup_partner_peer(struct wlan_objmgr_peer *peer);
+
+/**
+ * lim_mlo_set_mld_mac_peer() - set mld mac
+ * @sta_ds: Pointer to internal STA Datastructure
+ * @peer_mld_addr: peer mld mac addr
+ *
+ * Return: void
+ */
+void lim_mlo_set_mld_mac_peer(tpDphHashNode sta_ds,
+			      uint8_t peer_mld_addr[QDF_MAC_ADDR_SIZE]);
+
+/**
+ * lim_is_mlo_conn() - whether it is mlo connection
+ * @session: pe session
+ * @sta_ds: Pointer to internal STA Datastructure
+ *
+ * Return: true if it is mlo connection
+ */
+bool lim_is_mlo_conn(struct pe_session *session, tpDphHashNode sta_ds);
+
+/**
+ * lim_is_mlo_recv_assoc() - whether it received assoc frame or not
+ * @sta_ds: Pointer to internal STA Datastructure
+ *
+ * Return: true if this peer corresponding link received assoc frame
+ */
+bool lim_is_mlo_recv_assoc(tpDphHashNode sta_ds);
+
+/**
+ * lim_set_mlo_recv_assoc() - set received assoc frame flag
+ * @sta_ds: Pointer to internal STA Datastructure
+ * @mlo_recv_assoc_frm: true if it received assoc frame
+ *
+ * Return: void
+ */
+void lim_set_mlo_recv_assoc(tpDphHashNode sta_ds, bool mlo_recv_assoc_frm);
+#else
+
+static inline void lim_mlo_notify_peer_disconn(struct pe_session *pe_session,
+					       tpDphHashNode sta_ds)
+{
+}
+
+static inline void lim_mlo_set_mld_mac_peer(
+				tpDphHashNode sta_ds,
+				uint8_t peer_mld_addr[QDF_MAC_ADDR_SIZE])
+{
+}
+
+static inline void lim_mlo_cleanup_partner_peer(struct vdev_mlme_obj *vdev_mlme,
+						struct wlan_objmgr_peer *peer)
+{
+}
+
+static inline bool lim_is_mlo_conn(struct pe_session *session,
+				   tpDphHashNode sta_ds)
+{
+	return false;
+}
+
+static inline bool lim_is_mlo_recv_assoc(tpDphHashNode sta_ds)
+{
+	return false;
+}
+
+static inline void lim_set_mlo_recv_assoc(tpDphHashNode sta_ds,
+					  bool mlo_recv_assoc_frm)
+{
+}
 #endif
 #endif

core/mac/src/pe/lim/lim_process_sme_req_messages.c

@@ -64,6 +64,7 @@
 #include <wlan_reg_ucfg_api.h>
 #include "wlan_lmac_if_def.h"
 #include "wlan_reg_services_api.h"
+#include <lim_mlo.h>
 
 /* SME REQ processing function templates */
 static bool __lim_process_sme_sys_ready_ind(struct mac_context *, uint32_t *);
@@ -5442,6 +5443,7 @@ void lim_delete_all_peers(struct pe_session *session)
 					    &session->dph.dphHashTable);
 		if (!sta_ds)
 			continue;
+		lim_mlo_notify_peer_disconn(session, sta_ds);
 		status = lim_del_sta(mac_ctx, sta_ds, true, session);
 		if (QDF_STATUS_SUCCESS == status) {
 			lim_delete_dph_hash_entry(mac_ctx, sta_ds->staAddr,

core/mac/src/pe/lim/lim_types.h

@@ -133,7 +133,8 @@ enum eLimDisassocTrigger {
 	eLIM_LINK_MONITORING_DEAUTH,
 	eLIM_JOIN_FAILURE,
 	eLIM_REASSOC_REJECT,
-	eLIM_DUPLICATE_ENTRY
+	eLIM_DUPLICATE_ENTRY,
+	eLIM_MLO_PARTNER_PEER
 };
 
 /**