From 78b92e0fbc675b4c61b48f93e28b60d7cacfe22c Mon Sep 17 00:00:00 2001 From: Asa Hammond Date: Thu, 25 Feb 2021 18:38:45 -0800 Subject: [PATCH] fixup noisemodel so its correct dimension --- gtsam/navigation/tests/testConstantVelocityFactor.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/gtsam/navigation/tests/testConstantVelocityFactor.cpp b/gtsam/navigation/tests/testConstantVelocityFactor.cpp index ca731f404..5bc2599c3 100644 --- a/gtsam/navigation/tests/testConstantVelocityFactor.cpp +++ b/gtsam/navigation/tests/testConstantVelocityFactor.cpp @@ -49,7 +49,7 @@ TEST(ConstantVelocityFactor, VelocityFactor) { const auto state2 = NavState{Pose3{Rot3::Yaw(0), Point3{0.0, 0.0, 2.0}}, Velocity3{0.0, 0.0, 1.0}}; const double mu{1000}; - const auto noise_model = noiseModel::Constrained::All(3, mu); + const auto noise_model = noiseModel::Constrained::All(9, mu); const auto factor = ConstantVelocityFactor(x1, x2, dt, noise_model);