mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-07 02:07:45 +08:00
Fixed last scan drifting in maps created when not optimizing from the last node
This commit is contained in:
+1
-1
@@ -1232,7 +1232,7 @@ void CoreWrapper::process(
|
||||
SensorData tmpData = data;
|
||||
tmpData.setId(-1);
|
||||
tmpSignature.insert(std::make_pair(-1, Signature(-1, -1, 0, data.stamp(), "", odom, tmpData)));
|
||||
filteredPoses.insert(std::make_pair(-1, odom));
|
||||
filteredPoses.insert(std::make_pair(-1, rtabmap_.getMapCorrection()*odom));
|
||||
|
||||
// Update maps
|
||||
filteredPoses = mapsManager_.updateMapCaches(
|
||||
|
||||
Reference in New Issue
Block a user