diff --git a/src/mavextra/mymavextra.js b/src/mavextra/mymavextra.js index fe49af4b8..eee2e3116 100644 --- a/src/mavextra/mymavextra.js +++ b/src/mavextra/mymavextra.js @@ -20,5 +20,29 @@ window.angle_diff = (angle1, angle2) => { return ret } +// eslint-disable-next-line camelcase +window.wrap_360 = (angle) => { + let ret = angle + if (ret > 360) { + ret -= 360 + } + if (ret < 0) { + ret += 360 + } + return ret +} + +// eslint-disable-next-line camelcase +window.wrap_180 = (angle) => { + let ret = angle + if (ret > 180) { + ret -= 360 + } + if (ret < -180) { + ret += 360 + } + return ret +} + window.min = Math.min window.max = Math.max