LAPTOP-SNT8I5JK\Boounion
2025-09-19 334b16b4abb4cbe3d1d4e4f211efd6f4468ae09f
SourceCode/Bond/Servo/CMaster.cpp
@@ -53,7 +53,7 @@
      m_ullRunTime = 0;
      m_state = MASTERSTATE::READY;
      m_pActiveRobotTask = nullptr;
      m_nLastError = 0;
      m_nLastError = ER_CODE_NOERROR;
      m_isCompareMapsBeforeProceeding = FALSE;
      m_bJobMode = FALSE;
      m_bEnableEventReport = true;
@@ -62,6 +62,8 @@
      m_bBatch = false;
      m_nContinuousTransferCount = 0;
      m_nContinuousTransferStep = CTStep_Unknow;
      m_nContinuousWorkingPort = 0;
      m_nContinuousWorkingSlot = 0;
      m_pControlJob = nullptr;
      m_nTestFlag = 0;
      InitializeCriticalSection(&m_criticalSection);
@@ -131,7 +133,7 @@
         BoardVersion version{};
         int nRet = m_cclink.GetBoardVersion(version);
         if (nRet == 0) {
            LOGI("版本信息:%s.", version.toString().c_str());
            LOGD("版本信息:%s.", version.toString().c_str());
         }
         else {
            LOGE("获取CC-Link版本信息失败.");
@@ -140,7 +142,7 @@
         BoardStatus status;
         nRet = m_cclink.GetBoardStatus(status);
         if (nRet == 0) {
            LOGI("状态:%s.", status.toString().c_str());
            LOGD("状态:%s.", status.toString().c_str());
         }
         else {
            LOGE("获取CC-Link状态失败.");
@@ -307,7 +309,7 @@
      return 0;
   }
   int CMaster::stop()
   int CMaster::stop(int nErCode/* = ER_CODE_NOERROR*/)
   {
      // 运行时间为累加结果,本次停止时刷新;
      lock();
@@ -321,6 +323,7 @@
      // 更新状态
      m_nLastError = nErCode;
      setState(MASTERSTATE::STOPPING);
@@ -422,7 +425,8 @@
                  TRACE("a0001\n", writeCode, retCode);
               });
            if (nRet != 0) {
               LOGI("<Master>EFEM切换Start状态失败");
               LOGE("<Master>EFEM切换Start状态失败");
               m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
               m_strLastError = "EFEM切换Start状态失败.";
               goto WAIT;
            }
@@ -435,7 +439,8 @@
                  TRACE("a0002\n");
               });
            if (nRet != 0) {
               LOGI("<Master>Bonder1切换Start状态失败");
               LOGE("<Master>Bonder1切换Start状态失败");
               m_nLastError = ER_CODE_BONDER_OPERATION_MODE_FAIL;
               m_strLastError = "Bonder1切换Start状态失败.";
               goto WAIT;
            }
@@ -448,7 +453,8 @@
                  TRACE("a0003\n");
               });
            if (nRet != 0) {
               LOGI("<Master>Bonder2切换Start状态失败");
               LOGE("<Master>Bonder2切换Start状态失败");
               m_nLastError = ER_CODE_BONDER_OPERATION_MODE_FAIL;
               m_strLastError = "Bonder2切换Start状态失败.";
               goto WAIT;
            }
@@ -461,7 +467,8 @@
                  TRACE("a0004\n");
               });
            if (nRet != 0) {
               LOGI("<Master>BakeCooling切换Start状态失败");
               LOGE("<Master>BakeCooling切换Start状态失败");
               m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
               m_strLastError = "BakeCooling切换Start状态失败.";
               goto WAIT;
            }
@@ -474,7 +481,8 @@
                  TRACE("a0005\n");
               });
            if (nRet != 0) {
               LOGI("<Master>VacuumBake切换Start状态失败");
               LOGE("<Master>VacuumBake切换Start状态失败");
               m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
               m_strLastError = "VacuumBake切换Start状态失败.";
               goto WAIT;
            }
@@ -487,7 +495,8 @@
                  TRACE("a0006\n");
               });
            if (nRet != 0) {
               LOGI("<Master>Measurement切换Start状态失败");
               LOGE("<Master>Measurement切换Start状态失败");
               m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
               m_strLastError = "Measurement切换Start状态失败.";
               goto WAIT;
            }
@@ -501,7 +510,7 @@
            for (int i = 0; i < 6; i++) {
               if (!bIomcOk[i]) {
                  bIomcOk[6] = FALSE;
                  LOGI("<Master>%s切换Start状态失败", pEq[i]->getName().c_str());
                  LOGE("<Master>%s切换Start状态失败", pEq[i]->getName().c_str());
               }
            }
            
@@ -545,7 +554,8 @@
                     TRACE("s000%d: ret=%d\n", i + 1, retCode);
                  });
               if (nRet != 0) {
                  LOGI("<Master>%s切换Stop状态发送失败", pEq[i]->getName().c_str());
                  LOGE("<Master>%s切换Stop状态发送失败", pEq[i]->getName().c_str());
                  m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
                  m_strLastError = pEq[i]->getName() + "切换Stop状态发送失败.";
                  bIomcOk[i] = FALSE;
                  promises[i].set_value(); // 避免 wait 阻塞
@@ -560,7 +570,7 @@
            for (int i = 0; i < 6; ++i) {
               if (!bIomcOk[i]) {
                  bIomcOk[6] = FALSE;
                  LOGI("<Master>%s切换Stop状态失败", pEq[i]->getName().c_str());
                  LOGE("<Master>%s切换Stop状态失败", pEq[i]->getName().c_str());
               }
            }
@@ -570,7 +580,11 @@
            }
            LOGI("<Master>所有设备成功切换到 Stop 模式");
            setState(MASTERSTATE::READY);
            if(m_nLastError == ER_CODE_NOERROR)
               setState(MASTERSTATE::READY);
            else
               setState(MASTERSTATE::ATHERERROR);
            continue;
         }
@@ -734,7 +748,7 @@
            if (!rmd.armState[0]) {
               // m_nTestFlag = 1;
               if (m_nTestFlag == 1) LOGI("createTransferTask 004df %d, %d", MaterialsType::G1, secondaryType);
               if (m_nTestFlag == 1) LOGD("createTransferTask 004df %d, %d", MaterialsType::G1, secondaryType);
               m_pActiveRobotTask = createTransferTask(pAligner, pVacuumBake, MaterialsType::G1, secondaryType);
               CHECK_RUN_ACTIVE_ROBOT_TASK(m_pActiveRobotTask);
               m_nTestFlag = 0;
@@ -767,6 +781,15 @@
                  && pLoadPorts[s]->getPortStatus() == PORT_INUSE) {
                  m_pActiveRobotTask = createTransferTask(pLoadPorts[s], pAligner, primaryType, secondaryType, 1, m_bJobMode);
                  if (m_pActiveRobotTask != nullptr) {
                     CGlass* pGlass = (CGlass*)m_pActiveRobotTask->getContext();
                     if (pGlass->getBuddy() != nullptr) {
                        delete m_pActiveRobotTask;
                        m_pActiveRobotTask = nullptr;
                        continue;
                     }
                     pGlass->queue();
                     pGlass->start();
                     pEFEM->setContext(m_pActiveRobotTask->getContext());
                     goto PORT_GET;
                  }
@@ -791,7 +814,7 @@
            CJState state = m_pControlJob->state();
            if (state == CJState::Completed || state == CJState::Aborted || state == CJState::Failed) {
               // ConrolJpb已完成
               LOGI("<Master>ControlJob已经完成或失败中断");
               LOGE("<Master>ControlJob已经完成或失败中断");
               unlock();
               continue;
            }
@@ -828,7 +851,7 @@
               }
            }
            if (m_inProcesJobs.empty()) {
               LOGI("<Master>选择当前ProcessJob失败!");
               LOGE("<Master>选择当前ProcessJob失败!");
               unlock();
               continue;
            }
@@ -880,7 +903,7 @@
            // Measurement -> LoadPort
            if (rmd.armState[0] || rmd.armState[1]) {
               LOGI("Arm1 %s, Arm2 %s.", rmd.armState[0] ? _T("不可用") : _T("可用"),
               LOGD("Arm1 %s, Arm2 %s.", rmd.armState[0] ? _T("不可用") : _T("可用"),
                  rmd.armState[1] ? _T("不可用") : _T("可用"));
            }
            for (int s = 0; s < 4; s++) {
@@ -987,6 +1010,12 @@
                  m_pActiveRobotTask = createTransferTask(pLoadPorts[s], pAligner, primaryType, secondaryType, m_bJobMode);
                  if (m_pActiveRobotTask != nullptr) {
                     CGlass* pGlass = (CGlass*)m_pActiveRobotTask->getContext();
                     if (pGlass->getBuddy() != nullptr) {
                        delete m_pActiveRobotTask;
                        m_pActiveRobotTask = nullptr;
                        continue;
                     }
                     pEFEM->setContext(pGlass);
                     pGlass->start();
                     bool bMoved = glassFromQueueToInPorcess(pGlass);
@@ -1037,15 +1066,17 @@
            }
            // Measurement -> LoadPort
            for (int s = 0; s < 4; s++) {
               PortType pt = pLoadPorts[s]->getPortType();
            for (int p = 0; p < 4; p++) {
               if (p != m_nContinuousWorkingPort) continue;
               PortType pt = pLoadPorts[p]->getPortType();
               if ((m_nContinuousTransferStep == CTStep_Unknow || m_nContinuousTransferStep == CTStep_BakeCooling_Measurement)
                  && !rmd.armState[0] && pLoadPorts[s]->isEnable()
                  && !rmd.armState[0] && pLoadPorts[p]->isEnable()
                  && (pt == PortType::Unloading || pt == PortType::Both)
                  && pLoadPorts[s]->getPortStatus() == PORT_INUSE) {
                  && pLoadPorts[p]->getPortStatus() == PORT_INUSE) {
                  for (int slot = 0; slot < SLOT_MAX; slot++) {
                     if (slot != m_nContinuousWorkingSlot) continue;
                     m_pActiveRobotTask = createTransferTask_continuous_transfer(pMeasurement,
                        0, pLoadPorts[s], slot);
                        0, pLoadPorts[p], slot);
                     if (m_pActiveRobotTask != nullptr) {
                        m_nContinuousTransferStep = CTStep_Measurement_LoadPort;
                        m_nContinuousTransferStep = CTStep_end;
@@ -1177,17 +1208,19 @@
            }
            // LoadPort -> Aligner
            for (int s = 0; s < 4; s++) {
               PortType pt = pLoadPorts[s]->getPortType();
            for (int p = 0; p < 4; p++) {
               PortType pt = pLoadPorts[p]->getPortType();
               if ((m_nContinuousTransferStep == CTStep_Unknow || m_nContinuousTransferStep == CTStep_end)
                  && !rmd.armState[0] && pLoadPorts[s]->isEnable()
                  && !rmd.armState[0] && pLoadPorts[p]->isEnable()
                  && (pt == PortType::Loading || pt == PortType::Both)
                  && pLoadPorts[s]->getPortStatus() == PORT_INUSE) {
                  && pLoadPorts[p]->getPortStatus() == PORT_INUSE) {
                  for (int slot = 0; slot < SLOT_MAX; slot++) {
                     m_pActiveRobotTask = createTransferTask_continuous_transfer(pLoadPorts[s],
                     m_pActiveRobotTask = createTransferTask_continuous_transfer(pLoadPorts[p],
                        slot, pAligner, 0);
                     if (m_pActiveRobotTask != nullptr) {
                        m_nContinuousTransferStep = CTStep_LoadPort_Aligner;
                        m_nContinuousWorkingPort = p;
                        m_nContinuousWorkingSlot = slot;
                        LOGI("<ContinuousTransfer>千传测试,开始搬送任务(LoadPort -> Aligner)...");
                        pEFEM->setContext(m_pActiveRobotTask->getContext());
                        goto CT_PORT_GET;
@@ -1299,22 +1332,22 @@
         BOOL bOk = FALSE;
         lock();
         if (m_pActiveRobotTask != nullptr) {
            LOGI("<CMaster>onPreFethedOutJob 0001.");
            LOGD("<CMaster>onPreFethedOutJob 0001.");
            if (m_pActiveRobotTask->getSrcPosition() == p->getID()) {
               LOGI("<CMaster>onPreFethedOutJob 0002.");
               LOGD("<CMaster>onPreFethedOutJob 0002.");
               CGlass* pGlass = p->getGlassFromSlot(m_pActiveRobotTask->getSrcSlot());
               if (pGlass != nullptr) {
                  LOGI("<CMaster>onPreFethedOutJob 0003.");
                  LOGD("<CMaster>onPreFethedOutJob 0003.");
                  CJobDataS* pJobDataS = pGlass->getJobDataS();
                  if (pJobDataS != nullptr
                     && pJobDataS->getCassetteSequenceNo() == pJobDataB->getCassetteSequenceNo()
                     && pJobDataS->getJobSequenceNo() == pJobDataB->getJobSequenceNo()) {
                     bOk = TRUE;
                     LOGI("<CMaster>onPreFethedOutJob, 已校验数据一致性.");
                     LOGD("<CMaster>onPreFethedOutJob, 已校验数据一致性.");
                  }
                  LOGI("<CMaster>onPreFethedOutJob 0004.");
                  LOGD("<CMaster>onPreFethedOutJob 0004.");
                  if (pJobDataS != nullptr) {
                     LOGI("<CMaster>onPreFethedOutJob 0005. %d,%d,%d,%d",
                     LOGD("<CMaster>onPreFethedOutJob 0005. %d,%d,%d,%d",
                        pJobDataS->getCassetteSequenceNo(),
                        pJobDataB->getCassetteSequenceNo(),
                        pJobDataS->getJobSequenceNo(),
@@ -1436,6 +1469,8 @@
               if (m_pActiveRobotTask->getSrcPosition() == EQ_ID_MEASUREMENT) {
                  CGlass* pGlass = (CGlass*)m_pActiveRobotTask->getContext();
                  pGlass->complete();
                  CGlass* pBuddy = pGlass->getBuddy();
                  if (pBuddy != nullptr) pBuddy->complete();
                  this->saveState();
                  bool bMoved = glassFromInPorcessToComplete(pGlass);
                  if (bMoved) {
@@ -1538,6 +1573,45 @@
         if (m_listener.onLoadPortStatusChanged != nullptr) {
            m_listener.onLoadPortStatusChanged(this, (CEquipment*)pEquipment, status, data);
         }
      };
      listener.onSVDataReport = [&](void* pEquipment, void* pData) {
         CSVData* pSVData = (CSVData*)pData;
         auto rawData = pSVData->getSVRawData();
         std::vector<CParam> params;
         ((CEquipment*)pEquipment)->parsingSVData((const char*)rawData.data(), rawData.size(), params);
         std::string strOut;
         char szBuffer[256];
         for (auto p : params) {
            if (!strOut.empty()) strOut.append(",");
            if (p.getValueType() == PVT_INT) {
               sprintf_s(szBuffer, 256, "%s:%d", p.getName().c_str(), p.getIntValue());
            }
            else if (p.getValueType() == PVT_DOUBLE) {
               sprintf_s(szBuffer, 256, "%s:%f", p.getName().c_str(), p.getDoubleValue());
            }
            strOut.append(szBuffer);
         }
         LOGD("<CMaster-%s>SVDataReport:%s", ((CEquipment*)pEquipment)->getName().c_str(), strOut.c_str());
      };
      listener.onPanelDataReport = [&](void* pEquipment, void* pContext) {
         LOGD("<CMaster-%s>onPanelDataReport", ((CEquipment*)pEquipment)->getName().c_str());
         CEquipment* pEq = (CEquipment*)pEquipment;
         CGlass* pGlass = (CGlass*)pContext;
         // 如果AOI检测失败,要停机
         if (pEq->getID() == EQ_ID_MEASUREMENT) {
            LOGD("<CMaster-%s>onPanelDataReport 01", ((CEquipment*)pEquipment)->getName().c_str());
            if (pGlass->getAOIInspResult() == InspResult::Fail) {
               LOGD("<CMaster-%s>onPanelDataReport 02", ((CEquipment*)pEquipment)->getName().c_str());
               if (stop() == 0) {
                  m_nLastError = ER_CODE_AOI_NG;
                  m_strLastError = "AOI检测未通过.";
               }
            }
         }
      };
      pEquipment->setListener(listener);
      pEquipment->setCcLink(&m_cclink);
@@ -1799,6 +1873,8 @@
         if (!m_inProcesGlasses.empty()) {
            CGlass* pGlass = m_inProcesGlasses.front();
            pGlass->complete();
            CGlass* pBuddy = pGlass->getBuddy();
            if (pBuddy != nullptr) pBuddy->complete();
            glassFromInPorcessToComplete(pGlass);
            this->saveState();
@@ -2005,12 +2081,12 @@
      pSrcEq->m_nTestFlag = m_nTestFlag;
      pTarSlot = pTarEq->getAvailableSlotForGlass(primaryType);
      pSrcSlot = pSrcEq->getProcessedSlot(primaryType, bJobMode);
      if (m_nTestFlag == 1) LOGI("createTransferTask 003 %x, %x", pTarSlot, pSrcSlot);
      if (pSrcSlot == nullptr || nullptr == pTarSlot && secondaryType != SERVO::MaterialsType::G0) {
      if (m_nTestFlag == 1) LOGD("createTransferTask 003 %x, %x", pTarSlot, pSrcSlot);
      if ((pSrcSlot == nullptr || nullptr == pTarSlot) && secondaryType != SERVO::MaterialsType::G0) {
         pTarSlot = pTarEq->getAvailableSlotForGlass(secondaryType);
         pSrcSlot = pSrcEq->getProcessedSlot(secondaryType, bJobMode);
      }
      if (m_nTestFlag == 1) LOGI("createTransferTask 004 %x, %x", pTarSlot, pSrcSlot);
      if (m_nTestFlag == 1) LOGD("createTransferTask 004 %x, %x", pTarSlot, pSrcSlot);
      if (pSrcSlot != nullptr && nullptr != pTarSlot) {
         pTask = new CRobotTask();
@@ -2243,6 +2319,22 @@
      int eqid[] = { EQ_ID_LOADPORT1, EQ_ID_LOADPORT2, EQ_ID_LOADPORT3, EQ_ID_LOADPORT4 };
      CLoadPort* pPort = (CLoadPort*)getEquipment(eqid[index]);
      pPort->localEanblePort(bEnable);
   }
   int CMaster::getPortCassetteSnSeed(int port)
   {
      ASSERT(1 <= port && port <= 4);
      int eqid[] = { EQ_ID_LOADPORT1, EQ_ID_LOADPORT2, EQ_ID_LOADPORT3, EQ_ID_LOADPORT4 };
      CLoadPort* pPort = (CLoadPort*)getEquipment(eqid[port - 1]);
      return pPort->getPortCassetteSnSeed();
   }
   void CMaster::setPortCassetteSnSeed(int port, int seed)
   {
      ASSERT(1 <= port && port <= 4);
      int eqid[] = { EQ_ID_LOADPORT1, EQ_ID_LOADPORT2, EQ_ID_LOADPORT3, EQ_ID_LOADPORT4 };
      CLoadPort* pPort = (CLoadPort*)getEquipment(eqid[port - 1]);
      return pPort->setPortCassetteSnSeed(seed);
   }
   void CMaster::setCompareMapsBeforeProceeding(BOOL bCompare)
@@ -2493,7 +2585,9 @@
         m_pControlJob = new CControlJob();
         if (!CControlJob::deserialize(ifs, *m_pControlJob)) return false;
      }
      else {
         return false;
      }
      // 读取 ProcessJob 列表
      uint32_t count = 0;
@@ -2663,4 +2757,123 @@
      return nullptr;
   }
   bool CMaster::completeControlJob(std::string description)
   {
      if (m_pControlJob == nullptr || m_state != SERVO::MASTERSTATE::READY) {
         return false;
      }
      for (auto item : m_processJobs) {
         item->abort(description);
      }
      m_pControlJob->abort(description);
      // 释放Job相关
      for (auto item : m_processJobs) {
         delete item;
      }
      m_processJobs.clear();
      if (m_pControlJob != nullptr) {
         delete m_pControlJob;
         m_pControlJob = nullptr;
      }
      saveState();
      return true;
   }
   bool CMaster::canCreateControlJob()
   {
      return m_pControlJob == nullptr;
   }
   bool CMaster::canCompleteControlJob()
   {
      return m_pControlJob != nullptr && m_state == SERVO::MASTERSTATE::READY;
   }
   bool CMaster::canDeleteControlJob()
   {
      return m_pControlJob != nullptr
         && m_pControlJob->state() == CJState::NoState
         && m_state == SERVO::MASTERSTATE::READY;
   }
   int CMaster::getWipGlasses(std::vector<CGlass*>& glasses)
   {
      for (auto eq : m_listEquipment) {
         auto p = dynamic_cast<CLoadPort*>(eq);
         if (p == nullptr) {
            eq->getAllGlass(glasses);
         }
      }
      return (int)glasses.size();
   }
   int CMaster::getLastError()
   {
      return m_nLastError;
   }
   std::string& CMaster::getLastErrorText()
   {
      return m_strLastError;
   }
   void CMaster::test()
   {
      if (stop() == 0) {
         m_nLastError = ER_CODE_AOI_NG;
         m_strLastError = "AOI检测未通过.";
      }
   }
   bool CMaster::moveGlassToBuf(int eqid, int slotNo)
   {
      CEquipment* pEquipment = getEquipment(eqid);
      if (pEquipment == nullptr) return false;
      CSlot* pSlot = pEquipment->getSlotWithNo(slotNo);
      if (pSlot == nullptr) return false;
      CGlass* pGlass = (CGlass*)pSlot->getContext();
      m_bufGlass.push_back(pGlass);
      pGlass->addRef();
      pSlot->setContext(nullptr);
      m_bDataModify = TRUE;
      if (m_listener.onEqDataChanged != nullptr) {
         m_listener.onEqDataChanged(this, pEquipment, 0);
      }
      return true;
   }
   bool CMaster::moveGlassToSlot(int eqid, int slotNo)
   {
      CEquipment* pEquipment = getEquipment(eqid);
      if (pEquipment == nullptr) return false;
      CSlot* pSlot = pEquipment->getSlotWithNo(slotNo);
      if (pSlot == nullptr) return false;
      if (m_bufGlass.empty()) return false;
      CGlass* pGlass = m_bufGlass.front();
      m_bufGlass.pop_front();
      if (pGlass == nullptr) return false;
      pSlot->setContext(pGlass);
      pGlass->release();
      m_bDataModify = TRUE;
      if (m_listener.onEqDataChanged != nullptr) {
         m_listener.onEqDataChanged(this, pEquipment, 0);
      }
      return true;
   }
}