进出科目二区域调整

yy1717

2020-04-02 24428a1b69afcf113883e9cede1159443201a1b8

 lib/src/main/cpp/test_items2/drive_straight.cpp

@@ -7,6 +7,7 @@
#include "../native-lib.h"
#include "../jni_log.h"
#include "road_exam.h"
#include "../master/comm_if.h"
#include <cmath>

#define DEBUG(fmt, args...)     LOGD("<drive_straight> <%s>: " fmt, __func__, ##args)
@@ -43,6 +44,14 @@

    MakeLine(&road_edge, &RoadMapList[index].roadEdgeLine[0].point[0], &RoadMapList[index].roadEdgeLine[0].point[1]);

    {
        double l1 = DistanceOf(car->carXY[car->right_front_tire[TIRE_OUTSIDE]], road_edge);

        double l2 = DistanceOf(car->carXY[car->right_rear_tire[TIRE_OUTSIDE]], road_edge);

        MA_SendDistance(-1, (l1+l2)/2.0);
    }

    if (!crossStartLine) {
        PointF p1, p2;