diff --git a/src/processor_motion.h b/src/processor_motion.h index 943c0fe0e44f3682ae8bc5df2056db12d1220319..d23d74709bccbfff78a9a560fa0681d6e910c38e 100644 --- a/src/processor_motion.h +++ b/src/processor_motion.h @@ -127,9 +127,15 @@ class ProcessorMotion : public ProcessorBase */ Eigen::VectorXs& getState(const TimeStamp& _ts); + /** \brief Gets a constant reference delta preintegrated covariance from all integrations so far + * \return the delta preintegrated covariance matrix + */ + const Eigen::MatrixXs getCurrentDeltaPreintCov(); + /** \brief Provides the motion integrated so far * \return a const reference to the integrated delta state */ + const Motion& getMotion() const; void getMotion(Motion& _motion) const; @@ -657,6 +663,11 @@ inline void ProcessorMotion::getCurrentState(Eigen::VectorXs& _x, TimeStamp& _ts _ts = getCurrentTimeStamp(); } +inline const Eigen::MatrixXs ProcessorMotion::getCurrentDeltaPreintCov() +{ + return delta_integrated_cov_; +} + inline const Motion& ProcessorMotion::getMotion() const { return getBuffer().get().back();