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

atune: initialize filter if not already initialized

Browse Source
This commit is contained in:
bresch 2023-11-16 17:31:33 +01:00 committed by Daniel Agar
parent 62027b0965
commit 2110eae25d
2 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/modules/fw_autotune_attitude_control/fw_autotune_attitude_control.cpp
View File

@ -229,7 +229,7 @@ void FwAutotuneAttitudeControl::checkFilters()
reset_filters = true;
}
if (reset_filters) {
if (reset_filters || !_are_filters_initialized) {
_are_filters_initialized = true;
_filter_sample_rate = update_rate_hz;
_sys_id.setLpfCutoffFrequency(_filter_sample_rate, _param_imu_gyro_cutoff.get());

2
src/modules/mc_autotune_attitude_control/mc_autotune_attitude_control.cpp
View File

@ -236,7 +236,7 @@ void McAutotuneAttitudeControl::checkFilters()
reset_filters = true;
}
if (reset_filters && !_are_filters_initialized) {
if (reset_filters || !_are_filters_initialized) {
_filter_dt = _sample_interval_avg;
const float filter_rate_hz = 1.f / _filter_dt;