1.加入连接图示

LAPTOP-SNT8I5JK\Boounion

2025-03-21 980d4fc1690b4f8a81dc65e8573d2898f34a406f

 SourceCode/Bond/Servo/CEquipment.cpp

@@ -1,26 +1,131 @@
#include "stdafx.h"
#include "CEquipment.h"
#include "ToolUnits.h"


namespace SERVO {

   CEquipment::CEquipment()
   CEquipment::CEquipment() : m_nID(0), m_strName(""), m_strDescription(""), m_station(0, 255)
   {
      m_listener = { nullptr, nullptr };
      m_alive = {FALSE, 0, FALSE};
      m_bCimState = FALSE;
      m_bUpstreamInline = FALSE;
      m_bDownstreamInline = FALSE;
      m_bLocalAlarm = FALSE;
      m_bAutoRecipeChange = FALSE;
      m_bVCREnable[0] = FALSE;
      m_pCclink = nullptr;
      m_nBaseAlarmId = 0;
      InitializeCriticalSection(&m_criticalSection);
   }

   CEquipment::~CEquipment()
   {
      for (auto item : m_mapStep) {
         delete item.second;
      }
      m_mapStep.clear();

      for (auto item : m_inputPins) {
         delete item;
      }
      m_inputPins.clear();

      for (auto item : m_outputPins) {
         delete item;
      }
      m_outputPins.clear();

      DeleteCriticalSection(&m_criticalSection);
   }

   void CEquipment::setListener(EquipmentListener listener)
   {
      m_listener.onAlive = listener.onAlive;
      m_listener.onCimStateChanged = listener.onCimStateChanged;
   }

   void CEquipment::setCcLink(CCCLinkIEControl* pCcLink)
   {
      m_pCclink = pCcLink;
   }

   void CEquipment::setBaseAlarmId(int nBaseId)
   {
      m_nBaseAlarmId = nBaseId;
   }

   int CEquipment::getBaseAlarmId()
   {
      return m_nBaseAlarmId;
   }

   void CEquipment::getProperties(std::vector<std::pair<std::string, std::string>>& container)
   {
      container.clear();
      // 示例：将一些属性添加到容器
      container.push_back(std::make_pair("DeviceName", "ServoMotor"));
      container.push_back(std::make_pair("SerialNumber", "123456789"));
      container.push_back(std::make_pair("Version", "1.0"));
   }

   std::map<unsigned int, CStep*>& CEquipment::getSteps()
   {
      return m_mapStep;
   }

   CStep* CEquipment::getStep(unsigned int addr)
   {
      auto iter = m_mapStep.find(addr);
      if (iter == m_mapStep.end()) return nullptr;
      return iter->second;
   }

   CStep* CEquipment::getStepWithName(const char* pszName)
   {
      for (auto item : m_mapStep) {
         if (item.second->getName().compare(pszName) == 0) {
            return item.second;
         }
      }

      return nullptr;
   }

   int CEquipment::addStep(unsigned int addr, CStep* pStep)
   {
      auto iter = m_mapStep.find(addr);
      if (iter != m_mapStep.end()) return -1;
      pStep->setEquipment(this);
      pStep->setCcLink(m_pCclink);
      m_mapStep[addr] = pStep;
      return 0;
   }

   void CEquipment::init()
   {

      initPins();
      for (auto item : m_mapStep) {
         item.second->init();
      }
   }

   void CEquipment::term()
   {
      for (auto item : m_mapStep) {
         item.second->term();
      }
   }

   void CEquipment::setID(int nID)
   {
      m_nID = nID;
   }

   int CEquipment::getID()
   {
      return m_nID;
   }

   void CEquipment::setName(const char* pszName)
@@ -54,12 +159,46 @@
      return m_station;
   }

   void CEquipment::getAttributeVector(CAttributeVector& attrubutes)
   {
      attrubutes.clear();
      attrubutes.addAttribute(new CAttribute("Network",
         std::to_string(m_station.nNetNo).c_str(), ""));
      attrubutes.addAttribute(new CAttribute("Station",
         std::to_string(m_station.nStNo).c_str(), ""));
      attrubutes.addAttribute(new CAttribute("ID",
         std::to_string(m_nID).c_str(), ""));
      attrubutes.addAttribute(new CAttribute("Name",
         m_strName.c_str(), ""));
      attrubutes.addAttribute(new CAttribute("Description",
         m_strDescription.c_str(), ""));
      attrubutes.addAttribute(new CAttribute("Alive",
         this->isAlive() ? _T("TRUE") : _T("FALSE"), ""));
      attrubutes.addAttribute(new CAttribute("CIM State",
         m_bCimState ? _T("ON") : _T("OFF"), ""));
      attrubutes.addAttribute(new CAttribute("Upstream",
         m_bUpstreamInline ? _T("Inline") : _T("Offline"), ""));
      attrubutes.addAttribute(new CAttribute("Downstream",
         m_bDownstreamInline ? _T("Inline") : _T("Offline"), ""));
      attrubutes.addAttribute(new CAttribute("Local Alarm",
         m_bLocalAlarm ? _T("TRUE") : _T("FALSE"), ""));
      attrubutes.addAttribute(new CAttribute("Auto Recipe Change",
         m_bAutoRecipeChange ? _T("TRUE") : _T("FALSE"), ""));
      char szTemp[256];
      for (int i = 0; i < VCR_MAX; i++) {
         sprintf_s(szTemp, 256, "VCR-%d", i + 1);
         attrubutes.addAttribute(new CAttribute(szTemp,
            m_bVCREnable[i] ? _T("Enable") : _T("Disable"), ""));
      }
   }

   void CEquipment::setReadBitBlock(unsigned int start, unsigned int end)
   {
      m_blockReadBit.type = (unsigned int)DeviceType::LB;;
      m_blockReadBit.type = (unsigned int)DeviceType::B;
      m_blockReadBit.start = start;
      m_blockReadBit.end = end;
      m_blockReadBit.size = (m_blockReadBit.end - m_blockReadBit.start + 1) / 8;
      ASSERT(m_blockReadBit.size < BLOCK_BUFFER_MAX);
   }

   MemoryBlock& CEquipment::getReadBitBlock()
@@ -82,7 +221,19 @@

   void CEquipment::onTimer(UINT nTimerid)
   {
      // 每隔一秒，检查一下ALIVE状态

      static int tick = 0;
      tick++;
      if (tick % (4 * 1) == 0) {
         m_alive.count++;
         if (m_alive.alive && m_alive.count > ALIVE_TIMEOUT) {
            m_alive.alive = FALSE;
            if (m_listener.onAlive != nullptr) {
               m_listener.onAlive(this, m_alive.alive);
            }
         }
      }
   }

   void CEquipment::serialize(CArchive& ar)
@@ -90,4 +241,210 @@

   }

   void CEquipment::onReceiveLBData(const char* pszData, size_t size)
   {
      /*
      TRACE("%s onReceiveLBData: %d bytes\n", m_strName.c_str(), size);
      for (unsigned int i = 0; i < size; i++) {
         if (pszData[i] != 0)
            TRACE("%d[%x]\n", i, pszData[i]);
      }
      */

      // 以下解释和处理数据
      BOOL bFlag;
      int index = 0x340;


      // alive
      bFlag = isBitOn(pszData, size, index);
      if (!equalBool(m_alive.flag, bFlag)) {
         m_alive.flag = bFlag;
         m_alive.count = 0;

         // ״̬
         if (!m_alive.alive) {
            m_alive.alive = TRUE;
            if (m_listener.onAlive != nullptr) {
               m_listener.onAlive(this, m_alive.alive);
            }
         }
      }
	
      // CIM State
      bFlag = isBitOn(pszData, size, ++index);
      if (!equalBool(m_bCimState, bFlag)) {
         m_bCimState = bFlag;
         if (m_listener.onCimStateChanged != nullptr) {
            m_listener.onCimStateChanged(this, m_bCimState);
         }
      }

      // UpstreamInline
      bFlag = isBitOn(pszData, size, ++index);
      if (!equalBool(m_bUpstreamInline, bFlag)) {
         m_bUpstreamInline = bFlag;
      }

      // DownstreamInline
      bFlag = isBitOn(pszData, size, ++index);
      if (!equalBool(m_bDownstreamInline, bFlag)) {
         m_bDownstreamInline = bFlag;
      }

      // LocalAlarm
      bFlag = isBitOn(pszData, size, ++index);
      if (!equalBool(m_bLocalAlarm, bFlag)) {
         m_bLocalAlarm = bFlag;
      }

      // AutoRecipeChange
      bFlag = isBitOn(pszData, size, ++index);
      if (!equalBool(m_bAutoRecipeChange, bFlag)) {
         m_bAutoRecipeChange = bFlag;
      }

      // AutoRecipeChange
      bFlag = isBitOn(pszData, size, ++index);
      if (!equalBool(m_bVCREnable[0], bFlag)) {
         m_bVCREnable[0] = bFlag;
      }


      // 以下根据信号做流程处理
      CStep* pStep;

      // Equipment Mode Change Report(0x360)
      // Equipment Status Change Report(0x361)
      // Equipment Alarm Change Report(0x362 ~ 0x366)
      for (int i = 0; i < 7; i++) {
         index = 0x360 + i;;
         bFlag = isBitOn(pszData, size, index);
         pStep = getStep(index);
         if (pStep != nullptr) {
            ((CReadStep*)pStep)->onReadSignal(bFlag);
         }
      }

      index = 0x350;
      bFlag = isBitOn(pszData, size, index);
      pStep = getStep(index);
      if (pStep != nullptr) {
         ((CWriteStep*)pStep)->onRecvSignal(bFlag);
      }
   }

   BOOL CEquipment::isBitOn(const char* pszData, size_t size, int index)
   {
      int byteIndex, bitIndex;
      byteIndex = (index) / 8;
      bitIndex = (index) % 8;

      return CToolUnits::getBit(pszData[byteIndex], bitIndex);
   }

   BOOL CEquipment::equalBool(BOOL b1, BOOL b2)
   {
      return (b1 && b2) || (!b1 && !b2);
   }

   BOOL CEquipment::isAlive()
   {
      return m_alive.alive;
   }

   BOOL CEquipment::isCimOn()
   {
      return m_bCimState;
   }

   BOOL CEquipment::isUpstreamInline()
   {
      return m_bUpstreamInline;
   }

   BOOL CEquipment::isDownstreamInline()
   {
      return m_bDownstreamInline;
   }

   BOOL CEquipment::isLocalAlarm()
   {
      return m_bLocalAlarm;
   }

   BOOL CEquipment::isAutoRecipeChange()
   {
      return m_bAutoRecipeChange;
   }

   BOOL CEquipment::isVCREnable(unsigned int index)
   {
      if (index >= VCR_MAX) return FALSE;
      return m_bVCREnable[index];
   }

   CPin* CEquipment::addPin(PinType type, char* pszName)
   {
      // 不允许名字添加重复的pin
      CPin* pPin = getPin(pszName);
      if (pPin != nullptr) return nullptr;


      // 添加到Pin列表，看是输入pin或输出pin
      if (type == PinType::INPUT) {
         pPin = new CPin(this, type, pszName);
         m_inputPins.push_back(pPin);
         return pPin;
      }
      else if (type == PinType::OUTPUT) {
         pPin = new CPin(this, type, pszName);
         m_outputPins.push_back(pPin);
         return pPin;
      }

      return nullptr;
   }

   CPin* CEquipment::getPin(char* pszName)
   {
      for (auto item : m_inputPins) {
         if (item->getName().compare(pszName) == 0) {
            return item;
         }
      }

      for (auto item : m_outputPins) {
         if (item->getName().compare(pszName) == 0) {
            return item;
         }
      }

      return nullptr;
   }

   std::vector<CPin*>& CEquipment::getInputPins()
   {
      return m_inputPins;
   }

   std::vector<CPin*>& CEquipment::getOutputPins()
   {
      return m_outputPins;
   }

   int CEquipment::recvIntent(CPin* pPin, CIntent* pIntent)
   {
      return 0;
   }

   void CEquipment::addPanelToList(CPanel* pPanel)
   {
      ASSERT(pPanel);

      Lock();
      pPanel->addRef();
      m_panelList.push_back(pPanel);
      Unlock();
   }
}