From e731e05bb712765bf85a359ff4d505e39ca09c02 Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期二, 01 七月 2025 14:19:01 +0800
Subject: [PATCH] 1.Port Status 测试; 2.Cassette ctrl cmd测试和修改地址;
---
SourceCode/Bond/Servo/CEFEM.cpp | 8 ++++++++
1 files changed, 8 insertions(+), 0 deletions(-)
diff --git a/SourceCode/Bond/Servo/CEFEM.cpp b/SourceCode/Bond/Servo/CEFEM.cpp
index 901e3ae..8175eed 100644
--- a/SourceCode/Bond/Servo/CEFEM.cpp
+++ b/SourceCode/Bond/Servo/CEFEM.cpp
@@ -880,4 +880,12 @@
{
return 10000;
}
+
+ void CEFEM::printDebugRobotState()
+ {
+ LOGI("<CEFEM>Robot status:%d, ARM1:%s, ARM2:%s",
+ m_robotData.status,
+ m_robotData.armState[1] ? _T("ON") : _T("OFF"),
+ m_robotData.armState[2] ? _T("ON") : _T("OFF"));
+ }
}
--
Gitblit v1.9.3