Odom: reset buffered guess only after when we recovered from being lost

This commit is contained in:
matlabbe
2020-04-26 23:28:13 -04:00
parent dff012718e
commit f034bf4e91
+1 -1
View File
@@ -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_;
//*********************