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;
|
||||
|
||||
|
||||
measured = Pose2(x, y, yaw);
|
||||
measured = inverse(Pose2(x, y, yaw));
|
||||
|
||||
// SharedGaussian noise = noiseModel::Gaussian::Covariance(m, smart);
|
||||
// hack use diagonal for now !
|
||||
|
|
|
|||
Loading…
Reference in New Issue