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