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