From f2b8a263d6bbd9f166307d82d2e75bdcc13b32ac Mon Sep 17 00:00:00 2001 From: Frank Dellaert Date: Fri, 17 May 2019 22:10:48 -0400 Subject: [PATCH] Wrap ScenarioRunner --- gtsam.h | 24 ++++++++++++++++++++++++ 1 file changed, 24 insertions(+) diff --git a/gtsam.h b/gtsam.h index 686203748..d40a109b3 100644 --- a/gtsam.h +++ b/gtsam.h @@ -2856,6 +2856,30 @@ virtual class AcceleratingScenario : gtsam::Scenario { Vector omega_b); }; +#include +class ScenarioRunner { + ScenarioRunner(const gtsam::Scenario& scenario, + const gtsam::PreintegrationParams* p, + double imuSampleTime, + const gtsam::imuBias::ConstantBias& bias); + Vector gravity_n() const; + Vector actualAngularVelocity(double t) const; + Vector actualSpecificForce(double t) const; + Vector measuredAngularVelocity(double t) const; + Vector measuredSpecificForce(double t) const; + double imuSampleTime() const; + gtsam::PreintegratedImuMeasurements integrate( + double T, const gtsam::imuBias::ConstantBias& estimatedBias, + bool corrupted) const; + gtsam::NavState predict( + const gtsam::PreintegratedImuMeasurements& pim, + const gtsam::imuBias::ConstantBias& estimatedBias) const; + Matrix estimateCovariance( + double T, size_t N, + const gtsam::imuBias::ConstantBias& estimatedBias) const; + Matrix estimateNoiseCovariance(size_t N) const; +}; + //************************************************************************* // Utilities //*************************************************************************