#include "slaveMcuDataParse.h"
#include "slaveMcuComm.h"

static void stateMachine(void);

/* 状态机函数 */
static uint8_t analysisWait(void);
static uint8_t analysisStartFlagSL(void);
static uint8_t analysisPortSL(void);
static uint8_t analysisLengthSL(void);
static uint8_t analysisEndFlagSL(void);

/**
  * @brief  状态机函数
  * @param 
  * @retval 
  */
void stateMachine(void)
{
    if (state == wait) {
        if (analysisWait() == TRUE) {
            mcuUartRxTime = xTaskGetTickCount();
        }
    }

    else if (state == startFlagSL) {
        analysisStartFlagSL();
    }

    else if (state == portSL) {
        analysisPortSL();
    }

    else if (state == lengthSL) {
        analysisLengthSL();
    }

    else if (state == endFlagSL) {
        analysisEndFlagSL();
    }
}


/**
  * @brief  状态 wait
  * @param
  * @retval 0:解析失败
            1:解析成功
  */
#define waitMaxLen 2
uint8_t analysisWait(void)
{
    if (mcuUartRxBufferIndex >= 2) {
        /* 透传数据帧包头 */
        if (mcuUartRxBuffer[0] == 'S' && mcuUartRxBuffer[1] == 'L') {
            // log_info("startFlagSL\n");
            state = startFlagSL;
            return TRUE;
        }
    }

    if (mcuUartRxBufferIndex < waitMaxLen) {
        return FALSE;
    }

    state = wait;
    mcuUartRxBufferIndex--;
    memcpy(mcuUartRxBuffer, mcuUartRxBuffer + 1, mcuUartRxBufferIndex);

    return FALSE;
}

/**
  * @brief  状态 startFlagSL
  * @param
  * @retval 0:解析失败
            1:解析成功
  */
uint8_t analysisStartFlagSL(void)
{
    /* 校验端口号 */
    if (mcuUartRxBuffer[2] < 13) {
        // log_info("portSL\n");
        state = portSL;
        return TRUE;
    }

    // log_error("portSL %d \n", gw485RxBuffer[2]);
    state = wait;
    mcuUartRxBufferIndex--;
    memcpy(mcuUartRxBuffer, mcuUartRxBuffer + 1, mcuUartRxBufferIndex);
    return FALSE;
}

/**
  * @brief  状态 portSL
  * @param
  * @retval 0:解析失败
            1:解析成功
  */
#define PortSLMaxLen 5
uint8_t analysisPortSL(void)
{
    /* 解析数据包的度 */
    if (mcuUartRxBufferIndex >= PortSLMaxLen) {
        uint32_t tempLen = 0;
        tempLen = (mcuUartRxBuffer[3] << 8) | mcuUartRxBuffer[4];

        if (tempLen <= 1024) {
            // log_info("lengthSL\n");
            state = lengthSL;
            frameLength = 6 + tempLen;
            return TRUE;
        }
    }

    if (mcuUartRxBufferIndex < PortSLMaxLen) {
        return FALSE;
    }
    
    // log_error("lengthSL %d \n", (gw485RxBuffer[3] << 8) | gw485RxBuffer[4]);

    state = wait;
    mcuUartRxBufferIndex--;
    memcpy(mcuUartRxBuffer, mcuUartRxBuffer + 1, mcuUartRxBufferIndex);
    return FALSE;
}

/**
  * @brief  状态 lengthSL
  * @param
  * @retval 0:解析失败
            1:解析成功
  */
#define LengthSLMaxLen frameLength
uint8_t analysisLengthSL(void)
{
    /* 解析帧尾 */
    if (mcuUartRxBufferIndex >= LengthSLMaxLen) {
        if (mcuUartRxBuffer[LengthSLMaxLen - 1] == 0x17) {
            // log_info("endFlagSL\n");
            state = endFlagSL;
            return TRUE;
        }
    }

    if (mcuUartRxBufferIndex < LengthSLMaxLen) {
        return FALSE;
    }
    // log_info("endFlagSL %d\n", gw485RxBuffer[LengthSLMaxLen - 1]);

    state = wait;
    mcuUartRxBufferIndex--;
    memcpy(mcuUartRxBuffer, mcuUartRxBuffer + 1, mcuUartRxBufferIndex);
    return FALSE;
}

/**
  * @brief  状态 endFlagSL
  * @param
  * @retval 0:解析失败
            1:解析成功
  */
uint8_t analysisEndFlagSL(void)
{
    uint32_t tempLen = 0;
    tempLen = (mcuUartRxBuffer[3] << 8) | mcuUartRxBuffer[4];

    if (mcuUartRxBuffer[2] == SlaveMcu) {
        slaveFrameDataAnalyze(mcuUartRxBuffer, mcuUartRxBufferIndex);
        mcuUartRxBufferIndex = 0;
        state = wait;
        return 1;
    }

    //系统内存不足，丢去当前包
    if (xPortGetFreeHeapSize() < tempLen + 1024) {
        goto err;
    }

    /* 对于不同通端口，传输的结构体不同 */
    uint8_t *Buff;

    Buff = (uint8_t *)pvPortMalloc(tempLen + slaveQueueUartSendInfoSize);
    slaveQueueUartSendInfo *sendBuff = (slaveQueueUartSendInfo *)Buff;
    sendBuff->length = tempLen;
    sendBuff->data = Buff + slaveQueueUartSendInfoSize;
    memcpy((char *)sendBuff->data, (char *)&mcuUartRxBuffer[5], tempLen);


    /* 通过不同的端口将数据发送到不同的地方 */
    if (mcuUartRxBuffer[2] == J1) {
        if (uxQueueSpacesAvailable(J1_485_Queue)) {
            xQueueSend(J1_485_Queue, &Buff, 10);
        }
        /* 队列中无空间，释放内存，退出 */
        else {
            vPortFree(Buff);
        }
    }
    else if (mcuUartRxBuffer[2] == J3) {
        if (uxQueueSpacesAvailable(J3_485_Queue)) {
            xQueueSend(J3_485_Queue, &Buff, 10);
        }
        /* 队列中无空间，释放内存，退出 */
        else {
            vPortFree(Buff);
        }
    }    
    else if (mcuUartRxBuffer[2] == J5) {
        if (uxQueueSpacesAvailable(J5_485_Queue)) {
            xQueueSend(J5_485_Queue, &Buff, 10);
        }
        /* 队列中无空间，释放内存，退出 */
        else {
            vPortFree(Buff);
        }
    }    
    else if (mcuUartRxBuffer[2] == J7) {
        if (uxQueueSpacesAvailable(J7_485_Queue)) {
            xQueueSend(J7_485_Queue, &Buff, 10);
        }
        /* 队列中无空间，释放内存，退出 */
        else {
            vPortFree(Buff);
        }
    }
    else if (mcuUartRxBuffer[2] == J8) {
        if (uxQueueSpacesAvailable(J8_485_Queue)) {
            xQueueSend(J8_485_Queue, &Buff, 10);
        }
        /* 队列中无空间，释放内存，退出 */
        else {
            vPortFree(Buff);
        }
    }
    else if (mcuUartRxBuffer[2] == J9) {
        if (uxQueueSpacesAvailable(J9_485_Queue)) {
            xQueueSend(J9_485_Queue, &Buff, 10);
        }
        /* 队列中无空间，释放内存，退出 */
        else {
            vPortFree(Buff);
        }
    }

err:
    //清零buff
    state = wait;
    mcuUartRxBufferIndex = 0;
    return 1;
}

/**
  * @brief  解析智能模块发送来的数据
  * @param  device 用于接收智能模块发送来的数据的串口设备
  * @retval
  */
void slaveMcuUartDataAnalysis(device_handle device)
{
    /* 每次函数最多执行10ms */
    static uint32_t tickstart = 0U;
    tickstart = xTaskGetTickCount();

    /* 2S未解析出来一帧数据，将数据清零 */
    if (getTickDiff(mcuUartRxTime) >= tick_2S) {
        mcuUartRxTime = xTaskGetTickCount();
        mcuUartRxBufferIndex = 0;
        state = wait;
    }

    while (uart_dev_char_present(device) == 1 && ((xTaskGetTickCount() - tickstart) < 5)) {
        mcuUartRxBuffer[mcuUartRxBufferIndex++] = uart_dev_in_char(device);
        stateMachine();
    }

    if (uart_dev_char_present(device) != 1 && state != wait) {        
        stateMachine();
    }
}