From 6e0f29b08a040d14576d7053c1206a8439936570 Mon Sep 17 00:00:00 2001 From: yy1717 <fctom1215@outlook.com> Date: 星期二, 24 十一月 2020 14:18:03 +0800 Subject: [PATCH] 坐标 --- lib/src/main/cpp/test_common/Geometry.cpp | 13 +++++++++++++ 1 files changed, 13 insertions(+), 0 deletions(-) diff --git a/lib/src/main/cpp/test_common/Geometry.cpp b/lib/src/main/cpp/test_common/Geometry.cpp index 03c9d4b..bc05767 100644 --- a/lib/src/main/cpp/test_common/Geometry.cpp +++ b/lib/src/main/cpp/test_common/Geometry.cpp @@ -358,6 +358,19 @@ return deg; } +double DeltaYaw(double yaw1, double yaw2) +{ + double deltaAng; + + if (fabs(yaw1 - yaw2) > 180.0) { + deltaAng = 360.0 - fabs(yaw1 - yaw2); + } else { + deltaAng = fabs(yaw1 - yaw2); + } + + return deltaAng; +} + /********************************************************** * base 鍜� dest鐨勭浜岀偣閲嶅悎鏃跺舰鎴愮殑澶硅 * @param base -- Gitblit v1.8.0