From 8eee0a06c608281c6bb437b9481c0976aaaabe98 Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期四, 27 二月 2025 17:52:37 +0800
Subject: [PATCH] 1.添加CEqProcessStep

---
 SourceCode/Bond/Servo/CEqModeStep.cpp |   16 +++++++++++++---
 1 files changed, 13 insertions(+), 3 deletions(-)

diff --git a/SourceCode/Bond/Servo/CEqModeStep.cpp b/SourceCode/Bond/Servo/CEqModeStep.cpp
index e869c74..c7883b2 100644
--- a/SourceCode/Bond/Servo/CEqModeStep.cpp
+++ b/SourceCode/Bond/Servo/CEqModeStep.cpp
@@ -20,11 +20,17 @@
 		CStep::onReadData();
 
 		DWordContainer dc;
-		m_pCclink->ReadDWordData(m_station, DeviceType::W, m_nModeDev, 1, dc);
+		if (0 != m_pCclink->ReadDWordData(m_station, DeviceType::W, m_nModeDev, 1, dc)) {
+			return -2;
+		}
+		if (dc.size() < 1) {
+			return -2;
+		}
+
 		m_nMode = dc.at(0);
 		std::string strTemp;
 		LOGI("<CEqModeStep> Equipment Mode Changed<%s>\n",
-			getModeDescription(strTemp).c_str());
+				getModeDescription(strTemp).c_str());
 
 		return 0;
 	}
@@ -50,6 +56,11 @@
 		m_nModeDev = nDev;
 	}
 
+	int CEqModeStep::getMode()
+	{
+		return m_nMode;
+	}
+
 	/*
 	0: No Equipment Mode exist
 		1: Normal Mode
@@ -58,7 +69,6 @@
 		4 : Cold Run Mode
 		5 : ETC."
 	*/
-
 	std::string& CEqModeStep::getModeDescription(std::string& strDescription)
 	{
 		switch (m_nMode) {

--
Gitblit v1.9.3