坐标

yy1717

2020-09-21 f1ff7e339eca91b114497d3e847fa1fc33baccc4

 lib/src/main/cpp/driver_test.cpp

@@ -896,6 +896,8 @@
    return true;
}

static int currRoad = -1, currCrossing = -1;

void RoadChange(int road, int status)
{
    struct roadStatusBrief brief;
@@ -904,6 +906,8 @@
    brief.status = status;

    MA_SendRoadStatus(&brief);

    currRoad = (status == 1? road : -1);

    DEBUG("报告长官 进出路段 road %d status %d", road, status);
}
@@ -917,6 +921,8 @@
    brief.status = status;

    MA_SendCrossingStatus(&brief);

    currCrossing = (status == 1? crossing : -1);

    DEBUG("报告长官 进出路口 road %d crossing %d status %d", road, crossing, status);
}
@@ -947,6 +953,35 @@
    ExamFaultList.clear();
}

void MasterInqRoadStatus(void)
{
    struct roadStatusBrief brief;
    struct crossingStatusBrief brief2;

    brief2.road_id = brief.road_id = currRoad;

    if (currRoad >= 0) {
        brief.status = 1;

        if (currCrossing >= 0) {
            brief2.crossing_index = currCrossing;
            brief2.status = 1;
        } else {
            brief2.crossing_index = -1;
            brief2.status = 0;
        }
    }
    else {
        brief.status = 0;
        brief2.crossing_index = -1;
        brief2.status = 0;
    }

    MA_SendRoadStatus(&brief);

    MA_SendCrossingStatus(&brief2);
}

/*******************************************************************
 * @brief 由主天线坐标计算车身点坐标
 * @param azimuth