1.接上

chenluhua1980

2026-01-23 08fc60deca0fa2a0658a676d9dd76e0e69436312

 SourceCode/Bond/Servo/CEqModeStep.cpp

@@ -4,7 +4,7 @@


namespace SERVO {
   CEqModeStep::CEqModeStep() : CStep()
   CEqModeStep::CEqModeStep() : CReadStep()
   {
      m_nModeDev = 0;
      m_nMode = 0;
@@ -15,12 +15,24 @@

   }

   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)) {
      if (0 != m_pCclink->ReadDWordDataEx(m_station, DeviceType::W, m_nModeDev, 1, dc)) {
         return -2;
      }
      if (dc.size() < 1) {
@@ -37,7 +49,7 @@

   int CEqModeStep::onComplete()
   {
      CStep::onComplete();
      CReadStep::onComplete();
      LOGI("<CEqModeStep> onComplete.");

      return 0;
@@ -45,7 +57,7 @@

   int CEqModeStep::onTimeout()
   {
      CStep::onTimeout();
      CReadStep::onTimeout();
      LOGI("<CEqModeStep> onTimeout.");

      return 0;
@@ -56,6 +68,11 @@
      m_nModeDev = nDev;
   }

   int CEqModeStep::getMode()
   {
      return m_nMode;
   }

   /*
   0: No Equipment Mode exist
      1: Normal Mode