Add generic Delay filter

This commit is contained in:
Oleg Kalachev
2025-10-17 19:19:27 +03:00
parent 253aae2220
commit 186cf88d84
2 changed files with 23 additions and 3 deletions
+2 -3
View File
@@ -49,9 +49,8 @@ void rotateIMU(Vector& data) {
}
void calibrateGyroOnce() {
static float landedTime = 0;
landedTime = landed ? landedTime + dt : 0;
if (landedTime < 2) return; // calibrate only if definitely stationary
static Delay landedDelay(2);
if (!landedDelay.update(landed)) return; // calibrate only if definitely stationary
static LowPassFilter<Vector> gyroCalibrationFilter(0.001);
gyroBias = gyroCalibrationFilter.update(gyro);