From cacea2da59a3acd73f3161d819a10e0060762616 Mon Sep 17 00:00:00 2001
From: mrDarker <mr.darker@163.com>
Date: 星期二, 06 五月 2025 14:54:13 +0800
Subject: [PATCH] Merge branch 'clh' into liuyang

---
 SourceCode/Bond/Servo/CEqStatusStep.cpp |   35 +++++++++++++++++++++++++++++++----
 1 files changed, 31 insertions(+), 4 deletions(-)

diff --git a/SourceCode/Bond/Servo/CEqStatusStep.cpp b/SourceCode/Bond/Servo/CEqStatusStep.cpp
index 9df8a03..52eaa0f 100644
--- a/SourceCode/Bond/Servo/CEqStatusStep.cpp
+++ b/SourceCode/Bond/Servo/CEqStatusStep.cpp
@@ -5,7 +5,7 @@
 
 
 namespace SERVO {
-	CEqStatusStep::CEqStatusStep() : CStep()
+	CEqStatusStep::CEqStatusStep() : CReadStep()
 	{
 		m_nStatusDev = 0;
 		for (int i = 0; i < STATUS_MAX; i++) {
@@ -21,9 +21,36 @@
 
 	}
 
+	void CEqStatusStep::getAttributeVector(CAttributeVector& attrubutes)
+	{
+		CReadStep::getAttributeVector(attrubutes);
+
+		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(), ""));
+			sprintf_s(szName, 256, "Reason Code %d", i + 1);
+			attrubutes.addAttribute(new CAttribute(szName,
+				std::to_string(m_nReasonCode[i]).c_str(), ""));
+		}
+
+		std::string strTemp;
+		attrubutes.addAttribute(new CAttribute("Status Dev",
+			("W" + CToolUnits::toHexString(m_nStatusDev, strTemp)).c_str(), ""));
+	}
+
+	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 +83,7 @@
 
 	int CEqStatusStep::onComplete()
 	{
-		CStep::onComplete();
+		CReadStep::onComplete();
 		LOGI("<CEqStatusStep> onComplete.");
 
 		return 0;
@@ -64,7 +91,7 @@
 
 	int CEqStatusStep::onTimeout()
 	{
-		CStep::onTimeout();
+		CReadStep::onTimeout();
 		LOGI("<CEqStatusStep> onTimeout.");
 
 		return 0;

--
Gitblit v1.9.3