qcacld-3.0: Process offload Tx data packet for pkt capture mode

Subscribe for offload Tx data wdi event and process offload Tx
data packets and post into mon thread for packet capture mode

Change-Id: Ic61043b8461eed4be5e8dc8d41baca2574224a90
CRs-Fixed: 2845598

components/pkt_capture/core/inc/wlan_pkt_capture_data_txrx.h

@@ -115,6 +115,7 @@ void pkt_capture_rx_in_order_drop_offload_pkt(qdf_nbuf_t head_msdu);
  */
 bool pkt_capture_rx_in_order_offloaded_pkt(qdf_nbuf_t rx_ind_msg);
 
+#ifndef WLAN_FEATURE_PKT_CAPTURE_LITHIUM
 /**
  * pkt_capture_offload_deliver_indication_handler() - Handle offload data pkts
  * @msg: offload netbuf msg
@@ -127,6 +128,20 @@ bool pkt_capture_rx_in_order_offloaded_pkt(qdf_nbuf_t rx_ind_msg);
 void pkt_capture_offload_deliver_indication_handler(
 					void *msg, uint8_t vdev_id,
 					uint8_t *bssid, htt_pdev_handle pdev);
+#else
+/**
+ * pkt_capture_offload_deliver_indication_handler() - Handle offload data pkts
+ * @msg: offload netbuf msg
+ * @vdev_id: vdev id
+ * @bssid: bssid
+ * @soc: dp_soc handle
+ *
+ * Return: none
+ */
+void pkt_capture_offload_deliver_indication_handler(
+					void *msg, uint8_t vdev_id,
+					uint8_t *bssid, void *soc);
+#endif
 
 /**
  * pkt_capture_tx_hdr_elem_t - tx packets header struture to

components/pkt_capture/core/src/wlan_pkt_capture_data_txrx.c

@@ -1424,6 +1424,7 @@ struct htt_tx_data_hdr_information *pkt_capture_tx_get_txcomplete_data_hdr(
 	return txcomplete_data_hrd_list;
 }
 
+#ifndef WLAN_FEATURE_PKT_CAPTURE_LITHIUM
 void pkt_capture_offload_deliver_indication_handler(
 					void *msg, uint8_t vdev_id,
 					uint8_t *bssid, htt_pdev_handle pdev)
@@ -1475,3 +1476,64 @@ void pkt_capture_offload_deliver_indication_handler(
 			tid, status, pkt_format, bssid, pdev,
 			offload_deliver_msg->tx_retry_cnt);
 }
+#else
+#define FRAME_CTRL_TYPE_DATA	0x0008
+void pkt_capture_offload_deliver_indication_handler(
+					void *msg, uint8_t vdev_id,
+					uint8_t *bssid, void *soc)
+{
+	int nbuf_len;
+	qdf_nbuf_t netbuf;
+	uint8_t status;
+	uint8_t tid = 0;
+	bool pkt_format;
+	u_int32_t *msg_word = (u_int32_t *)msg;
+	u_int8_t *buf = (u_int8_t *)msg;
+	struct htt_tx_data_hdr_information *txhdr;
+	struct htt_tx_offload_deliver_ind_hdr_t *offload_deliver_msg;
+	struct htt_tx_data_hdr_information *cmpl_desc = NULL;
+
+	offload_deliver_msg = (struct htt_tx_offload_deliver_ind_hdr_t *)msg;
+
+	txhdr = (struct htt_tx_data_hdr_information *)
+		(msg_word + 1);
+
+	nbuf_len = offload_deliver_msg->tx_mpdu_bytes;
+
+	netbuf = qdf_nbuf_alloc(NULL,
+				roundup(nbuf_len + RESERVE_BYTES, 4),
+				RESERVE_BYTES, 4, false);
+
+	if (!netbuf)
+		return;
+
+	qdf_nbuf_put_tail(netbuf, nbuf_len);
+
+	qdf_mem_copy(qdf_nbuf_data(netbuf),
+		     buf + sizeof(struct htt_tx_offload_deliver_ind_hdr_t),
+		     nbuf_len);
+
+	qdf_nbuf_push_head(
+			netbuf,
+			sizeof(struct htt_tx_data_hdr_information));
+
+	qdf_mem_copy(qdf_nbuf_data(netbuf), txhdr,
+		     sizeof(struct htt_tx_data_hdr_information));
+
+	status = offload_deliver_msg->status;
+	pkt_format = offload_deliver_msg->format;
+	tid = offload_deliver_msg->tid_num;
+
+	cmpl_desc = (struct htt_tx_data_hdr_information *)
+				(qdf_nbuf_data(netbuf));
+
+	/* filling packet type as data, as framectrl is not available */
+	cmpl_desc->framectrl = FRAME_CTRL_TYPE_DATA;
+
+	pkt_capture_datapkt_process(
+			vdev_id,
+			netbuf, TXRX_PROCESS_TYPE_DATA_TX,
+			tid, status, pkt_format, bssid, soc,
+			offload_deliver_msg->tx_retry_cnt);
+}
+#endif

components/pkt_capture/core/src/wlan_pkt_capture_main.c

@@ -37,6 +37,7 @@ static struct wlan_objmgr_vdev *gp_pkt_capture_vdev;
 #ifdef WLAN_FEATURE_PKT_CAPTURE_LITHIUM
 wdi_event_subscribe PKT_CAPTURE_TX_SUBSCRIBER;
 wdi_event_subscribe PKT_CAPTURE_RX_SUBSCRIBER;
+wdi_event_subscribe PKT_CAPTURE_OFFLOAD_TX_SUBSCRIBER;
 
 /**
  * pkt_capture_wdi_event_subscribe() - Subscribe pkt capture callbacks
@@ -67,6 +68,15 @@ static void pkt_capture_wdi_event_subscribe(struct wlan_objmgr_psoc *psoc)
 	cdp_wdi_event_sub(soc, pdev_id, &PKT_CAPTURE_RX_SUBSCRIBER,
 			  WDI_EVENT_PKT_CAPTURE_RX_DATA);
 
+	/* subscribing for offload tx data packets */
+	PKT_CAPTURE_OFFLOAD_TX_SUBSCRIBER.callback =
+				pkt_capture_callback;
+
+	PKT_CAPTURE_OFFLOAD_TX_SUBSCRIBER.context =
+						wlan_psoc_get_dp_handle(psoc);
+
+	cdp_wdi_event_sub(soc, pdev_id, &PKT_CAPTURE_OFFLOAD_TX_SUBSCRIBER,
+			  WDI_EVENT_PKT_CAPTURE_OFFLOAD_TX_DATA);
 }
 
 /**
@@ -87,6 +97,10 @@ static void pkt_capture_wdi_event_unsubscribe(struct wlan_objmgr_psoc *psoc)
 	/* unsubscribing for rx data packets */
 	cdp_wdi_event_unsub(soc, pdev_id, &PKT_CAPTURE_RX_SUBSCRIBER,
 			    WDI_EVENT_PKT_CAPTURE_RX_DATA);
+
+	/* unsubscribing for offload tx data packets */
+	cdp_wdi_event_unsub(soc, pdev_id, &PKT_CAPTURE_OFFLOAD_TX_SUBSCRIBER,
+			    WDI_EVENT_PKT_CAPTURE_OFFLOAD_TX_DATA);
 }
 
 enum pkt_capture_mode
@@ -206,6 +220,34 @@ void pkt_capture_callback(void *soc, enum WDI_EVENT event, void *log_data,
 		break;
 	}
 
+	case WDI_EVENT_PKT_CAPTURE_OFFLOAD_TX_DATA:
+	{
+		struct htt_tx_offload_deliver_ind_hdr_t *offload_deliver_msg;
+		bool is_pkt_during_roam = false;
+		uint32_t freq = 0;
+
+		if (!(pkt_capture_get_pktcap_mode_lithium() &
+					PKT_CAPTURE_MODE_DATA_ONLY))
+			return;
+
+		offload_deliver_msg =
+		(struct htt_tx_offload_deliver_ind_hdr_t *)log_data;
+		is_pkt_during_roam =
+		(offload_deliver_msg->reserved_2 ? true : false);
+
+		if (is_pkt_during_roam) {
+			vdev_id = HTT_INVALID_VDEV;
+			freq =
+			(uint32_t)offload_deliver_msg->reserved_3;
+		} else {
+			vdev_id = offload_deliver_msg->vdev_id;
+		}
+
+		pkt_capture_offload_deliver_indication_handler(
+						log_data,
+						vdev_id, bssid, soc);
+	}
+
 	default:
 		break;
 	}