Skip to content

armgit / flix

Public Imported from GitHub
0

Making an ESP32-based quadcopter from scratch

Remove LED horizontality signalization It's better to control the attitude estimation using QGC

Oleg Kalachev2fdad7bdb643
diff --git a/flix/estimate.ino b/flix/estimate.ino
index ed6506a..cf63ee3 100644
--- a/flix/estimate.ino
+++ b/flix/estimate.ino
@@ -16,7 +16,6 @@ LowPassFilter<Vector> ratesFilter(RATES_LFP_ALPHA);
void estimate() {
applyGyro();
applyAcc();
- signalizeHorizontality();
}
void applyGyro() {
@@ -43,8 +42,3 @@ void applyAcc() {
attitude *= Quaternion::fromAngularRates(correction);
attitude.normalize();
}
-
-void signalizeHorizontality() {
- float angle = Vector::angleBetweenVectors(attitude.rotate(Vector(0, 0, 1)), Vector(0, 0, 1));
- setLED(angle < radians(15));
-}
diff --git a/gazebo/flix.h b/gazebo/flix.h
index f405f10..c4cbe63 100644
--- a/gazebo/flix.h
+++ b/gazebo/flix.h
@@ -34,7 +34,6 @@ Quaternion attitude;
void computeLoopFreq();
void applyGyro();
void applyAcc();
-void signalizeHorizontality();
void control();
void interpretRC();
void controlAttitude();