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

atune: use butterworth 1st order hpf

Browse Source 
Equations from: R. Allred, Digital Filters for Everyone
This commit is contained in:
bresch
2024-01-24 10:03:52 +01:00
parent 1b4815cd98
commit 825c11fc8a
3 changed files with 5 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/system_identification/system_identification.cpp
+2 -2
View File
@@ -79,8 +79,8 @@ void SystemIdentification::updateFilters(float u, float y)
const float u_lpf = _u_lpf.apply(u);
const float y_lpf = _y_lpf.apply(y);
_u_hpf = _alpha_hpf * _u_hpf + _alpha_hpf * (u_lpf - _u_prev);
_y_hpf = _alpha_hpf * _y_hpf + _alpha_hpf * (y_lpf - _y_prev);
_u_hpf = u_lpf - _u_prev - (_gamma_hpf - 1.f) * _u_hpf;
_y_hpf = y_lpf - _y_prev - (_gamma_hpf - 1.f) * _y_hpf;
_u_prev = u_lpf;
_y_prev = y_lpf;