vtol_att_control: limit excessive scheduling

src/modules/vtol_att_control/vtol_att_control_main.cpp

@@ -51,6 +51,7 @@
 #include <uORB/Publication.hpp>
 
 using namespace matrix;
+using namespace time_literals;
 
 VtolAttitudeControl::VtolAttitudeControl() :
 	WorkItem(MODULE_NAME, px4::wq_configurations::rate_ctrl),
@@ -342,6 +343,15 @@ VtolAttitudeControl::Run()
 		return;
 	}
 
+	const hrt_abstime now = hrt_absolute_time();
+
+	// prevent excessive scheduling (> 500 Hz)
+	if (now - _last_run_timestamp < 2_ms) {
+		return;
+	}
+
+	_last_run_timestamp = now;
+
 	if (!_initialized) {
 		parameters_update();  // initialize parameter cache
 

src/modules/vtol_att_control/vtol_att_control_main.h

@@ -213,6 +213,8 @@ class VtolAttitudeControl : public ModuleBase<VtolAttitudeControl>, public px4::
 		param_t mpc_land_alt2;
 	} _params_handles{};
 
+	hrt_abstime _last_run_timestamp{0};
+
 	/* for multicopters it is usual to have a non-zero idle speed of the engines
 	 * for fixed wings we want to have an idle speed of zero since we do not want
 	 * to waste energy when gliding. */