us.ihmc.simulationconstructionset.util.IndexOrderChecker Maven / Gradle / Ivy

Go to download

Show more of this group Show more artifacts with this name
Show all versions of simulation-construction-set

Simulation Construction Set

There is a newer version: 0.25.2

package us.ihmc.simulationconstructionset.util;

import us.ihmc.yoVariables.registry.YoRegistry;
import us.ihmc.yoVariables.variable.YoBoolean;
import us.ihmc.yoVariables.variable.YoInteger;

public class IndexOrderChecker
{
   private final YoInteger previousIndex;
   private final YoInteger missedIndices;
   private final YoBoolean hasBeenUpdated;
   private int increment;

   public IndexOrderChecker(String name, YoRegistry registry, int increment)
   {
      previousIndex = new YoInteger(name + "PrevIndex", registry);
      missedIndices = new YoInteger(name + "MissedIndices", registry);
      hasBeenUpdated = new YoBoolean(name + "HasBeenUpdated", registry);
      this.increment = increment;
   }

   public void update(int newIndex)
   {
      if (hasBeenUpdated.getBooleanValue())
      {
         int correctedNew = newIndex;
         int correctedPrevious = previousIndex.getIntegerValue();
         if (correctedPrevious > correctedNew)
         {
            // assume a single overflow
            correctedNew += Integer.MIN_VALUE;
            correctedPrevious -= Integer.MAX_VALUE + 1;
         }
         missedIndices.add(Math.abs(correctedNew - correctedPrevious - increment)); // abs because we also don't want the new index to be too small
      }
      else
         hasBeenUpdated.set(true);
      previousIndex.set(newIndex);
   }

   public int getMissedIndices()
   {
      return missedIndices.getIntegerValue();
   }
}