plugins/net.mograsim.logic.model.am2900/src/net/mograsim/logic/model/am2900/components/am2910/ModelAm2910RegCntr.java

   1 package net.mograsim.logic.model.am2900.components.am2910;
   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.ZERO;
   6
   7 import java.util.Arrays;
   8 import java.util.Map;
   9
  10 import net.mograsim.logic.core.types.Bit;
  11 import net.mograsim.logic.core.types.BitVector;
  12 import net.mograsim.logic.core.wires.CoreWire.ReadEnd;
  13 import net.mograsim.logic.core.wires.CoreWire.ReadWriteEnd;
  14 import net.mograsim.logic.model.model.LogicModelModifiable;
  15 import net.mograsim.logic.model.model.components.atomic.SimpleRectangularHardcodedModelComponent;
  16 import net.mograsim.logic.model.model.wires.Pin;
  17 import net.mograsim.logic.model.model.wires.PinUsage;
  18 import net.mograsim.logic.model.serializing.IndirectModelComponentCreator;
  19 import net.mograsim.logic.model.snippets.symbolrenderers.PinNamesSymbolRenderer.PinNamesParams.Position;
  20
  21 public class ModelAm2910RegCntr extends SimpleRectangularHardcodedModelComponent
  22 {
  23         public ModelAm2910RegCntr(LogicModelModifiable model, String name)
  24         {
  25                 super(model, "Am2910RegCntr", name, "Register/\nCounter", false);
  26                 setSize(40, 40);
  27                 addPin(new Pin(model, this, "D", 12, PinUsage.INPUT, 20, 0), Position.BOTTOM);
  28                 addPin(new Pin(model, this, "_RLD", 1, PinUsage.INPUT, 0, 5), Position.RIGHT);
  29                 addPin(new Pin(model, this, "WE", 1, PinUsage.INPUT, 0, 20), Position.RIGHT);
  30                 addPin(new Pin(model, this, "DEC", 1, PinUsage.INPUT, 0, 30), Position.RIGHT);
  31                 addPin(new Pin(model, this, "C", 1, PinUsage.INPUT, 40, 20), Position.LEFT);
  32                 addPin(new Pin(model, this, "Y", 12, PinUsage.OUTPUT, 20, 40), Position.TOP);
  33
  34                 init();
  35         }
  36
  37         @Override
  38         public Object recalculate(Object lastState, Map<String, ReadEnd> readEnds, Map<String, ReadWriteEnd> readWriteEnds)
  39         {
  40                 Bit[] QC = (Bit[]) lastState;
  41                 if (QC == null)
  42                 {
  43                         QC = new Bit[13];
  44                         Arrays.fill(QC, U);
  45                 }
  46
  47                 ReadEnd D = readEnds.get("D");
  48                 ReadEnd _RLD = readEnds.get("_RLD");
  49                 ReadEnd WE = readEnds.get("WE");
  50                 ReadEnd DEC = readEnds.get("DEC");
  51                 ReadEnd C = readEnds.get("C");
  52                 ReadWriteEnd Y = readWriteEnds.get("Y");
  53
  54                 Bit oldCVal = QC[12];
  55                 Bit CVal = C.getValue();
  56
  57                 // TODO handle U/X/Z
  58                 if (oldCVal == ZERO && CVal == ONE)
  59                 {
  60                         if ((DEC.getValue() == ZERO && WE.getValue() == ONE) || _RLD.getValue() == ZERO)
  61                                 System.arraycopy(D.getValues().getBits(), 0, QC, 0, 12);
  62                         else if (WE.getValue() == ONE)
  63                         {
  64                                 Bit carry = Bit.ZERO;
  65                                 // TODO extract to helper. This code almost also exists in Modelinc.
  66                                 for (int i = 11; i >= 0; i--)
  67                                 {
  68                                         Bit a = QC[i];
  69                                         QC[i] = a.xnor(carry);
  70                                         carry = a.or(carry);
  71                                 }
  72                         }
  73                 }
  74                 QC[12] = CVal;
  75                 Y.feedSignals(Arrays.copyOfRange(QC, 0, 12));
  76
  77                 return QC;
  78         }
  79
  80         @Override
  81         protected Object getHighLevelState(Object state, String stateID)
  82         {
  83                 switch (stateID)
  84                 {
  85                 case "q":
  86                         return BitVector.of(Arrays.copyOfRange((Bit[]) state, 0, 12));
  87                 default:
  88                         return super.getHighLevelState(state, stateID);
  89                 }
  90         }
  91
  92         @Override
  93         protected Object setHighLevelState(Object lastState, String stateID, Object newHighLevelState)
  94         {
  95                 switch (stateID)
  96                 {
  97                 case "q":
  98                         BitVector newHighLevelStateCasted = (BitVector) newHighLevelState;
  99                         if (newHighLevelStateCasted.length() != 12)
 100                                 throw new IllegalArgumentException("Expected BitVector of length 12, not " + newHighLevelStateCasted.length());
 101                         System.arraycopy(newHighLevelStateCasted.getBits(), 0, lastState, 0, 12);
 102                         return lastState;
 103                 default:
 104                         return super.setHighLevelState(lastState, stateID, newHighLevelState);
 105                 }
 106         }
 107
 108         static
 109         {
 110                 IndirectModelComponentCreator.setComponentSupplier(ModelAm2910RegCntr.class.getCanonicalName(),
 111                                 (m, p, n) -> new ModelAm2910RegCntr(m, n));
 112         }
 113 }