added warning

ctu-mrs · Aug 23, 2023 · cefafaf · cefafaf
1 parent b740a5c
commit cefafaf
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/src/mpc_tracker/mpc_tracker.cpp b/src/mpc_tracker/mpc_tracker.cpp
@@ -1037,6 +1037,8 @@ std::optional<mrs_msgs::TrackerCommand> MpcTracker::update(const mrs_msgs::UavSt
 
   if (dt > 0) {
     iterateModel(dt);
+  } else {
+    ROS_WARN_THROTTLE(1.0, "[MpcTracker]: dt !> 0, not iterating the model");
   }
 
   auto [mpc_x, mpc_x_heading] = mrs_lib::get_mutexed(mutex_mpc_x_, mpc_x_, mpc_x_heading_);