One more fix, inverse was actually needed in one case.
parent
b82d054aaa
commit
9b62b326c9
|
|
@ -114,7 +114,7 @@ pair<sharedPose2Graph, sharedPose2Config> load2D(const string& filename,
|
||||||
if (maxID && (id1 >= maxID || id2 >= maxID)) continue;
|
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);
|
// SharedGaussian noise = noiseModel::Gaussian::Covariance(m, smart);
|
||||||
// hack use diagonal for now !
|
// hack use diagonal for now !
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue