tb: implement block test: smp_sim reset

3 files changed, 47 insertions, 0 deletions

diff --git a/tb/models/__init__.py b/tb/models/__init__.py
new file mode 100644
index 0000000..4f14c05
--- /dev/null
+++ b/tb/models/__init__.py
@@ -0,0 +1,3 @@
+from .core import *
+from .smp import *
+
diff --git a/tb/models/core.py b/tb/models/core.py
new file mode 100644
index 0000000..c32fadb
--- /dev/null
+++ b/tb/models/core.py
@@ -0,0 +1,22 @@
+import random
+
+import cocotb
+from cocotb.triggers import ClockCycles
+
+class CorePaceModel:
+    def __init__(self, *, clk, halt, step, bkpt, halted):
+        self._clk = clk
+        self._halt = halt
+        self._step = step
+        self._bkpt = halted
+        self._halted = halted
+
+        self._bkpt.value = 0
+        self._halted.value = 0
+
+    async def run(self):
+        while True:
+            # Señales de step y halt pueden tomar algunas ciclos en surtir
+            # efecto, dependiendo de lo que esté ocurriendo en la pipeline
+            await ClockCycles(self._clk, random.randint(0, 10))
+            self._halted.value = self._step.value or self._halt.value
diff --git a/tb/models/smp.py b/tb/models/smp.py
new file mode 100644
index 0000000..a6439f8
--- /dev/null
+++ b/tb/models/smp.py
@@ -0,0 +1,22 @@
+__all__ = ['SmpModel']
+
+class SmpModel:
+    def __init__(self):
+        self._pe0 = SmpPe(0)
+        self._pe1 = SmpPe(1)
+        self._pe2 = SmpPe(1)
+        self._pe3 = SmpPe(1)
+
+    def read(self):
+        return self._pe0.read() \
+                | self._pe1.read() << 8 \
+                | self._pe2.read() << 16 \
+                | self._pe3.read() << 24
+
+class SmpPe:
+    def __init__(self, halt_on_reset):
+        self._bkpt = 0
+        self._halted = halt_on_reset
+
+    def read(self):
+        return self._bkpt << 1 | self._halted