qcacld-3.0: Config addba resp for TDLS on MLO

For TDLS in MLO case, when send addba response, it needs to
use MLD macaddr and set action code, then the frame can send
out properly and be received by peer.

Change-Id: I93b46ad88738fc2ee9c88bd52ab5d3a86ead3cd7
CRs-Fixed: 3462062

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

@@ -1604,6 +1604,7 @@ static QDF_STATUS lim_send_tdls_dis_rsp_frame(struct mac_context *mac,
 	uint8_t smeSessionId = 0;
 	uint16_t mlo_ie_len = 0;
 	uint8_t *eht_cap_ie = NULL, eht_cap_ie_len = 0;
+	uint16_t action;
 
 	if (!pe_session) {
 		pe_err("pe_session is NULL");
@@ -1820,6 +1821,7 @@ static QDF_STATUS lim_send_tdls_dis_rsp_frame(struct mac_context *mac,
 	 * wma does not do header conversion to 802.3 before calling tx/rx
 	 * routine and subsequenly target also sends frame as is OTA
 	 */
+	action = ACTION_CATEGORY_PUBLIC << 8 | TDLS_DISCOVERY_RESPONSE;
 	qdf_status = wma_tx_frameWithTxComplete(mac, pPacket, (uint16_t) nBytes,
 					      TXRX_FRM_802_11_MGMT,
 					      ANI_TXDIR_IBSS,
@@ -1829,7 +1831,7 @@ static QDF_STATUS lim_send_tdls_dis_rsp_frame(struct mac_context *mac,
 					      HAL_USE_SELF_STA_REQUESTED_MASK,
 					      smeSessionId, false, 0,
 					      RATEID_DEFAULT, 0,
-					      TDLS_DISCOVERY_RESPONSE);
+					      action);
 	if (!QDF_IS_STATUS_SUCCESS(qdf_status)) {
 		mac->lim.tdls_frm_session_id = NO_SESSION;
 		pe_err("could not send TDLS Discovery Response frame!");

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

@@ -6045,6 +6045,35 @@ bool lim_tdls_peer_support_he(tpDphHashNode sta_ds)
 }
 #endif
 
+#ifdef WLAN_FEATURE_11BE_MLO
+static
+void lim_prepare_tdls_with_mlo(struct pe_session *session,
+			       tSirMacAddr peer_mac, tSirMacAddr self_mac,
+			       uint16_t *action)
+{
+	uint8_t *mld_addr;
+
+	if (!sir_compare_mac_addr(session->bssId, peer_mac) &&
+	    wlan_mlo_get_tdls_link_vdev(session->vdev)) {
+		mld_addr = wlan_vdev_mlme_get_mldaddr(session->vdev);
+		sir_copy_mac_addr(self_mac, mld_addr);
+		*action = ACTION_CATEGORY_BACK << 8 | ADDBA_RESPONSE;
+	} else {
+		sir_copy_mac_addr(self_mac, session->self_mac_addr);
+		*action = 0;
+	}
+}
+#else
+static
+void lim_prepare_tdls_with_mlo(struct pe_session *session,
+			       tSirMacAddr peer_mac, tSirMacAddr self_mac,
+			       uint16_t *action)
+{
+	sir_copy_mac_addr(self_mac, session->self_mac_addr);
+	*action = 0;
+}
+#endif
+
 QDF_STATUS lim_send_addba_response_frame(struct mac_context *mac_ctx,
 		tSirMacAddr peer_mac, uint16_t tid,
 		struct pe_session *session, uint8_t addba_extn_present,
@@ -6069,6 +6098,8 @@ QDF_STATUS lim_send_addba_response_frame(struct mac_context *mac_ctx,
 	bool he_cap = false;
 	bool eht_cap = false;
 	struct wlan_mlme_qos *qos_aggr;
+	tSirMacAddr self_mac;
+	uint16_t action;
 
 	vdev_id = session->vdev_id;
 
@@ -6181,8 +6212,13 @@ QDF_STATUS lim_send_addba_response_frame(struct mac_context *mac_ctx,
 		}
 	}
 
+	/*
+	 * for TDLS MLO case, it needs to use MLD mac address for TA and
+	 * set action code to send out from specific vdev in fw.
+	 */
+	lim_prepare_tdls_with_mlo(session, peer_mac, self_mac, &action);
 	pe_debug("Sending a ADDBA Response from "QDF_MAC_ADDR_FMT" to "QDF_MAC_ADDR_FMT,
-		 QDF_MAC_ADDR_REF(session->self_mac_addr),
+		 QDF_MAC_ADDR_REF(self_mac),
 		 QDF_MAC_ADDR_REF(peer_mac));
 	pe_debug("tid %d dialog_token %d status %d buff_size %d amsdu_supp %d",
 		 tid, frm.DialogToken.token, frm.Status.status,
@@ -6216,7 +6252,7 @@ QDF_STATUS lim_send_addba_response_frame(struct mac_context *mac_ctx,
 	qdf_mem_zero(frame_ptr, num_bytes);
 
 	lim_populate_mac_header(mac_ctx, frame_ptr, SIR_MAC_MGMT_FRAME,
-		SIR_MAC_MGMT_ACTION, peer_mac, session->self_mac_addr);
+		SIR_MAC_MGMT_ACTION, peer_mac, self_mac);
 
 	/* Update A3 with the BSSID */
 	mgmt_hdr = (tpSirMacMgmtHdr) frame_ptr;
@@ -6261,7 +6297,8 @@ QDF_STATUS lim_send_addba_response_frame(struct mac_context *mac_ctx,
 						NULL, frame_ptr,
 						lim_addba_rsp_tx_complete_cnf,
 						tx_flag, vdev_id,
-						false, 0, RATEID_DEFAULT, 0, 0);
+						false, 0, RATEID_DEFAULT, 0,
+						action);
 	MTRACE(qdf_trace(QDF_MODULE_ID_PE, TRACE_CODE_TX_COMPLETE,
 			 session->peSessionId, qdf_status));
 	if (QDF_STATUS_SUCCESS != qdf_status) {

core/wma/inc/wma_types.h

@@ -685,7 +685,7 @@ void wma_tx_abort(uint8_t vdev_id);
  * @channel_freq: channel frequency
  * @rid: rate id
  * @peer_rssi: peer RSSI value
- * @action: TDLS action code
+ * @action: action code
  *
  * This function sends the frame corresponding to the
  * given vdev id.
@@ -700,7 +700,7 @@ QDF_STATUS wma_tx_packet(void *wma_context, void *tx_frame, uint16_t frmLen,
 			 wma_tx_ota_comp_callback tx_frm_ota_comp_cb,
 			 uint8_t tx_flag, uint8_t vdev_id, bool tdls_flag,
 			 uint16_t channel_freq, enum rateid rid,
-			 int8_t peer_rssi, enum tdls_actioncode action);
+			 int8_t peer_rssi, uint16_t action);
 
 /**
  * wma_open() - Allocate wma context and initialize it.

core/wma/src/wma_data.c

@@ -2279,7 +2279,7 @@ QDF_STATUS wma_tx_packet(void *wma_context, void *tx_frame, uint16_t frmLen,
 			 wma_tx_ota_comp_callback tx_frm_ota_comp_cb,
 			 uint8_t tx_flag, uint8_t vdev_id, bool tdls_flag,
 			 uint16_t channel_freq, enum rateid rid,
-			 int8_t peer_rssi, enum tdls_actioncode action)
+			 int8_t peer_rssi, uint16_t action)
 {
 	tp_wma_handle wma_handle = (tp_wma_handle) (wma_context);
 	int32_t status;
@@ -2698,7 +2698,8 @@ QDF_STATUS wma_tx_packet(void *wma_context, void *tx_frame, uint16_t frmLen,
 	    pFc->subType != SIR_MAC_MGMT_PROBE_REQ &&
 	    pFc->subType != SIR_MAC_MGMT_AUTH &&
 	    pFc->subType != SIR_MAC_MGMT_ASSOC_REQ &&
-	    action != TDLS_DISCOVERY_RESPONSE)
+	    action != (ACTION_CATEGORY_PUBLIC << 8 | TDLS_DISCOVERY_RESPONSE) &&
+	    action != (ACTION_CATEGORY_BACK << 8 | ADDBA_RESPONSE))
 		mgmt_param.mlo_link_agnostic = true;
 
 	if (tx_flag & HAL_USE_INCORRECT_KEY_PMF)