Skip to content
Snippets Groups Projects
Commit 54a72140 authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

[skip ci] Document boostrap

parent cbba811c
No related branches found
No related tags found
1 merge request!54devel->main
......@@ -85,7 +85,6 @@ class ProcessorImu : public ProcessorMotion{
void configure(SensorBasePtr _sensor) override { };
void preProcess() override;
void bootstrapEnable(bool _bootstrap_enable = true);
protected:
void computeCurrentDelta(const Eigen::VectorXd& _data,
......@@ -126,14 +125,31 @@ class ProcessorImu : public ProcessorMotion{
FeatureBasePtr emplaceFeature(CaptureMotionPtr _capture_motion) override;
FactorBasePtr emplaceFactor(FeatureBasePtr _feature_motion, CaptureBasePtr _capture_origin) override;
virtual void bootstrap() override;
CaptureBasePtr bootstrapOrigin() const;
VectorXd bootstrapDelta() const;
bool recomputeStates() const;
public:
/** \brief Enable bootstrapping process
*/
void bootstrapEnable(bool _bootstrap_enable = true);
protected:
/** \brief Bootstrap the IMU initial conditions
*/
virtual void bootstrap() override;
/** \brief Get the Capture where the IMU data started the bootstrap
*/
CaptureBasePtr bootstrapOrigin() const;
/** \brief Compose all preintegrated Deltas accumulated during the whole bootstrap process.
*/
VectorXd bootstrapDelta() const;
/** \brief Incrementally compute all state values according to the current initial conditions and all
* preintegrated deltas.
*
* This is executed at the end of the bootstrap process
*/
bool recomputeStates() const;
protected:
ParamsProcessorImuPtr params_motion_Imu_;
std::list<FactorBasePtr> list_fac_inactive_bootstrap_;
std::list<FactorBasePtr> list_fac_inactive_bootstrap_; ///< List of all IMU factors created while IMU is bootstrapping
};
}
......
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