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