Localization mode: fixed errors when planning, fixed localization from last node, fixed localization flickers when memory management is running

This commit is contained in:
matlabbe
2015-09-29 23:48:05 -04:00
parent 3fa6124ad0
commit fccaa11de1
3 changed files with 153 additions and 137 deletions

View File

@@ -234,8 +234,8 @@ private:
std::map<int, Transform> _optimizedPoses;
std::multimap<int, Link> _constraints;
Transform _mapCorrection;
Transform _mapTransform; // for localization mode
Transform _lastLocalizationPose; // for localization mode
int _lastLocalizationNodeId; // for localization mode
// Planning stuff
int _pathStatus;