Include new angle_diff calculation code (shortened a statement)

Co-authored-by: sigonasr2 <sigonasr2@gmail.com>
2 years ago · f47d7703a1
parent 722d293fb8
commit f47d7703a1
1 changed files with 7 additions and 10 deletions
--- a/main.cpp
+++ b/main.cpp
@ -14,16 +14,13 @@ float angle_difference(float angle_1, float angle_2)
 {
    angle_1=(angle_1<0)?angle_1+360:fmod(angle_1,360);
    angle_2=(angle_2<0)?angle_2+360:fmod(angle_2,360);
-    float angle_diff = angle_1-angle_2;
-    if (abs(angle_diff)>180) {
-        if (angle_1>180) {
-            angle_1-=360;
-        }
-        if (angle_2>180) {
-            angle_2-=360;
-        }
-        angle_diff = angle_1-angle_2;
-    }
+    float angle_diff = angle_1 - angle_2;
+
+    if (angle_diff > 180)
+      angle_diff -= 360;
+    else if (angle_diff < -180)
+      angle_diff += 360;
+
    return -angle_diff;
 }