From dc6a7d446f645e9b2a4c3d8948dce43c159f5517 Mon Sep 17 00:00:00 2001
From: Takatoshi Sato <takatoshi6321@gmail.com>
Date: Sun, 9 Apr 2023 18:08:49 +0900
Subject: [PATCH] Fix to avoid dt = 0

---
 src/ros_filter.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

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<T>::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_);