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 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();