QDAC-firmware/app/tiny_frame/by_tiny_frame_parse.c

#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;
uint8_t listern_slave_id;
uint8_t listern_flag;
uint16_t listern_timeout;
uint16_t listern_timevia;
by_tf_parse_frame_t frame_now;
by_tf_parse_done_handle_func parse_done_handle;

void by_tiny_frame_parse_init(void)
{
#if defined(BY_TF_DEVICE_MASTER)
    listern_timeout = BY_TF_PARSE_TIMEOUT;
#endif

    /** 初始化环形缓冲区 **/
    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;
}

/**
 * @brief by_tf_parse 串口回调函数，在对应串口中断函数中调用
 *
 * @param buff
 */
void by_tiny_frame_parse_uart_handle(uint8_t buff)
{
    lwrb_write(&lwrb_struct, &buff, 1);
}

/**
 * @brief by_tf_parse 定时回调函数，要求触发周期为 1ms
 *
 */
void by_tiny_frame_parse_timer_handle(void)
{
#if defined(BY_TF_DEVICE_MASTER)
    if (listern_flag) {
        listern_timevia++;
    } else {
        listern_timevia = 0;
    }
#endif
}

/**
 * @brief
 *
 */
void by_tiny_frame_parse_run(void)
{

#if defined(BY_TF_DEVICE_MASTER)
    if (0 == listern_flag) {
        return;
    } else {
        if (listern_timeout <= listern_timevia) {
            // 接收超时，停止监听
            parse_done_handle(frame_now, 1);
            by_tiny_frame_parse_end_listern();
#if (BY_TF_DEBUG)
            printf("by_tf_listern timeout\r\n");
#endif
        }
    }
#endif

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

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

// TODO 目前接收校验错误也会等待直至超时
// TODO 待结合 read&wirte 部分修改监听的从机地址
#if defined(BY_TF_DEVICE_SLAVE)
        if (!by_tiny_frame_parse_listening(&frame_now, BY_TF_DEVICE_SLAVE_ADDRESS, buffer_out))
#else
        if (!by_tiny_frame_parse_listening(&frame_now, listern_slave_id, buffer_out))
#endif
        {
            if (!by_tiny_frame_parse_crc(&frame_now)) {

                // 接收成功后停止监听
                by_tiny_frame_parse_end_listern();
                // 解析成功回调
                parse_done_handle(frame_now, 0);
#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;
    }

    // 校验错误则直接结束监听
    by_tiny_frame_parse_end_listern();
    parse_done_handle(frame_now, 1);

    return 1;
}

void by_tiny_frame_parse_handle_register(by_tf_parse_done_handle_func func)
{
    // FIXME 未校验是否传入非空值，另外假设未执行注册，也会产生非法访问
    parse_done_handle = func;
}

void by_tiny_frame_parse_start_listern(void)
{
    listern_flag = 1;
}

void by_tiny_frame_parse_end_listern(void)
{
    listern_flag = 0;
}