Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-08 17:08:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

Filter: Increase gain modifier action

Browse Source
This commit is contained in:
Paul Riseborough 2021-04-11 08:19:24 +10:00 committed by Andrew Tridgell
parent 458c46353d
commit 6e6df3df58
2 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/Filter/SlewLimiter.cpp
View File

@ -119,7 +119,7 @@ float SlewLimiter::modifier(float sample, float dt)
// Calculate the gain adjustment
float mod;
if (_oscillation_slew_rate > slew_rate_max) {
mod = slew_rate_max / _oscillation_slew_rate;
mod = slew_rate_max / (slew_rate_max + MODIFIER_GAIN * (_oscillation_slew_rate - slew_rate_max));
} else {
mod = 1.0f;
}

1
libraries/Filter/SlewLimiter.h
View File

@ -10,6 +10,7 @@
#define N_EVENTS 2 // number of positive and negative consecutive slew rate exceedance events recorded where a value of 2 corresponds to a complete cycle
#define WINDOW_MS 250 // time in msec required for a half cycle of the slowest oscillation frequency expected
#define MODIFIER_GAIN 1.5f // ratio of modifier reduction to slew rate exceedance ratio
class SlewLimiter {
public: