i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-05 17:27:46 +08:00
Code Issues Packages Projects Releases Wiki Activity

MapOptimizer: fixed a crash when optimizing a global map received

Browse Source
This commit is contained in:
matlabbe
2015-07-19 20:20:26 -04:00
parent 93c5b60c04
commit de98828dc3
1 changed files with 1 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/MapOptimizerNode.cpp
+1 -3
View File
@@ -194,7 +194,6 @@ public:
}
}
}
// Optimize only if there is a subscriber
if(mapDataPub_.getNumSubscribers())
{
@@ -214,9 +213,8 @@ public:
posesOut,
linksOut);
optimizedPoses = optimizer.optimize(fromId, posesOut, linksOut);
mapToOdomMutex_.lock();
mapCorrection = optimizedPoses.at(poses.rbegin()->first) * poses.rbegin()->second.inverse();
mapCorrection = optimizedPoses.at(posesOut.rbegin()->first) * posesOut.rbegin()->second.inverse();
mapToOdom_ = mapCorrection;
mapToOdomMutex_.unlock();
}