From fa38b1ad5c981b4e49da255667eb071e27bbea34 Mon Sep 17 00:00:00 2001 From: Silvan Fuhrer Date: Mon, 15 May 2023 10:59:48 +0200 Subject: [PATCH] TECS: init _velocity_control_traj_generator properly Signed-off-by: Silvan Fuhrer --- src/lib/tecs/TECS.cpp | 1 + 1 file changed, 1 insertion(+) diff --git a/src/lib/tecs/TECS.cpp b/src/lib/tecs/TECS.cpp index 717a33f657..5b6f5f2ffc 100644 --- a/src/lib/tecs/TECS.cpp +++ b/src/lib/tecs/TECS.cpp @@ -211,6 +211,7 @@ void TECSAltitudeReferenceModel::initialize(const AltitudeReferenceState &state) const float init_state_alt_rate = PX4_ISFINITE(state.alt_rate) ? state.alt_rate : 0.f; _alt_control_traj_generator.reset(0.0f, init_state_alt_rate, init_state_alt); + _velocity_control_traj_generator.reset(0.f, init_state_alt_rate, init_state_alt); } void TECSControl::initialize(const Setpoint &setpoint, const Input &input, Param ¶m, const Flag &flag)