//
// Created by YY on 2020/3/25.
//

#include "operate_gear.h"
#include "../driver_test.h"
#include "../common/apptimer.h"
#include "../native-lib.h"
#include "../test_common/car_sensor.h"
#include "../jni_log.h"

#define DEBUG(fmt, args...)     LOGD("<operate_gear> <%s>: " fmt, __func__, ##args)

static int opGear;
static bool testing;
static int examTtsSeq = 0;
static int expectGear;
static int upDownShift;
static bool checkError;
static int opCnt = 0;

enum {
    START_GEAR,
    WAIT_TTS_END,
    TTS_END,
    WAITE_CHECK,
    CHECKED
};

static void CheckGear(union sigval sig);

void StartOperateGearExam(int index, LIST_ROAD_MAP &RoadMapList) {
    if (index == -1)
        return;

    testing = true;
    opGear = START_GEAR;
    checkError = false;
    upDownShift = 0;
    opCnt = 0;
}

void TerminateOperateGearExam(void)
{
    AppTimer_delete(CheckGear);
}

int ExecuteOperateGearExam(int index, LIST_ROAD_MAP &RoadMapList, const car_model *car,
                       LIST_CAR_MODEL &CarModelList, double speed, int moveDirect, const struct RtkTime *rtkTime) {
    DEBUG("opGear %d", opGear);

    if (opGear == START_GEAR) {
        int currGear = ReadCarStatus(GEAR);
        switch (currGear) {
            case GEAR_1: {
                opGear = WAIT_TTS_END;
                upDownShift = 1;
                expectGear = GEAR_2;
                examTtsSeq = PlayTTS("请加到二挡");
                break;
            }
            case GEAR_2: {
                opGear = WAIT_TTS_END;
                if (upDownShift == 0) {
                    upDownShift = 1;
                    expectGear = GEAR_3;
                    examTtsSeq = PlayTTS("请加到三挡");
                } else if (upDownShift == 1) {
                    upDownShift = -1;
                    expectGear = GEAR_1;
                    examTtsSeq = PlayTTS("请减到一挡");
                } else {
                    upDownShift = 1;
                    expectGear = GEAR_3;
                    examTtsSeq = PlayTTS("请加到三挡");
                }
                break;
            }
            case GEAR_3: {
                opGear = WAIT_TTS_END;
                if (upDownShift == 0) {
                    upDownShift = -1;
                    expectGear = GEAR_2;
                    examTtsSeq = PlayTTS("请减到二挡");
                } else if (upDownShift == 1) {
                    upDownShift = -1;
                    expectGear = GEAR_2;
                    examTtsSeq = PlayTTS("请减到二挡");
                } else {
                    upDownShift = 1;
                    expectGear = GEAR_4;
                    examTtsSeq = PlayTTS("请加到四挡");
                }
                break;
            }
            case GEAR_4: {
                opGear = WAIT_TTS_END;
                if (upDownShift == 0) {
                    upDownShift = -1;
                    expectGear = GEAR_3;
                    examTtsSeq = PlayTTS("请减到三挡");
                } else if (upDownShift == 1) {
                    upDownShift = -1;
                    expectGear = GEAR_3;
                    examTtsSeq = PlayTTS("请减到三挡");
                } else {
                    upDownShift = 1;
                    expectGear = GEAR_5;
                    examTtsSeq = PlayTTS("请加到五挡");
                }
                break;
            }
            case GEAR_5: {
                opGear = WAIT_TTS_END;
                upDownShift = -1;
                expectGear = GEAR_4;
                examTtsSeq = PlayTTS("请减到四挡");
                break;
            }
            default:
                // 未读到有效挡位，继续尝试
                break;
        }
    } else if (opGear == WAIT_TTS_END) {

    } else if (opGear == TTS_END) {
        opCnt++;
        opGear = WAITE_CHECK;
        checkError = false;
        AppTimer_delete(CheckGear);
        AppTimer_add(CheckGear, D_SEC(5));
    } else if (opGear == CHECKED) {
        if (checkError) {
            // 未按指令操作挡位，不合格
            DEBUG("未按指令操作挡位");
            AddExamFault(31, rtkTime);
        }

        if (opCnt < 2) {
            opGear = START_GEAR;
        } else {
            testing = false;
        }
    }

    return testing ? index : -1;
}

void OperateGearTTSDone(int id)
{
    DEBUG("OperateGearTTSDone %d", id);
    // 等语音播报完毕后计时
    if (id == examTtsSeq) {
        opGear = TTS_END;
    }
}

static void CheckGear(union sigval sig)
{
    AppTimer_delete(CheckGear);

    DEBUG("检测挡位 %d", expectGear);
    // 检查挡位
    if (ReadCarStatus(GEAR) != expectGear) {
        // 不执行指定挡位，不合格
        checkError = true;
    }
    opGear = CHECKED;
}