qcacld-3.0: update PTP timestamp for Rx packet

Host driver could not get correct timestamp of Rx AMPDU packet sometimes.
The reason is PTP timestamp is stored in PPDU_END info, only last msdu
description contain it.Rx indication which sent from target has limited
number of MSDU.If none of them is last msdu, Host driver will not get
the correct timestamp.
Add two parameters to record the last system time and timestamp. If
Host driver detect no last msdu in Rx indication, It will calculate the
timestamp according to the difference of two parameters and current
system time.

Change-Id: Iea94f5c0a681ec1d377cbed9dd5b00b100223cc7
CRs-Fixed: 2513659

core/dp/htt/htt_rx_ll.c

@@ -1396,6 +1396,40 @@ int htt_rx_msdu_buff_in_order_replenish(htt_pdev_handle pdev, uint32_t num)
 	return filled;
 }
 
+#if defined(WLAN_FEATURE_TSF_PLUS) && !defined(CONFIG_HL_SUPPORT)
+/**
+ * htt_rx_tail_msdu_timestamp() - update tail msdu tsf64 timestamp
+ * @tail_rx_desc: pointer to tail msdu descriptor
+ * @timestamp_rx_desc: pointer to timestamp msdu descriptor
+ *
+ * Return: none
+ */
+static inline void htt_rx_tail_msdu_timestamp(
+			struct htt_host_rx_desc_base *tail_rx_desc,
+			struct htt_host_rx_desc_base *timestamp_rx_desc)
+{
+	if (tail_rx_desc) {
+		if (!timestamp_rx_desc) {
+			tail_rx_desc->ppdu_end.wb_timestamp_lower_32 = 0;
+			tail_rx_desc->ppdu_end.wb_timestamp_upper_32 = 0;
+		} else {
+			if (timestamp_rx_desc != tail_rx_desc) {
+				tail_rx_desc->ppdu_end.wb_timestamp_lower_32 =
+			timestamp_rx_desc->ppdu_end.wb_timestamp_lower_32;
+				tail_rx_desc->ppdu_end.wb_timestamp_upper_32 =
+			timestamp_rx_desc->ppdu_end.wb_timestamp_upper_32;
+			}
+		}
+	}
+}
+#else
+static inline void htt_rx_tail_msdu_timestamp(
+			struct htt_host_rx_desc_base *tail_rx_desc,
+			struct htt_host_rx_desc_base *timestamp_rx_desc)
+{
+}
+#endif
+
 static int
 htt_rx_amsdu_rx_in_order_pop_ll(htt_pdev_handle pdev,
 				qdf_nbuf_t rx_ind_msg,
@@ -1409,12 +1443,13 @@ htt_rx_amsdu_rx_in_order_pop_ll(htt_pdev_handle pdev,
 	unsigned int msdu_count = 0;
 	uint8_t offload_ind, frag_ind;
 	uint8_t peer_id;
-	struct htt_host_rx_desc_base *rx_desc;
+	struct htt_host_rx_desc_base *rx_desc = NULL;
 	enum rx_pkt_fate status = RX_PKT_FATE_SUCCESS;
 	qdf_dma_addr_t paddr;
 	qdf_mem_info_t mem_map_table = {0};
 	int ret = 1;
 	bool ipa_smmu = false;
+	struct htt_host_rx_desc_base *timestamp_rx_desc = NULL;
 
 	HTT_ASSERT1(htt_rx_in_order_ring_elems(pdev) != 0);
 
@@ -1523,6 +1558,10 @@ htt_rx_amsdu_rx_in_order_pop_ll(htt_pdev_handle pdev,
 		rx_desc = htt_rx_desc(msdu);
 		htt_rx_extract_lro_info(msdu, rx_desc);
 
+		/* check if the msdu is last mpdu */
+		if (rx_desc->attention.last_mpdu)
+			timestamp_rx_desc = rx_desc;
+
 		/*
 		 * Make the netbuf's data pointer point to the payload rather
 		 * than the descriptor.
@@ -1640,6 +1679,8 @@ htt_rx_amsdu_rx_in_order_pop_ll(htt_pdev_handle pdev,
 		}
 	}
 
+	htt_rx_tail_msdu_timestamp(rx_desc, timestamp_rx_desc);
+
 end:
 	return ret;
 }

core/dp/txrx/ol_rx.c

@@ -1173,6 +1173,21 @@ static inline void ol_rx_timestamp(struct cdp_cfg *cfg_pdev,
 	msdu->tstamp = ns_to_ktime((u_int64_t)rx_ppdu_desc->tsf32 *
 				   NSEC_PER_USEC);
 }
+
+static inline void ol_rx_timestamp_update(ol_txrx_pdev_handle pdev,
+					  qdf_nbuf_t head_msdu,
+					  qdf_nbuf_t tail_msdu)
+{
+	qdf_nbuf_t loop_msdu;
+	struct htt_host_rx_desc_base *rx_desc;
+
+	loop_msdu = head_msdu;
+	while (loop_msdu) {
+		rx_desc = htt_rx_msdu_desc_retrieve(pdev->htt_pdev, loop_msdu);
+		ol_rx_timestamp(pdev->ctrl_pdev, rx_desc, loop_msdu);
+		loop_msdu = qdf_nbuf_next(loop_msdu);
+	}
+}
 #else
 static inline void ol_rx_timestamp(struct cdp_cfg *cfg_pdev,
 				   void *rx_desc, qdf_nbuf_t msdu)
@@ -1198,12 +1213,65 @@ static inline void ol_rx_timestamp(struct cdp_cfg *cfg_pdev,
 
 	msdu->tstamp = ns_to_ktime(tsf64_ns);
 }
+
+/**
+ * ol_rx_timestamp_update() - update msdu tsf64 timestamp
+ * @pdev: pointer to txrx handle
+ * @head_msdu: pointer to head msdu
+ * @tail_msdu: pointer to tail msdu
+ *
+ * Return: none
+ */
+static inline void ol_rx_timestamp_update(ol_txrx_pdev_handle pdev,
+					  qdf_nbuf_t head_msdu,
+					  qdf_nbuf_t tail_msdu)
+{
+	qdf_nbuf_t loop_msdu;
+	uint64_t hostime, detlahostime, tsf64_time;
+	struct htt_host_rx_desc_base *rx_desc;
+
+	if (!ol_cfg_is_ptp_rx_opt_enabled(pdev->ctrl_pdev))
+		return;
+
+	if (!tail_msdu)
+		return;
+
+	hostime = ktime_get_ns();
+	rx_desc = htt_rx_msdu_desc_retrieve(pdev->htt_pdev, tail_msdu);
+	if (rx_desc->ppdu_end.wb_timestamp_lower_32 == 0 &&
+	    rx_desc->ppdu_end.wb_timestamp_upper_32 == 0) {
+		detlahostime = hostime - pdev->last_host_time;
+		do_div(detlahostime, NSEC_PER_USEC);
+		tsf64_time = pdev->last_tsf64_time + detlahostime;
+
+		rx_desc->ppdu_end.wb_timestamp_lower_32 =
+						tsf64_time & 0xFFFFFFFF;
+		rx_desc->ppdu_end.wb_timestamp_upper_32 = tsf64_time >> 32;
+	} else {
+		pdev->last_host_time = hostime;
+		pdev->last_tsf64_time =
+		  (uint64_t)rx_desc->ppdu_end.wb_timestamp_upper_32 << 32 |
+		  rx_desc->ppdu_end.wb_timestamp_lower_32;
+	}
+
+	loop_msdu = head_msdu;
+	while (loop_msdu) {
+		ol_rx_timestamp(pdev->ctrl_pdev, rx_desc, loop_msdu);
+		loop_msdu = qdf_nbuf_next(loop_msdu);
+	}
+}
 #endif
 #else
 static inline void ol_rx_timestamp(struct cdp_cfg *cfg_pdev,
 				   void *rx_desc, qdf_nbuf_t msdu)
 {
 }
+
+static inline void ol_rx_timestamp_update(ol_txrx_pdev_handle pdev,
+					  qdf_nbuf_t head_msdu,
+					  qdf_nbuf_t tail_msdu)
+{
+}
 #endif
 
 #ifdef WLAN_FEATURE_DSRC
@@ -1492,8 +1560,6 @@ ol_rx_in_order_indication_handler(ol_txrx_pdev_handle pdev,
 	uint32_t msdu_count;
 	uint8_t pktlog_bit;
 	uint32_t filled = 0;
-	struct htt_host_rx_desc_base *rx_desc;
-	qdf_nbuf_t loop_msdu;
 
 	if (tid >= OL_TXRX_NUM_EXT_TIDS) {
 		ol_txrx_err("invalid tid, %u", tid);
@@ -1578,15 +1644,9 @@ ol_rx_in_order_indication_handler(ol_txrx_pdev_handle pdev,
 		}
 		return;
 	}
-	/*Loop msdu to fill tstamp with tsf64 time in ol_rx_timestamp*/
-	loop_msdu = head_msdu;
-	while (loop_msdu) {
-		qdf_nbuf_t msdu = head_msdu;
 
-		rx_desc = htt_rx_msdu_desc_retrieve(pdev->htt_pdev, loop_msdu);
-		ol_rx_timestamp(pdev->ctrl_pdev, rx_desc, msdu);
-		loop_msdu = qdf_nbuf_next(loop_msdu);
-	}
+	/*Loop msdu to fill tstamp with tsf64 time in ol_rx_timestamp*/
+	ol_rx_timestamp_update(pdev, head_msdu, tail_msdu);
 
 	peer->rx_opt_proc(vdev, peer, tid, head_msdu);
 }

core/dp/txrx/ol_txrx_types.h

@@ -1079,6 +1079,8 @@ struct ol_txrx_pdev_t {
 	uint8_t peer_id_unmap_ref_cnt;
 	bool enable_peer_unmap_conf_support;
 	bool enable_tx_compl_tsf64;
+	uint64_t last_host_time;
+	uint64_t last_tsf64_time;
 };
 
 #define OL_TX_HL_DEL_ACK_HASH_SIZE    256