fix(ekf_localizer): fix bug in autowarefoundation#5054 (autowarefound…

…ation#5066) * fix(ekf_localizer): fix bug in autowarefoundation#5054 Signed-off-by: kminoda <[email protected]> * fix bug Signed-off-by: kminoda <[email protected]> --------- Signed-off-by: kminoda <[email protected]>
tier4 · Sep 22, 2023 · c6001e9 · c6001e9
1 parent 6a81ed5
commit c6001e9
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/localization/ekf_localizer/src/ekf_localizer.cpp b/localization/ekf_localizer/src/ekf_localizer.cpp
@@ -387,7 +387,7 @@ void EKFLocalizer::callbackTwistWithCovariance(
 {
   // Ignore twist if velocity is too small.
   // Note that this inequality must not include "equal".
-  if (msg->twist.twist.linear.x < params_.threshold_observable_velocity_mps) {
+  if (std::abs(msg->twist.twist.linear.x) < params_.threshold_observable_velocity_mps) {
     msg->twist.covariance[0 * 6 + 0] = 10000.0;
   }
   twist_queue_.push(msg);