//
|
// Created by YY on 2019/10/21.
|
//
|
|
#ifndef RTKDRIVERTEST_DRIVER_TEST_H
|
#define RTKDRIVERTEST_DRIVER_TEST_H
|
|
#include "Geometry.h"
|
#include "rtk_module/rtk.h"
|
#include "test_items2/dummy_light.h"
|
|
#include <vector>
|
#include <string>
|
#include <list>
|
|
#define EXAM_AREA_NONE 0
|
#define EXAM_AREA_START 1
|
#define EXAM_AREA_RUN 2
|
#define EXAM_AREA_END 3
|
|
#define TIRE_OUTSIDE 0
|
#define TIRE_INSIDE 1
|
#define AXIAL_FRONT 0
|
#define AXIAL_REAR 1
|
|
using namespace std;
|
|
struct car_desc_ {
|
double distance; // 距离主天线的距离
|
double angle; // 从中轴线逆时针形成的角度
|
};
|
|
struct RtkTime {
|
int YY;
|
int MM;
|
int DD;
|
int hh;
|
int mm;
|
int ss;
|
int mss;
|
};
|
|
typedef struct {
|
struct RtkTime tm;
|
PointF basePoint; // 现场测量的主天线坐标
|
int axial[2];
|
int left_front_tire[2];
|
int right_front_tire[2];
|
int left_rear_tire[2];
|
int right_rear_tire[2];
|
int bodyNum;
|
int *body;
|
int pointNum;
|
double antPitch; // 前后天线因安装位置之固有pitch角
|
double yaw;
|
double pitch;
|
struct car_desc_ *carDesc; // 经现场测量点计算后的值
|
PointF *carXY; // 计算后的车身各点坐标
|
} car_model;
|
|
// 总数
|
// 中轴线前点,id 0，中轴线后点id
|
// 左包围， 右包围
|
// 左前轮，外内
|
typedef struct {
|
int body_num;
|
int body[64];
|
int front_left_tire[2];
|
int front_right_tire[2];
|
int rear_left_tire[2];
|
int rear_right_tire[2];
|
} carModelDesc_t;
|
|
typedef struct {
|
uint32_t uptime;
|
int point_num;
|
PointF *points;
|
carModelDesc_t *desc;
|
} car_model_cache_t;
|
|
struct ExamFault {
|
int sn;
|
char utc[32];
|
int wrong_id;
|
};
|
|
struct trigger_line_t {
|
int triggerMapId;
|
Polygon line;
|
};
|
|
struct road_exam_map {
|
int id;
|
int type;
|
|
string tts;
|
|
int redLineNum;
|
Polygon *redLine;
|
|
int greenLineNum;
|
Polygon *greenLine;
|
|
int redAreaNum;
|
Polygon *redArea;
|
|
int triggerLineNum;
|
trigger_line_t *triggerLine;
|
|
Polygon area; // 子项目的区域
|
Line stopLine; // 诸如人行道、路口等考点的停止线
|
int flagStop; // 到达开始线前，是否需要停车
|
};
|
|
typedef vector<struct road_exam_map> LIST_ROAD_MAP;
|
|
typedef list<car_model *> LIST_CAR_MODEL;
|
|
//vector<ExamFault> ExamFaultList;
|
|
void DriverTestInit(void);
|
void ReadDriverExamPrimer(void);
|
void ClearMap(void);
|
void AddMap(int id, int type, const double (*map)[2], int pointNum, const double (*map2)[2], int pointNum2);
|
void CleanRoadMap(void);
|
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<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,
|
int *body, int bodyNum, double (*point)[2], int pointNum, double antPitch);
|
|
void StartDriverExam(int start, int type);
|
void StartMapExam(int map_id, int exam);
|
|
void UpdateRTKInfo(const rtk_info *s);
|
void AddExamFault(int wrong, const struct RtkTime *rtkTime);
|
car_model_cache_t *GetCarModelCache(int node);
|
void SystemShutdown(int event, int timeout);
|
|
void SetDummyLightExam(int n, struct dummy_light_exam *cfg);;
|
|
#endif //RTKDRIVERTEST_DRIVER_TEST_H
|
