diff --git a/gtsam/navigation/tests/testImuFactor.cpp b/gtsam/navigation/tests/testImuFactor.cpp index a54143bd0..0d16ba444 100644 --- a/gtsam/navigation/tests/testImuFactor.cpp +++ b/gtsam/navigation/tests/testImuFactor.cpp @@ -193,9 +193,13 @@ TEST(ImuFactor, Accelerating) { boost::function f = boost::bind(&PreintegrationBase::updatedDeltaXij, pim, _1, _2, T/10, boost::none, boost::none, boost::none); + const Vector3 measuredAcc = runner.measured_acceleration(T); + const Vector3 measuredOmega = runner.measured_angular_velocity(T); pim.updatedDeltaXij(measuredAcc, measuredOmega, T / 10, boost::none, aG1, aG2); - EXPECT(assert_equal(numericalDerivative21(f, measuredAcc, measuredOmega, 1e-7), aG1, 1e-7)); - EXPECT(assert_equal(numericalDerivative22(f, measuredAcc, measuredOmega, 1e-7), aG2, 1e-7)); + EXPECT(assert_equal( + numericalDerivative21(f, measuredAcc, measuredOmega, 1e-7), aG1, 1e-7)); + EXPECT(assert_equal( + numericalDerivative22(f, measuredAcc, measuredOmega, 1e-7), aG2, 1e-7)); } /* ************************************************************************* */