create angle_diff() function

ArduPilot · Apr 17, 2024 · f84b0eb · f84b0eb
1 parent 2b5aa4d
commit f84b0eb
Showing 1 changed file with 11 additions and 0 deletions.
diff --git a/src/mavextra/mymavextra.js b/src/mavextra/mymavextra.js
@@ -7,3 +7,14 @@ window.named = (NAMED_VALUE_FLOAT, key) => {
     }
     return null
 }
+
+window.angle_diff = (angle1, angle2) => {
+    let ret = angle1 - angle2
+    if (ret > 180) {
+        ret -= 360
+    }
+    if (ret < -180) {
+        ret += 360
+    }
+    return ret
+}