removed displacement too small warning when the robot is not moving

This commit is contained in:
Mathieu Labbe
2015-02-17 18:54:08 -05:00
parent dcee7ef2e2
commit 22f2246a05
+5 -6
View File
@@ -960,12 +960,7 @@ void CoreWrapper::process(
odomVariance,
id);
if(!rtabmap_.process(data))
{
timeRtabmap = timer.ticks();
ROS_WARN("RTAB-Map could not process the data received! (ROS id = %d)", id);
}
else
if(rtabmap_.process(data))
{
timeRtabmap = timer.ticks();
mapToOdomMutex_.lock();
@@ -1029,6 +1024,10 @@ void CoreWrapper::process(
}
}
}
else
{
timeRtabmap = timer.ticks();
}
ROS_INFO("rtabmap: Update rate=%fs, Limit=%fs, RTAB-Map=%fs, Publish=%fs (%d local nodes)",
1.0f/rate_,
rtabmap_.getTimeThreshold()/1000.0f,