diff --git a/src/mpc_tracker/mpc_tracker.cpp b/src/mpc_tracker/mpc_tracker.cpp index 0d35878..a2043a8 100644 --- a/src/mpc_tracker/mpc_tracker.cpp +++ b/src/mpc_tracker/mpc_tracker.cpp @@ -1037,6 +1037,8 @@ std::optional 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_);