From f84b0eb34ab7e35991867cf390ae77b1818f2b71 Mon Sep 17 00:00:00 2001 From: Willian Galvani Date: Wed, 17 Apr 2024 12:25:24 -0300 Subject: [PATCH] create angle_diff() function --- src/mavextra/mymavextra.js | 11 +++++++++++ 1 file changed, 11 insertions(+) diff --git a/src/mavextra/mymavextra.js b/src/mavextra/mymavextra.js index 5bdfc7b9..cbcf684d 100644 --- 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 +}