177 lines
4.2 KiB
C
177 lines
4.2 KiB
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_flag;
|
|
uint16_t listern_timeout;
|
|
uint16_t listern_timevia;
|
|
by_tf_parse_frame_t frame_now;
|
|
by_tf_parse_success_handle_func parse_success_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
|
|
}
|
|
|
|
void by_tiny_frame_parse_run(void)
|
|
{
|
|
|
|
#if defined(BY_TF_DEVICE_MASTER)
|
|
if (0 == listern_flag) {
|
|
return;
|
|
} else {
|
|
if (listern_timeout <= listern_timevia) {
|
|
// 接收超时，停止监听
|
|
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 (!by_tiny_frame_parse_listening(&frame_now, 0x0D, buffer_out)) {
|
|
if (!by_tiny_frame_parse_crc(&frame_now)) {
|
|
|
|
// 接收成功后停止监听
|
|
by_tiny_frame_parse_end_listern();
|
|
// 解析成功回调
|
|
parse_success_handle();
|
|
#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;
|
|
}
|
|
|
|
void by_tiny_frame_parse_handle_register(by_tf_parse_success_handle_func func)
|
|
{
|
|
parse_success_handle = func;
|
|
}
|
|
|
|
void by_tiny_frame_parse_start_listern(void)
|
|
{
|
|
listern_flag = 1;
|
|
}
|
|
|
|
void by_tiny_frame_parse_end_listern(void)
|
|
{
|
|
listern_flag = 0;
|
|
}
|