qcacld-3.0: Handle CSA in MLO sta partner link before it is up

Before MLO sta partner link is up, FW can't indicate CSA event to host.
For this case, host need save csa parameters and process it when MLO
sta partner link is up.

Change-Id: I543c5e1069af5b1e88c6619364a7a44330134d2c
CRs-Fixed: 3082437

components/mlme/core/src/wlan_mlme_vdev_mgr_interface.c

@@ -1,6 +1,6 @@
 /*
  * Copyright (c) 2018-2021 The Linux Foundation. All rights reserved.
- * Copyright (c) 2021 Qualcomm Innovation Center, Inc. All rights reserved.
+ * Copyright (c) 2021-2022 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
@@ -1928,5 +1928,6 @@ static struct mlo_mlme_ext_ops mlo_ext_ops = {
 	.mlo_mlme_ext_peer_delete = lim_mlo_cleanup_partner_peer,
 	.mlo_mlme_ext_peer_assoc_fail = lim_mlo_ap_sta_assoc_fail,
 	.mlo_mlme_ext_assoc_resp = lim_mlo_ap_sta_assoc_suc,
+	.mlo_mlme_ext_handle_sta_csa_param = lim_handle_mlo_sta_csa_param,
 };
 #endif

core/mac/inc/sir_api.h

@@ -3967,29 +3967,6 @@ struct adaptive_dwelltime_params {
 	uint8_t   wifi_act_threshold;
 };
 
-/**
- * struct csa_offload_params - CSA offload request parameters
- * @channel: channel
- * @switch_mode: switch mode
- * @sec_chan_offset: second channel offset
- * @new_ch_width: new channel width
- * @new_ch_freq_seg1: channel center freq 1
- * @new_ch_freq_seg2: channel center freq 2
- * @ies_present_flag: IE present flag
- */
-struct csa_offload_params {
-	uint8_t channel;
-	uint32_t csa_chan_freq;
-	uint8_t switch_mode;
-	uint8_t sec_chan_offset;
-	uint8_t new_ch_width;
-	uint8_t new_op_class;
-	uint8_t new_ch_freq_seg1;
-	uint8_t new_ch_freq_seg2;
-	uint32_t ies_present_flag;
-	tSirMacAddr bssId;
-};
-
 /**
  * enum obss_ht40_scancmd_type - obss scan command type
  * @HT40_OBSS_SCAN_PARAM_START: OBSS scan start

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

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2011-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2022 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
@@ -37,6 +38,99 @@
 #include "lim_assoc_utils.h"
 #include "lim_prop_exts_utils.h"
 #include "lim_ser_des_utils.h"
+#ifdef WLAN_FEATURE_11BE_MLO
+#include <wlan_mlo_mgr_sta.h>
+#include <cds_ieee80211_common.h>
+#endif
+
+#ifdef WLAN_FEATURE_11BE_MLO
+void lim_process_beacon_mlo(struct mac_context *mac_ctx,
+			    struct pe_session *session,
+			    tSchBeaconStruct *bcn_ptr)
+{
+	struct csa_offload_params csa_param;
+	int i;
+	uint8_t link_id;
+	uint8_t *per_sta_pro;
+	uint32_t per_sta_pro_len;
+	uint8_t *sta_pro;
+	uint32_t sta_pro_len;
+	uint16_t stacontrol;
+	struct ieee80211_channelswitch_ie *csa_ie;
+	struct ieee80211_extendedchannelswitch_ie *xcsa_ie;
+	struct wlan_objmgr_vdev *vdev;
+	struct wlan_objmgr_pdev *pdev;
+	struct wlan_mlo_dev_context *mlo_ctx;
+
+	if (!session || !bcn_ptr || !mac_ctx) {
+		pe_err("invalid input parameters");
+		return;
+	}
+	vdev = session->vdev;
+	if (!vdev || !wlan_vdev_mlme_is_mlo_vdev(vdev))
+		return;
+
+	pdev = wlan_vdev_get_pdev(vdev);
+	if (!pdev) {
+		pe_err("null pdev");
+		return;
+	}
+	mlo_ctx = vdev->mlo_dev_ctx;
+	if (!mlo_ctx) {
+		pe_err("null mlo_dev_ctx");
+		return;
+	}
+
+	for (i = 0; i < bcn_ptr->mlo_ie.mlo_ie.num_sta_profile; i++) {
+		csa_ie = NULL;
+		xcsa_ie = NULL;
+		qdf_mem_zero(&csa_param, sizeof(csa_param));
+		per_sta_pro = bcn_ptr->mlo_ie.mlo_ie.sta_profile[i].data;
+		per_sta_pro_len =
+			bcn_ptr->mlo_ie.mlo_ie.sta_profile[i].num_data;
+		stacontrol = *(uint16_t *)per_sta_pro;
+		sta_pro = per_sta_pro + 2; /* sta control */
+		sta_pro_len = per_sta_pro_len - 2;
+		link_id = QDF_GET_BITS(
+			    stacontrol,
+			    WLAN_ML_BV_LINFO_PERSTAPROF_STACTRL_LINKID_IDX,
+			    WLAN_ML_BV_LINFO_PERSTAPROF_STACTRL_LINKID_BITS);
+		if (!mlo_is_sta_csa_synced(mlo_ctx, link_id)) {
+			csa_ie = (struct ieee80211_channelswitch_ie *)
+					wlan_get_ie_ptr_from_eid(
+						DOT11F_EID_CHANSWITCHANN,
+						sta_pro, sta_pro_len);
+			xcsa_ie = (struct ieee80211_extendedchannelswitch_ie *)
+					wlan_get_ie_ptr_from_eid(
+						DOT11F_EID_EXT_CHAN_SWITCH_ANN,
+						sta_pro, sta_pro_len);
+		}
+		if (csa_ie) {
+			csa_param.channel = csa_ie->newchannel;
+			csa_param.csa_chan_freq = wlan_reg_legacy_chan_to_freq(
+						pdev, csa_ie->newchannel);
+			csa_param.switch_mode = csa_ie->switchmode;
+			csa_param.ies_present_flag |= MLME_CSA_IE_PRESENT;
+			mlo_sta_csa_save_params(mlo_ctx, link_id, &csa_param);
+		} else if (xcsa_ie) {
+			csa_param.channel = xcsa_ie->newchannel;
+			csa_param.switch_mode = xcsa_ie->switchmode;
+			csa_param.new_op_class = xcsa_ie->newClass;
+			if (wlan_reg_is_6ghz_op_class(pdev, xcsa_ie->newClass))
+				csa_param.csa_chan_freq =
+					wlan_reg_chan_band_to_freq(
+						pdev, xcsa_ie->newchannel,
+						BIT(REG_BAND_6G));
+			else
+				csa_param.csa_chan_freq =
+					wlan_reg_legacy_chan_to_freq(
+						pdev, xcsa_ie->newchannel);
+			csa_param.ies_present_flag |= MLME_XCSA_IE_PRESENT;
+			mlo_sta_csa_save_params(mlo_ctx, link_id, &csa_param);
+		}
+	}
+}
+#endif
 
 /**
  * lim_process_beacon_frame() - to process beacon frames
@@ -100,6 +194,8 @@ lim_process_beacon_frame(struct mac_context *mac_ctx, uint8_t *rx_pkt_info,
 		return;
 	}
 
+	lim_process_beacon_mlo(mac_ctx, session, bcn_ptr);
+
 	/*
 	 * during scanning, when any session is active, and
 	 * beacon/Pr belongs to one of the session, fill up the

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

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2022 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
@@ -55,6 +56,7 @@
 #include "lim_process_fils.h"
 #include "wma.h"
 #include <../../core/src/wlan_cm_vdev_api.h>
+#include <wlan_mlo_mgr_sta.h>
 
 void lim_send_sme_rsp(struct mac_context *mac_ctx, uint16_t msg_type,
 		      tSirResultCodes result_code, uint8_t vdev_id)
@@ -1728,18 +1730,16 @@ static bool lim_is_csa_channel_allowed(struct mac_context *mac_ctx,
 }
 
 /**
- * lim_handle_csa_offload_msg() - Handle CSA offload message
- * @mac_ctx:         pointer to global adapter context
- * @msg:             Message pointer.
+ * lim_handle_sta_csa_param() - Handle CSA offload param
+ * @mac_ctx: pointer to global adapter context
+ * @csa_params: csa parameters.
  *
  * Return: None
  */
-void lim_handle_csa_offload_msg(struct mac_context *mac_ctx,
-				struct scheduler_msg *msg)
+static void lim_handle_sta_csa_param(struct mac_context *mac_ctx,
+				     struct csa_offload_params *csa_params)
 {
 	struct pe_session *session_entry;
-	struct csa_offload_params *csa_params =
-				(struct csa_offload_params *) (msg->bodyptr);
 	tpDphHashNode sta_ds = NULL;
 	uint8_t session_id;
 	uint16_t aid = 0;
@@ -1757,13 +1757,12 @@ void lim_handle_csa_offload_msg(struct mac_context *mac_ctx,
 
 	session_entry =
 		pe_find_session_by_bssid(mac_ctx,
-			csa_params->bssId, &session_id);
+			csa_params->bssid.bytes, &session_id);
 	if (!session_entry) {
 		pe_err("Session does not exists for "QDF_MAC_ADDR_FMT,
-				QDF_MAC_ADDR_REF(csa_params->bssId));
+		       QDF_MAC_ADDR_REF(csa_params->bssid.bytes));
 		goto err;
 	}
-
 	sta_ds = dph_lookup_hash_entry(mac_ctx, session_entry->bssId, &aid,
 		&session_entry->dph.dphHashTable);
 
@@ -1860,9 +1859,9 @@ void lim_handle_csa_offload_msg(struct mac_context *mac_ctx,
 	} else if (channel_bonding_mode &&
 	    ((session_entry->vhtCapability && session_entry->htCapability) ||
 	      lim_is_session_he_capable(session_entry))) {
-		if ((csa_params->ies_present_flag & lim_wbw_ie_present) &&
-			(QDF_STATUS_SUCCESS == lim_process_csa_wbw_ie(mac_ctx,
-					csa_params, chnl_switch_info,
+		if ((csa_params->ies_present_flag & MLME_WBW_IE_PRESENT) &&
+		    (QDF_STATUS_SUCCESS == lim_process_csa_wbw_ie(
+					mac_ctx, csa_params, chnl_switch_info,
 					session_entry))) {
 			lim_ch_switch->sec_ch_offset =
 				PHY_SINGLE_CHANNEL_CENTERED;
@@ -1878,7 +1877,7 @@ void lim_handle_csa_offload_msg(struct mac_context *mac_ctx,
 									true;
 			}
 		} else if (csa_params->ies_present_flag
-				& lim_xcsa_ie_present) {
+				& MLME_XCSA_IE_PRESENT) {
 			uint32_t fw_vht_ch_wd = wma_get_vht_ch_width();
 
 			if (wlan_reg_is_6ghz_op_class
@@ -1960,7 +1959,7 @@ void lim_handle_csa_offload_msg(struct mac_context *mac_ctx,
 
 	} else if (channel_bonding_mode && session_entry->htCapability) {
 		if (csa_params->ies_present_flag
-				& lim_xcsa_ie_present) {
+				& MLME_XCSA_IE_PRESENT) {
 			chan_space =
 				wlan_reg_dmn_get_chanwidth_from_opclass_auto(
 						country_code,
@@ -2053,6 +2052,62 @@ err:
 	qdf_mem_free(csa_params);
 }
 
+void lim_handle_csa_offload_msg(struct mac_context *mac_ctx,
+				struct scheduler_msg *msg)
+{
+	struct pe_session *session;
+	struct csa_offload_params *csa_params =
+				(struct csa_offload_params *)(msg->bodyptr);
+	uint8_t session_id;
+
+	if (!csa_params) {
+		pe_err("limMsgQ body ptr is NULL");
+		return;
+	}
+
+	session = pe_find_session_by_bssid(
+				mac_ctx, csa_params->bssid.bytes, &session_id);
+	if (!session) {
+		pe_err("Session does not exists for " QDF_MAC_ADDR_FMT,
+		       QDF_MAC_ADDR_REF(csa_params->bssid.bytes));
+		qdf_mem_free(csa_params);
+		return;
+	}
+	if (wlan_vdev_mlme_is_mlo_vdev(session->vdev) &&
+	    mlo_is_sta_csa_param_handled(session->vdev, csa_params)) {
+		pe_debug("vdev_id: %d, csa param is already handled. return",
+			 session_id);
+		qdf_mem_free(csa_params);
+		return;
+	}
+	lim_handle_sta_csa_param(mac_ctx, csa_params);
+}
+
+#ifdef WLAN_FEATURE_11BE_MLO
+void lim_handle_mlo_sta_csa_param(struct wlan_objmgr_vdev *vdev,
+				  struct csa_offload_params *csa_params)
+{
+	struct mac_context *mac;
+	struct csa_offload_params *tmp_csa_params;
+
+	mac = cds_get_context(QDF_MODULE_ID_PE);
+	if (!mac) {
+		pe_err("mac ctx is null");
+		return;
+	}
+
+	tmp_csa_params = qdf_mem_malloc(sizeof(*tmp_csa_params));
+	if (!tmp_csa_params) {
+		pe_err("tmp_csa_params allocation fails");
+		return;
+	}
+
+	qdf_mem_copy(tmp_csa_params, csa_params, sizeof(*tmp_csa_params));
+
+	lim_handle_sta_csa_param(mac, tmp_csa_params);
+}
+#endif
+
 /*--------------------------------------------------------------------------
    \brief pe_delete_session() - Handle the Delete BSS Response from HAL.
 

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

@@ -1,5 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
+ * Copyright (c) 2022 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
@@ -207,6 +208,13 @@ void lim_send_sme_set_context_rsp(struct mac_context *mac,
 void lim_handle_delete_bss_rsp(struct mac_context *mac,
 				struct del_bss_resp *del_bss_rsp);
 
+/**
+ * lim_handle_csa_offload_msg() - Handle CSA offload message
+ * @mac_ctx:         pointer to global adapter context
+ * @msg:             Message pointer.
+ *
+ * Return: None
+ */
 void lim_handle_csa_offload_msg(struct mac_context *mac_ctx,
 				struct scheduler_msg *msg);
 
@@ -262,11 +270,16 @@ void
 lim_process_beacon_tx_success_ind(struct mac_context *mac, uint16_t msgType,
 				  void *event);
 
-typedef enum {
-	lim_csa_ie_present = 0x00000001,
-	lim_xcsa_ie_present = 0x00000002,
-	lim_wbw_ie_present = 0x00000004,
-	lim_cswarp_ie_present = 0x00000008,
-} lim_csa_event_ies_present_flag;
+#ifdef WLAN_FEATURE_11BE_MLO
+/**
+ * lim_handle_mlo_sta_csa_param() - handle mlo sta csa parameters
+ * @vdev: vdev
+ * @csa_params: csa parameters
+ *
+ * Return: None
+ */
+void lim_handle_mlo_sta_csa_param(struct wlan_objmgr_vdev *vdev,
+				  struct csa_offload_params *csa_params);
+#endif /* WLAN_FEATURE_11BE_MLO */
 
 #endif /* __LIM_SEND_SME_RSP_H */

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

@@ -1,6 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
- * Copyright (c) 2021 Qualcomm Innovation Center, Inc. All rights reserved.
+ * Copyright (c) 2021-2022 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
@@ -391,6 +391,28 @@ QDF_STATUS lim_init_mlm(struct mac_context *);
 void lim_cleanup_mlm(struct mac_context *);
 
 /* Management frame handling functions */
+
+#ifdef WLAN_FEATURE_11BE_MLO
+/**
+ * lim_process_beacon_mlo() - process beacon mlo IE
+ * @mac_ctx: global mac context
+ * @session: pe session
+ * @bcn_ptr: pointer to tSchBeaconStruct
+ *
+ * Return none
+ */
+void lim_process_beacon_mlo(struct mac_context *mac_ctx,
+			    struct pe_session *session,
+			    tSchBeaconStruct *bcn_ptr);
+#else
+static inline
+void lim_process_beacon_mlo(struct mac_context *mac_ctx,
+			    struct pe_session *session,
+			    tSchBeaconStruct *bcn_ptr)
+{
+}
+#endif
+
 void lim_process_beacon_frame(struct mac_context *, uint8_t *, struct pe_session *);
 void lim_process_probe_req_frame(struct mac_context *, uint8_t *, struct pe_session *);
 void lim_process_probe_rsp_frame(struct mac_context *, uint8_t *, struct pe_session *);

core/mac/src/pe/sch/sch_beacon_process.c

@@ -1,6 +1,6 @@
 /*
  * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
- * Copyright (c) 2021 Qualcomm Innovation Center, Inc. All rights reserved.
+ * Copyright (c) 2021-2022 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
@@ -1099,6 +1099,7 @@ sch_beacon_process(struct mac_context *mac_ctx, uint8_t *rx_pkt_info,
 
 	sch_send_beacon_report(mac_ctx, &bcn, session);
 	__sch_beacon_process_for_session(mac_ctx, &bcn, rx_pkt_info, session);
+	lim_process_beacon_mlo(mac_ctx, session, &bcn);
 }
 
 /**

core/sme/src/common/sme_api.c

@@ -16050,8 +16050,7 @@ QDF_STATUS sme_switch_channel(mac_handle_t mac_handle,
 	if (!csa_offload_event)
 		return QDF_STATUS_E_NOMEM;
 
-	qdf_mem_copy(csa_offload_event->bssId, bssid->bytes,
-		     QDF_MAC_ADDR_SIZE);
+	qdf_copy_macaddr(&csa_offload_event->bssid, bssid);
 	csa_offload_event->csa_chan_freq = (uint32_t)chan_freq;
 	csa_offload_event->new_ch_width = (uint8_t)chan_width;
 	csa_offload_event->channel =
@@ -16060,7 +16059,7 @@ QDF_STATUS sme_switch_channel(mac_handle_t mac_handle,
 	csa_offload_event->switch_mode = 1;
 
 	sme_debug("bssid " QDF_MAC_ADDR_FMT " freq %u width %u",
-		  QDF_MAC_ADDR_REF(csa_offload_event->bssId),
+		  QDF_MAC_ADDR_REF(csa_offload_event->bssid.bytes),
 		  csa_offload_event->csa_chan_freq,
 		  csa_offload_event->new_ch_width);
 

core/wma/src/wma_features.c

@@ -1,6 +1,6 @@
 /*
  * Copyright (c) 2013-2021 The Linux Foundation. All rights reserved.
- * Copyright (c) 2021 Qualcomm Innovation Center, Inc. All rights reserved.
+ * Copyright (c) 2021-2022 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
@@ -1252,7 +1252,8 @@ int wma_csa_offload_handler(void *handle, uint8_t *event, uint32_t len)
 	}
 
 	qdf_mem_zero(csa_offload_event, sizeof(*csa_offload_event));
-	qdf_mem_copy(csa_offload_event->bssId, &bssid, QDF_MAC_ADDR_SIZE);
+	qdf_copy_macaddr(&csa_offload_event->bssid,
+			 (struct qdf_mac_addr *)bssid);
 
 	if (csa_event->ies_present_flag & WMI_CSA_IE_PRESENT) {
 		csa_ie = (struct ieee80211_channelswitch_ie *)
@@ -1262,6 +1263,7 @@ int wma_csa_offload_handler(void *handle, uint8_t *event, uint32_t len)
 			wlan_reg_legacy_chan_to_freq(wma->pdev,
 						     csa_ie->newchannel);
 		csa_offload_event->switch_mode = csa_ie->switchmode;
+		csa_offload_event->ies_present_flag |= MLME_CSA_IE_PRESENT;
 	} else if (csa_event->ies_present_flag & WMI_XCSA_IE_PRESENT) {
 		xcsa_ie = (struct ieee80211_extendedchannelswitch_ie *)
 						(&csa_event->xcsa_ie[0]);
@@ -1278,6 +1280,7 @@ int wma_csa_offload_handler(void *handle, uint8_t *event, uint32_t len)
 				wlan_reg_legacy_chan_to_freq
 					(wma->pdev, xcsa_ie->newchannel);
 		}
+		csa_offload_event->ies_present_flag |= MLME_XCSA_IE_PRESENT;
 	} else {
 		wma_err("CSA Event error: No CSA IE present");
 		qdf_mem_free(csa_offload_event);
@@ -1290,6 +1293,7 @@ int wma_csa_offload_handler(void *handle, uint8_t *event, uint32_t len)
 		csa_offload_event->new_ch_width = wb_ie->new_ch_width;
 		csa_offload_event->new_ch_freq_seg1 = wb_ie->new_ch_freq_seg1;
 		csa_offload_event->new_ch_freq_seg2 = wb_ie->new_ch_freq_seg2;
+		csa_offload_event->ies_present_flag |= MLME_WBW_IE_PRESENT;
 	} else if (csa_event->ies_present_flag &
 		   WMI_CSWRAP_IE_EXTENDED_PRESENT) {
 		wb_ie = (struct ieee80211_ie_wide_bw_switch *)
@@ -1303,16 +1307,18 @@ int wma_csa_offload_handler(void *handle, uint8_t *event, uint32_t len)
 			csa_offload_event->new_ch_freq_seg2 =
 						wb_ie->new_ch_freq_seg2;
 			csa_event->ies_present_flag |= WMI_WBW_IE_PRESENT;
+			csa_offload_event->ies_present_flag |=
+				MLME_WBW_IE_PRESENT;
 		}
+		csa_offload_event->ies_present_flag |=
+			MLME_CSWRAP_IE_EXTENDED_PRESENT;
 	}
 
-	csa_offload_event->ies_present_flag = csa_event->ies_present_flag;
-
 	wma_debug("CSA: BSSID "QDF_MAC_ADDR_FMT" chan %d freq %d flag 0x%x width = %d freq1 = %d freq2 = %d op class = %d",
-		 QDF_MAC_ADDR_REF(csa_offload_event->bssId),
+		 QDF_MAC_ADDR_REF(csa_offload_event->bssid.bytes),
 		 csa_offload_event->channel,
 		 csa_offload_event->csa_chan_freq,
-		 csa_event->ies_present_flag,
+		 csa_offload_event->ies_present_flag,
 		 csa_offload_event->new_ch_width,
 		 csa_offload_event->new_ch_freq_seg1,
 		 csa_offload_event->new_ch_freq_seg2,