e48134f0aa57daa31ad91d3c3f113616b3b78272
[Mograsim.git] / 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.hardcodedComponentProcessTime = params.gateProcessTime * 5;
58                 params.wireTravelTime = 10;
59                 mainMemory = new AssignableMainMemory(new WordAddressableMemory(am2900MachineDefinition.getMainMemoryDefinition()));
60                 instMemory = new AssignableMicroInstructionMemory(
61                                 new StandardMicroInstructionMemory(am2900MachineDefinition.getMicroInstructionMemoryDefinition()));
62                 timeline = LogicCoreAdapter.convert(logicModel, params);
63                 am2900.setHighLevelState("ram.memory_binding", mainMemory);
64                 am2900.setHighLevelState("mpm.memory_binding", instMemory);
65                 clock = logicModel.getComponentBySubmodelPath("Am2900.Clock#0", ModelClock.class).getClock();
66                 clock.registerObserver(c ->
67                 {
68                         if (clock.isOn())
69                         {
70                                 long oldAddress = activeInstructionAddress;
71                                 activeInstructionAddress = getCurrentMicroInstructionAddress();
72                                 notifyActiveMicroInstructionChangedListeners(oldAddress, activeInstructionAddress);
73                         }
74                 });
75         }
76
77         @Override
78         public MachineDefinition getDefinition()
79         {
80                 return machineDefinition;
81         }
82
83         @Override
84         public void reset()
85         {
86                 MicroInstructionDefinition muiDef = getDefinition().getMicroInstructionMemoryDefinition().getMicroInstructionDefinition();
87                 ParameterClassification[] paramClassifications = muiDef.getParameterClassifications();
88                 MicroInstructionParameter[] defaultParams = muiDef.createDefaultInstruction().getParameters();
89                 defaultParams[19] = paramClassifications[19].parse("JZ");
90                 MicroInstruction jzMI = MicroInstruction.create(defaultParams);
91                 am2900.setHighLevelState("muir_2.q", jzMI.toBitVector());
92                 Bit regsValue = machineDefinition.expert ? Bit.U : Bit.ZERO;
93                 setRegistersTo(machineDefinition.getUnsortedRegisters(), regsValue);
94                 setRegisterGroupTo(machineDefinition.getRegisterGroups(), regsValue);
95                 // TODO reset latches?
96         }
97
98         private void setRegistersTo(List<Register> registers, Bit value)
99         {
100                 for (Register r : registers)
101                         if (r != muInstrRegister.instance)// don't reset; sometimes causes a glitch
102                                 setRegister(r, BitVector.of(value, r.getWidth()));
103         }
104
105         private void setRegisterGroupTo(List<RegisterGroup> registerGroups, Bit value)
106         {
107                 for (RegisterGroup rg : registerGroups)
108                 {
109                         setRegistersTo(rg.getRegisters(), value);
110                         setRegisterGroupTo(rg.getSubGroups(), value);
111                 }
112         }
113
114         @Override
115         public LogicModel getModel()
116         {
117                 return logicModel;
118         }
119
120         public ModelComponent getAm2900()
121         {
122                 return am2900;
123         }
124
125         @Override
126         public Timeline getTimeline()
127         {
128                 return timeline;
129         }
130
131         @Override
132         public CoreClock getClock()
133         {
134                 return clock;
135         }
136
137         @Override
138         public BitVector getRegister(Register r)
139         {
140                 return castAm2900Register(r).read(am2900);
141         }
142
143         @Override
144         public void setRegister(Register r, BitVector value)
145         {
146                 castAm2900Register(r).write(am2900, value);
147         }
148
149         @Override
150         public void addRegisterListener(Register r, Consumer<BitVector> listener)
151         {
152                 castAm2900Register(r).addListener(am2900, listener);
153         }
154
155         @Override
156         public void removeRegisterListener(Register r, Consumer<BitVector> listener)
157         {
158                 castAm2900Register(r).removeListener(am2900, listener);
159         }
160
161         private static Am2900Register castAm2900Register(Register r)
162         {
163                 if (r instanceof Am2900Register)
164                         return (Am2900Register) r;
165                 throw new IllegalArgumentException("Not a register of an Am2900Machine: " + r);
166         }
167
168         @Override
169         public AssignableMainMemory getMainMemory()
170         {
171                 return mainMemory;
172         }
173
174         @Override
175         public AssignableMicroInstructionMemory getMicroInstructionMemory()
176         {
177                 return instMemory;
178         }
179
180         @Override
181         public long getActiveMicroInstructionAddress()
182         {
183                 return activeInstructionAddress;
184         }
185
186         private long getCurrentMicroInstructionAddress()
187         {
188                 BitVector vector = (BitVector) am2900.getHighLevelState("mpm_address");
189                 return vector.isBinary() ? vector.getUnsignedValueLong() : -1;
190         }
191
192         @Override
193         public void addActiveMicroInstructionChangedListener(ActiveMicroInstructionChangedListener listener)
194         {
195                 amicListeners.add(listener);
196         }
197
198         @Override
199         public void removeActiveMicroInstructionChangedListener(ActiveMicroInstructionChangedListener listener)
200         {
201                 amicListeners.remove(listener);
202         }
203
204         private void notifyActiveMicroInstructionChangedListeners(long oldAddress, long newAddress)
205         {
206                 amicListeners.forEach(l -> l.instructionChanged(oldAddress, newAddress));
207         }
208 }