diff --git a/cpp/dataset.cpp b/cpp/dataset.cpp index 758693204..92dede565 100644 --- a/cpp/dataset.cpp +++ b/cpp/dataset.cpp @@ -114,7 +114,7 @@ pair 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 !