From e308a61abc0d97fe5bb5bbfe5777c03fd34ecc9e Mon Sep 17 00:00:00 2001
From: Gatsby Van <mail.gatsby.icu>
Date: Wed, 31 Jan 2024 19:47:11 +0800
Subject: [PATCH] *add service data logging

---
 df_datalink_sp/src/networking/link_layer/service.c | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/df_datalink_sp/src/networking/link_layer/service.c b/df_datalink_sp/src/networking/link_layer/service.c
index 3d93851..6cec690 100644
--- a/df_datalink_sp/src/networking/link_layer/service.c
+++ b/df_datalink_sp/src/networking/link_layer/service.c
@@ -141,6 +141,9 @@ static int32_t Service_Packing(L2_INST *instPtr, L2_FRAME_TYPE type, uint8_t dst
 			DBG_ERROR("Fail to append CRC...\n");
 			return Status;
 		}
+
+		memcpy(instPtr->serviceFSM->txLog.data, buff, L2_SVC_PACK_LEN);
+		instPtr->serviceFSM->txLog.dataId = dataId;
 		break;
 	}
 	default:
@@ -294,6 +297,10 @@ int32_t L2_Service_PktHandler(L2_INST *instPtr, uint8_t *msg)
 				SysMonitor_UpdateRecvPayloadRaw(msg+L2_MSG_SVC_PAYLOAD, PAYLOAD_LEN_LJ_RX);
 			}
 		}
+
+		// Logging
+		memcpy(instPtr->serviceFSM->rxLog.data, msg, L2_SVC_PACK_LEN);
+		instPtr->serviceFSM->rxLog.dataId = dataId;
 		
 #ifdef DATALINK_ENABLE_AUTOTIMESYNC
 		// Implement a auto time sync.