yy1717
2020-08-21 8a09b209f1c546a2fa15329e8f69b4a4f89557c9
lib/src/main/cpp/test_items2/operate_gear.cpp
@@ -19,7 +19,6 @@
static int setup;
static double maxMoveDistance;
static double gearMoveDistance;
static void TtsBack(int seq)
{
@@ -37,6 +36,8 @@
bool TestOperateGear(const struct RtkTime *rtkTime)
{
    static struct RtkTime shiftTime;
    car_sensor_value_t sensor = ReadCarSensorValue(GEAR);
    if (sensor.name != GEAR)
@@ -92,11 +93,11 @@
            return false;
        } else {
            // 在此挡位行驶一定距离,再执行下一个
            gearMoveDistance = ReadOdo();
            shiftTime = *rtkTime;
            setup = 3;
        }
    } else if (setup == 3) {
        if (ReadOdo() - gearMoveDistance > 10) {
        if (TimeGetDiff(&shiftTime, rtkTime) >= D_SEC(5)) {
            setup = 4;
            char buff[128];
            expectGear += 0 - upDownShift;
@@ -113,11 +114,11 @@
            return false;
        } else {
            // 在此挡位行驶一定距离,再执行下一个
            gearMoveDistance = ReadOdo();
            shiftTime = *rtkTime;
            setup = 5;
        }
    } else if (setup == 5) {
        if (ReadOdo() - gearMoveDistance > 10) {
        if (TimeGetDiff(&shiftTime, rtkTime) >= D_SEC(5)) {
            PlayTTS("加减挡位操作结束", NULL);
            return false;
        }