LAPTOP-SNT8I5JK\Boounion
2025-05-28 c743df7d475735b26395c6ed5c17b4be2d972be2
SourceCode/Bond/Servo/CEquipment.cpp
@@ -3,6 +3,8 @@
#include "ToolUnits.h"
#include <regex>
#include "CArm.h"
#include "CGlassPool.h"
#include "Servo.h"
#define CHECK_READ_STEP_SIGNAL(addr, data, size) {                     \
@@ -41,10 +43,13 @@
   CEquipment::~CEquipment()
   {
      for (auto item : m_glassList) {
         item->release();
      for (int i = 0; i < SLOT_MAX; i++) {
         CContext* pContext = m_slot[i].getContext();
         if (pContext != nullptr) {
            pContext->release();
            m_slot[i].setContext(nullptr);
         }
      }
      m_glassList.clear();
      for (auto item : m_mapStep) {
         delete item.second;
@@ -147,6 +152,7 @@
   {
      initPins();
      initSteps();
      initSlots();
      for (auto item : m_mapStep) {
         item.second->init();
      }
@@ -249,9 +255,19 @@
            std::to_string((int)item->getType()).c_str(), "", weight++));
      }
      for (auto item : m_glassList) {
         attrubutes.addAttribute(new CAttribute("Glass",
            item->getID().c_str(), "", weight++));
      for (int i = 0; i < SLOT_MAX; i++) {
         if (!m_slot[i].isEnable()) continue;
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (pGlass == nullptr) {
            attrubutes.addAttribute(new CAttribute(m_slot[i].getName().c_str(),
               "", "", weight++));
         }
         else {
            attrubutes.addAttribute(new CAttribute(m_slot[i].getName().c_str(),
               pGlass->getID().c_str(), "", weight++));
         }
      }
   }
@@ -303,23 +319,38 @@
   {
      if (ar.IsStoring()) {
         Lock();
         int count = (int)m_glassList.size();
         ar << count;
         for (auto item : m_glassList) {
            item->serialize(ar);
         for (int i = 0; i < SLOT_MAX; i++) {
            m_slot[i].serialize(ar);
         }
         Unlock();
      }
      else {
         for (int i = 0; i < SLOT_MAX; i++) {
            m_slot[i].serialize(ar);
            if (m_slot[i].getContext() != nullptr) {
               CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
               pGlass->serialize(ar);
               m_slot[i].setContext(pGlass);
            }
         }
         // 梳理各玻璃之间的绑定关系
         /*
         Lock();
         int count;
         ar >> count;
         for (int i = 0; i < count; i++) {
            CGlass* pGlass = new CGlass();
            pGlass->serialize(ar);
            addGlassToList(pGlass);
         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());
                  }
               }
            }
         }
         Unlock();
         */
      }
   }
@@ -476,30 +507,30 @@
      // CEqCassetteTranserStateStep
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_CASSETTIE_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_CASSETTIE_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_CASSETTIE_LOADED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_CASSETTIE_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_CASSETTIE_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_CASSETTIE_BLOCKED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_CASSETTIE_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_CASSETTIE_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_CASSETTIE_LOADED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_CASSETTIE_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_CASSETTIE_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_CASSETTIE_BLOCKED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_CASSETTIE_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_CASSETTIE_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_CASSETTIE_LOADED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_CASSETTIE_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_CASSETTIE_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_CASSETTIE_BLOCKED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_CASSETTIE_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_CASSETTIE_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_CASSETTIE_LOADED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_CASSETTIE_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_CASSETTIE_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_CASSETTIE_BLOCKED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_LOADED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT1_BLOCKED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_LOADED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT2_BLOCKED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_LOADED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_INUSE, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_UNLOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT3_BLOCKED, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_EMPTY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_LOAD_READY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_PORT4_LOADED, pszData, size);
      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);
   }
   BOOL CEquipment::isBitOn(const char* pszData, size_t size, int index)
@@ -578,6 +609,7 @@
            panelNo = (value & 0xffff);
            LOGI("Cim Message Confirm(msgID = %d, panel no.=%d).", msgId, panelNo);
         }
         /*
         else if (isVcrEventStep(pStep)) {
            SERVO::CEqVcrEventStep* pEqVcrEventStep = (SERVO::CEqVcrEventStep*)pStep;
            CVcrEventReport* pVcrEventReport = pEqVcrEventStep->getVcrEventReport();
@@ -590,6 +622,7 @@
            pEqVcrEventStep->setReturnCode(1);      
            return 1;
         }
         */
      }
@@ -671,160 +704,10 @@
      // 测试
      if (code == FLOW_TEST) {
         AfxMessageBox(pIntent->getMsg());
         return FLOW_ACCEPT;
      }
      // 信号
      if (code == FLOW_SIGNAL) {
         return FLOW_ACCEPT;
      }
      // 数据
      if (code == FLOW_SIGNAL) {
         return FLOW_ACCEPT;
      }
      // 物料
      if (code == FLOW_MOVE_MATERIAL) {
         CGlass* pGlass = (CGlass*)pIntent->getContext();
         ASSERT(pGlass);
         if (!glassWillArrive(pGlass)) {
            return FLOW_REJECT;
         }
         return glassArrived(pGlass);
      }
      return FLOW_ACCEPT;
   }
   int CEquipment::outputGlass(int port)
   {
      CPin* pOutPin = nullptr;
      if (port == 0) {
         pOutPin = getPin("Out");
         if (pOutPin == nullptr) {
            pOutPin = getPin("Out1");
         }
      }
      else if (port == 1) {
         pOutPin = getPin("Out2");
      }
      if (pOutPin == nullptr) {
         return -1;
      }
      // 模拟取出第一张Panel,传送到下一环节
      ULONGLONG time = CToolUnits::getTimestamp();
      Lock();
      if (m_glassList.empty()) {
         Unlock();
         return -2;
      }
      CGlass* pContext = m_glassList.front();
      pContext->addRef();
      CIntent intent(FLOW_MOVE_MATERIAL, "", pContext);
      int nRet = pOutPin->sendIntent(&intent);
      if (nRet == FLOW_REJECT) {
         LOGE("<CEquipment>对方拒绝接收Intent.");
      }
      else if (nRet == FLOW_ACCEPT) {
         CPath* pPath = pContext->getPathWithSiteID(m_nID);
         if (pPath != nullptr) {
            pPath->setOutTime(time);
         }
         m_glassList.pop_front();
         pContext->release();      // 添加到列队时addRef, 取出时release
         if (m_listener.onDataChanged != nullptr) {
            m_listener.onDataChanged(this, 0);
         }
      }
      pContext->release();
      Unlock();
      return 0;
   }
   BOOL CEquipment::glassWillArrive(CGlass* pGlass)
   {
      return TRUE;
   }
   int CEquipment::glassArrived(CGlass* pGlass)
   {
      Lock();
      pGlass->addPath(m_nID);
      pGlass->addRef();
      m_glassList.push_back(pGlass);
      Unlock();
      if (m_listener.onDataChanged != nullptr) {
         m_listener.onDataChanged(this, 0);
      }
      return FLOW_ACCEPT;
   }
   void CEquipment::addGlassToList(CGlass* pGlass)
   {
      ASSERT(pGlass);
      Lock();
      pGlass->addRef();
      m_glassList.push_back(pGlass);
      Unlock();
      if (m_listener.onDataChanged != nullptr) {
         m_listener.onDataChanged(this, 0);
      }
   }
   BOOL CEquipment::removeClass(CGlass* pGlass)
   {
      Lock();
      bool bExist = std::find(m_glassList.begin(), m_glassList.end(), pGlass) != m_glassList.end();
      if (bExist) {
         pGlass->addPath(EQ_ID_OPERATOR_REMOVE);
         pGlass->release();
         m_glassList.remove(pGlass);
      }
      Unlock();
      if (bExist && m_listener.onDataChanged != nullptr) {
         m_listener.onDataChanged(this, 0);
      }
      return bExist;
   }
   void CEquipment::getGlassList(std::list<CGlass*>& list)
   {
      Lock();
      for (auto item : m_glassList) {
         item->addRef();
         list.push_back(item);
      }
      Unlock();
   }
   CGlass* CEquipment::getFrontGlass()
   {
      CGlass* pGlass = nullptr;
      Lock();
      if (!m_glassList.empty()) {
         pGlass = m_glassList.front();
      }
      Unlock();
      return pGlass;
   }
   int CEquipment::fetchedOutJob(CJobDataB* pJobDataB)
@@ -835,16 +718,12 @@
      // 找到指定的glass id, 
      Lock();
      if (m_glassList.empty()) {
         Unlock();
         return -2;
      }
      CGlass* pContext = nullptr;
      for (auto iter = m_glassList.begin(); iter != m_glassList.end(); iter++) {
         if ((*iter)->getID().compare(pJobDataB->getGlassId()) == 0) {
            pContext = (*iter);
            m_glassList.erase(iter);
      for (int i = 0; i < SLOT_MAX; i++) {
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (pGlass != nullptr && compareJobDataB(pJobDataB, pGlass->getJobDataB())) {
            pContext = pGlass;
            m_slot[i].setContext(nullptr);
            break;
         }
      }
@@ -852,6 +731,20 @@
         Unlock();
         return -3;
      }
      // 如果此玻璃已经贴合,贴合的玻璃也要从列表中移除
      CGlass* pBuddy = pContext->getBuddy();
      if (pBuddy != nullptr) {
         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;
            }
         }
      }
      ((CArm*)m_pArm)->tempStore(pContext);
      pContext->release();
@@ -866,6 +759,7 @@
   int CEquipment::storedJob(CJobDataB* pJobDataB)
   {
      /*
      if (m_pArm == nullptr) {
         return -1;
      }
@@ -884,16 +778,34 @@
      pGlass->release();            // tempFetchOut需要调用一次release
      Unlock();
      // 如果此玻璃已经贴合,贴合的玻璃也要从加入到列表中
      CGlass* pBuddy = pGlass->getBuddy();
      if (pBuddy != nullptr) {
         Lock();
         pBuddy->addPath(m_nID);
         pBuddy->addRef();               // 加入list,addRef
         m_glassList.push_back(pBuddy);
         Unlock();
      }
      if (m_listener.onDataChanged != nullptr) {
         m_listener.onDataChanged(this, 0);
      }
      */
      return 0;
   }
   BOOL CEquipment::isGlassListEmpty()
   BOOL CEquipment::hasGlass()
   {
      return m_glassList.empty();
      for (int i = 0; i < SLOT_MAX; i++) {
         if (m_slot[i].isEnable() && !m_slot[i].isEmpty()) {
            return TRUE;
         }
      }
      return FALSE;
   }
   bool CEquipment::isAlarmStep(SERVO::CStep* pStep)
@@ -1006,6 +918,61 @@
      return pStep->setDateTime(year, month, day, hour, minute, second);
   }
   int CEquipment::setDispatchingMode(DISPATCHING_MODE mode, ONWRITED onWritedBlock/* = nullptr*/)
   {
      SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(STEP_EQ_DISPATCHINT_MODE_CHANGE);
      if (pStep == nullptr) {
         return -1;
      }
      LOGI("<CEquipment-%s>准备设置DispatchingMode<%d>", m_strName.c_str(), (int)mode);
      if (onWritedBlock != nullptr) {
         pStep->writeShort((short)mode, onWritedBlock);
      }
      else {
         pStep->writeShort((short)mode, [&, mode](int code) -> int {
            if (code == WOK) {
               LOGI("<CEquipment-%s>设置DispatchingMode成功.", m_strName.c_str());
            }
            else {
               LOGI("<CEquipment-%s>设置DispatchingMode失败,code:%d", m_strName.c_str(), code);
            }
            return 0;
            });
      }
      return 0;
   }
   int CEquipment::indexerOperationModeChange(IDNEXER_OPERATION_MODE mode, ONWRITED onWritedBlock/* = nullptr*/)
   {
      SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(STEP_EFEM_IN_OP_MODE_CHANGE);
      if (pStep == nullptr) {
         return -1;
      }
      unsigned short operationMode = (unsigned short)((unsigned short)mode + getIndexerOperationModeBaseValue());
      LOGI("<CEquipment-%s>准备设置indexerOperationMode<%d>", m_strName.c_str(), (int)mode);
      if (onWritedBlock != nullptr) {
         pStep->writeShort(operationMode, onWritedBlock);
      }
      else {
         pStep->writeShort(operationMode, [&, mode](int code) -> int {
            if (code == WOK) {
               LOGI("<CEquipment-%s>设置indexerOperationMode成功.", m_strName.c_str());
            }
            else {
               LOGI("<CEquipment-%s>设置indexerOperationMode失败,code:%d", m_strName.c_str(), code);
            }
            return 0;
            });
      }
      return 0;
   }
   int CEquipment::masterRecipeListRequest(short unitNo)
   {
      SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(STEP_EQ_MASTER_RECIPE_LIST_REQ);
@@ -1054,6 +1021,84 @@
         return 0;
         });
      return 0;
   }
   CSlot* CEquipment::getAvailableSlot()
   {
      for (int i = 0; i < SLOT_MAX; i++) {
         if (!m_slot[i].isEnable()) continue;
         if (m_slot[i].isLock()) continue;
         if (!m_slot[i].isEmpty()) continue;
         return &m_slot[i];
      }
      return nullptr;
   }
   CSlot* CEquipment::getAvailableSlotForGlass(MaterialsType type)
   {
      for (int i = 0; i < SLOT_MAX; i++) {
         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++) {
         if (!m_slot[i].isEnable()) continue;
         if (m_slot[i].isLock()) continue;
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (pGlass == nullptr) 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;
   }
   CGlass* CEquipment::getGlassFromSlot(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 (CGlass*)pSlot->getContext();
      }
      return nullptr;
   }
   CGlass* CEquipment::getAnyGlass()
   {
      CSlot* pSlot = nullptr;
      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;
         return pGlass;
      }
      return nullptr;
   }
   short CEquipment::decodeRecipeListReport(const char* pszData, size_t size)
@@ -1250,10 +1295,49 @@
      return index;
   }
   int CEquipment::decodeVCREventReport(CStep* pStep, const char* pszData, size_t size)
   {
      CVcrEventReport vcrEventReport;
      vcrEventReport.unserialize(pszData, size);
      LOGI("<CEquipment-%s>decodeVCREventReport<Result:%d, GlassId:%s>\n", m_strName.c_str(),
         vcrEventReport.getVcrResult(),
         vcrEventReport.getGlassId().c_str());
      // 缓存Attribute,用于调试时显示信息
      unsigned int weight = 201;
      CAttributeVector attrubutes;
      vcrEventReport.getAttributeVector(attrubutes, weight);
      pStep->addAttributeVector(attrubutes);
      // 0426, 先固定返回1(OK)
      ((CReadStep*)pStep)->setReturnCode((short)VCR_Reply_Code::OK);
      return 0;
   }
   int CEquipment::onPreStoredJob(int port, CJobDataB* pJobDataB)
   {
      LOGI("<CEquipment-%s>onPreStoredJob:port:%d|GlassId:%s",
         m_strName.c_str(), port, pJobDataB->getGlassId().c_str());
      CJobDataS* pJobDataS = getJobDataS(pJobDataB->getCassetteSequenceNo(), pJobDataB->getJobSequenceNo());
      if (pJobDataS == nullptr) {
         LOGE("<CFliper-%s>onPreFetchedOutJob,找不到对应的JobDataS(CassetteSequenceNo:%d, JobSequenceNo:%d), 注意排查风险!", m_strName.c_str(),
            pJobDataB->getCassetteSequenceNo(), pJobDataB->getJobSequenceNo());
         return FALSE;
      }
      // 当前不能有任何玻璃,且当前准备进的片是G2
      Lock();
      CSlot* pSlot = getAvailableSlotForGlass((MaterialsType)pJobDataS->getMaterialsType());
      if (pSlot == nullptr) {
         Unlock();
         LOGE("<CFliper-%s>onPreFetchedOutJob,找不到匹配的Slot,不能进料,请注意风险!", m_strName.c_str());
         return FALSE;
      }
      Unlock();
      return TRUE;
   }
@@ -1277,6 +1361,11 @@
   int CEquipment::onProcessData(CProcessData* pProcessData)
   {
      LOGI("<CEquipment-%s>onProcessData.", m_strName.c_str());
      return 0;
   }
   int CEquipment::getIndexerOperationModeBaseValue()
   {
      return 0;
   }
@@ -1369,4 +1458,17 @@
      return nullptr;
   }
   BOOL CEquipment::compareJobDataB(CJobDataB* pJobDataB1, CJobDataB* pJobDataB2)
   {
      ASSERT(pJobDataB1);
      ASSERT(pJobDataB2);
      if (pJobDataB1->getCassetteSequenceNo() != pJobDataB2->getCassetteSequenceNo())
         return FALSE;
      if (pJobDataB1->getJobSequenceNo() != pJobDataB2->getJobSequenceNo())
         return FALSE;
      return TRUE;
   }
}