Making an ESP32-based quadcopter from scratch
Python arduinoautopilotcontrol-theorydroneesp32flight-controlflight-controllermavlinkquadcopterquadcopter-firmwareuav
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.inoindex 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 HzLowPassFilter<Vector> ratesFilter(RATES_LFP_ALPHA);@@ -35,7 +35,7 @@ void applyAcc() {// calculate accelerometer correctionVector 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 correctionattitude = attitude.rotate(Quaternion::fromAngularRates(correction));