From d400f022161ff47f02cd0ea95a5076d0187ecd4d Mon Sep 17 00:00:00 2001
From: chenluhua1980 <Chenluhua@qq.com>
Date: 星期五, 30 一月 2026 15:11:06 +0800
Subject: [PATCH] 1.接上，日志完善；
---
SourceCode/Bond/Servo/CEqStatusStep.cpp | 18 +++++++++++++++++-
1 files changed, 17 insertions(+), 1 deletions(-)
diff --git a/SourceCode/Bond/Servo/CEqStatusStep.cpp b/SourceCode/Bond/Servo/CEqStatusStep.cpp
index 3f8195a..e63cc7d 100644
--- a/SourceCode/Bond/Servo/CEqStatusStep.cpp
+++ b/SourceCode/Bond/Servo/CEqStatusStep.cpp
@@ -8,6 +8,7 @@
CEqStatusStep::CEqStatusStep() : CReadStep()
{
m_nStatusDev = 0;
+ m_nUnitId = 0;
for (int i = 0; i < STATUS_MAX; i++) {
m_nStatus[i] = 0;
m_nReasonCode[i] = 0;
@@ -49,6 +50,20 @@
return -1;
}
+
+ int CEqStatusStep::getReasonCode(unsigned int uint) const
+ {
+ if (uint < STATUS_MAX) {
+ return m_nReasonCode[uint];
+ }
+
+ return -1;
+ }
+
+ unsigned int CEqStatusStep::getUnitId() const
+ {
+ return m_nUnitId;
+ }
int CEqStatusStep::onReadData()
{
CReadStep::onReadData();
@@ -60,10 +75,11 @@
return -1;
}
- unsigned int unitId = (unsigned int)CToolUnits::toInt16(&szBuffer[0]);
+ const unsigned int unitId = (unsigned int)CToolUnits::toInt16(&szBuffer[0]);
if (unitId >= STATUS_MAX) {
return -2;
}
+ m_nUnitId = unitId;
if (unitId == 0) {
m_nStatus[unitId] = CToolUnits::toInt16(&szBuffer[2 + unitId * 4]);
--
Gitblit v1.9.3