Implemented the Am2904ShiftInstrDecode gate-based
[Mograsim.git] / plugins / net.mograsim.logic.model.am2900 / src / net / mograsim / logic / model / am2900 / components / Modelram5_12.java
1 package net.mograsim.logic.model.am2900.components;
2
3 import static net.mograsim.logic.core.types.Bit.ONE;
4 import static net.mograsim.logic.core.types.Bit.U;
5 import static net.mograsim.logic.core.types.Bit.X;
6 import static net.mograsim.logic.core.types.Bit.Z;
7 import static net.mograsim.logic.core.types.Bit.ZERO;
8
9 import java.util.Arrays;
10 import java.util.Map;
11 import java.util.regex.Matcher;
12 import java.util.regex.Pattern;
13
14 import net.mograsim.logic.core.types.Bit;
15 import net.mograsim.logic.core.types.BitVector;
16 import net.mograsim.logic.core.wires.CoreWire.ReadEnd;
17 import net.mograsim.logic.core.wires.CoreWire.ReadWriteEnd;
18 import net.mograsim.logic.model.model.LogicModelModifiable;
19 import net.mograsim.logic.model.model.components.atomic.SimpleRectangularHardcodedModelComponent;
20 import net.mograsim.logic.model.model.wires.Pin;
21 import net.mograsim.logic.model.model.wires.PinUsage;
22 import net.mograsim.logic.model.serializing.IndirectModelComponentCreator;
23 import net.mograsim.logic.model.snippets.symbolrenderers.PinNamesSymbolRenderer.PinNamesParams.Position;
24
25 public class Modelram5_12 extends SimpleRectangularHardcodedModelComponent
26 {
27         public Modelram5_12(LogicModelModifiable model, String name)
28         {
29                 super(model, "ram5_12", name, "RAM\n5 x 12 Bit", false);
30                 setSize(40, 40);
31                 addPin(new Pin(model, this, "A", 3, PinUsage.INPUT, 10, 0), Position.BOTTOM);
32                 addPin(new Pin(model, this, "B", 3, PinUsage.INPUT, 30, 0), Position.BOTTOM);
33                 addPin(new Pin(model, this, "WE", 1, PinUsage.INPUT, 0, 5), Position.RIGHT);
34                 addPin(new Pin(model, this, "C", 1, PinUsage.INPUT, 0, 15), Position.RIGHT);
35                 addPin(new Pin(model, this, "Y", 12, PinUsage.OUTPUT, 0, 30), Position.RIGHT);
36                 addPin(new Pin(model, this, "D", 12, PinUsage.INPUT, 20, 40), Position.TOP);
37
38                 init();
39         }
40
41         @Override
42         public Object recalculate(Object lastState, Map<String, ReadEnd> readEnds, Map<String, ReadWriteEnd> readWriteEnds)
43         {
44                 BitVector[] memC = castAndInitState(lastState);
45
46                 BitVector CVal = readEnds.get("C").getValues();
47                 BitVector oldC = memC[5];
48                 // TODO is the timing right?
49                 if (oldC.getLSBit(0) == ZERO && CVal.getLSBit(0) == ONE && readEnds.get("WE").getValue() == ONE)
50                 {
51                         int BInt = getAsInt(readEnds.get("B").getValues());
52                         if (BInt == -1 || BInt > 4)
53                                 Arrays.fill(memC, BitVector.of(X, 12));
54                         else if (BInt == -2)
55                                 Arrays.fill(memC, BitVector.of(U, 12));
56                         else
57                                 memC[BInt] = readEnds.get("D").getValues();
58                 }
59                 int AInt = getAsInt(readEnds.get("A").getValues());
60                 BitVector YVal = AInt == -1 || AInt > 4 ? BitVector.of(X, 12) : AInt == -2 ? BitVector.of(U, 12) : memC[AInt];
61                 readWriteEnds.get("Y").feedSignals(YVal);
62                 memC[5] = CVal;
63                 return memC;
64         }
65
66         /**
67          * -1 means X, -2 means U
68          */
69         private static int getAsInt(BitVector vect)
70         {
71                 Bit[] bits = vect.getBits();
72                 for (int i = 0; i < 3; i++)
73                         if (bits[i] == X)
74                                 return -1;
75                 for (int i = 0; i < 3; i++)
76                         if (bits[i] == U)
77                                 return -2;
78                 for (int i = 0; i < 3; i++)
79                         if (bits[i] == Z)
80                                 return -1;
81                 return (bits[0] == ONE ? 4 : 0) + (bits[1] == ONE ? 2 : 0) + (bits[2] == ONE ? 1 : 0);
82         }
83
84         Pattern stateIDPattern = Pattern.compile("c(0[10][10]|100).q");
85
86         @Override
87         protected Object getHighLevelState(Object state, String stateID)
88         {
89                 BitVector[] memC = castAndInitState(state);
90
91                 Matcher m = stateIDPattern.matcher(stateID);
92                 if (m.matches())
93                         return memC[Integer.parseInt(m.group(1), 2)];
94                 return super.getHighLevelState(memC, stateID);
95         }
96
97         @Override
98         protected Object setHighLevelState(Object lastState, String stateID, Object newHighLevelState)
99         {
100                 BitVector[] memC = castAndInitState(lastState);
101
102                 Matcher m = stateIDPattern.matcher(stateID);
103                 if (m.matches())
104                 {
105                         int addr = Integer.parseInt(m.group(1), 2);
106                         BitVector newHighLevelStateCasted = (BitVector) newHighLevelState;
107                         if (newHighLevelStateCasted.length() != 12)
108                                 throw new IllegalArgumentException("Expected BitVector of length 12, not " + newHighLevelStateCasted.length());
109                         memC[addr] = newHighLevelStateCasted;
110                         return memC;
111                 }
112                 return super.setHighLevelState(memC, stateID, newHighLevelState);
113         }
114
115         private static BitVector[] castAndInitState(Object state)
116         {
117                 BitVector[] memC = (BitVector[]) state;
118                 if (memC == null)
119                 {
120                         memC = new BitVector[6];
121                         Arrays.fill(memC, 0, 5, BitVector.of(U, 12));
122                         memC[5] = BitVector.of(U);
123                 }
124                 return memC;
125         }
126
127         static
128         {
129                 IndirectModelComponentCreator.setComponentSupplier(Modelram5_12.class.getCanonicalName(), (m, p, n) -> new Modelram5_12(m, n));
130         }
131 }