diff --git a/src/Map.cpp b/src/Map.cpp index 3a7d681..66b0535 100644 --- a/src/Map.cpp +++ b/src/Map.cpp @@ -948,7 +948,8 @@ void Map::loadLocalGraph(SlamOptimizer &optimizer) int id1 = it - mLocalGraphKFs.begin(); { - Eigen::Map info(meas.cov); + Eigen::Map meas_cov(meas.cov); + Eigen::Matrix3d info = meas_cov.inverse(); addEdgeSE2(optimizer, Vector3D(meas.meas), i, id1, info); }