From be04224806497a59ce6ce9545a3d65ca91369017 Mon Sep 17 00:00:00 2001
From: bacon <bacon@rtems.cn>
Date: Mon, 10 Feb 2025 16:17:02 +0800
Subject: [PATCH] =?UTF-8?q?=E5=A2=9E=E5=8A=A0=E6=B1=87=E7=BC=96=E4=BB=A3?=
 =?UTF-8?q?=E7=A0=81=EF=BC=8C=E4=BD=BF=E7=94=A8=E6=B1=87=E7=BC=96=E6=A8=A1?=
 =?UTF-8?q?=E5=BC=8F=E5=92=8C=E4=BD=BF=E7=94=A8C=E8=AF=AD=E8=A8=80?=
 =?UTF-8?q?=E7=9A=84=E6=B5=8B=E8=AF=95=E7=94=A8=E4=BE=8B=E6=95=88=E6=9E=9C?=
 =?UTF-8?q?=E7=8E=B0=E5=9C=A8=E5=9F=BA=E6=9C=AC=E4=B8=80=E6=A0=B7=E4=BA=86?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 tb/sw/src/slvSvr.S | 9 ++++++---
 1 file changed, 6 insertions(+), 3 deletions(-)

diff --git a/tb/sw/src/slvSvr.S b/tb/sw/src/slvSvr.S
index 510e9c5..dbda3ce 100644
--- a/tb/sw/src/slvSvr.S
+++ b/tb/sw/src/slvSvr.S
@@ -180,14 +180,17 @@ isr_tx1_deq_hdl:
 
 isr_rx0_enq_hdl:
 	lw		x17, RX0_ReadRxFifo(REG_TL2CDR_BASE)
-	bnez 	x21, 1f
+	bnez 	x21, 1f   //if x21 != 0 then goto 1f
 	srli	x16, x17, 20
-	li		x18, 8
-	add		x16, x16, x18
+	add		x16, x16, REG_4
+	mv		x20, x16
+	add		x16, x16, REG_4
 	sw		x16, TX1_WriteTxLen(REG_TL2CDR_BASE)
 1:
+	bge     x21, x20, 1f
 	add		x21, x21, REG_4
 	sw		x17, TX1_WriteTxFifo(REG_TL2CDR_BASE)
+1:
 	mret
 
 isr_rx1_enq_hdl: