LAPTOP-SNT8I5JK\Boounion
2025-07-29 15a7d8ae540c2993d166fe99b1ca13b6d2b101f0
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;