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.am2900.machine.registers.muInstrRegister;
  14 import net.mograsim.logic.model.model.LogicModel;
  15 import net.mograsim.logic.model.model.LogicModelModifiable;
  16 import net.mograsim.logic.model.model.components.ModelComponent;
  17 import net.mograsim.logic.model.model.components.atomic.ModelClock;
  18 import net.mograsim.logic.model.modeladapter.CoreModelParameters;
  19 import net.mograsim.logic.model.modeladapter.LogicCoreAdapter;
  20 import net.mograsim.logic.model.serializing.IndirectModelComponentCreator;
  21 import net.mograsim.machine.Machine;
  22 import net.mograsim.machine.MachineDefinition;
  23 import net.mograsim.machine.mi.AssignableMicroInstructionMemory;
  24 import net.mograsim.machine.mi.MicroInstruction;
  25 import net.mograsim.machine.mi.MicroInstructionDefinition;
  26 import net.mograsim.machine.mi.StandardMicroInstructionMemory;
  27 import net.mograsim.machine.mi.parameters.MicroInstructionParameter;
  28 import net.mograsim.machine.mi.parameters.ParameterClassification;
  29 import net.mograsim.machine.registers.Register;
  30 import net.mograsim.machine.registers.RegisterGroup;
  31 import net.mograsim.machine.standard.memory.AssignableMainMemory;
  32 import net.mograsim.machine.standard.memory.WordAddressableMemory;
  33
  34 public class Am2900Machine implements Machine
  35 {
  36         private AbstractAm2900MachineDefinition machineDefinition;
  37         private LogicModelModifiable logicModel;
  38         private ModelComponent am2900;
  39         private Timeline timeline;
  40         private AssignableMainMemory mainMemory;
  41         private AssignableMicroInstructionMemory instMemory;
  42         private CoreClock clock;
  43         private long activeInstructionAddress;
  44
  45         private final Set<ActiveMicroInstructionChangedListener> amicListeners;
  46
  47         public Am2900Machine(LogicModelModifiable model, AbstractAm2900MachineDefinition am2900MachineDefinition)
  48         {
  49                 this.machineDefinition = am2900MachineDefinition;
  50                 this.logicModel = model;
  51                 this.am2900 = IndirectModelComponentCreator.createComponent(logicModel,
  52                                 "resloader:Am2900Loader:jsonres:net/mograsim/logic/model/am2900/components/Am2900.json", "Am2900");
  53                 this.amicListeners = new HashSet<>();
  54
  55                 CoreModelParameters params = new CoreModelParameters();
  56                 params.gateProcessTime = 50;
  57                 params.wireTravelTime = 10;
  58                 mainMemory = new AssignableMainMemory(new WordAddressableMemory(am2900MachineDefinition.getMainMemoryDefinition()));
  59                 instMemory = new AssignableMicroInstructionMemory(
  60                                 new StandardMicroInstructionMemory(am2900MachineDefinition.getMicroInstructionMemoryDefinition()));
  61                 timeline = LogicCoreAdapter.convert(logicModel, params);
  62                 am2900.setHighLevelState("ram.memory_binding", mainMemory);
  63                 am2900.setHighLevelState("mpm.memory_binding", instMemory);
  64                 clock = logicModel.getComponentBySubmodelPath("Am2900.Clock#0", ModelClock.class).getClock();
  65                 clock.registerObserver(c ->
  66                 {
  67                         if (clock.isOn())
  68                         {
  69                                 long oldAddress = activeInstructionAddress;
  70                                 activeInstructionAddress = getCurrentMicroInstructionAddress();
  71                                 notifyActiveMicroInstructionChangedListeners(oldAddress, activeInstructionAddress);
  72                         }
  73                 });
  74         }
  75
  76         @Override
  77         public MachineDefinition getDefinition()
  78         {
  79                 return machineDefinition;
  80         }
  81
  82         @Override
  83         public void reset()
  84         {
  85                 MicroInstructionDefinition muiDef = getDefinition().getMicroInstructionMemoryDefinition().getMicroInstructionDefinition();
  86                 ParameterClassification[] paramClassifications = muiDef.getParameterClassifications();
  87                 MicroInstructionParameter[] defaultParams = muiDef.createDefaultInstruction().getParameters();
  88                 defaultParams[19] = paramClassifications[19].parse("JZ");
  89                 MicroInstruction jzMI = MicroInstruction.create(defaultParams);
  90                 am2900.setHighLevelState("muir_2.q", jzMI.toBitVector());
  91                 Bit regsValue = machineDefinition.strict ? Bit.U : Bit.ZERO;
  92                 setRegistersTo(machineDefinition.getUnsortedRegisters(), regsValue);
  93                 setRegisterGroupTo(machineDefinition.getRegisterGroups(), regsValue);
  94                 // TODO reset latches?
  95         }
  96
  97         private void setRegistersTo(List<Register> registers, Bit value)
  98         {
  99                 for (Register r : registers)
 100                         if (r != muInstrRegister.instance)// don't reset; sometimes causes a glitch
 101                                 setRegister(r, BitVector.of(value, r.getWidth()));
 102         }
 103
 104         private void setRegisterGroupTo(List<RegisterGroup> registerGroups, Bit value)
 105         {
 106                 for (RegisterGroup rg : registerGroups)
 107                 {
 108                         setRegistersTo(rg.getRegisters(), value);
 109                         setRegisterGroupTo(rg.getSubGroups(), value);
 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 }