New equation (#410)

Improved tilt calculation
universam1 · Nov 10, 2020 · c0c8447 · c0c8447
1 parent 2054d44
commit c0c8447
Showing 1 changed file with 1 addition and 3 deletions.
diff --git a/pio/src/iSpindel.cpp b/pio/src/iSpindel.cpp
@@ -845,9 +845,7 @@ float calculateTilt()
   float _ax = ax;
   float _ay = ay;
   float _az = az;
-  float pitch = (atan2(_ay, sqrt(_ax * _ax + _az * _az))) * 180.0 / M_PI;
-  float roll = (atan2(_ax, sqrt(_ay * _ay + _az * _az))) * 180.0 / M_PI;
-  return sqrt(pitch * pitch + roll * roll);
+  return acos(_az / (sqrt(_ax * _ax + _ay * _ay + _az * _az))) * 180.0 / M_PI;
 }
 
 bool testAccel()