One more fix, inverse was actually needed in one case.

release/4.3a0
Richard Roberts 2010-01-26 20:10:45 +00:00
parent b82d054aaa
commit 9b62b326c9
1 changed files with 1 additions and 1 deletions

View File

@ -114,7 +114,7 @@ pair<sharedPose2Graph, sharedPose2Config> load2D(const string& filename,
if (maxID && (id1 >= maxID || id2 >= maxID)) continue;
measured = Pose2(x, y, yaw);
measured = inverse(Pose2(x, y, yaw));
// SharedGaussian noise = noiseModel::Gaussian::Covariance(m, smart);
// hack use diagonal for now !