qcacmn: CP hooks to support MLO device Context Structure

Control Path hooks to create, attach, detach and destroy
DP MLO device context structure

Change-Id: Ib3fe459dfabb8b8971b92c0529e9df0093bf5342
CRs-Fixed: 3567004

umac/cmn_services/obj_mgr/src/wlan_objmgr_vdev_obj.c

@@ -32,7 +32,7 @@
 #include "wlan_objmgr_vdev_obj_i.h"
 #include <wlan_utility.h>
 #include <wlan_osif_priv.h>
-
+#include "cdp_txrx_cmn.h"
 
 /*
  * APIs to Create/Delete Global object APIs
@@ -143,6 +143,7 @@ struct wlan_objmgr_vdev *wlan_objmgr_vdev_obj_create(
 	wlan_objmgr_vdev_status_handler stat_handler;
 	void *arg;
 	QDF_STATUS obj_status;
+	struct qdf_mac_addr *mld_addr;
 
 	if (!pdev) {
 		obj_mgr_err("pdev is NULL");
@@ -291,6 +292,22 @@ struct wlan_objmgr_vdev *wlan_objmgr_vdev_obj_create(
 
 	obj_mgr_debug("Created vdev %d", vdev->vdev_objmgr.vdev_id);
 
+	/* Attach DP vdev to DP MLO dev ctx */
+	mld_addr = (struct qdf_mac_addr *)wlan_vdev_mlme_get_mldaddr(vdev);
+
+	if (!qdf_is_macaddr_zero(mld_addr)) {
+		/* only for MLO vdev's */
+		if (cdp_mlo_dev_ctxt_attach(
+				wlan_psoc_get_dp_handle(psoc),
+				wlan_vdev_get_id(vdev),
+				(uint8_t *)mld_addr)
+				!= QDF_STATUS_SUCCESS) {
+			obj_mgr_err("Fail to attach vdev to DP MLO Dev ctxt");
+			wlan_objmgr_vdev_obj_delete(vdev);
+			return NULL;
+		}
+	}
+
 	return vdev;
 }
 qdf_export_symbol(wlan_objmgr_vdev_obj_create);
@@ -302,11 +319,20 @@ static QDF_STATUS wlan_objmgr_vdev_obj_destroy(struct wlan_objmgr_vdev *vdev)
 	QDF_STATUS obj_status;
 	void *arg;
 	uint8_t vdev_id;
+	struct wlan_objmgr_psoc *psoc = NULL;
+	struct qdf_mac_addr *mld_addr;
 
 	if (!vdev) {
 		obj_mgr_err("vdev is NULL");
 		return QDF_STATUS_E_FAILURE;
 	}
+
+	psoc = wlan_vdev_get_psoc(vdev);
+	if (!psoc) {
+		obj_mgr_err("Failed to get psoc");
+		return QDF_STATUS_E_FAILURE;
+	}
+
 	wlan_objmgr_notify_destroy(vdev, WLAN_VDEV_OP);
 
 	vdev_id = wlan_vdev_get_id(vdev);
@@ -323,6 +349,21 @@ static QDF_STATUS wlan_objmgr_vdev_obj_destroy(struct wlan_objmgr_vdev *vdev)
 	wlan_minidump_remove(vdev, sizeof(*vdev), wlan_vdev_get_psoc(vdev),
 			     WLAN_MD_OBJMGR_VDEV, "wlan_objmgr_vdev");
 
+	/* Detach DP vdev from DP MLO Device Context */
+	mld_addr = (struct qdf_mac_addr *)wlan_vdev_mlme_get_mldaddr(vdev);
+
+	if (!qdf_is_macaddr_zero(mld_addr)) {
+		/* only for MLO vdev's */
+		if (cdp_mlo_dev_ctxt_detach(wlan_psoc_get_dp_handle(psoc),
+					    wlan_vdev_get_id(vdev),
+					    (uint8_t *)mld_addr)
+					    != QDF_STATUS_SUCCESS) {
+			obj_mgr_err("Failed to detach DP vdev from DP MLO Dev ctxt");
+			QDF_BUG(0);
+			return QDF_STATUS_E_FAILURE;
+		}
+	}
+
 	/* Invoke registered destroy handlers in reverse order of creation */
 	for (id = WLAN_UMAC_COMP_ID_MAX - 1; id >= 0; id--) {
 		handler = g_umac_glb_obj->vdev_destroy_handler[id];

umac/mlo_mgr/src/wlan_mlo_mgr_main.c

@@ -32,6 +32,7 @@
 #include <wlan_mlo_t2lm.h>
 #include <wlan_cm_api.h>
 #include <wlan_mlo_mgr_public_api.h>
+#include "cdp_txrx_cmn.h"
 
 static void mlo_global_ctx_deinit(void)
 {
@@ -875,6 +876,7 @@ static QDF_STATUS mlo_dev_ctx_init(struct wlan_objmgr_vdev *vdev)
 	struct qdf_mac_addr *mld_addr;
 	struct mlo_mgr_context *g_mlo_ctx = wlan_objmgr_get_mlo_ctx();
 	uint8_t id = 0;
+	struct wlan_objmgr_psoc *psoc = NULL;
 
 	if (wlan_vdev_mlme_is_mlo_bridge_vdev(vdev)) {
 		status = mlo_add_to_bridge_vdev_list(vdev);
@@ -885,6 +887,12 @@ static QDF_STATUS mlo_dev_ctx_init(struct wlan_objmgr_vdev *vdev)
 
 	mld_addr = (struct qdf_mac_addr *)wlan_vdev_mlme_get_mldaddr(vdev);
 	ml_dev = wlan_mlo_get_mld_ctx_by_mldaddr(mld_addr);
+	psoc = wlan_vdev_get_psoc(vdev);
+
+	if (!psoc) {
+		mlo_err("Failed to get psoc");
+		return QDF_STATUS_E_FAILURE;
+	}
 
 	if (ml_dev) {
 		if (mlo_dev_config_check(ml_dev, vdev) != QDF_STATUS_SUCCESS)
@@ -953,6 +961,25 @@ static QDF_STATUS mlo_dev_ctx_init(struct wlan_objmgr_vdev *vdev)
 		}
 	}
 
+	/* Create DP MLO Device Context */
+	if (cdp_mlo_dev_ctxt_create(wlan_psoc_get_dp_handle(psoc),
+				    (uint8_t *)mld_addr) !=
+				    QDF_STATUS_SUCCESS) {
+		tsf_recalculation_lock_destroy(ml_dev);
+		if (wlan_vdev_mlme_get_opmode(vdev) == QDF_STA_MODE) {
+			qdf_mem_free(ml_dev->sta_ctx);
+#if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP)
+			qdf_mem_free(ml_dev->bridge_sta_ctx);
+#endif
+		} else if (wlan_vdev_mlme_get_opmode(vdev) == QDF_SAP_MODE) {
+			mlo_ap_ctx_deinit(ml_dev);
+		}
+		mlo_dev_lock_destroy(ml_dev);
+		qdf_mem_free(ml_dev);
+		mlo_err("Failed to create DP MLO Dev ctxt");
+		return QDF_STATUS_E_NOMEM;
+	}
+
 	mlo_dev_mlpeer_list_init(ml_dev);
 
 	ml_link_lock_acquire(g_mlo_ctx);
@@ -1030,9 +1057,17 @@ static QDF_STATUS mlo_dev_ctx_deinit(struct wlan_objmgr_vdev *vdev)
 	struct mlo_mgr_context *g_mlo_ctx = wlan_objmgr_get_mlo_ctx();
 	uint8_t id = 0;
 	struct wlan_cm_connect_req *connect_req;
+	struct wlan_objmgr_psoc *psoc = NULL;
 
 	mld_addr = (struct qdf_mac_addr *)wlan_vdev_mlme_get_mldaddr(vdev);
 	ml_dev = wlan_mlo_get_mld_ctx_by_mldaddr(mld_addr);
+	psoc = wlan_vdev_get_psoc(vdev);
+
+	if (!psoc) {
+		mlo_err("Failed to get psoc");
+		return QDF_STATUS_E_FAILURE;
+	}
+
 	if (!ml_dev) {
 		mlo_err("Failed to get MLD dev context by mld addr "QDF_MAC_ADDR_FMT,
 			QDF_MAC_ADDR_REF(mld_addr->bytes));
@@ -1103,6 +1138,15 @@ static QDF_STATUS mlo_dev_ctx_deinit(struct wlan_objmgr_vdev *vdev)
 		mlo_mgr_link_switch_deinit(ml_dev);
 		mlo_t2lm_ctx_deinit(vdev);
 		mlo_epcs_ctx_deinit(ml_dev);
+
+		/* Destroy DP MLO Device Context */
+		if (cdp_mlo_dev_ctxt_destroy(wlan_psoc_get_dp_handle(psoc),
+					     (uint8_t *)mld_addr) !=
+					     QDF_STATUS_SUCCESS) {
+			mlo_err("Failed to destroy DP MLO Dev ctxt");
+			QDF_BUG(0);
+		}
+
 		tsf_recalculation_lock_destroy(ml_dev);
 		mlo_dev_lock_destroy(ml_dev);
 		qdf_mem_free(ml_dev);