added limit for async loop rate

ctu-mrs · Aug 23, 2023 · b740a5c · b740a5c
1 parent 95c1d09
commit b740a5c
Showing 1 changed file with 5 additions and 0 deletions.
diff --git a/src/mpc_tracker/mpc_tracker.cpp b/src/mpc_tracker/mpc_tracker.cpp
@@ -453,6 +453,11 @@ bool MpcTracker::initialize(const ros::NodeHandle& nh, std::shared_ptr<mrs_uav_m
   param_loader.loadParam(yaml_prefix + "mpc_loop/synchronous_rate_limit", _mpc_synchronous_rate_limit_);
   param_loader.loadParam(yaml_prefix + "mpc_loop/asynchronous_loop_rate", _mpc_asynchronous_rate_);
 
+  if (_mpc_asynchronous_rate_ < 15) {
+    ROS_ERROR("[MpcTracker]: the asynchronous_loop_rate must be > 15 Hz");
+    return false;
+  }
+
   dt1_ = 1.0 / _mpc_asynchronous_rate_;
 
   param_loader.loadParam(yaml_prefix + "braking/enabled", drs_params_.braking_enabled);