From 53be5cac481ddc7927ca3f8fe75a5180f0d6567a Mon Sep 17 00:00:00 2001
From: fctom1215 <fctom1215@outlook.com>
Date: 星期五, 27 三月 2020 00:16:33 +0800
Subject: [PATCH] 角度修正。

---
 lib/src/main/cpp/test_items2/stop_car.cpp |   18 +++++++++++-------
 1 files changed, 11 insertions(+), 7 deletions(-)

diff --git a/lib/src/main/cpp/test_items2/stop_car.cpp b/lib/src/main/cpp/test_items2/stop_car.cpp
index 6629623..4e93662 100644
--- a/lib/src/main/cpp/test_items2/stop_car.cpp
+++ b/lib/src/main/cpp/test_items2/stop_car.cpp
@@ -61,9 +61,9 @@
 
 void StopCarTTSDone(int id)
 {
-    DEBUG("StopCarTTSDone %d", id);
     // 绛夎闊虫挱鎶ュ畬姣曞悗璁℃椂
     if (id == examTtsSeq) {
+        DEBUG("StopCarTTSDone %d", id);
         ttsPlayEnd = 1;
     }
 }
@@ -88,14 +88,16 @@
                                 rtkTime->mss * 10,
                                 prevPointTime.hour, prevPointTime.min,
                                 prevPointTime.sec, prevPointTime.msec * 10);
-
-    moveDistance += (double)diff * (speed + prevSpeed) / 2;
-    prevSpeed = speed;
-    Rtk2DriveTimer(prevPointTime, rtkTime);
+    if (diff >= D_SEC(1)) {
+        moveDistance += (double)diff * (speed + prevSpeed) / 2.0 / 1000.0;
+        prevSpeed = speed;
+        Rtk2DriveTimer(prevPointTime, rtkTime);
+        DEBUG("鍋滆溅宸茶椹惰窛绂� %f", moveDistance);
+    }
 
     if (moveDistance > 150) {
         // 150绫冲唴鏈仠杞︼紝涓嶅悎鏍�
-        DEBUG("鍋滆溅璺濈瓒呮爣");
+        DEBUG("鍋滆溅璺濈瓒呮爣锛岄潬杈瑰仠杞︾粨鏉�");
         AddExamFault(33, rtkTime);
         return -1;
     }
@@ -103,7 +105,7 @@
     if (moveDirect != prevMoveDirect) {
         if (moveDirect == 0) {
             stopTimepoint = TimeMakeComposite(rtkTime->hh, rtkTime->mm, rtkTime->ss, rtkTime->mss*10);
-            DEBUG("鍋滆溅浜� %d %d %d %d %d %d %d", rtkTime->YY, rtkTime->MM, rtkTime->DD, rtkTime->hh, rtkTime->mm, rtkTime->ss, rtkTime->mss);
+            DEBUG("####### 闈犺竟鍋滆溅锛屽仠杞︿簡 %d %d %d %d %d %d %d ######", rtkTime->YY, rtkTime->MM, rtkTime->DD, rtkTime->hh, rtkTime->mm, rtkTime->ss, rtkTime->mss);
         }
         prevMoveDirect = moveDirect;
     } else if (moveDirect == 0) {
@@ -189,6 +191,7 @@
             }
         }
     } else if (occurOpenDoor) {
+        DEBUG("寮�杞﹂棬锛岄潬杈瑰仠杞︾粨鏉�");
         return -1;
     }
 
@@ -196,6 +199,7 @@
         uint32_t tp = TimeMakeComposite(rtkTime->hh, rtkTime->mm, rtkTime->ss, rtkTime->mss*10);
 
         if (tp - openDoorTimepoint >= OPEN_DOOR_TIMEOUT + D_SEC(5)) {
+            DEBUG("寮�闂ㄦ椂闂村ぇ浜�20绉掞紝闈犺竟鍋滆溅缁撴潫");
             return -1;
         }
     }

--
Gitblit v1.8.0