diff --git a/src/ros_filter.cpp b/src/ros_filter.cpp index fe4b22cc8..93cc4e783 100644 --- a/src/ros_filter.cpp +++ b/src/ros_filter.cpp @@ -1967,7 +1967,7 @@ void RosFilter::poseCallback( } // Make sure this message is newer than the last one - if (last_message_times_[topic_name] <= msg->header.stamp) { + if (last_message_times_[topic_name] < msg->header.stamp) { RF_DEBUG( "Update vector for " << topic_name << " is:\n" << callback_data.update_vector_);