qcacld-3.0: Add support for T2LM request/response event for logging

Add support for T2LM request/response event for
connectivity logging.

For T2LM request/response band, token, status, tx_status and
is_rx parameter are logged for the event.

Change-Id: I5d65c99896ec26b67b763679b105036975a938d5
CRs-Fixed: 3607151

components/cmn_services/logging/inc/wlan_connectivity_logging.h

@@ -1206,11 +1206,42 @@ wlan_populate_vsie(struct wlan_objmgr_vdev *vdev,
  * Return: None
  */
 void wlan_connectivity_mlo_setup_event(struct wlan_objmgr_vdev *vdev);
+
+/**
+ * wlan_connectivity_t2lm_req_resp_event - API to send t2lm Req/resp
+ * event logs to userspace
+ * @vdev: vdev pointer
+ * @token: dialog Token
+ * @t2lm_status: T2LM response status code. Refer enum wlan_t2lm_resp_frm_type
+ * @tx_status: TX status
+ * @freq: Frame received/transmitted frequency
+ * @is_rx: Flag to inidcate packet being received
+ * @subtype: Determine whether the evnt sent is for t2lm request
+ * or t2lm response
+ *
+ * Return: None
+ */
+void
+wlan_connectivity_t2lm_req_resp_event(struct wlan_objmgr_vdev *vdev,
+				      uint8_t token,
+				      enum wlan_t2lm_resp_frm_type t2lm_status,
+				      enum qdf_dp_tx_rx_status tx_status,
+				      qdf_freq_t freq,
+				      bool is_rx, uint8_t subtype);
 #else
 static inline void
 wlan_connectivity_mlo_setup_event(struct wlan_objmgr_vdev *vdev)
 {
 }
+
+static inline void
+wlan_connectivity_t2lm_req_resp_event(struct wlan_objmgr_vdev *vdev,
+				      uint8_t token,
+				      enum wlan_t2lm_resp_frm_type status,
+				      enum qdf_dp_tx_rx_status tx_status,
+				      qdf_freq_t freq,
+				      bool is_rx, uint8_t subtype)
+{}
 #endif
 
 /**
@@ -1406,6 +1437,15 @@ static inline void
 wlan_connectivity_sta_info_event(struct wlan_objmgr_psoc *psoc,
 				 uint8_t vdev_id)
 {}
+
+static inline void
+wlan_connectivity_t2lm_req_resp_event(struct wlan_objmgr_vdev *vdev,
+				      uint8_t token,
+				      enum wlan_t2lm_resp_frm_type status,
+				      enum qdf_dp_tx_rx_status tx_status,
+				      qdf_freq_t freq,
+				      bool is_rx, uint8_t subtype)
+{}
 #endif
 
 #if defined(CONNECTIVITY_DIAG_EVENT) && defined(WLAN_FEATURE_11BE_MLO)

components/cmn_services/logging/src/wlan_connectivity_logging.c

@@ -302,6 +302,36 @@ wlan_cache_connectivity_log(struct wlan_objmgr_psoc *psoc, uint8_t vdev_id,
 #ifdef CONNECTIVITY_DIAG_EVENT
 
 #ifdef WLAN_FEATURE_11BE_MLO
+void
+wlan_connectivity_t2lm_req_resp_event(struct wlan_objmgr_vdev *vdev,
+				      uint8_t token,
+				      enum wlan_t2lm_resp_frm_type t2lm_status,
+				      enum qdf_dp_tx_rx_status tx_status,
+				      qdf_freq_t freq,
+				      bool is_rx, uint8_t subtype)
+{
+	WLAN_HOST_DIAG_EVENT_DEF(wlan_diag_event,
+				 struct wlan_diag_mlo_t2lm_req_resp);
+
+	wlan_diag_event.diag_cmn.vdev_id = wlan_vdev_get_id(vdev);
+	wlan_diag_event.diag_cmn.ktime_us = qdf_ktime_to_us(qdf_ktime_get());
+	wlan_diag_event.diag_cmn.timestamp_us = qdf_get_time_of_the_day_us();
+
+	wlan_diag_event.version = DIAG_MLO_T2LM_REQ_RESP_VERSION;
+
+	wlan_diag_event.token = token;
+	wlan_diag_event.subtype = subtype;
+
+	wlan_diag_event.status = t2lm_status;
+	wlan_diag_event.tx_status = wlan_get_diag_tx_status(tx_status);
+	wlan_diag_event.is_rx = is_rx;
+
+	wlan_diag_event.band = wlan_convert_freq_to_diag_band(freq);
+
+	WLAN_HOST_DIAG_EVENT_REPORT(&wlan_diag_event,
+				    EVENT_WLAN_MLO_T2LM_REQ_RESP);
+}
+
 static QDF_STATUS
 wlan_populate_link_addr(struct wlan_objmgr_vdev *vdev,
 			struct wlan_diag_sta_info *wlan_diag_event)

components/umac/mlme/mlo_mgr/src/wlan_t2lm_api.c

@@ -23,6 +23,7 @@
 #include <wlan_mlo_t2lm.h>
 #include "wlan_cm_api.h"
 #include "wlan_mlo_mgr_roam.h"
+#include "wlan_connectivity_logging.h"
 
 #define T2LM_MIN_DIALOG_TOKEN         1
 #define T2LM_MAX_DIALOG_TOKEN         0xFF
@@ -186,6 +187,10 @@ QDF_STATUS t2lm_handle_rx_req(struct wlan_objmgr_vdev *vdev,
 	}
 
 	*token = t2lm_req.dialog_token;
+	wlan_connectivity_t2lm_req_resp_event(
+			vdev, *token, 0, 0,
+			wlan_vdev_mlme_get_bss_chan(vdev)->ch_freq,
+			true, WLAN_CONN_DIAG_MLO_T2LM_REQ_EVENT);
 
 	return status;
 }

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

@@ -18,11 +18,10 @@
  */
 
 /**
- * \file lim_send_management_frames.c
- *
- * \brief Code for preparing and sending 802.11 Management frames
- *
+ * DOC: lim_send_management_frames.c
  *
+ * WLAN Host Device Driver file for preparing and sending 802.11 Management
+ * frames
  */
 
 #include "sir_api.h"
@@ -62,6 +61,7 @@
 #include "lim_mlo.h"
 #include "wlan_mlo_mgr_sta.h"
 #include "wlan_t2lm_api.h"
+#include "wlan_connectivity_logging.h"
 
 /**
  *
@@ -2144,8 +2144,7 @@ lim_send_delts_req_action_frame(struct mac_context *mac,
 
 /**
  * wlan_send_tx_complete_event() - Fill mgmt params
- *
- * @context: Pointer to mac context
+ * @mac: Pointer to mac context
  * @buf: skb buffer
  * @params: Pointer to wmi_mgmt_params
  * @tx_complete: Sent status
@@ -2219,8 +2218,8 @@ static void wlan_send_tx_complete_event(struct mac_context *mac, qdf_nbuf_t buf,
  * lim_assoc_tx_complete_cnf()- Confirmation for assoc sent over the air
  * @context: pointer to global mac
  * @buf: buffer
- * @tx_complete : Sent status
- * @params; tx completion params
+ * @tx_complete: Sent status
+ * @params: tx completion params
  *
  * Return: This returns QDF_STATUS
  */
@@ -3168,8 +3167,8 @@ lim_get_addba_rsp_ptr(uint8_t *ie, uint32_t ie_len)
  * lim_addba_rsp_tx_complete_cnf() - Confirmation for add BA response OTA
  * @context: pointer to global mac
  * @buf: buffer which is nothing but entire ADD BA frame
- * @tx_complete : Sent status
- * @params; tx completion params
+ * @tx_complete: Sent status
+ * @params: tx completion params
  *
  * Return: This returns QDF_STATUS
  */
@@ -3381,11 +3380,10 @@ uint32_t lim_calculate_auth_mlo_ie_len(struct mac_context *mac_ctx,
 
 /**
  * lim_send_auth_mgmt_frame() - Send an Authentication frame
- *
  * @mac_ctx: Pointer to Global MAC structure
  * @auth_frame: Pointer to Authentication frame structure
  * @peer_addr: MAC address of destination peer
- * @wep_bit: wep bit in frame control for Authentication frame3
+ * @wep_challenge_len: wep challenge length
  * @session: PE session information
  *
  * This function is called by lim_process_mlm_messages(). Authentication frame
@@ -6035,30 +6033,24 @@ QDF_STATUS lim_send_sa_query_request_frame(struct mac_context *mac, uint8_t *tra
 
 returnAfterError:
 	cds_packet_free((void *)pPacket);
+
 	return nSirStatus;
 } /* End lim_send_sa_query_request_frame */
 
 /**
- * \brief Send SA query response action frame to peer
- *
- * \sa lim_send_sa_query_response_frame
- *
- *
- * \param mac    The global struct mac_context *object
- *
- * \param transId Transaction identifier received in SA query request action frame
- *
- * \param peer    The Mac address of the AP to which this action frame is addressed
+ * lim_send_sa_query_response_frame() - Send SA query response action frame to
+ * peer
+ * @mac: The global struct mac_context *object
+ * @transId: Transaction identifier received in SA query request action frame
+ * @peer:    The Mac address of the AP to which this action frame is addressed
+ * @pe_session: The PE session entry
  *
- * \param pe_session The PE session entry
- *
- * \return QDF_STATUS_SUCCESS if setup completes successfully
+ * Return: QDF_STATUS_SUCCESS if setup completes successfully
  *         QDF_STATUS_E_FAILURE is some problem is encountered
  */
-
 QDF_STATUS lim_send_sa_query_response_frame(struct mac_context *mac,
-					       uint8_t *transId, tSirMacAddr peer,
-					       struct pe_session *pe_session)
+					    uint8_t *transId, tSirMacAddr peer,
+					    struct pe_session *pe_session)
 {
 
 	tDot11fSaQueryRsp frm;  /* SA query response action frame */
@@ -6846,6 +6838,62 @@ error_epcs_td:
 	return qdf_status;
 }
 
+static QDF_STATUS
+lim_mgmt_t2lm_rsp_tx_complete(void *context, qdf_nbuf_t buf,
+			      uint32_t tx_status, void *params)
+{
+	struct mac_context *mac_ctx = (struct mac_context *)context;
+	struct pe_session *pe_session;
+	struct wlan_frame_hdr *mac_hdr;
+	struct wmi_mgmt_params *mgmt_params;
+	tDot11ft2lm_neg_rsp rsp = {0};
+	enum qdf_dp_tx_rx_status qdf_tx_complete;
+	uint32_t extract_status;
+	uint8_t *frame_ptr;
+
+	if (qdf_nbuf_len(buf) < sizeof(struct wlan_frame_hdr) + 2)
+		return QDF_STATUS_E_FAILURE;
+
+	if (!params)
+		return QDF_STATUS_E_FAILURE;
+
+	mgmt_params = params;
+	pe_session = pe_find_session_by_vdev_id(mac_ctx, mgmt_params->vdev_id);
+	if (!pe_session || pe_session->opmode != QDF_STA_MODE)
+		return QDF_STATUS_SUCCESS;
+
+	mac_hdr = (struct wlan_frame_hdr *)qdf_nbuf_data(buf);
+
+	if (tx_status == WMI_MGMT_TX_COMP_TYPE_COMPLETE_OK)
+		qdf_tx_complete = QDF_TX_RX_STATUS_OK;
+	else if (tx_status  == WMI_MGMT_TX_COMP_TYPE_DISCARD)
+		qdf_tx_complete = QDF_TX_RX_STATUS_FW_DISCARD;
+	else
+		qdf_tx_complete = QDF_TX_RX_STATUS_NO_ACK;
+
+	frame_ptr = qdf_nbuf_data(buf);
+	extract_status =
+		dot11f_unpack_t2lm_neg_rsp(mac_ctx,
+					   frame_ptr + sizeof(*mac_hdr),
+					   qdf_nbuf_len(buf), &rsp, false);
+	if (DOT11F_FAILED(extract_status)) {
+		pe_err("Failed to unpack T2LM negotiation response (0x%08x)",
+		       extract_status);
+		return QDF_STATUS_E_FAILURE;
+	}
+
+	wlan_connectivity_t2lm_req_resp_event(pe_session->vdev,
+					      rsp.DialogToken.token,
+					      rsp.Status.status,
+					      qdf_tx_complete,
+					      mgmt_params->chanfreq,
+					      false,
+					      WLAN_CONN_DIAG_MLO_T2LM_RESP_EVENT);
+	qdf_nbuf_free(buf);
+
+	return QDF_STATUS_SUCCESS;
+}
+
 QDF_STATUS
 lim_send_t2lm_action_rsp_frame(struct mac_context *mac_ctx,
 			       tSirMacAddr peer_mac,
@@ -6856,14 +6904,13 @@ lim_send_t2lm_action_rsp_frame(struct mac_context *mac_ctx,
 	uint8_t session_id = 0;
 	uint8_t *frame_ptr;
 	tpSirMacMgmtHdr mgmt_hdr;
-	uint32_t num_bytes, payload_size, status;
+	uint32_t num_bytes, payload_size, dot11f_status;
 	void *pkt_ptr = NULL;
-	QDF_STATUS qdf_status;
+	QDF_STATUS status;
 	uint8_t vdev_id = 0;
 	uint8_t tx_flag = 0;
 
 	session_id = session->smeSessionId;
-
 	vdev_id = session->vdev_id;
 
 	qdf_mem_zero((uint8_t *)&frm, sizeof(frm));
@@ -6879,22 +6926,22 @@ lim_send_t2lm_action_rsp_frame(struct mac_context *mac_ctx,
 	pe_debug("Dialog token %d status %d", frm.DialogToken.token,
 		 frm.Status.status);
 
-	status = dot11f_get_packed_t2lm_neg_rspSize(mac_ctx, &frm,
-						    &payload_size);
-	if (DOT11F_FAILED(status)) {
+	dot11f_status = dot11f_get_packed_t2lm_neg_rspSize(mac_ctx, &frm,
+							   &payload_size);
+	if (DOT11F_FAILED(dot11f_status)) {
 		pe_err("Failed to calculate packed size for a T2LM negotiation Response (0x%08x).",
-		       status);
+		       dot11f_status);
 		/* We'll fall back on the worst case scenario: */
 		payload_size = sizeof(tDot11ft2lm_neg_rsp);
-	} else if (DOT11F_WARNED(status)) {
+	} else if (DOT11F_WARNED(dot11f_status)) {
 		pe_warn("There were warnings while calculating packed size for a T2LM negotiation Response (0x%08x).",
-			status);
+			dot11f_status);
 	}
 
 	num_bytes = payload_size + sizeof(*mgmt_hdr);
-	qdf_status = cds_packet_alloc(num_bytes, (void **)&frame_ptr,
-				      (void **)&pkt_ptr);
-	if (!QDF_IS_STATUS_SUCCESS(qdf_status) || (!pkt_ptr)) {
+	status = cds_packet_alloc(num_bytes, (void **)&frame_ptr,
+				  (void **)&pkt_ptr);
+	if (!QDF_IS_STATUS_SUCCESS(status) || !pkt_ptr) {
 		pe_err("Failed to allocate %d bytes for a T2LM rsp action frm",
 		       num_bytes);
 		return QDF_STATUS_E_FAILURE;
@@ -6918,7 +6965,7 @@ lim_send_t2lm_action_rsp_frame(struct mac_context *mac_ctx,
 	if (DOT11F_FAILED(status)) {
 		pe_err("Failed to pack a T2LM negotiation response (0x%08x)",
 		       status);
-		qdf_status = QDF_STATUS_E_FAILURE;
+		status = QDF_STATUS_E_FAILURE;
 		goto error_t2lm_rsp;
 	} else if (DOT11F_WARNED(status)) {
 		pe_warn("There were warnings while packing T2LM rsp (0x%08x)",
@@ -6932,22 +6979,23 @@ lim_send_t2lm_action_rsp_frame(struct mac_context *mac_ctx,
 
 	MTRACE(qdf_trace(QDF_MODULE_ID_PE, TRACE_CODE_TX_MGMT,
 			 session->peSessionId, mgmt_hdr->fc.subType));
-	qdf_status = wma_tx_frame(mac_ctx, pkt_ptr, (uint16_t)num_bytes,
-				  TXRX_FRM_802_11_MGMT, ANI_TXDIR_TODS, 7,
-				  lim_tx_complete, frame_ptr, tx_flag,
-				  vdev_id, 0, RATEID_DEFAULT, 0);
+	status = wma_tx_frameWithTxComplete(
+			mac_ctx, pkt_ptr, (uint16_t)num_bytes,
+			TXRX_FRM_802_11_MGMT, ANI_TXDIR_TODS, 7,
+			lim_tx_complete, frame_ptr,
+			lim_mgmt_t2lm_rsp_tx_complete,
+			tx_flag, vdev_id, 0, session->curr_op_freq,
+			RATEID_DEFAULT, 0, 0);
 	MTRACE(qdf_trace(QDF_MODULE_ID_PE, TRACE_CODE_TX_COMPLETE,
-			 session->peSessionId, qdf_status));
-	if (QDF_STATUS_SUCCESS != qdf_status) {
-		pe_err("wma_tx_frame FAILED! Status [%d]", qdf_status);
-		return QDF_STATUS_E_FAILURE;
-	} else {
-		return QDF_STATUS_SUCCESS;
-	}
+			 session->peSessionId, status));
+	if (QDF_IS_STATUS_ERROR(status))
+		pe_err("wma_tx_frame FAILED! Status [%d]", status);
+
+	return status;
 
 error_t2lm_rsp:
 	cds_packet_free((void *)pkt_ptr);
-	return qdf_status;
+	return status;
 }
 
 QDF_STATUS
@@ -7108,15 +7156,13 @@ error_t2lm_req:
  * lim_delba_tx_complete_cnf() - Confirmation for Delba OTA
  * @context: pointer to global mac
  * @buf: netbuf of Del BA frame
- * @tx_complete : Sent status
- * @params; tx completion params
+ * @tx_complete: Sent status
+ * @params: tx completion params
  *
  * Return: This returns QDF_STATUS
  */
-static QDF_STATUS lim_delba_tx_complete_cnf(void *context,
-					    qdf_nbuf_t buf,
-					    uint32_t tx_complete,
-					    void *params)
+static QDF_STATUS lim_delba_tx_complete_cnf(void *context, qdf_nbuf_t buf,
+					    uint32_t tx_complete, void *params)
 {
 	struct mac_context *mac_ctx = (struct mac_context *)context;
 	tSirMacMgmtHdr *mac_hdr;