From 539bdbbebc2410bbad25af01d9088594d02c95b0 Mon Sep 17 00:00:00 2001
From: yy1717 <fctom1215@outlook.com>
Date: 星期三, 12 八月 2020 18:45:58 +0800
Subject: [PATCH] 坐标
---
lib/src/main/cpp/driver_test.cpp | 18 ++++++++++++++++++
1 files changed, 18 insertions(+), 0 deletions(-)
diff --git a/lib/src/main/cpp/driver_test.cpp b/lib/src/main/cpp/driver_test.cpp
index b43d9a2..9c60b10 100644
--- a/lib/src/main/cpp/driver_test.cpp
+++ b/lib/src/main/cpp/driver_test.cpp
@@ -304,6 +304,24 @@
DEBUG("SetCarMeasurePoint Calc Over");
}
+/***********************************************
+ * TIME1 - TIME2: millisecond
+ * @param rtkTime1
+ * @param rtkTime2
+ * @return
+ */
+uint32_t TimeGetDiff(const struct RtkTime *rtkTime1, const struct RtkTime *rtkTime2)
+{
+ if (rtkTime1->YY == rtkTime2->YY && rtkTime1->MM == rtkTime2->MM && rtkTime1->DD == rtkTime2->DD) {
+ return TimeGetDiff(rtkTime1->hh, rtkTime1->mm, rtkTime1->ss, rtkTime1->mss*10,
+ rtkTime2->hh, rtkTime2->mm, rtkTime2->ss, rtkTime2->mss*10);
+ } else {
+ return (TimeMakeComposite(rtkTime1->YY, rtkTime1->MM, rtkTime1->DD, rtkTime1->hh, rtkTime1->mm, rtkTime1->ss) -
+ TimeMakeComposite(rtkTime2->YY, rtkTime2->MM, rtkTime2->DD, rtkTime2->hh, rtkTime2->mm, rtkTime2->ss)) * 1000
+ + (1000 + rtkTime1->mss*10 - rtkTime2->mss*10) % 1000;
+ }
+}
+
void SetDummyLightExam(int n, struct dummy_light_exam *cfg)
{
DEBUG("鑾峰彇妯℃嫙璺�冪伅鍏夋祴璇曢」鐩� N = %d %d", n, ExamStart);
--
Gitblit v1.8.0