chenluhua1980
8 天以前 238f41fd4edac2febc03d2e428bce7206f609e99
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]);