1. 模仿Bander添加VacuumBake、BakeCooling和Measurement写入事件 2. 修复搬运交互的地址 3. 修复状态图Va...

mrDarker

2025-06-12 c4a65f54c7876395a07e4a0914035d707fac7ee2

 SourceCode/Bond/Servo/CEquipment.cpp

@@ -27,7 +27,7 @@

   CEquipment::CEquipment() : m_nID(0), m_strName(""), m_strDescription(""), m_station(0, 255)
   {
      m_listener = { nullptr, nullptr, nullptr, nullptr, nullptr, nullptr };
      m_listener = { };
      m_alive = { FALSE, 0, FALSE };
      m_bCimState = FALSE;
      m_bUpstreamInline = FALSE;
@@ -35,6 +35,7 @@
      m_bLocalAlarm = FALSE;
      m_bAutoRecipeChange = FALSE;
      m_bVCREnable[0] = FALSE;
      memset(m_bLinkSignal, 0, sizeof(m_bLinkSignal));
      m_pCclink = nullptr;
      m_nBaseAlarmId = 0;
      m_pArm = nullptr;
@@ -46,7 +47,6 @@
      for (int i = 0; i < SLOT_MAX; i++) {
         CContext* pContext = m_slot[i].getContext();
         if (pContext != nullptr) {
            pContext->release();
            m_slot[i].setContext(nullptr);
         }
      }
@@ -71,12 +71,7 @@

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

   void CEquipment::setCcLink(CCCLinkIEControl* pCcLink)
@@ -331,7 +326,7 @@
      else {
         for (int i = 0; i < SLOT_MAX; i++) {
            m_slot[i].serialize(ar);
            if (m_slot[i].getContext() != nullptr) {
            if (m_slot[i].getTempContext() != nullptr) {
               CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
               pGlass->serialize(ar);
               m_slot[i].setContext(pGlass);
@@ -339,22 +334,23 @@
         }
         
         // 梳理各玻璃之间的绑定关系
         /*
         Lock();
         std::list<CGlass*> list = m_glassList;
         for (auto item : list) {
            std::string& strBuddyId = item->getBuddyId();
            if (!strBuddyId.empty()) {
               for (auto item2 : m_glassList) {
                  if (strBuddyId.compare(item2->getID()) == 0) {
                     item->setBuddy(item2);
                     TRACE("绑定关系: %s <- %s\n", item->getID().c_str(), item2->getID().c_str());
         for (int i = 0; i < SLOT_MAX; i++) {
            CGlass* pGlass = (CGlass*)m_slot[i].getContext();
            if (pGlass != nullptr) {
               std::string& strBuddyId = pGlass->getBuddyId();
               if (!strBuddyId.empty()) {
                  for (int j = 0; j < SLOT_MAX; j++) {
                     CGlass* pBudy = (CGlass*)m_slot[j].getContext();
                     if (pBudy != nullptr && strBuddyId.compare(pBudy->getID()) == 0) {
                        pGlass->setBuddy(pBudy);
                        TRACE("绑定关系: %s <- %s\n", pGlass->getID().c_str(), pBudy->getID().c_str());
                     }
                  }
               }
            }
         }
         Unlock();
         */
      }
   }

@@ -368,9 +364,20 @@
      }
      */

      // 以下解释和处理数据
      // 连接信号解释和保存
      BOOL bFlag;
      int index = 0x540;
      int index = 0;
      for (int i = 0; i < 8; i++) {
         m_bLinkSignal[i][SIGNAL_UPSTREAM_INLINE] = isBitOn(pszData, size, index + 0);
         m_bLinkSignal[i][SIGNAL_UPSTREAM_TROUBLE] = isBitOn(pszData, size, index + 1);
         m_bLinkSignal[i][SIGNAL_INTERLOCK] = isBitOn(pszData, size, index + 2);
         m_bLinkSignal[i][SIGNAL_SEND_ABLE] = isBitOn(pszData, size, index + 3);
         index += 0x40;
      }		 


      // 其它信号及响应
      index = 0x540;


      // alive
@@ -535,6 +542,10 @@
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_BLOCKED, pszData, size);

      // robot cmd reply
      CHECK_WRITE_STEP_SIGNAL(STEP_ID_ROBOT_CMD_REPLY, pszData, size);
		
   }

   BOOL CEquipment::isBitOn(const char* pszData, size_t size, int index)
@@ -585,6 +596,28 @@
   {
      if (index >= VCR_MAX) return FALSE;
      return m_bVCREnable[index];
   }

   BOOL CEquipment::isLinkSignalOn(unsigned int path, unsigned int signal)
   {
      if (path >= PATH_MAX) return FALSE;
      if (signal >= SIGNAL_MAX) return FALSE;
      return m_bLinkSignal[path][signal];
   }

   void CEquipment::setLinkSignal(unsigned int path, unsigned int signal, BOOL bOn)
   {
      if (path >= PATH_MAX) return;
      if (signal >= SIGNAL_MAX) return;
      m_bLinkSignal[path][signal] = bOn;
   }

   void CEquipment::setLinkSignalBlock(unsigned int path, BOOL* pSignal)
   {
      if (path >= PATH_MAX) return;
      for (int i = 0; i < SIGNAL_MAX; i++) {
         m_bLinkSignal[path][i] = pSignal[i];
      }
   }

   int CEquipment::onStepEvent(CStep* pStep, int code)
@@ -727,6 +760,7 @@
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (pGlass != nullptr && compareJobDataB(pJobDataB, pGlass->getJobDataB())) {
            pContext = pGlass;
            if (pGlass != nullptr) pGlass->addRef();
            m_slot[i].setContext(nullptr);
            break;
         }
@@ -742,7 +776,6 @@
         for (int i = 0; i < SLOT_MAX; i++) {
            CGlass* pGlass = (CGlass*)m_slot[i].getContext();
            if (pGlass != nullptr && compareJobDataB(pBuddy->getJobDataB(), pGlass->getJobDataB())) {
               pContext->release();
               m_slot[i].setContext(nullptr);
               break;
            }
@@ -761,9 +794,8 @@
      return 0;
   }

   int CEquipment::storedJob(CJobDataB* pJobDataB)
   int CEquipment::storedJob(CJobDataB* pJobDataB, short putSlot)
   {
      /*
      if (m_pArm == nullptr) {
         return -1;
      }
@@ -776,9 +808,8 @@

      ASSERT(pGlass);
      Lock();
      pGlass->addPath(m_nID);
      pGlass->addRef();               // 加入list,addRef
      m_glassList.push_back(pGlass);
      pGlass->addPath(m_nID, getSlotUnit(putSlot));
      m_slot[putSlot - 1].setContext(pGlass);
      pGlass->release();            // tempFetchOut需要调用一次release
      Unlock();

@@ -787,9 +818,13 @@
      CGlass* pBuddy = pGlass->getBuddy();
      if (pBuddy != nullptr) {
         Lock();
         pBuddy->addPath(m_nID);
         pBuddy->addRef();               // 加入list,addRef
         m_glassList.push_back(pBuddy);
         pBuddy->addPath(m_nID, 0);
         if (putSlot % 2 == 0) {
            m_slot[putSlot - 2].setContext(pBuddy);
         }
         else {
            m_slot[putSlot].setContext(pBuddy);
         }
         Unlock();
      }

@@ -797,7 +832,7 @@
      if (m_listener.onDataChanged != nullptr) {
         m_listener.onDataChanged(this, EDCC_STORED_JOB);
      }
      */
		
      return 0;
   }

@@ -810,6 +845,20 @@
      }

      return FALSE;
   }

   CGlass* CEquipment::getGlass(const char* pszGlassId)
   {
      for (int i = 0; i < SLOT_MAX; i++) {
         if (!m_slot[i].isEnable()) continue;
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (pGlass == nullptr) continue;
         if (pGlass->getID().compare(pszGlassId) == 0) {
            return pGlass;
         }
      }

      return nullptr;
   }

   bool CEquipment::isAlarmStep(SERVO::CStep* pStep)
@@ -1057,6 +1106,27 @@
      return nullptr;
   }

   CSlot* CEquipment::getAvailableSlotForGlass2(MaterialsType type, const std::vector<int>& candidates)
   {
      for (auto item : candidates) {
         for (int i = 0; i < SLOT_MAX; i++) {
            if (item == i + 1) {
               if (!m_slot[i].isEnable()) continue;
               if (m_slot[i].isLock()) continue;
               if (!m_slot[i].isEmpty()) continue;

               MaterialsType slotType = m_slot[i].getType();
               if (type == MaterialsType::G1 && slotType == MaterialsType::G2) continue;
               if (type == MaterialsType::G2 && slotType == MaterialsType::G1) continue;

               return &m_slot[i];
            }
         }
      }

      return nullptr;
   }

   CSlot* CEquipment::getNonEmptySlot(MaterialsType putSlotType)
   {
      for (int i = 0; i < SLOT_MAX; i++) {
@@ -1073,6 +1143,62 @@
      }

      return nullptr;
   }

   CSlot* CEquipment::getProcessedSlot(MaterialsType putSlotType)
   {
      for (int i = 0; i < SLOT_MAX; i++) {
         if (!m_slot[i].isEnable()) continue;
         if (m_slot[i].isLock()) continue;
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (pGlass == nullptr) continue;
         int lsPath = m_slot[i].getLinkSignalPath();
         if(!m_bLinkSignal[lsPath][SIGNAL_UPSTREAM_INLINE]
            || m_bLinkSignal[lsPath][SIGNAL_UPSTREAM_TROUBLE]
            || !m_bLinkSignal[lsPath][SIGNAL_INTERLOCK]
            || !m_bLinkSignal[lsPath][SIGNAL_SEND_ABLE] ) continue;

         MaterialsType glassType = pGlass->getType();
         if (glassType == MaterialsType::G1 && putSlotType == MaterialsType::G2) continue;
         if (glassType == MaterialsType::G2 && putSlotType == MaterialsType::G1) continue;

         return &m_slot[i];
      }

      return nullptr;
   }

   CSlot* CEquipment::getProcessedSlot2(MaterialsType putSlotType, const std::vector<int>& candidates)
   {
      for (auto item : candidates) {
         for (int i = 0; i < SLOT_MAX; i++) {
            if (item == i + 1) {
               if (!m_slot[i].isEnable()) continue;
               if (m_slot[i].isLock()) continue;
               CGlass* pGlass = (CGlass*)m_slot[i].getContext();
               if (pGlass == nullptr) continue;
               int lsPath = m_slot[i].getLinkSignalPath();
               if (!m_bLinkSignal[lsPath][SIGNAL_UPSTREAM_INLINE]
                  || m_bLinkSignal[lsPath][SIGNAL_UPSTREAM_TROUBLE]
                  || !m_bLinkSignal[lsPath][SIGNAL_INTERLOCK]
                  || !m_bLinkSignal[lsPath][SIGNAL_SEND_ABLE]) continue;

               MaterialsType glassType = pGlass->getType();
               if (glassType == MaterialsType::G1 && putSlotType == MaterialsType::G2) continue;
               if (glassType == MaterialsType::G2 && putSlotType == MaterialsType::G1) continue;

               return &m_slot[i];
            }
         }
      }

      return nullptr;
   }

   CSlot* CEquipment::getSlot(int index)
   {
      if (index >= SLOT_MAX) return nullptr;
      return &m_slot[index];
   }

   CGlass* CEquipment::getGlassFromSlot(int slotNo)
@@ -1103,6 +1229,30 @@
      }

      return nullptr;
   }

   BOOL CEquipment::canPlaceGlassInSlot(const short slotIndex)
   {
      if (slotIndex >= SLOT_MAX) return FALSE;
      if (!m_slot[slotIndex].isEnable()) return FALSE;
      if (m_slot[slotIndex].getContext() != nullptr) return FALSE;

      return TRUE;
   }

   int CEquipment::removeGlass(int slotNo)
   {
      CSlot* pSlot = nullptr;
      for (int i = 0; i < SLOT_MAX; i++) {
         if (!m_slot[i].isEnable()) continue;
         if (m_slot[i].getNo() != slotNo) continue;
         pSlot = &m_slot[i];
         break;
      }

      if (pSlot == nullptr) return -1;
      pSlot->setContext(nullptr);
      return 0;
   }

   short CEquipment::decodeRecipeListReport(const char* pszData, size_t size)
@@ -1324,7 +1474,7 @@
      return 0;
   }

   int CEquipment::onPreStoredJob(int port, CJobDataB* pJobDataB)
   int CEquipment::onPreStoredJob(int port, CJobDataB* pJobDataB, short& putSlot)
   {
      LOGI("<CEquipment-%s>onPreStoredJob:port:%d|GlassId:%s",
         m_strName.c_str(), port, pJobDataB->getGlassId().c_str());
@@ -1336,7 +1486,7 @@
         return FALSE;
      }

      // 当前不能有任何玻璃，且当前准备进的片是G2
      // 如果没有可用位置，报错
      Lock();
      CSlot* pSlot = getAvailableSlotForGlass((MaterialsType)pJobDataS->getMaterialsType());
      if (pSlot == nullptr) {
@@ -1346,6 +1496,17 @@
      }
      Unlock();


      if (m_listener.onPreStoredJob != nullptr) {
         if (!m_listener.onPreStoredJob(this, pJobDataB, putSlot)) {
            return FALSE;
         }

         if(!canPlaceGlassInSlot(putSlot - 1)) {
            return FALSE;
         }
      }

      return TRUE;
   }

@@ -1354,10 +1515,11 @@
      LOGI("<CEquipment-%s>onStore:port:%d|GlassId:%s",
         m_strName.c_str(), port, pJobDataB->getGlassId().c_str());

      BOOL bCheck = onPreStoredJob(port, pJobDataB);
      short putSlot = 0;
      BOOL bCheck = onPreStoredJob(port, pJobDataB, putSlot);
      if (bCheck) {
         addJobDataB(pJobDataB);
         return storedJob(pJobDataB);
         return storedJob(pJobDataB, putSlot);
      }

      // 数据异常，处理或显示
@@ -1369,6 +1531,7 @@
   int CEquipment::onProcessData(CProcessData* pProcessData)
   {
      LOGI("<CEquipment-%s>onProcessData.", m_strName.c_str());

      return 0;
   }