From 7d7f6be7ceb7f568b1bc004b62465b820af75d78 Mon Sep 17 00:00:00 2001
From: Florent Kermarrec <florent@enjoy-digital.fr>
Date: Tue, 29 Aug 2017 16:41:29 +0200
Subject: [PATCH] gateware/serwb: generate wishbone error if link loose ready
 in the middle of a transaction

---
 artiq/gateware/serwb/etherbone.py | 50 ++++++++++++++++++-------------
 1 file changed, 30 insertions(+), 20 deletions(-)

diff --git a/artiq/gateware/serwb/etherbone.py b/artiq/gateware/serwb/etherbone.py
index a5dff54c0..9ac7bdb7e 100644
--- a/artiq/gateware/serwb/etherbone.py
+++ b/artiq/gateware/serwb/etherbone.py
@@ -667,33 +667,43 @@ class EtherboneWishboneSlave(Module):
             )
         )
         fsm.act("SEND_WRITE",
-            source.stb.eq(1),
-            source.eop.eq(1),
-            source.base_addr[2:].eq(bus.adr),
-            source.count.eq(1),
-            source.be.eq(bus.sel),
-            source.we.eq(1),
-            source.data.eq(bus.dat_w),
-            If(source.stb & source.ack,
-                bus.ack.eq(1),
-                NextState("IDLE")
+            If(~self.ready,
+                NextState("SEND_ERROR")
+            ).Else(
+                source.stb.eq(1),
+                source.eop.eq(1),
+                source.base_addr[2:].eq(bus.adr),
+                source.count.eq(1),
+                source.be.eq(bus.sel),
+                source.we.eq(1),
+                source.data.eq(bus.dat_w),
+                If(source.stb & source.ack,
+                    bus.ack.eq(1),
+                    NextState("IDLE")
+                )
             )
         )
         fsm.act("SEND_READ",
-            source.stb.eq(1),
-            source.eop.eq(1),
-            source.base_addr.eq(0),
-            source.count.eq(1),
-            source.be.eq(bus.sel),
-            source.we.eq(0),
-            source.data[2:].eq(bus.adr),
-            If(source.stb & source.ack,
-                NextState("WAIT_READ")
+            If(~self.ready,
+                NextState("SEND_ERROR")
+            ).Else(
+                source.stb.eq(1),
+                source.eop.eq(1),
+                source.base_addr.eq(0),
+                source.count.eq(1),
+                source.be.eq(bus.sel),
+                source.we.eq(0),
+                source.data[2:].eq(bus.adr),
+                If(source.stb & source.ack,
+                    NextState("WAIT_READ")
+                )
             )
         )
         fsm.act("WAIT_READ",
             sink.ack.eq(1),
-            If(sink.stb & sink.we,
+            If(~self.ready,
+                NextState("SEND_ERROR")
+            ).Elif(sink.stb & sink.we,
                 bus.ack.eq(1),
                 bus.dat_r.eq(sink.data),
                 NextState("IDLE")