feat: 移植从机通信帧协议

app/tiny_frame/by_tiny_frame_parse.c

@@ -0,0 +1,198 @@
+#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 listen_slave_id;
+uint8_t listen_flag;
+uint16_t listen_timeout;
+uint16_t listen_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)
+    listen_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 (listen_flag) {
+        listen_timevia++;
+    } else {
+        listen_timevia = 0;
+    }
+#endif
+}
+
+/**
+ * @brief
+ *
+ */
+void by_tiny_frame_parse_run(void)
+{
+
+#if defined(BY_TF_DEVICE_MASTER)
+    if (0 == listen_flag) {
+        return;
+    } else {
+        if (listen_timeout <= listen_timevia) {
+            // 接收超时，停止监听
+            parse_done_handle(frame_now, 1);
+            by_tiny_frame_parse_end_listen();
+#if (BY_TF_DEBUG)
+            printf("by_tf_listen 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, listen_slave_id, buffer_out))
+#endif
+        {
+            if (!by_tiny_frame_parse_crc(&frame_now)) {
+
+                // 接收成功后停止监听
+                by_tiny_frame_parse_end_listen();
+                // 解析成功回调
+                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_listen();
+    parse_done_handle(frame_now, 1);
+
+    return 1;
+}
+
+void by_tiny_frame_parse_handle_register(by_tf_parse_done_handle_func func)
+{
+    // FIXME 监听过程中应不允许更改
+    // FIXME 未校验是否传入非空值，另外假设未执行注册，也会产生非法访问
+    parse_done_handle = func;
+}
+
+void by_tiny_frame_parse_start_listen(void)
+{
+    listen_flag = 1;
+}
+
+void by_tiny_frame_parse_end_listen(void)
+{
+    listen_flag = 0;
+}
+
+void by_tiny_frame_parse_set_listen_slave_id(uint8_t slave_id)
+{
+    listen_slave_id = slave_id;
+}