//
// Created by fctom on 2020/2/13.
//

#include "comm_test.h"
#include "../driver_test.h"
#include "../defs.h"

static bool seatbeltInsert;
static bool engineStart;

const int ENGINE_MIN_ROTATE = 200;

static uint16_t gpioStore = 0;
static uint16_t engineStore = 0;

static void SensorChange(int index, bool value);

void CommTestStart(void)
{
    gpioStore = engineStore = 0;
}

void UpdateSensor(uint16_t gpio, uint16_t speed, uint16_t engine)
{
    int idx, lvl;

    uint16_t chg = gpioStore^gpio;

    if (chg == 0)
        return;

    for (int i = 0; i < 16; ++i) {
        if (chg & BV(i)) {
            SensorChange(i, (bool)(gpio & BV(i)));
        }
    }

    gpioStore = gpio;



    // 安全带

    // 挡位

    // 启动指示

    // 熄火监控
}

static void SensorChange(int index, bool value)
{
    int func;

    switch (func) {
        case SENSOR_SEATBELT:
            break;
        case SENSOR_TURNRIGHT:
            break;

    }
}