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

ExternalLoopExample: adding all nodes from all sessions in cache

Browse Source
This commit is contained in:
matlabbe
2020-06-25 13:55:07 -04:00
parent 83c40d079d
commit 8186dd6dc8
1 changed files with 8 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/ExternalLoopDetectionExample.cpp
+8 -11
View File
@@ -201,18 +201,15 @@ int main(int argc, char** argv)
int addedNodes = 0;
for(size_t i=0; i<mapRes.data.nodes.size(); ++i)
{
if(poses.find(mapRes.data.nodes.at(i).id) != poses.end())
rtabmap::Signature s = rtabmap_ros::nodeDataFromROS(mapRes.data.nodes.at(i));
rtabmap::SensorData compressedData = s.sensorData();
s.sensorData().uncompressData();
if(loopClosureDetector.process(s.sensorData(), rtabmap::Transform()))
{
rtabmap::Signature s = rtabmap_ros::nodeDataFromROS(mapRes.data.nodes.at(i));
rtabmap::SensorData compressedData = s.sensorData();
s.sensorData().uncompressData();
if(loopClosureDetector.process(s.sensorData(), rtabmap::Transform()))
{
localData.insert(std::make_pair(
loopClosureDetector.getStatistics().getLastSignatureData().id(),
compressedData));
++addedNodes;
}
localData.insert(std::make_pair(
loopClosureDetector.getStatistics().getLastSignatureData().id(),
compressedData));
++addedNodes;
}
}
ROS_INFO("Added %d/%d nodes to memory! Vocabulary size=%d",