From 7c5b25c8617807635e9f272ebe9e98304d07cf2f Mon Sep 17 00:00:00 2001
From: fctom1215 <fctom1215@outlook.com>
Date: 星期五, 14 二月 2020 14:28:25 +0800
Subject: [PATCH] 增加单片机信息传递。
---
lib/src/main/cpp/rtk_platform/platform.cpp | 24 ++++++++++++++++++++++++
1 files changed, 24 insertions(+), 0 deletions(-)
diff --git a/lib/src/main/cpp/rtk_platform/platform.cpp b/lib/src/main/cpp/rtk_platform/platform.cpp
index 322708f..bd801f8 100644
--- a/lib/src/main/cpp/rtk_platform/platform.cpp
+++ b/lib/src/main/cpp/rtk_platform/platform.cpp
@@ -390,6 +390,30 @@
MA_SendRtkBrief(&brief);
UpdateRTKInfo(rtk);
}
+ if (events & MCU_UPDATE_EVT) {
+ DEBUG("MCU_UPDATE_EVT length %d", length);
+ // 0-31 version
+ // 32-33 selftest
+ // 34-35 gpio
+ // 36-37 speed
+ // 38-39 engine
+ // 40-55 sn
+ struct mcuBrief brief;
+
+ memset(&brief, 0, sizeof(brief));
+
+ int x = 0;
+ while(data[x] != 0 && x < 32) x++;
+
+ ConvertHex2String(brief.version, data, x);
+ brief.selftest = BUILD_UINT16(data[33], data[32]);
+ brief.gpio = BUILD_UINT16(data[35], data[34]);
+ brief.speed = BUILD_UINT16(data[37], data[36]);
+ brief.engine = BUILD_UINT16(data[39], data[38]);
+ memcpy(brief.sn, data+40, 16);
+
+ MA_SendMcuBrief(&brief);
+ }
}
static void *PlatformDataListenThread(void *p) {
--
Gitblit v1.8.0