20200723

yy1717

2020-07-23 27c78b3431a38878b8c8b1b81c79694cea4a2bcf

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

@@ -72,9 +72,9 @@
        reportOffsetOver = true;

        //////////////////////////////////////////////
        startPoint = car->basePoint;
        edgeDistance = dis2roadEdge;
        reportOffsetOver = false;
//        startPoint = car->basePoint;
//        edgeDistance = dis2roadEdge;
//        reportOffsetOver = false;
    }

    if (distanceToStart > CHECK_STAGE_DISTANCE) {
@@ -99,6 +99,7 @@
    if (id == examTtsSeq) {
        DEBUG("StopCarTTSDone %d", id);
        ttsPlayEnd = 1;
        AppTimer_delete(PlayTTSTimeout);
    }
}

@@ -141,9 +142,11 @@

FIND_VP_END:
    if (get_vp) {
        DEBUG("得到垂点 %d: %f, %f -- %f, %f", road.id, car->basePoint.X, car->basePoint.Y, vp.X, vp.Y);
        distance = DistanceOf(car->basePoint, vp);
    } else {
        // 没有找到匹配线端，按最小距离顶点计算
        DEBUG("无垂点");
        distance = 100;
        for (int i = 0; i < road.leftEdge.size(); ++i) {
            for (int j = 0; j < road.leftEdge[i].points.size(); ++j) {