atune: initialize filter if not already initialized

PX4 · Nov 17, 2023 · 2110eae · 2110eae
1 parent 62027b0
commit 2110eae
Show file tree

Hide file tree

Showing 2 changed files with 2 additions and 2 deletions.
diff --git a/src/modules/fw_autotune_attitude_control/fw_autotune_attitude_control.cpp b/src/modules/fw_autotune_attitude_control/fw_autotune_attitude_control.cpp
@@ -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());

diff --git a/src/modules/mc_autotune_attitude_control/mc_autotune_attitude_control.cpp b/src/modules/mc_autotune_attitude_control/mc_autotune_attitude_control.cpp
@@ -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;