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