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