feat: 增加通信帧提取功能

app/tiny_frame/by_tiny_frame_parse.c

@@ -0,0 +1,97 @@
+#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;
+
+    printf("%0.2X\r\n", buff);
+
+    do {
+        if ((0 == cnt_s) && (((slave_id << 1) + 1) == buff)) {
+            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];
+            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;
+        }
+
+        if (!by_tiny_frame_parse_listening(&frame_now, 127, buffer_out)) {
+            if (!by_tiny_frame_parse_crc(&frame_now)) {
+                printf("frame parsed!\r\n");
+            }
+            // 解析帧
+        }
+        // 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));
+
+    printf("get: %0.2X", frame_s->crc_val);
+    printf("\r\n");
+
+    printf("cal: %0.2X", calc_crc_val);
+    printf("\r\n");
+
+    if ((frame_s->crc_val == calc_crc_val) || (frame_s->crc_val == 0xFFFF)) {
+        return 0;
+    }
+
+    return 1;
+}