fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-14 17:17:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

FWLatLongControl: call updateParameters() before using performance params

Browse Source 
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer
2025-05-20 13:29:53 +02:00
parent 5b7d78d54f
commit 23a4854e82
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/fw_lateral_longitudinal_control/FwLateralLongitudinalControl.cpp
+3 -3
View File
@@ -85,6 +85,9 @@ void
FwLateralLongitudinalControl::parameters_update()
{
updateParams();
_performance_model.updateParameters();
_performance_model.runSanityChecks();
_tecs.set_max_climb_rate(_performance_model.getMaximumClimbRate(_air_density));
_tecs.set_max_sink_rate(_param_fw_t_sink_max.get());
_tecs.set_min_sink_rate(_performance_model.getMinimumSinkRate(_air_density));
@@ -108,9 +111,6 @@ FwLateralLongitudinalControl::parameters_update()
_tecs.set_airspeed_rate_measurement_std_dev(_param_speed_rate_standard_dev.get());
_tecs.set_airspeed_filter_process_std_dev(_param_process_noise_standard_dev.get());
_performance_model.runSanityChecks();
_performance_model.updateParameters();
_roll_slew_rate.setSlewRate(radians(_param_fw_pn_r_slew_max.get()));
_tecs_alt_time_const_slew_rate.setSlewRate(TECS_ALT_TIME_CONST_SLEW_RATE);