From 21407e7ee3acce124d761fb562aee9f31033d42a Mon Sep 17 00:00:00 2001
From: mrDarker <mr.darker@163.com>
Date: 星期三, 04 六月 2025 12:01:21 +0800
Subject: [PATCH] Merge branch 'clh'

---
 SourceCode/Bond/Servo/CEqStatusStep.cpp |   38 +++++++++++++++++++++++++++++++++-----
 1 files changed, 33 insertions(+), 5 deletions(-)

diff --git a/SourceCode/Bond/Servo/CEqStatusStep.cpp b/SourceCode/Bond/Servo/CEqStatusStep.cpp
index 9df8a03..6108c58 100644
--- a/SourceCode/Bond/Servo/CEqStatusStep.cpp
+++ b/SourceCode/Bond/Servo/CEqStatusStep.cpp
@@ -5,11 +5,11 @@
 
 
 namespace SERVO {
-	CEqStatusStep::CEqStatusStep() : CStep()
+	CEqStatusStep::CEqStatusStep() : CReadStep()
 	{
 		m_nStatusDev = 0;
 		for (int i = 0; i < STATUS_MAX; i++) {
-			m_nStatus[i] = 7;
+			m_nStatus[i] = 0;
 			m_nReasonCode[i] = 0;
 		}
 	
@@ -21,9 +21,37 @@
 
 	}
 
+	void CEqStatusStep::getAttributeVector(CAttributeVector& attrubutes)
+	{
+		CReadStep::getAttributeVector(attrubutes);
+
+		unsigned int weight = 31;
+		char szName[256];
+		for (int i = 0; i < STATUS_MAX; i++) {
+			sprintf_s(szName, 256, "Status %d", i + 1);
+			attrubutes.addAttribute(new CAttribute(szName,
+				std::to_string(m_nStatus[i]).c_str(), "", weight++));
+			sprintf_s(szName, 256, "Reason Code %d", i + 1);
+			attrubutes.addAttribute(new CAttribute(szName,
+				std::to_string(m_nReasonCode[i]).c_str(), "", weight++));
+		}
+
+		std::string strTemp;
+		attrubutes.addAttribute(new CAttribute("Status Dev",
+			("W" + CToolUnits::toHexString(m_nStatusDev, strTemp)).c_str(), "", weight++));
+	}
+
+	int CEqStatusStep::getStatus(unsigned int uint)
+	{
+		if (uint < STATUS_MAX) {
+			return m_nStatus[uint];
+		}
+
+		return -1;
+	}
 	int CEqStatusStep::onReadData()
 	{
-		CStep::onReadData();
+		CReadStep::onReadData();
 
 		char szBuffer[64];
 		int nRet = m_pCclink->ReadData2(m_station, DeviceType::W,
@@ -56,7 +84,7 @@
 
 	int CEqStatusStep::onComplete()
 	{
-		CStep::onComplete();
+		CReadStep::onComplete();
 		LOGI("<CEqStatusStep> onComplete.");
 
 		return 0;
@@ -64,7 +92,7 @@
 
 	int CEqStatusStep::onTimeout()
 	{
-		CStep::onTimeout();
+		CReadStep::onTimeout();
 		LOGI("<CEqStatusStep> onTimeout.");
 
 		return 0;

--
Gitblit v1.9.3