From 46f56f26bfcc6ce26ffd8132ee11bf019eef3289 Mon Sep 17 00:00:00 2001
From: yy1717 <fctom1215@outlook.com>
Date: 星期一, 13 四月 2020 11:48:28 +0800
Subject: [PATCH] 计算边距
---
lib/src/main/cpp/test_items/park_edge.cpp | 21 +++++++++++++++++++++
1 files changed, 21 insertions(+), 0 deletions(-)
diff --git a/lib/src/main/cpp/test_items/park_edge.cpp b/lib/src/main/cpp/test_items/park_edge.cpp
index 9387896..987dd0f 100644
--- a/lib/src/main/cpp/test_items/park_edge.cpp
+++ b/lib/src/main/cpp/test_items/park_edge.cpp
@@ -11,6 +11,7 @@
#include "../utils/xconvert.h"
#include "../test_common/car_sensor.h"
#include "../master/comm_if.h"
+#include "area_exam.h"
#include <vector>
#include <cstdlib>
@@ -64,6 +65,10 @@
int TestParkEdge(const Polygon *map, const car_model *car, const car_model *carPrev, double speed, int moveStatus, const struct RtkTime *rtkTime)
{
+ vector<double> dtox;
+ vector<Line> line_set;
+ Line distance_line;
+
if (CrashRedLine1(map, car)) {
if (!occurCrashRedLine1 && occurMoveBack) {
// 杞﹁疆鍘嬭竟绾匡紝姣忔鎵�10鍒�
@@ -97,6 +102,22 @@
goto TEST_END;
}
+ // 璺濈妫�娴�
+ MakeLine(&distance_line, &map->point[0], &map->point[7]);
+ line_set.push_back(distance_line);
+ MakeLine(&distance_line, &map->point[1], &map->point[2]);
+ line_set.push_back(distance_line);
+ MakeLine(&distance_line, &map->point[2], &map->point[3]);
+ line_set.push_back(distance_line);
+ MakeLine(&distance_line, &map->point[3], &map->point[4]);
+ line_set.push_back(distance_line);
+ MakeLine(&distance_line, &map->point[4], &map->point[5]);
+ line_set.push_back(distance_line);
+ MakeLine(&distance_line, &map->point[5], &map->point[6]);
+ line_set.push_back(distance_line);
+ DistanceOfTire2X(dtox, car, line_set);
+ MA_SendDistance(dtox[0], dtox[1]);
+
if (occurMoveBack) {
uint32_t tp = TimeMakeComposite(rtkTime->hh, rtkTime->mm, rtkTime->ss, rtkTime->mss*10);
--
Gitblit v1.8.0