Method addStateWithCheck

src/FactorGraph.cpp:151–157

  }

  void FactorGraph::addStateWithCheck(string Name, DataType Type, double Timestamp)
  {
    if (!this->getStateData().checkElement(Name, Timestamp))
    {
      this->addState(Name, Type, Timestamp);
    }
  }

  void FactorGraph::addIMUPreintegrationFactor(StateList List, PreintegratedIMUResult IMUState)
  {