diff --git a/rtabmap_odom/src/OdometryROS.cpp b/rtabmap_odom/src/OdometryROS.cpp index 3a77d19e..b0277010 100644 --- a/rtabmap_odom/src/OdometryROS.cpp +++ b/rtabmap_odom/src/OdometryROS.cpp @@ -1043,7 +1043,7 @@ void OdometryROS::processData(SensorData & data, const std_msgs::Header & header { double curentRate = 1.0/(ros::WallTime::now()-time).toSec(); syncDiagnostic_->tick(header.stamp, - maxUpdateRate_>0 && maxUpdateRate_ < curentRate ? maxUpdateRate_: + maxUpdateRate_>0 ? maxUpdateRate_: expectedUpdateRate_>0 && expectedUpdateRate_ < curentRate ? expectedUpdateRate_: previousStamp_ == 0.0 || header.stamp.toSec() - previousStamp_ > 1.0/curentRate?0:curentRate); }