qcacld-3.0: Populate mlo ie and send to FW

When MLO is enabled, populate MLO IE and send to FW via
WMI_VDEV_SET_IE_CMDID.

Change-Id: Id342294ab2e53692fbd649317077279d2c47a113
CRs-Fixed: 3097737

core/mac/src/include/parser_api.h

@@ -692,6 +692,12 @@ populate_dot11f_probe_req_mlo_ie(struct mac_context *mac_ctx,
 QDF_STATUS
 sir_convert_mlo_probe_rsp_frame2_struct(tDot11fProbeResponse *pr,
 					tpSirMultiLink_IE mlo_ie_ptr);
+
+QDF_STATUS
+populate_dot11f_mlo_caps(struct mac_context *mac_ctx,
+			 struct pe_session *session,
+			 tDot11fIEmlo_ie *mlo_ie);
+
 #else
 static inline QDF_STATUS
 populate_dot11f_probe_req_mlo_ie(struct mac_context *mac_ctx,
@@ -707,6 +713,14 @@ sir_convert_mlo_probe_rsp_frame2_struct(tDot11fProbeResponse *pr,
 {
 	return QDF_STATUS_E_NOSUPPORT;
 }
+
+static inline QDF_STATUS
+populate_dot11f_mlo_caps(struct mac_context *mac_ctx,
+			 struct pe_session *session,
+			 tDot11fIEmlo_ie *mlo_ie)
+{
+	return QDF_STATUS_E_NOSUPPORT;
+}
 #endif
 
 #ifdef ANI_SUPPORT_11H

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

@@ -3942,6 +3942,11 @@ lim_cm_handle_join_req(struct cm_vdev_join_req *req)
 		       pe_session->vdev_id);
 		goto fail;
 	}
+	if (wlan_vdev_mlme_is_mlo_vdev(pe_session->vdev) &&
+	    !wlan_vdev_mlme_is_mlo_link_vdev(pe_session->vdev))
+		lim_send_mlo_caps_ie(mac_ctx, pe_session,
+				     QDF_STA_MODE,
+				     pe_session->vdev_id);
 
 	return QDF_STATUS_SUCCESS;
 

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

@@ -8075,6 +8075,79 @@ void lim_update_sta_mlo_info(tpAddStaParams add_sta_params,
 		 QDF_MAC_ADDR_REF(add_sta_params->mld_mac_addr),
 		 add_sta_params->is_assoc_peer);
 }
+
+void lim_set_mlo_caps(struct mac_context *mac, struct pe_session *session,
+		      uint8_t *ie_start, uint32_t num_bytes)
+{
+	const uint8_t *ie = NULL;
+	tDot11fIEmlo_ie dot11_cap;
+	struct wlan_mlo_ie_info *mlo_ie_info;
+
+	populate_dot11f_mlo_caps(mac, session, &dot11_cap);
+
+	if (!dot11_cap.present)
+		return;
+
+	ie = wlan_get_ext_ie_ptr_from_ext_id(MLO_IE_OUI_TYPE,
+					     MLO_IE_OUI_SIZE,
+					     ie_start, num_bytes);
+
+	if (ie) {
+		/* convert from unpacked to packed structure */
+		mlo_ie_info = (struct wlan_mlo_ie_info *)&ie[2 + MLO_IE_OUI_SIZE];
+
+		mlo_ie_info->type = dot11_cap.type;
+		mlo_ie_info->reserved = dot11_cap.reserved;
+		mlo_ie_info->mld_mac_addr_present =
+				dot11_cap.mld_mac_addr_present;
+		mlo_ie_info->link_id_info_present =
+				dot11_cap.link_id_info_present;
+		mlo_ie_info->bss_param_change_cnt_present =
+				dot11_cap.bss_param_change_cnt_present;
+		mlo_ie_info->medium_sync_delay_info_present =
+				dot11_cap.medium_sync_delay_info_present;
+		mlo_ie_info->eml_capab_present = dot11_cap.eml_capab_present;
+		mlo_ie_info->mld_capab_present = dot11_cap.mld_capab_present;
+		mlo_ie_info->reserved_1 = dot11_cap.reserved_1;
+		qdf_mem_copy(&mlo_ie_info->mld_mac_addr.info.mld_mac_addr,
+			     &dot11_cap.mld_mac_addr.info.mld_mac_addr,
+			     QDF_MAC_ADDR_SIZE);
+		ie_start[1] += QDF_MAC_ADDR_SIZE;
+	}
+}
+
+QDF_STATUS lim_send_mlo_caps_ie(struct mac_context *mac_ctx,
+				struct pe_session *session,
+				enum QDF_OPMODE device_mode,
+				uint8_t vdev_id)
+{
+	uint8_t mlo_cap_total_len = DOT11F_IE_MLO_IE_MIN_LEN +
+				    EHT_CAP_OUI_LEN + QDF_MAC_ADDR_SIZE;
+	QDF_STATUS status_2g, status_5g;
+	uint8_t mlo_caps[DOT11F_IE_MLO_IE_MIN_LEN +
+			 EHT_CAP_OUI_LEN + QDF_MAC_ADDR_SIZE] = {0};
+
+	mlo_caps[0] = DOT11F_EID_MLO_IE;
+	mlo_caps[1] = DOT11F_IE_MLO_IE_MIN_LEN + 1;
+
+	qdf_mem_copy(&mlo_caps[2], MLO_IE_OUI_TYPE, MLO_IE_OUI_SIZE);
+	lim_set_mlo_caps(mac_ctx, session, mlo_caps, mlo_cap_total_len);
+
+	status_2g = lim_send_ie(mac_ctx, vdev_id, DOT11F_EID_MLO_IE,
+				CDS_BAND_2GHZ, &mlo_caps[2],
+				mlo_cap_total_len);
+
+	status_5g = lim_send_ie(mac_ctx, vdev_id, DOT11F_EID_MLO_IE,
+				CDS_BAND_5GHZ, &mlo_caps[2],
+				mlo_cap_total_len);
+
+	if (QDF_IS_STATUS_SUCCESS(status_2g) &&
+	    QDF_IS_STATUS_SUCCESS(status_5g)) {
+		return QDF_STATUS_SUCCESS;
+	}
+	return QDF_STATUS_SUCCESS;
+}
+
 #endif
 
 #ifdef WLAN_FEATURE_11BE

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

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2021 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
@@ -271,6 +272,14 @@ lim_release_mlo_conn_idx(struct mac_context *mac, uint16_t peer_idx,
  */
 void lim_update_sta_mlo_info(tpAddStaParams add_sta_params,
 			     tpDphHashNode sta_ds);
+
+void lim_set_mlo_caps(struct mac_context *mac, struct pe_session *session,
+		      uint8_t *ie_start, uint32_t num_bytes);
+
+QDF_STATUS lim_send_mlo_caps_ie(struct mac_context *mac_ctx,
+				struct pe_session *session,
+				enum QDF_OPMODE device_mode,
+				uint8_t vdev_id);
 #else
 static inline uint16_t lim_assign_mlo_conn_idx(struct mac_context *mac,
 					       struct pe_session *pe_session,
@@ -289,6 +298,21 @@ static inline void lim_update_sta_mlo_info(tpAddStaParams add_sta_params,
 					   tpDphHashNode sta_ds)
 {
 }
+
+static inline
+void lim_set_mlo_caps(struct mac_context *mac, struct pe_session *session,
+		      uint8_t *ie_start, uint32_t num_bytes)
+{
+}
+
+static inline
+QDF_STATUS lim_send_mlo_caps_ie(struct mac_context *mac_ctx,
+				struct pe_session *session,
+				enum QDF_OPMODE device_mode,
+				uint8_t vdev_id)
+{
+	return QDF_STATUS_E_NOSUPPORT;
+}
 #endif
 
 void lim_enable_overlap11g_protection(struct mac_context *mac,

core/mac/src/sys/legacy/src/utils/src/parser_api.c

@@ -7609,6 +7609,29 @@ populate_dot11f_probe_req_mlo_ie(struct mac_context *mac_ctx,
 	return QDF_STATUS_SUCCESS;
 }
 
+QDF_STATUS
+populate_dot11f_mlo_caps(struct mac_context *mac_ctx,
+			 struct pe_session *session,
+			 tDot11fIEmlo_ie *mlo_ie)
+{
+	uint8_t *mld_addr;
+
+	mlo_ie->present = 1;
+	mlo_ie->type = 0;
+	mlo_ie->mld_mac_addr_present = 1;
+	mld_addr = wlan_vdev_mlme_get_mldaddr(session->vdev);
+	qdf_mem_copy(&mlo_ie->mld_mac_addr.info.mld_mac_addr, mld_addr,
+		     sizeof(mlo_ie->mld_mac_addr.info.mld_mac_addr));
+	mlo_ie->link_id_info_present = 0;
+
+	mlo_ie->bss_param_change_cnt_present = 0;
+	mlo_ie->medium_sync_delay_info_present = 0;
+	mlo_ie->eml_capab_present = 0;
+	mlo_ie->mld_capab_present = 1;
+
+	return QDF_STATUS_SUCCESS;
+}
+
 QDF_STATUS
 sir_convert_mlo_probe_rsp_frame2_struct(tDot11fProbeResponse *pr,
 					tpSirMultiLink_IE mlo_ie_ptr)