From: Florent Kermarrec <florent@enjoy-digital.fr>
Date: Tue, 11 Nov 2014 08:57:43 +0000 (+0100)
Subject: phy: send 2 ALIGN primitives every 256 DWORDs
X-Git-Tag: 24jan2021_ls180~2572^2~168
X-Git-Url: https://git.libre-soc.org/?a=commitdiff_plain;h=30964db4a10c2e6a5b998fbd5f3ed3b8c574f2e0;p=litex.git

phy: send 2 ALIGN primitives every 256 DWORDs
---

diff --git a/lib/sata/phy/k7sataphy/datapath.py b/lib/sata/phy/k7sataphy/datapath.py
index ef06c09a..83088d99 100644
--- a/lib/sata/phy/k7sataphy/datapath.py
+++ b/lib/sata/phy/k7sataphy/datapath.py
@@ -127,14 +127,31 @@ class K7SATAPHYDatapath(Module):
 			gtx.txcharisk.eq(tx.source.charisk),
 		]
 
+	# Align cnt (send 2 Align DWORDs every 256 DWORDs)
+		align_cnt = Signal(8)
+		self.sync += \
+			If(~ctrl.ready,
+				align_cnt.eq(0)
+			).Elsif(tx.sink.stb & tx.sink.ack,
+				align_cnt.eq(align_cnt+1)
+			)
+		send_align = (align_cnt < 2)
+
 	# user / ctrl mux
 		self.comb += [
 			# user
 			If(ctrl.ready,
-				tx.sink.stb.eq(self.sink.stb),
-				tx.sink.data.eq(self.sink.data),
-				tx.sink.charisk.eq(self.sink.charisk),
-				self.sink.ack.eq(tx.sink.ack),
+				If(send_align,
+					tx.sink.stb.eq(1),
+					tx.sink.data.eq(ALIGN_VAL),
+					tx.sink.charisk.eq(0b0001),
+					self.sink.ack.eq(0)
+				).Else(
+					tx.sink.stb.eq(self.sink.stb),
+					tx.sink.data.eq(self.sink.data),
+					tx.sink.charisk.eq(self.sink.charisk),
+					self.sink.ack.eq(tx.sink.ack)
+				)
 
 				self.source.stb.eq(rx.source.stb),
 				self.source.data.eq(rx.source.data),