TECS: init _velocity_control_traj_generator properly

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer
2023-05-15 10:59:48 +02:00
committed by bresch
parent 20ab4ccaca
commit fa38b1ad5c
+1
View File
@@ -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 &param, const Flag &flag)