Changed getCurrentMicroInstructionAddress to use HighLevelStates
[Mograsim.git] / plugins / net.mograsim.logic.model.am2900 / src / net / mograsim / logic / model / am2900 / machine / Am2900Machine.java
index ac1b237..ab0643f 100644 (file)
@@ -1,8 +1,13 @@
 package net.mograsim.logic.model.am2900.machine;
 
+import java.util.HashSet;
+import java.util.Set;
+
 import net.mograsim.logic.core.components.CoreClock;
 import net.mograsim.logic.core.timeline.Timeline;
 import net.mograsim.logic.core.types.BitVector;
+import net.mograsim.logic.model.am2900.machine.registers.NumberedRegister;
+import net.mograsim.logic.model.am2900.machine.registers.QRegister;
 import net.mograsim.logic.model.model.LogicModel;
 import net.mograsim.logic.model.model.LogicModelModifiable;
 import net.mograsim.logic.model.model.components.ModelComponent;
@@ -31,6 +36,9 @@ public class Am2900Machine implements Machine
        private AssignableMainMemory mainMemory;
        private AssignableMicroInstructionMemory instMemory;
        private CoreClock clock;
+       private long activeInstructionAddress;
+
+       private final Set<ActiveMicroInstructionChangedListener> amicListeners;
 
        public Am2900Machine(LogicModelModifiable model, Am2900MachineDefinition am2900MachineDefinition)
        {
@@ -38,6 +46,8 @@ public class Am2900Machine implements Machine
                this.logicModel = model;
                this.am2900 = IndirectModelComponentCreator.createComponent(logicModel,
                                "resloader:Am2900Loader:jsonres:net/mograsim/logic/model/am2900/components/Am2900.json", "Am2900");
+               this.amicListeners = new HashSet<>();
+
                CoreModelParameters params = new CoreModelParameters();
                params.gateProcessTime = 50;
                params.wireTravelTime = 10;
@@ -48,6 +58,15 @@ public class Am2900Machine implements Machine
                am2900.setHighLevelState("ram.memory_binding", mainMemory);
                am2900.setHighLevelState("mpm.memory_binding", instMemory);
                clock = logicModel.getComponentBySubmodelPath("Am2900.Clock#0", ModelClock.class).getClock();
+               clock.registerObserver(c ->
+               {
+                       if (clock.isOn())
+                       {
+                               long oldAddress = activeInstructionAddress;
+                               activeInstructionAddress = getCurrentMicroInstructionAddress();
+                               notifyActiveMicroInstructionChangedListeners(oldAddress, activeInstructionAddress);
+                       }
+               });
        }
 
        @Override
@@ -64,7 +83,7 @@ public class Am2900Machine implements Machine
                MicroInstructionParameter[] defaultParams = muiDef.createDefaultInstruction().getParameters();
                defaultParams[19] = paramClassifications[19].parse("JZ");
                MicroInstruction jzMI = MicroInstruction.create(defaultParams);
-               logicModel.getComponentByName("Am2900").setHighLevelState("muir_2.q", jzMI.toBitVector());
+               am2900.setHighLevelState("muir_2.q", jzMI.toBitVector());
        }
 
        @Override
@@ -93,15 +112,37 @@ public class Am2900Machine implements Machine
        @Override
        public BitVector getRegister(Register r)
        {
-               // TODO Auto-generated method stub
-               return null;
+               String am2901CellSuffix;
+               if (r instanceof QRegister)
+                       am2901CellSuffix = "qreg.q";
+               else if (r instanceof NumberedRegister)
+                       am2901CellSuffix = "regs.c" + ((NumberedRegister) r).getIndexAsBitstring() + ".q";
+               else
+                       throw new IllegalArgumentException("Not a register of an Am2900Machine: " + r);
+               BitVector result = BitVector.of();
+               for (int i = 0; i < 16; i += 4)
+               {
+                       String hlsID = String.format("am2901_%d-%d.%s", (i + 3), i, am2901CellSuffix);
+                       result = result.concat((BitVector) am2900.getHighLevelState(hlsID));
+               }
+               return result;
        }
 
        @Override
        public void setRegister(Register r, BitVector value)
        {
-               // TODO Auto-generated method stub
-
+               String am2901CellSuffix;
+               if (r instanceof QRegister)
+                       am2901CellSuffix = "qreg.q";
+               else if (r instanceof NumberedRegister)
+                       am2901CellSuffix = "regs.c" + ((NumberedRegister) r).getIndexAsBitstring() + ".q";
+               else
+                       throw new IllegalArgumentException("Not a register of an Am2900Machine: " + r);
+               for (int i = 0; i < 16; i += 4)
+               {
+                       String hlsID = String.format("am2901_%d-%d.%s", (i + 3), i, am2901CellSuffix);
+                       am2900.setHighLevelState(hlsID, value.subVector(i, i + 4));
+               }
        }
 
        @Override
@@ -115,4 +156,33 @@ public class Am2900Machine implements Machine
        {
                return instMemory;
        }
+
+       @Override
+       public long getActiveMicroInstructionAddress()
+       {
+               return activeInstructionAddress;
+       }
+
+       private long getCurrentMicroInstructionAddress()
+       {
+               BitVector vector = (BitVector) am2900.getHighLevelState("mpm_address");
+               return vector.isBinary() ? vector.getUnsignedValueLong() : -1;
+       }
+
+       @Override
+       public void addActiveMicroInstructionChangedListener(ActiveMicroInstructionChangedListener listener)
+       {
+               amicListeners.add(listener);
+       }
+
+       @Override
+       public void removeActiveMicroInstructionChangedListener(ActiveMicroInstructionChangedListener listener)
+       {
+               amicListeners.remove(listener);
+       }
+
+       private void notifyActiveMicroInstructionChangedListeners(long oldAddress, long newAddress)
+       {
+               amicListeners.forEach(l -> l.instructionChanged(oldAddress, newAddress));
+       }
 }
\ No newline at end of file