ControlAllocator: only run allocator on torque updates, not thrust

Signed-off-by: Silvan <silvan@auterion.com>
This commit is contained in:
Silvan 2025-06-02 14:25:54 +02:00 committed by Ramon Roche
parent f0b05ea7cf
commit 66fe3aa2b3

View File

@ -390,15 +390,8 @@ ControlAllocator::Run()
}
// Also run allocator on thrust setpoint changes if the torque setpoint
// has not been updated for more than 5ms
if (_vehicle_thrust_setpoint_sub.update(&vehicle_thrust_setpoint)) {
_thrust_sp = matrix::Vector3f(vehicle_thrust_setpoint.xyz);
if (dt > 0.005f) {
do_update = true;
_timestamp_sample = vehicle_thrust_setpoint.timestamp_sample;
}
}
if (do_update) {