From 00c07fb94c6927f3bb8ebfec383a33936f04447b Mon Sep 17 00:00:00 2001
From: yy1717 <fctom1215@outlook.com>
Date: 星期五, 22 五月 2020 19:01:18 +0800
Subject: [PATCH] 坐标
---
lib/src/main/cpp/test_items2/road_exam.h | 3
lib/src/main/cpp/driver_test.cpp | 165 -----------
lib/src/main/cpp/test_items2/through_something.h | 4
lib/src/main/cpp/master/comm_if.cpp | 49 +++
lib/src/main/cpp/test_items2/through_something.cpp | 99 ------
lib/src/main/cpp/test_items2/road_exam.cpp | 512 +++++++++++++++++++++------------
lib/src/main/cpp/driver_test.h | 65 +--
7 files changed, 395 insertions(+), 502 deletions(-)
diff --git a/lib/src/main/cpp/driver_test.cpp b/lib/src/main/cpp/driver_test.cpp
index 233b416..d7ef572 100644
--- a/lib/src/main/cpp/driver_test.cpp
+++ b/lib/src/main/cpp/driver_test.cpp
@@ -65,11 +65,7 @@
static LIST_AREA_MAP AreaMapList;
-static Polygon RoadMapPoints;
static road_exam_map RoadMap;
-
-static LIST_ROAD_MAP RoadMapList;
-
static int exam_dummy_light;
@@ -109,10 +105,6 @@
AreaMapList.clear();
- RoadMapPoints.num = 0;
- RoadMapPoints.point = NULL;
-
-// RoadMapList.clear();
RoadMap.roads.clear();
RoadMap.specialAreas.clear();
RoadMap.triggerLines.clear();
@@ -210,162 +202,6 @@
RoadMap.triggerLines.assign(map.triggerLines.begin(), map.triggerLines.end());
DEBUG("寰楀埌鏂扮殑璺�冨湴鍥� 璺暟閲� %d 鐗规畩鍖哄煙鏁伴噺 %d 瑙﹀彂绾挎暟閲� %d", RoadMap.roads.size(), RoadMap.specialAreas.size(), RoadMap.triggerLines.size());
-}
-
-void SetRoadMapPoints(vector<double> &mapPoints)
-{
- DEBUG("鍔犲叆璺�冨湴鍥剧偣闆嗗悎 num = %d", mapPoints.size()/2);
-
- RoadMapPoints.num = mapPoints.size()/2;
-
- if (RoadMapPoints.num > 0) {
- RoadMapPoints.point = (PointF *)malloc(sizeof(PointF) * RoadMapPoints.num);
- for (int i = 0; i < RoadMapPoints.num; ++i) {
- RoadMapPoints.point[i].X = mapPoints[i*2];
- RoadMapPoints.point[i].Y = mapPoints[i*2+1];
- }
- }
-}
-
-void AddRoadMapParent(int id, int type, string tts, int stopFlag,
- vector<vector<int>> &redLines,
- vector<vector<int>> &redAreas,
- vector<vector<int>> &greenLines,
- vector<vector<int>> &triggerLines,
- vector<vector<int>> &roadEdgeLines,
- vector<int> area,
- vector<int> stopLine)
-{
-/* struct road_exam_map newMap;
-
- newMap.id = id;
- newMap.type = type;
- newMap.tts = tts;
- newMap.flagStop = stopFlag;
-
- DEBUG("鍔犲叆璺�冨湴鍥句俊鎭� id = %d type = %d", id, type);
-
- if (!tts.empty()) {
- DEBUG("TTS 淇℃伅 = %s", tts.c_str());
- }
-
- if ((newMap.redLineNum = redLines.size()) > 0) {
- newMap.redLine = (Polygon *) malloc(sizeof(Polygon) * newMap.redLineNum);
-
- DEBUG("绾㈢嚎 %d 鏍�", newMap.redLineNum);
-
- for (int i = 0; i < newMap.redLineNum; ++i) {
- newMap.redLine[i].num = redLines[i].size();
- newMap.redLine[i].point = (PointF *) malloc(sizeof(PointF) * newMap.redLine[i].num);
-
- DEBUG(" 缁撶偣 %d 涓�", newMap.redLine[i].num);
-
- for (int j = 0; j < newMap.redLine[i].num; ++j) {
- newMap.redLine[i].point[j] = RoadMapPoints.point[redLines[i][j]];
- }
- }
- } else {
- newMap.redLine = NULL;
- }
-
- if ((newMap.redAreaNum = redAreas.size()) > 0) {
- newMap.redArea = (Polygon *) malloc(sizeof(Polygon) * newMap.redAreaNum);
-
- DEBUG("绾㈠尯 %d 涓�", newMap.redAreaNum);
-
- for (int i = 0; i < newMap.redAreaNum; ++i) {
- newMap.redArea[i].num = redAreas[i].size();
- newMap.redArea[i].point = (PointF *) malloc(sizeof(PointF) * newMap.redLine[i].num);
-
- DEBUG(" 缁撶偣 %d 涓�", newMap.redArea[i].num);
-
- for (int j = 0; j < newMap.redArea[i].num; ++j) {
- newMap.redArea[i].point[j] = RoadMapPoints.point[redAreas[i][j]];
- }
- }
- } else {
- newMap.redArea = NULL;
- }
-
- if ((newMap.greenLineNum = greenLines.size()) > 0) {
- newMap.greenLine = (Polygon *) malloc(sizeof(Polygon) * newMap.greenLineNum);
-
- DEBUG("缁跨嚎 %d 鏍�", newMap.greenLineNum);
- for (int i = 0; i < newMap.greenLineNum; ++i) {
- newMap.greenLine[i].num = greenLines[i].size();
- newMap.greenLine[i].point = (PointF *) malloc(sizeof(PointF) * newMap.greenLine[i].num);
-
- DEBUG(" 缁撶偣 %d 涓�", newMap.greenLine[i].num);
- for (int j = 0; j < newMap.greenLine[i].num; ++j) {
- newMap.greenLine[i].point[j] = RoadMapPoints.point[greenLines[i][j]];
- }
- }
- } else {
- newMap.greenLine = NULL;
- }
-
- if ((newMap.triggerLineNum = triggerLines.size()) > 0) {
- newMap.triggerLine = (struct trigger_line_t *) malloc(sizeof(struct trigger_line_t) * newMap.triggerLineNum);
-
- DEBUG("瑙﹀彂绾� %d 鏍�", newMap.triggerLineNum);
-
- for (int i = 0; i < newMap.triggerLineNum; ++i) {
- newMap.triggerLine[i].line.num = triggerLines[i].size() - 1;
- newMap.triggerLine[i].line.point = (PointF *) malloc(sizeof(PointF) * newMap.triggerLine[i].line.num);
-
- DEBUG(" 缁撶偣 %d 涓�, 瑙﹀彂 id = %d", newMap.triggerLine[i].line.num, triggerLines[i][0]);
-
- newMap.triggerLine[i].triggerMapId = triggerLines[i][0];
- for (int j = 0; j < newMap.triggerLine[i].line.num; ++j) {
- newMap.triggerLine[i].line.point[j] = RoadMapPoints.point[triggerLines[i][j+1]];
- }
- }
- } else {
- newMap.triggerLine = NULL;
- }
-
- if ((newMap.roadEdgeLineNum = roadEdgeLines.size()) > 0) {
- newMap.roadEdgeLine = (Polygon *) malloc(sizeof(Polygon) * newMap.roadEdgeLineNum);
-
- DEBUG("閬撹矾杈圭嚎 %d 鏍�", newMap.roadEdgeLineNum);
- for (int i = 0; i < newMap.roadEdgeLineNum; ++i) {
- newMap.roadEdgeLine[i].num = roadEdgeLines[i].size();
- newMap.roadEdgeLine[i].point = (PointF *) malloc(sizeof(PointF) * newMap.roadEdgeLine[i].num);
-
- DEBUG(" 缁撶偣 %d 涓�", newMap.roadEdgeLine[i].num);
- for (int j = 0; j < newMap.roadEdgeLine[i].num; ++j) {
- newMap.roadEdgeLine[i].point[j] = RoadMapPoints.point[roadEdgeLines[i][j]];
- }
- }
- } else {
- newMap.roadEdgeLine = NULL;
- }
-
- if (area.size() > 0) {
- newMap.area.num = area.size();
- newMap.area.point = (PointF *) malloc(sizeof(PointF) * newMap.area.num);
-
- DEBUG("瀛愰」鐩尯鍩熺偣 %d 涓�", newMap.area.num);
- for (int i = 0; i < newMap.area.num; ++i) {
- newMap.area.point[i] = RoadMapPoints.point[area[i]];
- }
- } else {
- newMap.area.point = NULL;
- newMap.area.num = 0;
- }
-
- if (stopLine.size() == 2) {
- newMap.stopLine.X1 = RoadMapPoints.point[stopLine[0]].X;
- newMap.stopLine.Y1 = RoadMapPoints.point[stopLine[0]].Y;
- newMap.stopLine.X2 = RoadMapPoints.point[stopLine[1]].X;
- newMap.stopLine.Y2 = RoadMapPoints.point[stopLine[1]].Y;
- DEBUG("寰楀埌鍋滄绾� (%f,% f) --- (%f, %f)", newMap.stopLine.X1,
- newMap.stopLine.Y1,
- newMap.stopLine.X2,
- newMap.stopLine.Y2);
- }
-
- RoadMapList.push_back(newMap);*/
}
void SetCarMeasurePoint(double *basePoint, int *axial, int *left_front_tire,
@@ -784,7 +620,6 @@
if (ExamType != TEST_TYPE_AREA) {
if (exam_dummy_light == 2) {
-// TestRoadGeneral(RoadMapList, CarModel, CarModelList, speed, move, rtkTime);
TestRoadGeneral(RoadMap, CarModel, CarModelList, speed, move, rtkTime);
}
} else {
diff --git a/lib/src/main/cpp/driver_test.h b/lib/src/main/cpp/driver_test.h
index 81d7b1d..769a78d 100644
--- a/lib/src/main/cpp/driver_test.h
+++ b/lib/src/main/cpp/driver_test.h
@@ -92,41 +92,6 @@
int wrong_id;
};
-
-struct trigger_line_tx {
- int triggerMapId;
- Polygon line;
-};
-
-
-struct road_exam_mapx {
- int id;
- int type;
-
- string tts;
-
- int redLineNum;
- Polygon *redLine;
-
- int greenLineNum;
- Polygon *greenLine;
-
- int redAreaNum;
- Polygon *redArea;
-
- int triggerLineNum;
- trigger_line_tx *triggerLine;
-
- int roadEdgeLineNum; // 閬撹矾杈圭嚎锛屽彧鏈夌洿绾块┚椹躲�侀潬杈瑰仠杞︽墠鏈�
- Polygon *roadEdgeLine;
-
- Polygon area; // 瀛愰」鐩殑鍖哄煙
- Line stopLine; // 璇稿浜鸿閬撱�佽矾鍙ｇ瓑鑰冪偣鐨勫仠姝㈢嚎
- int flagStop; // 鍒拌揪寮�濮嬬嚎鍓嶏紝鏄惁闇�瑕佸仠杞�
-};
-
-typedef vector<struct road_exam_mapx> LIST_ROAD_MAP;
-
#define LINE_DOTTED 0
#define LINE_SOLID 1
#define LINE_HALF_SOLID_LEFT 2
@@ -142,6 +107,20 @@
#define SCHOOL_AREA 1
#define BUS_STATION_AREA 2
#define GRID_AREA 3
+
+#define ROAD_ITEM_NONE 0
+#define ROAD_ITEM_CHANGE_LANE 1
+#define ROAD_ITEM_OVERTAKE 2
+#define ROAD_ITEM_STRAIGHT 3
+#define ROAD_ITEM_OPERATE_GEAR 4
+#define ROAD_ITEM_START_CAR 5
+
+enum {
+ ROAD_ACTIVE_FORWARD,
+ ROAD_ACTIVE_TURN_LEFT,
+ ROAD_ACTIVE_TURN_RIGHT,
+ ROAD_ACTIVE_TURN_BACKWARD
+};
typedef struct {
int character; // 灞炴�э紙瀹炵嚎銆佽櫄绾匡紝鏈変簺鍙互鎺夊ご鐨勮矾娈碉級
@@ -165,6 +144,9 @@
Line startLine;
Line stopLine;
int active; // 鍒拌揪璺彛灏鹃儴鐨勮杩涙柟鍚�
+ bool activeBreak; // 璺彛鍒硅溅鍑忛��
+ bool activeStop; // 璺彛鍋滆溅鐬湜
+ bool errorLane; // 閿欒杞﹂亾
int targetRoad;
int stopFlag;
string tts;
@@ -179,6 +161,8 @@
int id;
int road;
int type;
+ bool activeBreak;
+ bool overSpeed;
std::vector<PointF> area; // 浜鸿閬撶瓑鍙充晶2鐐癸紝缃戞牸绾�4鐐�
std::vector<PointF> leftPoints; // 瀵瑰簲鍒伴亾璺乏渚х殑鐐�
} special_area_t;
@@ -190,7 +174,8 @@
int time; // 椤圭洰鏈�澶у畬鎴愭椂闂�
int distance; // 椤圭洰鏈�澶у畬鎴愯窛绂�
string tts;
- Line line;
+ std::vector<PointF> points;
+ std::vector<PointF> leftPoints; // 瀵瑰簲鍒伴亾璺乏渚х殑鐐�
} trigger_line_t;
struct road_exam_map {
@@ -210,8 +195,6 @@
typedef list<car_model *> LIST_CAR_MODEL;
-//vector<ExamFault> ExamFaultList;
-
void DriverTestInit(void);
void ReadDriverExamPrimer(void);
@@ -221,12 +204,6 @@
void CleanRoadMap(void);
void SetRoadMap(road_exam_map &map);
-
-void SetRoadMapPoints(vector<double> &mapPoints);
-void AddRoadMapParent(int id, int type, string tts, int stopFlag, vector<vector<int>> &redLines,
- vector<vector<int>> &redAreas, vector<vector<int>> &greenLines,
- vector<vector<int>> &triggerLines, vector<vector<int>> &roadEdgeLines,
- vector<int> area, vector<int> stopLine);
void SetCarMeasurePoint(double *basePoint, int *axial, int *left_front_tire,
int *right_front_tire, int *left_rear_tire, int *right_rear_tire,
diff --git a/lib/src/main/cpp/master/comm_if.cpp b/lib/src/main/cpp/master/comm_if.cpp
index c99a0d4..5ff520f 100644
--- a/lib/src/main/cpp/master/comm_if.cpp
+++ b/lib/src/main/cpp/master/comm_if.cpp
@@ -594,7 +594,6 @@
mapPoints.push_back((*itr2).GetDouble());
}
- SetRoadMapPoints(mapPoints);
}
if (doc.HasMember("maps")) {
@@ -737,7 +736,6 @@
tts = s.GetString();
}
- AddRoadMapParent(id, type, tts, stop_flag, redLines, redAreas, greenLines, triggerLines, roadEdgeLines, area, stopLine);
}
}
}
@@ -959,8 +957,6 @@
if (doc.HasMember("special_area")) {
const Value &a = doc["special_area"];
- vector<special_area_t> specialAreas;
-
for (Value::ConstValueIterator itr = a.Begin();
itr != a.End(); ++itr) {
special_area_t specialArea;
@@ -991,7 +987,52 @@
}
}
if (doc.HasMember("trigger_line")) {
+ const Value &a = doc["trigger_line"];
+ for (Value::ConstValueIterator itr = a.Begin();
+ itr != a.End(); ++itr) {
+ trigger_line_t trigger;
+
+ if (itr->HasMember("type")) {
+ const Value &s = (*itr)["type"];
+ trigger.active = s.GetInt();
+ }
+ if (itr->HasMember("id")) {
+ const Value &s = (*itr)["id"];
+ trigger.id = s.GetInt();
+ }
+ if (itr->HasMember("road")) {
+ const Value &s = (*itr)["road"];
+ trigger.road = s.GetInt();
+ }
+ if (itr->HasMember("tts")) {
+ const Value &s = (*itr)["tts"];
+ trigger.tts = s.GetString();
+ }
+ if (itr->HasMember("time")) {
+ const Value &s = (*itr)["time"];
+ trigger.time = s.GetInt();
+ } else {
+ trigger.time = 0;
+ }
+ if (itr->HasMember("distance")) {
+ const Value &s = (*itr)["distance"];
+ trigger.distance = s.GetInt();
+ } else {
+ trigger.distance = 0;
+ }
+
+ if (itr->HasMember("line")) {
+ const Value &a2 = (*itr)["line"];
+
+ for (Value::ConstValueIterator itr2 = a2.Begin();
+ itr2 != a2.End(); ++itr2) {
+ trigger.points.push_back(mapPoints[(*itr2).GetInt()]);
+ }
+ }
+
+ map.triggerLines.push_back(trigger);
+ }
}
DEBUG("鍦板浘瑙ｆ瀽瀹屾瘯");
diff --git a/lib/src/main/cpp/test_items2/road_exam.cpp b/lib/src/main/cpp/test_items2/road_exam.cpp
index a2205f9..d132808 100644
--- a/lib/src/main/cpp/test_items2/road_exam.cpp
+++ b/lib/src/main/cpp/test_items2/road_exam.cpp
@@ -40,6 +40,14 @@
static const int TURN_CHECK_INTERVAL = 500;
const double SLIDE_DISTANCE_THRESHOLD_RED = 0.3;
const double SLIDE_DISTANCE_THRESHOLD_YELLOW = 0.1;
+const double CHANGE_LANE_RANGE = 100.0;
+const double OVERTAKE_RANGE = 150.0;
+const double OVERTAKE_HOLD_RANGE = 30.0; // 鍦ㄨ秴杞﹂亾琛岄┒鐨勪竴娈佃窛绂�
+
+static const double LASTEST_BREAK_POINT = 30.0;
+static const double NEXT_ROAD_TIP = 100.0; // 鍒拌揪璺彛鍓嶆彁绀轰笅涓�涓�庝箞璧�
+static const double DISTANCE_STOP_CAR_TO_STOP_LINE = 5.0;
+static const double PASS_SCHOOL_MAX_SPEED = 30.0; // kmh
static const int FIND_POSITION = -2;
static const int INVALID_POSITION = -1;
@@ -75,13 +83,15 @@
static int startCar;
static int currExamMapIndex;
+static trigger_line_t *currRoadItem;
static int nextRoadId;
+static PointF roadItemStartPoint;
+static struct drive_timer roadItemStartTime;
+static bool overtake = false;
static bool checkDoor = false;
static bool handBreakActive = false;
static bool reportRPMOver = false;
-
-static int currCarOnRoadIndex;
static const uint32_t TURN_ERROR_COLD_TIME = D_SEC(10);
@@ -90,6 +100,8 @@
int road;
int separate;
int lane;
+ int direct; // 杞﹂亾鏂瑰悜闄愬埗
+ int type; // 瀹炵嚎锛岃櫄绾�
} CurrentLane;
static bool laneChanging;
@@ -103,7 +115,6 @@
static const uint32_t CRASH_DOTTED_LINE_TIMEOUT = D_SEC(10);
static const uint32_t TURN_SIGNAL_LAMP_ADVANCE = D_SEC(3);
-static const double NEXT_ROAD_TIP = 100.0; // 鍒拌揪璺彛鍓嶆彁绀轰笅涓�涓�庝箞璧�
static const int CRL_NONE = 0;
static const int CRL_SEP_DOTTED = 1;
@@ -118,11 +129,6 @@
static char isTurn(int currYaw, int prevYaw, int &ang);
static char CheckCarTurn(LIST_CAR_MODEL &CarModelList);
-static bool CrashRedLine(LIST_ROAD_MAP &RoadMapList, const car_model *car);
-static bool CrashRedArea(LIST_ROAD_MAP &RoadMapList, const car_model *car);
-static bool CrashGreenLine(LIST_ROAD_MAP &RoadMapList, const car_model *car, PointF &p1, PointF &p2);
-static int CrashTriggerLine(LIST_ROAD_MAP &RoadMapList, const car_model *car, LIST_CAR_MODEL &CarModelList);
-static int FindMapIndexById(int id, LIST_ROAD_MAP &RoadMapList);
static void TurnSignalError13ColdTimer(union sigval sig);
static void TurnSignalError14ColdTimer(union sigval sig);
@@ -132,6 +138,10 @@
static bool LaneIsSame(struct car_on_lane lane1, struct car_on_lane lane2);
static bool LaneIsValid(struct car_on_lane lane);
static void ArrivedRoadEnd(road_t &road, const car_model *car, LIST_CAR_MODEL &CarModelList);
+static trigger_line_t * EntryItem(int index, road_exam_map &RoadMap, const car_model *car, LIST_CAR_MODEL &CarModelList);
+static void ClearAll(road_exam_map &map);
+static void CheckBreakActive(road_exam_map &map, const car_model *car, LIST_CAR_MODEL &CarModelList,
+ double speed, int moveDirect, const struct RtkTime *rtkTime);
void InitRoadExam(road_exam_map &RoadMap)
{
@@ -141,6 +151,7 @@
occurCrashRedLine = false;
occurCrashGreenLine = false;
occurOverSpeed = false;
+
occurSecondBreak = false;
checkCrashGreenTimeout = 0;
carIntersectionOfGreenLine = 0;
@@ -161,6 +172,7 @@
currExamMapIndex = FIND_POSITION;
startCar = START_CAR_NOT_DO;
+ currRoadItem = NULL;
checkDoor = false;
handBreakActive = false;
@@ -170,12 +182,11 @@
turnError13Cold = turnError14Cold = true;
- currCarOnRoadIndex = FIND_POSITION;
-
CurrentLane.road = CurrentLane.separate = CurrentLane.lane = -1;
laneChanging = false;
- InitThroughSomething(RoadMap);
+ nextRoadId = -1;
+ ClearAll(RoadMap);
}
void TerminateRoadExam(void)
@@ -295,14 +306,12 @@
void TestRoadGeneral(road_exam_map &RoadMap, const car_model *car, LIST_CAR_MODEL &CarModelList, double speed, int moveDirect, const struct RtkTime *rtkTime)
{
- // 璧锋妫�娴�
- TestRoadStartCar(car, speed, moveDirect, rtkTime);
-
// 瓒呴�熸娴�
if (moveDirect != 0 && speed > MAX_SPEED) {
if (!occurOverSpeed) {
occurOverSpeed = true;
// 瓒呴�燂紝涓嶅悎鏍�
+ DEBUG("瓒呴�� %f", speed);
AddExamFault(10, rtkTime);
}
} else {
@@ -470,7 +479,8 @@
}
// 妫�娴嬮�氳繃璺彛銆佷汉琛岄亾绛夊尯鍩熸椂锛岄噴鏀惧埞杞︽垨鍑忛��
- CheckBreakActive(RoadMap, car, CarModelList);
+ CheckBreakActive(RoadMap, car, CarModelList,
+ speed, moveDirect, rtkTime);
// 妫�娴嬬寮�姝よ矾娈碉紝鍏ㄨ溅闇�涓嶅湪鑼冨洿鍐�
if (currExamMapIndex >= 0) {
@@ -579,6 +589,11 @@
if (IntersectionOf(car->carXY[car->axial[AXIAL_FRONT]], &area) == GM_Containment) {
currExamMapIndex = i;
DEBUG("杩涘叆閬撹矾 id = %d", RoadMap.roads[i].id);
+ if (nextRoadId >= 0 && RoadMap.roads[i].id != nextRoadId) {
+ DEBUG("涓嶆寜瑙勭煩琛岄┒锛岃繘鍏ラ敊璇矾娈�");
+ AddExamFault(3, rtkTime);
+ }
+ nextRoadId = -1;
break;
}
@@ -608,16 +623,16 @@
if (crl == CRL_NONE) {
// DEBUG("浠�涔堥兘娌″帇");
} else if (crl == CRL_SEP_DOTTED) {
-// DEBUG("鍘嬪垎閬撹櫄绾�");
+ DEBUG("鍘嬪垎閬撹櫄绾�");
crashGreenLineNow = true;
} else if (crl == CRL_SEP_SOLID) {
-// DEBUG("鍘嬪垎閬撳疄绾�");
+ DEBUG("鍘嬪垎閬撳疄绾�");
crashRedLineNow = true;
} else if (crl == CRL_EDGE_DOTTED) {
-// DEBUG("鍘嬭竟娌胯櫄绾�");
+ DEBUG("鍘嬭竟娌胯櫄绾�");
crashGreenLineNow = true;
} else if (crl == CRL_EDGE_SOLID) {
-// DEBUG("鍘嬭竟娌垮疄绾�");
+ DEBUG("鍘嬭竟娌垮疄绾�");
crashRedLineNow = true;
}
@@ -700,9 +715,23 @@
} else {
// 鍙橀亾瀹屾垚
DEBUG("鍙橀亾瀹屾垚");
+
+ if (currRoadItem != NULL && currRoadItem->active == ROAD_ITEM_CHANGE_LANE) {
+ DEBUG("鍙樻洿杞﹂亾椤圭洰瀹屾垚");
+ currRoadItem = NULL;
+ } else if (currRoadItem != NULL && currRoadItem->active == ROAD_ITEM_OVERTAKE) {
+ if (CurrentLane.lane > lane.lane) {
+ DEBUG("瓒呰溅鍙橀亾瀹屾垚");
+
+ } else {
+ DEBUG("鍙抽亾瓒呰溅锛岄敊璇�");
+ AddExamFault(3, rtkTime);
+ currRoadItem = NULL;
+ }
+ }
+
CurrentLane = lane;
laneChanging = false;
-
// 璁板綍鏈鍙橀亾鏃堕棿鐐�
Rtk2DriveTimer(crashGreenCmpTime, rtkTime);
}
@@ -710,11 +739,20 @@
if (lane.road != CurrentLane.road || lane.separate != CurrentLane.separate) {
// 璺垨娈靛彉鏇达紝鎾ら攢鍙橀亾璺熻釜
- DEBUG("============== 璺垨娈靛彉鏇� CURR %d, %d NEW %d, %d", CurrentLane.road,
- CurrentLane.separate,
- lane.road, lane.separate);
+ DEBUG("============== 璺垨娈靛彉鏇� CURR %d, %d dir %d NEW %d, %d, dir %d", CurrentLane.road,
+ CurrentLane.separate, CurrentLane.direct,
+ lane.road, lane.separate, lane.direct);
+
CurrentLane = lane;
laneChanging = false;
+ }
+
+ if (CurrentLane.direct != 0 && !(CurrentLane.direct & RoadMap.roads[currExamMapIndex].active)) {
+ if (!RoadMap.roads[currExamMapIndex].errorLane) {
+ RoadMap.roads[currExamMapIndex].errorLane = true;
+ DEBUG("涓嶆寜瑙勫畾杞﹂亾鏍囩嚎鏂瑰悜琛岄┒ %d", CurrentLane.direct);
+ AddExamFault(9, rtkTime);
+ }
}
}
@@ -773,6 +811,50 @@
// 涓嶅啀鍘嬭櫄绾�
occurCrashGreenLine = false;
checkCrashGreenTimeout = 0;
+ }
+
+ TestRoadStartCar(car, speed, moveDirect, rtkTime);
+
+ if (startCar != START_CAR_DONE)
+ return;
+
+ // 妫�娴嬬敱瑙﹀彂绾挎帶鍒剁殑椤圭洰
+ if (currRoadItem != NULL) {
+ if (currRoadItem->active == ROAD_ITEM_CHANGE_LANE) {
+ if (DistanceOf(car->basePoint, roadItemStartPoint) > CHANGE_LANE_RANGE) {
+ DEBUG("鍙橀亾璺濈瓒呮爣");
+ AddExamFault(3, rtkTime);
+ currRoadItem = NULL;
+ }
+ } else if (currRoadItem->active == ROAD_ITEM_OVERTAKE) {
+ if (!overtake && DistanceOf(car->basePoint, roadItemStartPoint) > OVERTAKE_RANGE) {
+ DEBUG("瓒呰溅璺濈瓒呮爣");
+ AddExamFault(3, rtkTime);
+ currRoadItem = NULL;
+ } else if (overtake && DistanceOf(car->basePoint, roadItemStartPoint) > OVERTAKE_HOLD_RANGE) {
+ DEBUG("鍥炲師杞﹂亾");
+ PlayTTS("璇疯繑鍥炲師杞﹂亾");
+ currRoadItem = NULL;
+ }
+ } else if (currRoadItem->active == ROAD_ITEM_OPERATE_GEAR) {
+ ExecuteOperateGearExam(rtkTime);
+ }
+ } else if (currExamMapIndex >= 0) {
+ currRoadItem = EntryItem(currExamMapIndex, RoadMap, car, CarModelList);
+ if (currRoadItem != NULL) {
+ if (!currRoadItem->tts.empty())
+ PlayTTS(currRoadItem->tts.c_str());
+
+ // 鍒濆鏃堕棿鍜岃窛绂婚檺鍒�
+ roadItemStartPoint = car->basePoint;
+ Rtk2DriveTimer(roadItemStartTime, rtkTime);
+
+ if (currRoadItem->active == ROAD_ITEM_OVERTAKE) {
+ overtake = false;
+ } else if (currRoadItem->active == ROAD_ITEM_OPERATE_GEAR) {
+ StartOperateGearExam(rtkTime);
+ }
+ }
}
}
@@ -839,7 +921,7 @@
PointF p1, p2;
Line sep;
- map<int, int> orthogonal;
+ map<int, vector<int>> orthogonal;
// 涓�娈靛垎閬撶粍鍐咃紝鏈変竴鏉℃浜わ紝灏卞繀椤讳繚璇佸悓缁勭殑鍏ㄩ兘姝ｄ氦锛屽惁鍒欑洿鎺ラ��鍑�
for (int j = 0; j < road.separate[i].lines.size(); ++j) { // 绾跨粍
@@ -853,15 +935,31 @@
MakeLine(&sep, &p1, &p2);
if (IntersectionOf(leftExtLine, sep) == GM_Intersection) {
- orthogonal.insert(pair<int, int>(j, 1));
+ vector<int> stor(4);
+
+ stor[0] = 1;
+ stor[1] = road.separate[i].lines[j][k].character;
+ stor[2] = road.separate[i].lines[j][k].left_lane_direct;
+ stor[3] = road.separate[i].lines[j][k].right_lane_direct;
+
+ orthogonal.insert(pair<int, vector<int>>(j, stor));
orthogonalInSegment = true;
intersection = true;
+
// DEBUG("鍒嗛亾绾� %d 宸︽浜�", j);
break;
} else if (IntersectionOf(rightExtLine, sep) == GM_Intersection) {
- orthogonal.insert(pair<int, int>(j, 2));
+ vector<int> stor(4);
+
+ stor[0] = 2;
+ stor[1] = road.separate[i].lines[j][k].character;
+ stor[2] = road.separate[i].lines[j][k].left_lane_direct;
+ stor[3] = road.separate[i].lines[j][k].right_lane_direct;
+
+ orthogonal.insert(pair<int, vector<int>>(j, stor));
orthogonalInSegment = true;
intersection = true;
+
// DEBUG("鍒嗛亾绾� %d 鍙虫浜�", j);
break;
}
@@ -875,16 +973,26 @@
if (orthogonal.size() == road.separate[i].lines.size()) {
// 寰楀埌褰撳墠鍦ㄧ鍑犱釜杞﹂亾
int x = 0;
+ int left_char = LINE_SOLID; // 閬撹矾宸﹁竟绾�
+ int right_direct = 0;
+
for (x = 0; x < orthogonal.size(); ++x) {
auto itx = orthogonal.find(x);
if (itx != orthogonal.end()) {
- if (itx->second != 1) {
+ if (itx->second[0] != 1) { // 鍦ㄨ溅杈嗗彸渚�
lane.road = road.id;
lane.separate = i;
lane.lane = itx->first;
-
+ if ((left_char == LINE_SOLID || left_char == LINE_HALF_SOLID_RIGHT) &&
+ (itx->second[1] == LINE_SOLID || itx->second[1] == LINE_HALF_SOLID_LEFT)) // 杞﹂亾宸﹀彸鍧囨槸瀹炵嚎
+ lane.direct = itx->second[2];
+ else
+ lane.direct = 0;
// DEBUG("璺� %d 娈� %d 杞﹂亾 %d", lane.road, lane.separate, lane.lane);
break;
+ } else {
+ right_direct = itx->second[3];
+ left_char = itx->second[2];
}
}
}
@@ -892,7 +1000,11 @@
lane.road = road.id;
lane.separate = i;
lane.lane = orthogonal.size();
-
+ // 鏈�鍚庤溅閬撶殑鍙充晶闄愬畾
+ if (left_char == LINE_SOLID || left_char == LINE_HALF_SOLID_RIGHT)
+ lane.direct = right_direct;
+ else
+ lane.direct = 0;
// DEBUG("璺� %d 娈� %d 杞﹂亾 %d", lane.road, lane.separate, lane.lane);
}
out = lane;
@@ -1026,6 +1138,7 @@
return false;
}
+#if 0
void TestRoadGeneral(LIST_ROAD_MAP &RoadMapList, const car_model *car, LIST_CAR_MODEL &CarModelList, double speed, int moveDirect, const struct RtkTime *rtkTime)
{
// 璧锋妫�娴�
@@ -1383,6 +1496,7 @@
}
}
+
bool ExitSonArea(int index, LIST_ROAD_MAP &RoadMapList, const car_model *car)
{
bool ret = false;
@@ -1464,6 +1578,7 @@
return ret;
}
+#endif
void Rtk2DriveTimer(struct drive_timer &tm, const struct RtkTime *rtkTime)
{
@@ -1556,48 +1671,13 @@
return 0;
}
-/*****************************************************
- * CrashRedLine 鏁翠釜鑰冭瘯鍖哄煙鐨勯亾璺竟缂樼嚎锛屽疄绾跨瓑銆�
- * 鎸夎溅杞瑙﹁绠楋紝杞﹁韩涓嶈
- */
-static bool CrashRedLine(LIST_ROAD_MAP &RoadMapList, const car_model *car)
-{
- Line frontAxle, rearAxle;
-
- MakeLine(&frontAxle, &car->carXY[car->left_front_tire[TIRE_OUTSIDE]], &car->carXY[car->right_front_tire[TIRE_OUTSIDE]]);
- MakeLine(&rearAxle, &car->carXY[car->left_rear_tire[TIRE_OUTSIDE]], &car->carXY[car->right_rear_tire[TIRE_OUTSIDE]]);
-
- for (int i = 0; i < RoadMapList.size(); ++i) {
- if (RoadMapList[i].type == GENERAL_MAP) {
-
- // 姣忔潯绾块兘妫�娴�
- for (int j = 0; j < RoadMapList[i].redLineNum; ++j) {
- Line red_line;
- int kp = 0;
-
- for (int k = 1; k < RoadMapList[i].redLine[j].num; ++k) {
- MakeLine(&red_line, &RoadMapList[i].redLine[j].point[kp], &RoadMapList[i].redLine[j].point[k]);
-
- if (IntersectionOf(red_line, frontAxle) == GM_Intersection ||
- IntersectionOf(red_line, rearAxle) == GM_Intersection) {
- return true;
- }
- kp = k;
- }
- }
- break;
- }
- }
- return false;
-}
-
/**********************************************************
* 鎸夋暣涓溅韬槸鍚﹁鐩栬绠�
* @param RoadMapList
* @param car
* @return
*/
-static bool CrashRedArea(LIST_ROAD_MAP &RoadMapList, const car_model *car)
+/*static bool CrashRedArea(LIST_ROAD_MAP &RoadMapList, const car_model *car)
{
bool ret = false;
@@ -1625,119 +1705,7 @@
free(carBody.point);
return ret;
-}
-
-/**************************************************
- * 杞﹁疆瑙︾閬撹矾铏氱嚎銆傛娴嬭椹舵椂闂磋秴闀匡紱鍙橀亾鎯呭喌锛�
- * @param RoadMapList
- * @param car
- */
-static bool CrashGreenLine(LIST_ROAD_MAP &RoadMapList, const car_model *car, PointF &p1, PointF &p2)
-{
- Line frontAxle, rearAxle;
-
- MakeLine(&frontAxle, &car->carXY[car->left_front_tire[TIRE_OUTSIDE]], &car->carXY[car->right_front_tire[TIRE_OUTSIDE]]);
- MakeLine(&rearAxle, &car->carXY[car->left_rear_tire[TIRE_OUTSIDE]], &car->carXY[car->right_rear_tire[TIRE_OUTSIDE]]);
-
- for (int i = 0; i < RoadMapList.size(); ++i) {
- if (RoadMapList[i].type == GENERAL_MAP) {
-
- // 姣忔潯绾块兘妫�娴�
- for (int j = 0; j < RoadMapList[i].greenLineNum; ++j) {
- Line green_line;
- int kp = 0;
-
- for (int k = 1; k < RoadMapList[i].greenLine[j].num; ++k) {
- MakeLine(&green_line, &RoadMapList[i].greenLine[j].point[kp], &RoadMapList[i].greenLine[j].point[k]);
-
- if (IntersectionOf(green_line, frontAxle) == GM_Intersection ||
- IntersectionOf(green_line, rearAxle) == GM_Intersection) {
-
- p1 = RoadMapList[i].greenLine[j].point[kp];
- p2 = RoadMapList[i].greenLine[j].point[k];
-
- return true;
- }
- kp = k;
- }
- }
- break;
- }
- }
- return false;
-}
-
-/************************************************************
- * 妫�娴嬭溅杈嗘槸鍚﹁Е鍙戝瓙鑰冮」鍦板浘
- * @param RoadMapList
- * @param car
- * @param CarModelList
- * @return
- */
-static int CrashTriggerLine(LIST_ROAD_MAP &RoadMapList, const car_model *car, LIST_CAR_MODEL &CarModelList)
-{
- int map_idx = -1;
-
- if (CarModelList.size() < 5)
- return map_idx;
-
- Polygon trace;
-
- trace.num = 5;
- trace.point = (PointF *) malloc(sizeof(PointF) * trace.num);
-
- list<car_model *>::iterator iter = CarModelList.begin();
-
- int pn = 0;
- while (iter != CarModelList.end() && pn < trace.num) {
- trace.point[pn++] = ((car_model *)(*iter))->carXY[((car_model *)(*iter))->left_front_tire[TIRE_OUTSIDE]];
- ++iter;
- }
-
- for (int i = 0; i < RoadMapList.size(); ++i) {
- if (RoadMapList[i].type == GENERAL_MAP) {
-
- // 姣忔潯绾块兘妫�娴�
- for (int j = 0; j < RoadMapList[i].triggerLineNum; ++j) {
- Line trigger_line;
-
- int kp = 0;
-
- // 瑙﹀彂绾夸竴鑸簲璇ュ彧鏈夐灏�2鐐癸紙id, p1, p2锛�
- for (int k = 1; k < RoadMapList[i].triggerLine[j].line.num; ++k) {
- MakeLine(&trigger_line, &RoadMapList[i].triggerLine[j].line.point[kp], &RoadMapList[i].triggerLine[j].line.point[k]);
-
- int pp = 0;
- for (int p = 1; p < pn; ++p) {
- Line trace_line;
- MakeLine(&trace_line, &trace.point[pp], &trace.point[p]);
-
- if (IntersectionOf(trace_line, trigger_line) == GM_Intersection &&
- IntersectionOfLine(RoadMapList[i].triggerLine[j].line.point[kp],
- RoadMapList[i].triggerLine[j].line.point[k],
- car->carXY[car->left_front_tire[TIRE_OUTSIDE]]) == -1 &&
- DistanceOf(car->carXY[car->left_front_tire[TIRE_OUTSIDE]], trigger_line) > 0.1) {
- // 纰板埌瑙﹀彂绾�
- DEBUG("纰版挒瑙﹀彂绾� 寮曞彂鍦板浘 id = %d", RoadMapList[i].triggerLine[j].triggerMapId);
- map_idx = FindMapIndexById(RoadMapList[i].triggerLine[j].triggerMapId, RoadMapList);
- goto SEARCH_TRIGGER_LINE_END;
- }
-
- pp = p;
- }
-
- kp = k;
- }
- }
- break;
- }
- }
-
-SEARCH_TRIGGER_LINE_END:
- free(trace.point);
-
- return map_idx;
-}
+}*/
bool CrashTheLine(Line line, const car_model *car, LIST_CAR_MODEL &CarModelList)
{
@@ -1759,16 +1727,6 @@
return true;
}
return false;
-}
-
-static int FindMapIndexById(int id, LIST_ROAD_MAP &RoadMapList)
-{
- for (int i = 0; i < RoadMapList.size(); ++i) {
- if (RoadMapList[i].id == id) {
- return i;
- }
- }
- return -1;
}
/*********************************************************************
@@ -1822,6 +1780,12 @@
return px;
}
+/***************************************************
+ * 鎺ヨ繎璺彛鏃讹紝鎻愮ず涓嬩竴姝ユ�庝箞璧�
+ * @param road
+ * @param car
+ * @param CarModelList
+ */
static void ArrivedRoadEnd(road_t &road, const car_model *car, LIST_CAR_MODEL &CarModelList)
{
// 璁＄畻杞﹀墠杩涜建杩瑰欢闀跨嚎
@@ -1836,6 +1800,7 @@
IntersectionOfLine(extPoint, road.stopLine) == -1) {
if (DistanceOf(extPoint, road.stopLine) > 1.0 && !road.arrivedTail) {
// 鎺ヨ繎璺彛鍚庯紝瑕佹鏌ヨ溅杈嗘槸鍚﹁繘鍏ラ敊璇溅閬�
+ DEBUG("鎺ヨ繎璺彛");
road.arrivedTail = true;
if (!road.tts.empty())
PlayTTS(road.tts.c_str());
@@ -1845,6 +1810,177 @@
}
}
+static trigger_line_t * EntryItem(int index, road_exam_map &RoadMap, const car_model *car, LIST_CAR_MODEL &CarModelList)
+{
+ for (int i = 0; i < RoadMap.triggerLines.size(); ++i) {
+ if (RoadMap.triggerLines[i].road == RoadMap.roads[index].id) {
+ Line triggerLine;
+
+ if (RoadMap.triggerLines[i].leftPoints.size() != RoadMap.triggerLines[i].points.size()) {
+ RoadMap.triggerLines[i].leftPoints.clear();
+
+ for (int j = 0; j < RoadMap.triggerLines[i].points.size(); ++j) {
+ RoadMap.triggerLines[i].leftPoints.push_back(GetSELine(RoadMap.roads[index].leftEdge, RoadMap.triggerLines[i].points[j]));
+ }
+ }
+
+ MakeLine(&triggerLine, &RoadMap.triggerLines[i].points[0], &RoadMap.triggerLines[i].leftPoints[0]);
+
+ if (CrashTheLine(triggerLine, car, CarModelList)) {
+ return &RoadMap.triggerLines[i];
+ }
+ }
+ }
+
+ return NULL;
+}
+
+/************************************************************************
+ * 寮�濮嬫柊鐨勮�冭瘯鍚庯紝娓呴櫎鍦板浘鎵�鏈夌殑鍒硅溅銆佸仠杞﹁褰�
+ * @param map
+ */
+static void ClearAll(road_exam_map &map)
+{
+ for (int i = 0; i < map.roads.size(); ++i) {
+ map.roads[i].activeStop = map.roads[i].activeBreak = false;
+ map.roads[i].arrivedTail = false;
+ map.roads[i].errorLane = false;
+ }
+ for (int i = 0; i < map.specialAreas.size(); i++) {
+ map.specialAreas[i].overSpeed = map.specialAreas[i].activeBreak = false;
+ }
+}
+
+static void CheckBreakActive(road_exam_map &map, const car_model *car, LIST_CAR_MODEL &CarModelList,
+ double speed, int moveDirect, const struct RtkTime *rtkTime)
+{
+ int BreakDone = ReadCarStatus(BREAK);
+
+ // 璁＄畻杞﹀墠杩涜建杩瑰欢闀跨嚎
+ double yaw = YawOf(car->carXY[ car->axial[AXIAL_FRONT] ], car->carXY[ car->axial[AXIAL_REAR] ]);
+ PointF extPoint = PointExtend(car->carXY[ car->axial[AXIAL_FRONT] ], LASTEST_BREAK_POINT, yaw);
+
+ Line extLine;
+ MakeLine(&extLine, &car->carXY[ car->axial[AXIAL_FRONT] ], &extPoint);
+
+ // 璺彛鍒硅溅鐐�
+ for (int i = 0; i < map.roads.size(); ++i) {
+ // 杞﹀ご鍜岃矾鍙ｈ窛绂讳笉瓒�30绫�
+ if (IntersectionOf(extLine, map.roads[i].stopLine) == GM_Intersection &&
+ IntersectionOfLine(car->carXY[ car->axial[AXIAL_FRONT] ], map.roads[i].stopLine) == 1 ) {
+ DEBUG("杩涘叆鍑忛�熷尯");
+ if (BreakDone == BREAK_ACTIVE) {
+ map.roads[i].activeBreak = true;
+ }
+ if (DistanceOf(car->carXY[car->axial[AXIAL_FRONT]],
+ map.roads[i].stopLine) < DISTANCE_STOP_CAR_TO_STOP_LINE && moveDirect == 0) {
+ map.roads[i].activeStop = true;
+ }
+ }
+ // 璺ㄧ嚎鍚庯紝妫�鏌ュ埞杞﹀姩浣�
+ if (CrashTheLine(map.roads[i].stopLine, car, CarModelList)) {
+ if (map.roads[i].stopFlag != 0 && !map.roads[i].activeStop) {
+ // 涓嶅仠杞︾灜鏈涳紝涓嶅悎鏍�
+ DEBUG("涓嶅仠杞︾灜鏈�");
+ if (map.roads[i].active == ROAD_ACTIVE_FORWARD) {
+ AddExamFault(42, rtkTime);
+ } else if (map.roads[i].active == ROAD_ACTIVE_TURN_LEFT) {
+ AddExamFault(44, rtkTime);
+ } else if (map.roads[i].active == ROAD_ACTIVE_TURN_RIGHT) {
+ AddExamFault(47, rtkTime);
+ }
+ }
+ if (!map.roads[i].activeBreak) {
+ // 涓嶆寜瑙勫畾鍑忛�燂紝涓嶅悎鏍�
+ DEBUG("涓嶆寜瑙勫畾鍑忛��");
+ if (map.roads[i].active == ROAD_ACTIVE_FORWARD) {
+ AddExamFault(41, rtkTime);
+ } else if (map.roads[i].active == ROAD_ACTIVE_TURN_LEFT) {
+ AddExamFault(43, rtkTime);
+ } else if (map.roads[i].active == ROAD_ACTIVE_TURN_RIGHT) {
+ AddExamFault(46, rtkTime);
+ }
+ }
+ }
+ }
+ // 浜鸿閬撱�佸叕浜ょ珯鍒硅溅鐐癸紱瀛︽牎闄愰�熷尯
+ for (int i = 0; i < map.specialAreas.size(); i++) {
+ if (map.specialAreas[i].type == GRID_AREA)
+ continue;
+
+ if (map.specialAreas[i].area.size() == 2 && map.specialAreas[i].leftPoints.size() != 2) {
+ // 璁＄畻鐐瑰埌宸︿晶璺竟绾跨殑鍨傜偣
+ int road = 0;
+ for (road = 0; road < map.roads.size(); ++road) {
+ if (map.roads[road].id == map.specialAreas[i].road)
+ break;
+ }
+
+ PointF vPoint = GetSELine(map.roads[road].leftEdge, map.specialAreas[i].area[0]);
+ DEBUG("璁＄畻鍨傜偣1 (%f, %f)", vPoint.X, vPoint.Y);
+
+ map.specialAreas[i].leftPoints.push_back(vPoint);
+
+ vPoint = GetSELine(map.roads[road].leftEdge, map.specialAreas[i].area[0]);
+ DEBUG("璁＄畻鍨傜偣2 (%f, %f)", vPoint.X, vPoint.Y);
+ map.specialAreas[i].leftPoints.push_back(vPoint);
+ }
+
+ if (map.specialAreas[i].type == ZEBRA_CROSSING || map.specialAreas[i].type == BUS_STATION_AREA) {
+ Line startLine;
+
+ MakeLine(&startLine, &map.specialAreas[i].area[0], &map.specialAreas[i].leftPoints[0]);
+
+ // 杞﹀ご鍜屾枒椹嚎璺濈涓嶈冻30绫�
+ if (IntersectionOf(extLine, startLine) == GM_Intersection &&
+ IntersectionOfLine(car->carXY[ car->axial[AXIAL_FRONT] ], startLine) == 1 ) {
+ DEBUG("杩涘叆鍑忛�熷尯 %d", map.specialAreas[i].type);
+ if (BreakDone == BREAK_ACTIVE) {
+ map.specialAreas[i].activeBreak = true;
+ }
+ }
+
+ // 璺ㄧ嚎鍚庯紝妫�鏌ュ埞杞﹀姩浣�
+ if (CrashTheLine(startLine, car, CarModelList)) {
+ if (!map.specialAreas[i].activeBreak) {
+ // 涓嶆寜瑙勫畾鍑忛�燂紝涓嶅悎鏍�
+ DEBUG("涓嶆寜瑙勫畾鍑忛��");
+ if (map.specialAreas[i].type == ZEBRA_CROSSING) {
+ AddExamFault(48, rtkTime);
+ } else {
+ AddExamFault(50, rtkTime);
+ }
+ } else {
+ DEBUG("鎸夎瀹氬噺閫�");
+ }
+
+ }
+ } else if (map.specialAreas[i].type == SCHOOL_AREA) {
+ Polygon school;
+
+ school.num = 4;
+ school.point = (PointF *) malloc(school.num * sizeof(PointF));
+
+ school.point[0] = map.specialAreas[i].area[0];
+ school.point[1] = map.specialAreas[i].area[1];
+ school.point[2] = map.specialAreas[i].leftPoints[1];
+ school.point[3] = map.specialAreas[i].leftPoints[0];
+
+ if (IntersectionOf(car->carXY[ car->axial[AXIAL_FRONT] ], &school) == GM_Containment) {
+ if (ConvertMs2KMh(speed) > PASS_SCHOOL_MAX_SPEED) {
+ if (!map.specialAreas[i].overSpeed) {
+ DEBUG("閫氳繃瀛︽牎鍖哄煙瓒呴��");
+ AddExamFault(49, rtkTime);
+ map.specialAreas[i].overSpeed = true;
+ }
+ }
+ }
+
+ free(school.point);
+ }
+ }
+}
+
#if 0
typedef struct {
diff --git a/lib/src/main/cpp/test_items2/road_exam.h b/lib/src/main/cpp/test_items2/road_exam.h
index 57a4f5c..30bdc7d 100644
--- a/lib/src/main/cpp/test_items2/road_exam.h
+++ b/lib/src/main/cpp/test_items2/road_exam.h
@@ -30,9 +30,6 @@
void InitRoadExam(road_exam_map &RoadMap);
void TerminateRoadExam(void);
void TestRoadGeneral(road_exam_map &RoadMap, const car_model *car, LIST_CAR_MODEL &CarModelList, double speed, int moveDirect, const struct RtkTime *rtkTime);
-void TestRoadGeneral(LIST_ROAD_MAP &RoadMapList, const car_model *car, LIST_CAR_MODEL &CarModelList, double speed, int moveDirect, const struct RtkTime *rtkTime);
-bool ExitSonArea(int index, LIST_ROAD_MAP &RoadMapList, const car_model *car);
-bool CrashSonRedLine(int index, LIST_ROAD_MAP &RoadMapList, const car_model *car, LIST_CAR_MODEL &CarModelList);
bool CrashTheLine(Line line, const car_model *car, LIST_CAR_MODEL &CarModelList);
PointF GetSELine(std::vector<edge_t> &edge, PointF point);
diff --git a/lib/src/main/cpp/test_items2/through_something.cpp b/lib/src/main/cpp/test_items2/through_something.cpp
index 5a87311..9c70cff 100644
--- a/lib/src/main/cpp/test_items2/through_something.cpp
+++ b/lib/src/main/cpp/test_items2/through_something.cpp
@@ -15,6 +15,7 @@
#define DEBUG(fmt, args...) LOGD("<through_something> <%s>: " fmt, __func__, ##args)
+#if 0
using namespace std;
static const double LASTEST_BREAK_POINT = 30.0;
@@ -26,7 +27,7 @@
static int stopActive;
static bool crashRedLine;
-static map<int, bool> breakRecord; // 璁板綍杞﹁締椹惰繃鍚勪釜鍋滄绾垮墠鍒硅溅鍔ㄤ綔
+
void StartThroughExam(int index, LIST_ROAD_MAP &RoadMapList)
{
@@ -155,101 +156,7 @@
return index;
}
+#endif
-
-void CheckBreakActive(road_exam_map &map, const car_model *car, LIST_CAR_MODEL &CarModelList)
-{
- int BreakDone = ReadCarStatus(BREAK);
-
- // 璁＄畻杞﹀墠杩涜建杩瑰欢闀跨嚎
- double yaw = YawOf(car->carXY[ car->axial[AXIAL_FRONT] ], car->carXY[ car->axial[AXIAL_REAR] ]);
- PointF extPoint = PointExtend(car->carXY[ car->axial[AXIAL_FRONT] ], LASTEST_BREAK_POINT, yaw);
- PointF extPoint2 = PointExtend(car->carXY[ car->axial[AXIAL_FRONT] ], NEXT_ROAD_TIP, yaw);
- Line extLine, extLine2;
- MakeLine(&extLine, &car->carXY[ car->axial[AXIAL_FRONT] ], &extPoint);
- MakeLine(&extLine2, &car->carXY[ car->axial[AXIAL_FRONT] ], &extPoint2);
-
- // 璺彛鍒硅溅鐐�
- for (int i = 0; i < map.roads.size(); ++i) {
- // 杞﹀ご鍜岃矾鍙ｈ窛绂讳笉瓒�30绫�
- if (IntersectionOf(extLine, map.roads[i].stopLine) == GM_Intersection &&
- IntersectionOfLine(car->carXY[ car->axial[AXIAL_FRONT] ], map.roads[i].stopLine) == 1 ) {
- DEBUG("杩涘叆鍑忛�熷尯");
- if (BreakDone == BREAK_ACTIVE) {
- auto itx = breakRecord.find(map.roads[i].id);
- if (itx != breakRecord.end()) {
- itx->second = true;
- }
- }
- }
- // 璺ㄧ嚎鍚庯紝妫�鏌ュ埞杞﹀姩浣�
- if (CrashTheLine(map.roads[i].stopLine, car, CarModelList)) {
- auto itx = breakRecord.find(map.roads[i].id);
- if (itx != breakRecord.end()) {
- if (itx->second == false) {
- // 涓嶆寜瑙勫畾鍑忛�燂紝涓嶅悎鏍�
- DEBUG("涓嶆寜瑙勫畾鍑忛��");
-
- }
- itx->second = false;
- }
- }
- }
- // 浜鸿閬撱�佸叕浜ょ珯鍒硅溅鐐癸紱瀛︽牎闄愰�熷尯
- for (int i = 0; i < map.specialAreas.size(); i++) {
- if (map.specialAreas[i].type == GRID_AREA)
- continue;
-
- if (map.specialAreas[i].area.size() == 2 && map.specialAreas[i].leftPoints.size() != 2) {
- // 璁＄畻鐐瑰埌宸︿晶璺竟绾跨殑鍨傜偣
- int road = 0;
- for (road = 0; road < map.roads.size(); ++road) {
- if (map.roads[road].id == map.specialAreas[i].road)
- break;
- }
-
- PointF vPoint = GetSELine(map.roads[road].leftEdge, map.specialAreas[i].area[0]);
- DEBUG("璁＄畻鍨傜偣1 (%f, %f)", vPoint.X, vPoint.Y);
-
- map.specialAreas[i].leftPoints.push_back(vPoint);
-
- vPoint = GetSELine(map.roads[road].leftEdge, map.specialAreas[i].area[0]);
- DEBUG("璁＄畻鍨傜偣2 (%f, %f)", vPoint.X, vPoint.Y);
- map.specialAreas[i].leftPoints.push_back(vPoint);
- }
-
- if (map.specialAreas[i].type == ZEBRA_CROSSING || map.specialAreas[i].type == BUS_STATION_AREA) {
- Line startLine;
-
- MakeLine(&startLine, &map.specialAreas[i].area[0], &map.specialAreas[i].leftPoints[0]);
-
- // 杞﹀ご鍜屾枒椹嚎璺濈涓嶈冻30绫�
- if (IntersectionOf(extLine, startLine) == GM_Intersection &&
- IntersectionOfLine(car->carXY[ car->axial[AXIAL_FRONT] ], startLine) == 1 ) {
- DEBUG("杩涘叆鍑忛�熷尯");
- if (BreakDone == BREAK_ACTIVE) {
- auto itx = breakRecord.find(map.specialAreas[i].id);
- if (itx != breakRecord.end()) {
- itx->second = true;
- }
- }
- }
-
- // 璺ㄧ嚎鍚庯紝妫�鏌ュ埞杞﹀姩浣�
- if (CrashTheLine(startLine, car, CarModelList)) {
- auto itx = breakRecord.find(map.specialAreas[i].id);
- if (itx != breakRecord.end()) {
- if (itx->second == false) {
- // 涓嶆寜瑙勫畾鍑忛�燂紝涓嶅悎鏍�
- DEBUG("涓嶆寜瑙勫畾鍑忛��");
- }
- itx->second = false;
- }
- }
- } else if (map.specialAreas[i].type == SCHOOL_AREA) {
-
- }
- }
-}
diff --git a/lib/src/main/cpp/test_items2/through_something.h b/lib/src/main/cpp/test_items2/through_something.h
index dc3ee53..f677d5b 100644
--- a/lib/src/main/cpp/test_items2/through_something.h
+++ b/lib/src/main/cpp/test_items2/through_something.h
@@ -6,11 +6,11 @@
#define MYAPPLICATION2_THROUGH_SOMETHING_H
#include "../driver_test.h"
-
+/*
void StartThroughExam(int index, LIST_ROAD_MAP &RoadMapList);
void InitThroughSomething(road_exam_map &RoadMap);
void CheckBreakActive(road_exam_map &map, const car_model *car, LIST_CAR_MODEL &CarModelList);
int ExecuteThroughExam(int index, LIST_ROAD_MAP &RoadMapList, const car_model *car,
LIST_CAR_MODEL &CarModelList, double speed, int moveDirect, const struct RtkTime *rtkTime);
-
+*/
#endif //MYAPPLICATION2_THROUGH_SOMETHING_H
--
Gitblit v1.8.0