From afc6868ca39f238e930101c03cfd52e2a46795c5 Mon Sep 17 00:00:00 2001 From: Varun Agrawal Date: Sun, 22 Dec 2024 18:17:09 -0500 Subject: [PATCH] wrap ImuFactor2 --- gtsam/navigation/navigation.i | 16 ++++++++++++++++ 1 file changed, 16 insertions(+) diff --git a/gtsam/navigation/navigation.i b/gtsam/navigation/navigation.i index adb8bf2bb..ceeab3b35 100644 --- a/gtsam/navigation/navigation.i +++ b/gtsam/navigation/navigation.i @@ -156,6 +156,22 @@ virtual class ImuFactor: gtsam::NonlinearFactor { void serialize() const; }; +virtual class ImuFactor2: gtsam::NonlinearFactor { + ImuFactor2(); + ImuFactor2(size_t state_i, size_t state_j, + size_t bias, + const gtsam::PreintegratedImuMeasurements& preintegratedMeasurements); + + // Standard Interface + gtsam::PreintegratedImuMeasurements preintegratedMeasurements() const; + gtsam::Vector evaluateError(const gtsam::NavState& state_i, + gtsam::NavState& state_j, + const gtsam::imuBias::ConstantBias& bias_i); + + // enable serialization functionality + void serialize() const; +}; + #include virtual class PreintegrationCombinedParams : gtsam::PreintegrationParams { PreintegrationCombinedParams(gtsam::Vector n_gravity);