12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

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
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
gtsam/navigation/tests/testConstantVelocityFactor.cpp
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 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 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); const auto factor = ConstantVelocityFactor(x1, x2, dt, noise_model);