plugins/net.mograsim.logic.model.am2900/src/net/mograsim/logic/model/am2900/machine/Am2900Machine.java

   1 package net.mograsim.logic.model.am2900.machine;
   2
   3 import java.util.HashSet;
   4 import java.util.List;
   5 import java.util.Set;
   6 import java.util.function.Consumer;
   7
   8 import net.mograsim.logic.core.components.CoreClock;
   9 import net.mograsim.logic.core.timeline.Timeline;
  10 import net.mograsim.logic.core.types.Bit;
  11 import net.mograsim.logic.core.types.BitVector;
  12 import net.mograsim.logic.model.am2900.machine.registers.Am2900Register;
  13 import net.mograsim.logic.model.model.LogicModel;
  14 import net.mograsim.logic.model.model.LogicModelModifiable;
  15 import net.mograsim.logic.model.model.components.ModelComponent;
  16 import net.mograsim.logic.model.model.components.atomic.ModelClock;
  17 import net.mograsim.logic.model.modeladapter.CoreModelParameters;
  18 import net.mograsim.logic.model.modeladapter.LogicCoreAdapter;
  19 import net.mograsim.logic.model.serializing.IndirectModelComponentCreator;
  20 import net.mograsim.machine.Machine;
  21 import net.mograsim.machine.MachineDefinition;
  22 import net.mograsim.machine.mi.AssignableMicroInstructionMemory;
  23 import net.mograsim.machine.mi.MicroInstruction;
  24 import net.mograsim.machine.mi.MicroInstructionDefinition;
  25 import net.mograsim.machine.mi.StandardMicroInstructionMemory;
  26 import net.mograsim.machine.mi.parameters.MicroInstructionParameter;
  27 import net.mograsim.machine.mi.parameters.ParameterClassification;
  28 import net.mograsim.machine.registers.Register;
  29 import net.mograsim.machine.registers.RegisterGroup;
  30 import net.mograsim.machine.standard.memory.AssignableMainMemory;
  31 import net.mograsim.machine.standard.memory.WordAddressableMemory;
  32
  33 public class Am2900Machine implements Machine
  34 {
  35         private AbstractAm2900MachineDefinition machineDefinition;
  36         private LogicModelModifiable logicModel;
  37         private ModelComponent am2900;
  38         private Timeline timeline;
  39         private AssignableMainMemory mainMemory;
  40         private AssignableMicroInstructionMemory instMemory;
  41         private CoreClock clock;
  42         private long activeInstructionAddress;
  43
  44         private final Set<ActiveMicroInstructionChangedListener> amicListeners;
  45
  46         public Am2900Machine(LogicModelModifiable model, AbstractAm2900MachineDefinition am2900MachineDefinition)
  47         {
  48                 this.machineDefinition = am2900MachineDefinition;
  49                 this.logicModel = model;
  50                 this.am2900 = IndirectModelComponentCreator.createComponent(logicModel,
  51                                 "resloader:Am2900Loader:jsonres:net/mograsim/logic/model/am2900/components/Am2900.json", "Am2900");
  52                 this.amicListeners = new HashSet<>();
  53
  54                 CoreModelParameters params = new CoreModelParameters();
  55                 params.gateProcessTime = 50;
  56                 params.wireTravelTime = 10;
  57                 mainMemory = new AssignableMainMemory(new WordAddressableMemory(am2900MachineDefinition.getMainMemoryDefinition()));
  58                 instMemory = new AssignableMicroInstructionMemory(
  59                                 new StandardMicroInstructionMemory(am2900MachineDefinition.getMicroInstructionMemoryDefinition()));
  60                 timeline = LogicCoreAdapter.convert(logicModel, params);
  61                 am2900.setHighLevelState("ram.memory_binding", mainMemory);
  62                 am2900.setHighLevelState("mpm.memory_binding", instMemory);
  63                 clock = logicModel.getComponentBySubmodelPath("Am2900.Clock#0", ModelClock.class).getClock();
  64                 clock.registerObserver(c ->
  65                 {
  66                         if (clock.isOn())
  67                         {
  68                                 long oldAddress = activeInstructionAddress;
  69                                 activeInstructionAddress = getCurrentMicroInstructionAddress();
  70                                 notifyActiveMicroInstructionChangedListeners(oldAddress, activeInstructionAddress);
  71                         }
  72                 });
  73         }
  74
  75         @Override
  76         public MachineDefinition getDefinition()
  77         {
  78                 return machineDefinition;
  79         }
  80
  81         @Override
  82         public void reset()
  83         {
  84                 MicroInstructionDefinition muiDef = getDefinition().getMicroInstructionMemoryDefinition().getMicroInstructionDefinition();
  85                 ParameterClassification[] paramClassifications = muiDef.getParameterClassifications();
  86                 MicroInstructionParameter[] defaultParams = muiDef.createDefaultInstruction().getParameters();
  87                 defaultParams[19] = paramClassifications[19].parse("JZ");
  88                 MicroInstruction jzMI = MicroInstruction.create(defaultParams);
  89                 am2900.setHighLevelState("muir_2.q", jzMI.toBitVector());
  90                 if (!machineDefinition.strict)
  91                 {
  92                         setRegistersToZero(machineDefinition.getUnsortedRegisters());
  93                         setRegisterGroupToZero(machineDefinition.getRegisterGroups());
  94                         // TODO reset latches?
  95                 }
  96         }
  97
  98         private void setRegistersToZero(List<Register> registers)
  99         {
 100                 for (Register r : registers)
 101                         setRegister(r, BitVector.of(Bit.ZERO, r.getWidth()));
 102         }
 103
 104         private void setRegisterGroupToZero(List<RegisterGroup> registerGroups)
 105         {
 106                 for (RegisterGroup rg : registerGroups)
 107                 {
 108                         setRegistersToZero(rg.getRegisters());
 109                         setRegisterGroupToZero(rg.getSubGroups());
 110                 }
 111         }
 112
 113         @Override
 114         public LogicModel getModel()
 115         {
 116                 return logicModel;
 117         }
 118
 119         public ModelComponent getAm2900()
 120         {
 121                 return am2900;
 122         }
 123
 124         @Override
 125         public Timeline getTimeline()
 126         {
 127                 return timeline;
 128         }
 129
 130         @Override
 131         public CoreClock getClock()
 132         {
 133                 return clock;
 134         }
 135
 136         @Override
 137         public BitVector getRegister(Register r)
 138         {
 139                 return castAm2900Register(r).read(am2900);
 140         }
 141
 142         @Override
 143         public void setRegister(Register r, BitVector value)
 144         {
 145                 castAm2900Register(r).write(am2900, value);
 146         }
 147
 148         @Override
 149         public void addRegisterListener(Register r, Consumer<BitVector> listener)
 150         {
 151                 castAm2900Register(r).addListener(am2900, listener);
 152         }
 153
 154         @Override
 155         public void removeRegisterListener(Register r, Consumer<BitVector> listener)
 156         {
 157                 castAm2900Register(r).removeListener(am2900, listener);
 158         }
 159
 160         private static Am2900Register castAm2900Register(Register r)
 161         {
 162                 if (r instanceof Am2900Register)
 163                         return (Am2900Register) r;
 164                 throw new IllegalArgumentException("Not a register of an Am2900Machine: " + r);
 165         }
 166
 167         @Override
 168         public AssignableMainMemory getMainMemory()
 169         {
 170                 return mainMemory;
 171         }
 172
 173         @Override
 174         public AssignableMicroInstructionMemory getMicroInstructionMemory()
 175         {
 176                 return instMemory;
 177         }
 178
 179         @Override
 180         public long getActiveMicroInstructionAddress()
 181         {
 182                 return activeInstructionAddress;
 183         }
 184
 185         private long getCurrentMicroInstructionAddress()
 186         {
 187                 BitVector vector = (BitVector) am2900.getHighLevelState("mpm_address");
 188                 return vector.isBinary() ? vector.getUnsignedValueLong() : -1;
 189         }
 190
 191         @Override
 192         public void addActiveMicroInstructionChangedListener(ActiveMicroInstructionChangedListener listener)
 193         {
 194                 amicListeners.add(listener);
 195         }
 196
 197         @Override
 198         public void removeActiveMicroInstructionChangedListener(ActiveMicroInstructionChangedListener listener)
 199         {
 200                 amicListeners.remove(listener);
 201         }
 202
 203         private void notifyActiveMicroInstructionChangedListeners(long oldAddress, long newAddress)
 204         {
 205                 amicListeners.forEach(l -> l.instructionChanged(oldAddress, newAddress));
 206         }
 207 }