#include "by_tiny_frame_parse.h"

#include "crc16.h"
#include "lwrb.h"

lwrb_t lwrb_struct;
uint8_t buffer_rb[BY_TF_PARSE_BUFFER_SIZE];
uint8_t buffer_out;
by_tf_parse_frame_t frame_now;

void by_tiny_frame_parse_init(void)
{
    /** 初始化环形缓冲区 **/
    lwrb_init(&lwrb_struct, buffer_rb, 40);
}

uint8_t by_tiny_frame_parse_listening(by_tf_parse_frame_t *frame_s, const uint8_t slave_id, const uint8_t buff)
{

    static uint8_t cnt_s      = 0;
    static uint8_t cnt_rest_s = 0;

#if (BY_TF_DEBUG)
    printf("%0.2X\r\n", buff);
#endif

    do {

#if defined(BY_TF_DEVICE_SLAVE)
        if ((0 == cnt_s) && ((slave_id << 1) == buff)) {
#else
        if ((0 == cnt_s) && (((slave_id << 1) + 1) == buff)) {
#endif
            memset(frame_s, 0, sizeof(*frame_s));
            cnt_s             = 1;
            cnt_rest_s        = 9;
            frame_s->frame[0] = buff;
            break;
        }

        if (1 <= cnt_s) {
            frame_s->frame[cnt_s] = buff;
            cnt_s++;
        }

        if (0 == --cnt_rest_s) {
            cnt_s = 0;

            frame_s->cmd = frame_s->frame[1];
            frame_s->reg_addr |= ((uint16_t)frame_s->frame[2] << 8);
            frame_s->reg_addr |= (uint16_t)frame_s->frame[3];
            frame_s->data |= ((uint32_t)frame_s->frame[4] << 24);
            frame_s->data |= ((uint32_t)frame_s->frame[5] << 16);
            frame_s->data |= ((uint32_t)frame_s->frame[6] << 8);
            frame_s->data |= (uint32_t)frame_s->frame[7];
            frame_s->crc_val |= ((uint16_t)frame_s->frame[8] << 8);
            frame_s->crc_val |= (uint16_t)frame_s->frame[9];
            return 0;
        }
    } while (0);

    return 1;
}

void by_tiny_frame_parse_uart_handle(uint8_t buff)
{
    lwrb_write(&lwrb_struct, &buff, 1);
}

void by_tiny_frame_parse_run(void)
{
    for (uint8_t i = 0; i < lwrb_get_full(&lwrb_struct); i++) {

        if (!lwrb_read(&lwrb_struct, &buffer_out, 1)) {
            break;
        }

        // TODO 待结合 read&wirte 部分修改监听的从机地址
        if (!by_tiny_frame_parse_listening(&frame_now, 0x0D, buffer_out)) {
            if (!by_tiny_frame_parse_crc(&frame_now)) {

#if (BY_TF_DEBUG)
                printf("frame parsed!\r\n");
#endif
                // 解析帧
            }
        }
        // if (!mp_cmd_parse_modbus_handle(data)) {
        //     mp_cmd_mb_parse(&mp_cmd_mb_now, &mp_cmd_parsed_now);
        // }
    }
}

uint8_t by_tiny_frame_parse_crc(by_tf_parse_frame_t *frame_s)
{
    uint16_t calc_crc_val = 0;

    calc_crc_val = crc16_check(frame_s->frame, (sizeof(frame_s->frame) - 2));

#if (BY_TF_DEBUG)
    printf("get: %0.2X", frame_s->crc_val);
    printf("\r\n");

    printf("cal: %0.2X", calc_crc_val);
    printf("\r\n");
#endif

    if ((frame_s->crc_val == calc_crc_val) || (frame_s->crc_val == 0xFFFF)) {
        return 0;
    }

    return 1;
}