Skip to content

armgit / flix

Public Imported from GitHub
0

Making an ESP32-based quadcopter from scratch

Remove dt multiplier from acc correction and increase acc weight More classical complementary filter implementation Increase effective accelerometer weight for faster convergence

Oleg Kalachevbda44fca0298
diff --git a/flix/estimate.ino b/flix/estimate.ino
index fa8c306..8bcdf97 100644
--- a/flix/estimate.ino
+++ b/flix/estimate.ino
@@ -8,7 +8,7 @@
#include "lpf.h"
#include "util.h"
-#define WEIGHT_ACC 0.5f
+#define WEIGHT_ACC 0.003
#define RATES_LFP_ALPHA 0.2 // cutoff frequency ~ 40 Hz
LowPassFilter<Vector> ratesFilter(RATES_LFP_ALPHA);
@@ -35,7 +35,7 @@ void applyAcc() {
// calculate accelerometer correction
Vector up = attitude.rotateVector(Vector(0, 0, 1));
- Vector correction = Vector::angularRatesBetweenVectors(acc, up) * dt * WEIGHT_ACC;
+ Vector correction = Vector::angularRatesBetweenVectors(acc, up) * WEIGHT_ACC;
// apply correction
attitude = attitude.rotate(Quaternion::fromAngularRates(correction));