Skip to content
Snippets Groups Projects
Commit 14169564 authored by Dinesh Atchuthan's avatar Dinesh Atchuthan
Browse files

added method processorMotion::getCurrentDeltaPreintCov()

parent 74f83a4e
No related branches found
No related tags found
No related merge requests found
...@@ -127,9 +127,15 @@ class ProcessorMotion : public ProcessorBase ...@@ -127,9 +127,15 @@ class ProcessorMotion : public ProcessorBase
*/ */
Eigen::VectorXs& getState(const TimeStamp& _ts); 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 /** \brief Provides the motion integrated so far
* \return a const reference to the integrated delta state * \return a const reference to the integrated delta state
*/ */
const Motion& getMotion() const; const Motion& getMotion() const;
void getMotion(Motion& _motion) const; void getMotion(Motion& _motion) const;
...@@ -657,6 +663,11 @@ inline void ProcessorMotion::getCurrentState(Eigen::VectorXs& _x, TimeStamp& _ts ...@@ -657,6 +663,11 @@ inline void ProcessorMotion::getCurrentState(Eigen::VectorXs& _x, TimeStamp& _ts
_ts = getCurrentTimeStamp(); _ts = getCurrentTimeStamp();
} }
inline const Eigen::MatrixXs ProcessorMotion::getCurrentDeltaPreintCov()
{
return delta_integrated_cov_;
}
inline const Motion& ProcessorMotion::getMotion() const inline const Motion& ProcessorMotion::getMotion() const
{ {
return getBuffer().get().back(); return getBuffer().get().back();
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment