fixup noisemodel so its correct dimension

release/4.3a0
Asa Hammond 2021-02-25 18:38:45 -08:00
parent d7c565d885
commit 78b92e0fbc
1 changed files with 1 additions and 1 deletions

View File

@ -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);