修改了上坡起步。

fctom1215

2020-02-11 3ce7d9cbccabf7f94d8203a98796599cd9dd5411

 lib/src/main/cpp/test_items/park_edge.cpp

@@ -98,15 +98,18 @@

    if (moveStatus != prevMoveStatus) {
        if (moveStatus == 0) {
            DEBUG("停车了");
            parkStatus = 0;
            stopTimepoint = TimeMakeComposite(2000 + rtkTime->YY, rtkTime->MM, rtkTime->DD, rtkTime->hh, rtkTime->mm, rtkTime->ss);
            stopTimepoint = stopTimepoint * 1000 + rtkTime->mss*10;
            storeMoveStatusBeforeStop = prevMoveStatus;

            DEBUG("停车了 %d %d %d %d %d %d %d", rtkTime->YY, rtkTime->MM, rtkTime->DD, rtkTime->hh, rtkTime->mm, rtkTime->ss, rtkTime->mss);
        } else {
            DEBUG("继续行驶");
            DEBUG("继续行驶 %d %d %d %d %d %d %d", rtkTime->YY, rtkTime->MM, rtkTime->DD, rtkTime->hh, rtkTime->mm, rtkTime->ss, rtkTime->mss);
            uint64_t tp = TimeMakeComposite(2000 + rtkTime->YY, rtkTime->MM, rtkTime->DD, rtkTime->hh, rtkTime->mm, rtkTime->ss);
            tp = tp * 1000 + rtkTime->mss * 10;

            DEBUG("停车时间 %ld", tp - stopTimepoint);

            if (moveStatus == storeMoveStatusBeforeStop) {
                // 同方向再启动，继续判断是否停车超时
@@ -127,6 +130,13 @@
                        AddExamFault(21, rtkTime);
                        DEBUG("移库不入");
                        status = -1;
                    }

                    // 在这里检查转向灯状态
                    if (true) {
                        // 不开转向灯，扣10分
                        AddExamFault(25, rtkTime);
                        DEBUG("未开启转向灯");
                    }
                }
            }
@@ -232,7 +242,6 @@
    CleanPolygon(&parking);
    free(car_body.point);

    DEBUG("检查停车到位结束");
    return succ;
}