start connecting up Pi2LSUI

diff --git a/src/soc/experiment/pi2ls.py b/src/soc/experiment/pi2ls.py
index 9be33016c7793682544239d6dab7fb20b074ec02..97a42c860a462b75f2e834ee431ac3bc75e1d2c0 100644 (file)
--- a/src/soc/experiment/pi2ls.py
+++ b/src/soc/experiment/pi2ls.py
@@ -10,7 +10,7 @@
 
     busy_o/1        most likely to be x_busy_o
     go_die_i/1      rst?
-    addr.data/48    x_addr_i[4:] (x_addr_i[:4] goes into LenExpand)
+    addr.data/48    x_addr_i (x_addr_i[:4] goes into LenExpand)
     addr.ok/1       probably x_valid_i & ~x_stall_i
 
     addr_ok_o/1     no equivalent.  *might* work using x_stall_i
@@ -32,11 +32,37 @@ from nmigen import Elaboratable, Module, Signal
 class Pi2LSUI(Elaboratable):
 
     def __init__(self, name, regwid=64, addrwid=48):
+        self.addrbits = 4
         self.pi = PortInterface(name="%s_pi", regwid, addrwid)
-        self.lsui = LoadStoreUnitInterface(addrwid, 4, regwid)
+        self.lsui = LoadStoreUnitInterface(addrwid, self.addrbits, regwid)
+
+    def splitaddr(self, addr):
+        """split the address into top and bottom bits of the memory granularity
+        """
+        return addr[:self.addrbits], addr[self.addrbits:]
 
     def elaborate(self, platform):
         m = Module()
-        m.submodules.lenexp = lenexp = LenExpand(4, 8)
+        pi, lsui, addrbits = self.pi, self.lsui, self.addrbits
+        m.submodules.lenexp = lenexp = LenExpand(self.addrbits, 8)
+
+        m.d.comb += lsui.x_ld_i.eq(pi.is_ld_i)
+        m.d.comb += lsui.x_st_i.eq(pi.is_st_i)
+
+        with m.If(pi.addr.ok):
+            # expand the LSBs of address plus LD/ST len into 16-bit mask
+            m.d.comb += lenexp.len_i.eq(pi.data_len)
+            m.d.comb += lenexp.addr_i.eq(pi.addr.data[addrbits]) # LSBs of addr
+            m.d.comb += lsui.x_mask_i.eq(lenexp.lexp_o)
+            # pass through the address, indicate "valid"
+            m.d.comb += lsui.x_addr_i.eq(pi.addr.data) # full address
+            m.d.comb += lsui.x_valid_i.eq(1)
+
+        with m.If(pi.is_ld_i):
+            m.d.comb += pi.ld.data.eq(lsui.m_ld_data_o)
+            #m.d.comb += pi.ld.ok.eq(TODO)
+
+        with m.If(pi.is_st_i & pi.st.ok):
+            m.d.comb += lsui.x_st_data_i.eq(pi.st.data)
 
         return m