chenluhua1980
2026-01-21 da507a84b7790fa5eab4a01737af5aaca1526390
SourceCode/Bond/Servo/CEqModeStep.cpp
@@ -4,7 +4,7 @@
namespace SERVO {
   CEqModeStep::CEqModeStep() : CStep()
   CEqModeStep::CEqModeStep() : CReadStep()
   {
      m_nModeDev = 0;
      m_nMode = 0;
@@ -15,26 +15,41 @@
   }
   void CEqModeStep::getAttributeVector(CAttributeVector& attrubutes)
   {
      CReadStep::getAttributeVector(attrubutes);
      unsigned int weight = 31;
      std::string strTemp;
      attrubutes.addAttribute(new CAttribute("Mode",
         std::to_string(m_nMode).c_str(), getModeDescription(strTemp).c_str(), weight++));
      attrubutes.addAttribute(new CAttribute("Mode Dev",
         ("W" + CToolUnits::toHexString(m_nModeDev, strTemp)).c_str(), "", weight++));
   }
   int CEqModeStep::onReadData()
   {
      CStep::onReadData();
      CReadStep::onReadData();
      DWordContainer dc;
      if (0 == m_pCclink->ReadDWordData(m_station, DeviceType::W, m_nModeDev, 1, dc)
         && dc.size() >= 1) {
         m_nMode = dc.at(0);
         std::string strTemp;
         LOGI("<CEqModeStep> Equipment Mode Changed<%s>\n",
            getModeDescription(strTemp).c_str());
      if (0 != m_pCclink->ReadDWordDataEx(m_station, DeviceType::W, m_nModeDev, 1, dc)) {
         return -2;
      }
      if (dc.size() < 1) {
         return -2;
      }
      m_nMode = dc.at(0);
      std::string strTemp;
      LOGI("<CEqModeStep> Equipment Mode Changed<%s>\n",
            getModeDescription(strTemp).c_str());
      return 0;
   }
   int CEqModeStep::onComplete()
   {
      CStep::onComplete();
      CReadStep::onComplete();
      LOGI("<CEqModeStep> onComplete.");
      return 0;
@@ -42,7 +57,7 @@
   int CEqModeStep::onTimeout()
   {
      CStep::onTimeout();
      CReadStep::onTimeout();
      LOGI("<CEqModeStep> onTimeout.");
      return 0;
@@ -53,6 +68,11 @@
      m_nModeDev = nDev;
   }
   int CEqModeStep::getMode()
   {
      return m_nMode;
   }
   /*
   0: No Equipment Mode exist
      1: Normal Mode