//
|
// Created by YY on 2020/8/20.
|
//
|
|
#include "car_start.h"
|
#include "../driver_test.h"
|
#include "../test_common/odo_graph.h"
|
#include "../native-lib.h"
|
#include "../test_common/car_sensor.h"
|
#include "road_exam.h"
|
#include "../jni_log.h"
|
#include "../common/apptimer.h"
|
|
#define DEBUG(fmt, args...) LOGD("<road_exam car_start> <%s>: " fmt, __func__, ##args)
|
|
static double startCarMoveDistance;
|
static bool checkEngineRPM, checkStartCarSignal, checkDoor, handBreakActive;
|
|
void cb(int seq)
|
{
|
DEBUG("语音结束 %d", seq);
|
}
|
|
void CarStartInit(void)
|
{
|
startCarMoveDistance = ReadOdo();
|
checkEngineRPM = false;
|
checkStartCarSignal = false;
|
checkDoor = false;
|
handBreakActive = false;
|
PlayTTS(examParam.start_car_begin_tts, cb);
|
|
DEBUG("车辆起步");
|
}
|
|
bool TestCarStart(const car_model *car, double speed, int moveDirect, const struct RtkTime *rtkTime)
|
{
|
car_sensor_value_t sensor;
|
double moveDistance = ReadOdo() - startCarMoveDistance;
|
|
// DEBUG("起步行驶距离 %f", moveDistance);
|
|
if (!checkStartCarSignal && moveDirect == 1) {
|
checkStartCarSignal = true;
|
|
sensor = ReadCarSensorValue(TURN_SIGNAL_LAMP);
|
if (sensor.name == TURN_SIGNAL_LAMP) {
|
if (sensor.value != LEFT_TURN_LIGHT) {
|
DEBUG("变调未打灯!!");
|
// 没打灯，不合格
|
AddExamFault(30121, rtkTime);
|
} else if (TimeGetDiff(rtkTime, &sensor.time) < D_SEC(3)) {
|
DEBUG("转向灯时间不足");
|
// 不足3秒，不合格
|
AddExamFault(30122, rtkTime);
|
}
|
}
|
}
|
|
if (moveDistance > examParam.start_car_limit_distance) {
|
/*sensor = ReadCarSensorValue(HAND_BREAK);
|
if (sensor.name == HAND_BREAK && sensor.value == BREAK_ACTIVE) {
|
DEBUG("Handbreak active move over 10m");
|
// 手刹拉起状态下，行驶了10米以上，不合格
|
AddExamFault(40205, rtkTime);
|
} else if (handBreakActive) {
|
// 手刹拉起状态下，行驶了1米以上，扣10分
|
DEBUG("Handbreak active move over 1M");
|
AddExamFault(40206, rtkTime);
|
}*/
|
|
PlayTTS(examParam.start_car_end_tts, NULL);
|
DEBUG("############# 完成起步 ############");
|
|
return false;
|
} else if (moveDistance >= examParam.open_door_drive_allow_distance) {
|
if (!checkDoor) {
|
checkDoor = true;
|
|
sensor = ReadCarSensorValue(DOOR);
|
if (sensor.name == DOOR && sensor.value == DOOR_OPEN) {
|
// 车门未完全关闭，不合格
|
DEBUG("车门未关闭");
|
AddExamFault(40202, rtkTime);
|
}
|
|
sensor = ReadCarSensorValue(HAND_BREAK);
|
if (sensor.name == HAND_BREAK && sensor.value == BREAK_ACTIVE) {
|
handBreakActive = true;
|
}
|
}
|
}
|
|
if (ReadCarStatus(ENGINE_RPM) > examParam.start_car_max_rpm && !checkEngineRPM) {
|
// 转速超标，不合格
|
DEBUG("转速超标");
|
AddExamFault(40210, rtkTime);
|
checkEngineRPM = true;
|
}
|
|
return true;
|
}
|
