From 3750362b49fd7a477c81613e2c7bb4f2111b908c Mon Sep 17 00:00:00 2001 From: krunalchande Date: Tue, 10 Mar 2015 18:16:45 -0400 Subject: [PATCH] Test fails with incorrect imuBias operator-. --- gtsam/navigation/tests/testCombinedImuFactor.cpp | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/gtsam/navigation/tests/testCombinedImuFactor.cpp b/gtsam/navigation/tests/testCombinedImuFactor.cpp index 3f7109543..384a9b157 100644 --- a/gtsam/navigation/tests/testCombinedImuFactor.cpp +++ b/gtsam/navigation/tests/testCombinedImuFactor.cpp @@ -270,13 +270,13 @@ TEST( CombinedImuFactor, FirstOrderPreIntegratedMeasurements ) /* ************************************************************************* */ TEST(CombinedImuFactor, PredictPositionAndVelocity){ - imuBias::ConstantBias bias(Vector3(0, 0, 0), Vector3(0, 0, 0)); // Biases (acc, rot) + imuBias::ConstantBias bias(Vector3(0, 0.1, 0), Vector3(0, 0.1, 0)); // Biases (acc, rot) // Measurements Vector3 gravity; gravity << 0, 0, 9.81; Vector3 omegaCoriolis; omegaCoriolis << 0, 0, 0; - Vector3 measuredOmega; measuredOmega << 0, 0, 0;//M_PI/10.0+0.3; - Vector3 measuredAcc; measuredAcc << 0,1,-9.81; + Vector3 measuredOmega; measuredOmega << 0, 0.1, 0;//M_PI/10.0+0.3; + Vector3 measuredAcc; measuredAcc << 0,1.1,-9.81; double deltaT = 0.001; Matrix I6x6(6,6);