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

fixed #536

Browse Source
This commit is contained in:
matlabbe
2021-02-12 15:25:15 -05:00
parent e7567cc3b9
commit d4651d1fe0
1 changed files with 1 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/CoreWrapper.cpp
+1 -5
View File
@@ -2102,11 +2102,7 @@ void CoreWrapper::process(
std::map<int, float> nodes = graph::findNearestNodes(filteredPoses, mapToOdom_*odom, maxMappingNodes_);
for(std::map<int, float>::iterator iter=nodes.begin(); iter!=nodes.end(); ++iter)
{
std::map<int, Transform>::iterator pter = filteredPoses.find(iter->first);
if(pter != filteredPoses.end())
{
nearestPoses.insert(*pter);
}
nearestPoses.insert(*filteredPoses.find(iter->first));
}
//add latest/zero and make sure those on a planned path are not filtered
std::set<int> onPath;