mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-03 16:27:46 +08:00
Odom: reset buffered guess only after when we recovered from being lost
This commit is contained in:
+1
-1
@@ -630,9 +630,9 @@ void OdometryROS::processData(const SensorData & data, const ros::Time & stamp)
|
||||
dataCpy.setGroundTruth(groundTruth);
|
||||
}
|
||||
rtabmap::Transform pose = odometry_->process(dataCpy, guess_, &info);
|
||||
guess_.setNull();
|
||||
if(!pose.isNull())
|
||||
{
|
||||
guess_.setNull();
|
||||
resetCurrentCount_ = resetCountdown_;
|
||||
|
||||
//*********************
|
||||
|
||||
Reference in New Issue
Block a user