From 25bdbfbf6f4c9f1530be74fc194ad1dd0a13e8c9 Mon Sep 17 00:00:00 2001
From: fctom1215 <fctom1215@outlook.com>
Date: 星期日, 08 三月 2020 23:12:49 +0800
Subject: [PATCH] 角度修正。

---
 lib/src/main/cpp/master/comm_if.cpp |    9 ++++++++-
 1 files changed, 8 insertions(+), 1 deletions(-)

diff --git a/lib/src/main/cpp/master/comm_if.cpp b/lib/src/main/cpp/master/comm_if.cpp
index 3c227c9..3ee83da 100644
--- a/lib/src/main/cpp/master/comm_if.cpp
+++ b/lib/src/main/cpp/master/comm_if.cpp
@@ -564,6 +564,8 @@
                 int bodyNum = 0;
                 int *body = NULL;
                 int pointNum = 0;
+                double antPitch = 0;
+
                 double (*point)[2] = NULL;
 
                 if (doc.HasMember("main_ant")) {
@@ -656,8 +658,13 @@
                     }
                 }
 
+                if (doc.HasMember("ant_pitch")) {
+                    const Value& s = doc["ant_pitch"];
+                    antPitch = s.GetDouble();
+                }
+
                 SetCarMeasurePoint(basePoint, axial, left_front_tire, right_front_tire,
-                        left_rear_tire, right_rear_tire, body, bodyNum, point, pointNum);
+                        left_rear_tire, right_rear_tire, body, bodyNum, point, pointNum, antPitch);
 
                 if (body != NULL) delete []body;
                 if (point != NULL) delete []point;

--
Gitblit v1.8.0