Method predict

include/factors/OdometryFactor3D.h:197–206

predict the next state for initialization, order is the same as for Evaluate() */

      /** predict the next state for initialization, order is the same as for Evaluate() */
      void predict(const std::vector<double*> &StatePointers) const
      {
        OdometryModel6DOF<double>::applyForward(StatePointers[0],
                                                StatePointers[1],
                                                StatePointers[2],
                                                StatePointers[3],
                                                this->_MeasurementVector.head(3),
                                                this->_MeasurementVector.tail(3),
                                                this->_DeltaTime);
      }
  };

  template<typename ErrorType>