From 4bd08f0355b6b2cf3c027202d5ad301b4e182953 Mon Sep 17 00:00:00 2001
From: yy1717 <fctom1215@outlook.com>
Date: 星期五, 31 三月 2023 17:16:22 +0800
Subject: [PATCH] 科目二修改

---
 lib/src/main/cpp/rtk_platform/platform.cpp |   19 ++++++++++---------
 1 files changed, 10 insertions(+), 9 deletions(-)

diff --git a/lib/src/main/cpp/rtk_platform/platform.cpp b/lib/src/main/cpp/rtk_platform/platform.cpp
index 6f49707..a48d7d2 100644
--- a/lib/src/main/cpp/rtk_platform/platform.cpp
+++ b/lib/src/main/cpp/rtk_platform/platform.cpp
@@ -23,9 +23,6 @@
 #include "../utils/num.h"
 #include "../driver_test.h"
 #include "../test_common/car_sensor.h"
-#include "../test_items2/stop_car.h"
-#include "../test_items2/operate_gear.h"
-#include "../test_items2/drive_straight.h"
 #include "../rtk_module/virtual_rtk.h"
 
 #define PARSE_BUFF_SIZE         4096
@@ -402,7 +399,7 @@
         case GPS_UPDATE_EVT: {
             const gpsStatus_t *gps = (gpsStatus_t *) data;
 
-            DEBUG("GPS: %s", const_cast<gpsStatus_t *>(gps)->toString().c_str());
+//            DEBUG("GPS: %s", const_cast<gpsStatus_t *>(gps)->toString().c_str());
 
             gbf.qf = gps->gps_status;
             gbf.latitude = gps->latitude;
@@ -432,9 +429,9 @@
             uint32_t ost = AppTimer_GetTickCount();
             uint32_t ost1 = ost;
 
-            const rtk_info *rtk = (rtk_info *) data;
+            const rtk_info_t *rtk = (rtk_info_t *) data;
 
-            DEBUG("RTK: %s", const_cast<rtk_info *>(rtk)->toString().c_str());
+//            DEBUG("RTK: %s", const_cast<rtk_info_t *>(rtk)->toString().c_str());
 
             rbf.qf = rtk->qf;
             rbf.coord_x = rtk->y;
@@ -446,8 +443,11 @@
             rbf.coord_y_dir = 'E';
             rbf.rtcm_length = rtcmLength;
 
-            sprintf(rbf.utc, "%04d%02d%02d%02d%02d%02d.%02d", 2000 + rtk->YY, rtk->MM, rtk->DD,
-                    rtk->hh, rtk->mm, rtk->ss, rtk->dss);
+            struct TimeStructure ts;
+
+            TimeBreakdown(rtk->utc_time / 1000, &ts);
+            sprintf(rbf.utc, "%04d%02d%02d%02d%02d%02d.%02d", ts.Year, ts.Month, ts.Day,
+                    ts.Hour, ts.Minute, ts.Second, (rtk->utc_time % 1000) / 10);
             if (!strcmp(rbf.utc, gbf.utc)) {
                 rbf.sat_num = gbf.sat_num;
                 rbf.latitude = gbf.latitude;
@@ -461,7 +461,8 @@
 
             ost1 = AppTimer_GetTickCount() - ost1;
 
-            UpdateRTKInfo(rtk);
+            if (rtk->qf == 3)
+                UpdateRTKInfo(rtk);
 
             ost = AppTimer_GetTickCount() - ost;
 

--
Gitblit v1.8.0