| | |
| | | static int setup; |
| | | |
| | | static double maxMoveDistance; |
| | | static double gearMoveDistance; |
| | | |
| | | static void TtsBack(int seq) |
| | | { |
| | |
| | | |
| | | bool TestOperateGear(const struct RtkTime *rtkTime) |
| | | { |
| | | static struct RtkTime shiftTime; |
| | | |
| | | car_sensor_value_t sensor = ReadCarSensorValue(GEAR); |
| | | |
| | | if (sensor.name != GEAR) |
| | |
| | | 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; |
| | |
| | | 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; |
| | | } |