chenluhua1980
2026-01-06 4d9d8d22e3666076988c30afb4e7c6fe365c19aa
SourceCode/Bond/Servo/CEquipment.cpp
@@ -5,6 +5,7 @@
#include "CArm.h"
#include "CGlassPool.h"
#include "Servo.h"
#include "GlassJson.h"
namespace SERVO {
@@ -25,8 +26,8 @@
      m_pCclink = nullptr;
      m_nBaseAlarmId = 0;
      m_pArm = nullptr;
      m_processState = PROCESS_STATE::Ready;
      m_blockReadBit = { 0 };
      m_nTestFlag = 0;
      InitializeCriticalSection(&m_criticalSection);
   }
@@ -142,13 +143,15 @@
      return 0;
   }
   void CEquipment::setProcessState(PROCESS_STATE state)
   void CEquipment::setProcessState(int nSlotNo, PROCESS_STATE state)
   {
      m_processState = state;
      onProcessStateChanged(m_processState);
      if (nSlotNo <= 0 || nSlotNo > 8) return;
      m_processState[nSlotNo - 1] = state;
      onProcessStateChanged(nSlotNo, m_processState[nSlotNo - 1]);
      if (m_listener.onProcessStateChanged != nullptr) {
         m_listener.onProcessStateChanged(this, m_processState);
         m_listener.onProcessStateChanged(this, nSlotNo, m_processState[nSlotNo - 1]);
      }
   }
@@ -334,11 +337,16 @@
         for (int i = 0; i < SLOT_MAX; i++) {
            m_slot[i].serialize(ar);
            CGlass* pGlass = (CGlass *)m_slot[i].getContext();
            if (pGlass != nullptr) {
               pGlass->serialize(ar);
            if (pGlass != nullptr) {
               const std::string pretty = GlassJson::ToPrettyString(*pGlass);
               CString strPretty = CString(pretty.c_str());
               ar << strPretty;
               CGlass* pBuddy = pGlass->getBuddy();
               if (pBuddy != nullptr) {
                  pBuddy->serialize(ar);
                  const std::string prettyBuddy = GlassJson::ToPrettyString(*pBuddy);
                  CString strPrettyBuddy = CString(prettyBuddy.c_str());
                  ar << strPrettyBuddy;
               }
            }
         }
@@ -348,17 +356,29 @@
         for (int i = 0; i < SLOT_MAX; i++) {
            m_slot[i].serialize(ar);
            if (m_slot[i].getTempContext() != nullptr) {
               CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
               pGlass->serialize(ar);
               m_slot[i].setContext(pGlass);
               if (pGlass->getBuddy() != nullptr) {
                  CGlass* pBuddy = theApp.m_model.m_glassPool.allocaGlass();
                  pBuddy->serialize(ar);
                  pGlass->forceSetBuddy(pBuddy);
               CString strPretty;
               std::string pretty;
               ar >> strPretty;
               pretty = (LPTSTR)(LPCTSTR)strPretty;
               if (!pretty.empty()) {
                  CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
                  GlassJson::FromString(pretty, *pGlass);
                  m_slot[i].setContext(pGlass);
                  if (!pGlass->getBuddyId().empty()) {
                     CGlass* pBuddy = theApp.m_model.m_glassPool.allocaGlass();
                     CString strPrettyBuddy;
                     std::string prettyBuddy;
                     ar >> strPrettyBuddy;
                     prettyBuddy = (LPTSTR)(LPCTSTR)strPrettyBuddy;
                     GlassJson::FromString(prettyBuddy, *pBuddy);
                     pGlass->forceSetBuddy(pBuddy);
                  }
               }
            }
         }
         // 梳理各玻璃之间的绑定关系
         /*
         Lock();
@@ -489,11 +509,26 @@
      // process data report
      CHECK_READ_STEP_SIGNAL(STEP_ID_PROCESS_DATA_REPORT, pszData, size);
      // FAC Data report
      // CHECK_READ_STEP_SIGNAL(STEP_ID_FAC_DATA_REPORT, pszData, size);
      {
         SERVO::CStep* pStep = getStep(STEP_ID_FAC_DATA_REPORT);
         if (pStep != nullptr) {
               ((CReadStep*)pStep)->onReadSignal(TRUE);
         }
      }
      // 配方改变
      CHECK_READ_STEP_SIGNAL(STEP_ID_CURRENT_RECIPE_CHANGE_REPORT, pszData, size);
      
      // 主配方上报
      CHECK_READ_STEP_SIGNAL(STEP_ID_MASTER_RECIPE_LIST_REPORT, pszData, size);
      // 配方参数
      CHECK_WRITE_STEP_SIGNAL(STEP_ID_RECIPE_PARAMETER_CMD_REPLY, pszData, size);
      CHECK_READ_STEP_SIGNAL(STEP_ID_RECIPE_PARAMETER_REPORT, pszData, size);
      // CIM Mode
      CHECK_WRITE_STEP_SIGNAL(STEP_ID_CIMMODE_CHANGED_CMD_REPLY, pszData, size);
@@ -812,6 +847,16 @@
      return m_recipesManager.getRecipeList(unitNo);
   }
   bool CEquipment::saveRecipeList(int unitNo, std::string& strFilepath)
   {
      return m_recipesManager.saveRecipeList(unitNo, strFilepath);
   }
   bool CEquipment::readRecipeList(int unitNo, std::string& strFilepath)
   {
      return m_recipesManager.readRecipeList(unitNo, strFilepath);
   }
   int CEquipment::recvIntent(CPin* pPin, CIntent* pIntent)
   {
      ASSERT(pPin);
@@ -820,7 +865,7 @@
      CEquipment* pFromEq = pFromPin->getEquipment();
      ASSERT(pFromEq);
      LOGI("<CEquipment><%s-%s>收到来自<%s.%s>的Intent<%d,%s,0x%x>",
      LOGD("<CEquipment><%s-%s>收到来自<%s.%s>的Intent<%d,%s,0x%x>",
         this->getName().c_str(),
         pPin->getName().c_str(),
         pFromEq->getName().c_str(),
@@ -872,8 +917,8 @@
      Unlock();
      if (m_processState != PROCESS_STATE::Ready) {
         setProcessState(PROCESS_STATE::Ready);
      if (m_processState[port] != PROCESS_STATE::Ready) {
         setProcessState(port, PROCESS_STATE::Ready);
      }
      if (m_listener.onDataChanged != nullptr) {
@@ -897,14 +942,18 @@
      ASSERT(pGlass);
      Lock();
      pGlass->addPath(m_nID, getSlotUnit(putSlot));
      pGlass->addPath(m_nID, getSlotUnit(putSlot), putSlot);
      CGlass* pBuddy = pGlass->getBuddy();
      if (pBuddy != nullptr) pBuddy->addPath(m_nID, getSlotUnit(putSlot), putSlot);
      m_slot[putSlot - 1].setContext(pGlass);
      pGlass->release();            // tempFetchOut需要调用一次release
      Unlock();
      /*
      if (m_processState != PROCESS_STATE::Processing) {
         setProcessState(PROCESS_STATE::Processing);
      }
      */
      if (m_listener.onDataChanged != nullptr) {
         m_listener.onDataChanged(this, EDCC_STORED_JOB);
@@ -971,6 +1020,22 @@
      return nullptr;
   }
   int CEquipment::getAllGlass(std::vector<CGlass*>& glasses)
   {
      Lock();
      for (int i = 0; i < SLOT_MAX; i++) {
         if (!m_slot[i].isEnable()) continue;
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (pGlass != nullptr) {
            pGlass->addRef();
            glasses.push_back(pGlass);
         }
      }
      Unlock();
      return (int)glasses.size();
   }
   CJobDataS* CEquipment::getJobDataSWithCassette(int cassetteSequenceNo, int jobSequenceNo)
@@ -1119,7 +1184,7 @@
               LOGI("<CEquipment-%s>设置DispatchingMode成功.", m_strName.c_str());
            }
            else {
               LOGI("<CEquipment-%s>设置DispatchingMode失败,code:%d", m_strName.c_str(), code);
               LOGE("<CEquipment-%s>设置DispatchingMode失败,code:%d", m_strName.c_str(), code);
            }
            return 0;
@@ -1149,7 +1214,7 @@
            LOGI("<CEquipment-%s>返回值: %d", m_strName.c_str(), retCode);
         }
         else {
            LOGI("<CEquipment-%s>设置indexerOperationMode失败,code:%d", m_strName.c_str(), code);
            LOGE("<CEquipment-%s>设置indexerOperationMode失败,code:%d", m_strName.c_str(), code);
         }
         if (onWritedRetBlock != nullptr) {
@@ -1180,7 +1245,7 @@
         }
         else {
            m_recipesManager.syncFailed();
            LOGI("<CEquipment-%s>请求单元<%d>主配方列表失败,code:%d", m_strName.c_str(), unitNo, code);
            LOGE("<CEquipment-%s>请求单元<%d>主配方列表失败,code:%d", m_strName.c_str(), unitNo, code);
         }
         return 0;
@@ -1188,28 +1253,39 @@
      return 0;
   }
   int CEquipment::recipeParameterRequest(short masterRecipeId, short localRecipeId, short unitNo)
   int CEquipment::recipeParameterRequest(short masterRecipeId, short localRecipeId, short unitNo, ONSYNCINGSTATECHANGED block)
   {
      SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(STEP_EQ_MASTER_RECIPE_LIST_REQ);
      LOGI("<CEquipment-%s>正在请求单元<%d>主配参数列表", m_strName.c_str(), unitNo);
      m_recipesManager.setOnSyncingStateChanged(block);
      if (m_recipesManager.syncing() != 0) {
         return -2;
      }
      SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(STEP_EQ_RECIPE_PARAMETER_REQ);
      if (pStep == nullptr) {
         return -1;
      }
      LOGI("<CEquipment-%s>正在请求单元<%d>主配方列表", m_strName.c_str(), unitNo);
      if (m_recipesManager.syncing() != 0) {
         return -2;
      }
      pStep->writeShort(unitNo, [&, unitNo](int code) -> int {
      char szBuffer[14 * 2] = {0};
      int index = 0;
      memcpy(&szBuffer[index], &masterRecipeId, sizeof(short));
      index += sizeof(short);
      memcpy(&szBuffer[index], &localRecipeId, sizeof(short));
      index += sizeof(short);
      memcpy(&szBuffer[index], &unitNo, sizeof(short));
      pStep->writeDataEx(szBuffer, 14 * 2, [&, unitNo](int code) -> int {
         if (code == WOK) {
            LOGI("<CEquipment-%s>请求单元<%d>主配方列表成功,正在等待数据.", m_strName.c_str(), unitNo);
            LOGI("<CEquipment-%s>请求单元<%d>主配方参数列表成功,正在等待数据.", m_strName.c_str(), unitNo);
         }
         else {
            m_recipesManager.syncFailed();
            LOGI("<CEquipment-%s>请求单元<%d>主配方列表失败,code:%d", m_strName.c_str(), unitNo, code);
            LOGE("<CEquipment-%s>请求单元<%d>主配方参数列表失败,code:%d", m_strName.c_str(), unitNo, code);
         }
         return 0;
         });
      });
      return 0;
   }
@@ -1325,26 +1401,35 @@
      return nullptr;
   }
   CSlot* CEquipment::getProcessedSlot(MaterialsType putSlotType)
   CSlot* CEquipment::getProcessedSlot(MaterialsType putSlotType, BOOL bJobMode/* = FALSE*/)
   {
      for (int i = 0; i < SLOT_MAX; i++) {
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 001");
         if (!m_slot[i].isEnable()) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 002");
         if (m_slot[i].isLock()) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 003");
         CGlass* pGlass = (CGlass*)m_slot[i].getContext();
         if (!isSlotProcessed(i)) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 004");
         if (pGlass == nullptr) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 005");
         if (!pGlass->isScheduledForProcessing()) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 006");
         if (bJobMode && pGlass->getProcessJob() == nullptr) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 007");
         if(pGlass->getInspResult(m_nID, 0) == InspResult::Fail) continue;
         int lsPath = m_slot[i].getLinkSignalPath();
         if(!m_bLinkSignalToUpstream[lsPath][SIGNAL_UPSTREAM_INLINE]
            || m_bLinkSignalToUpstream[lsPath][SIGNAL_UPSTREAM_TROUBLE]
            || !m_bLinkSignalToUpstream[lsPath][SIGNAL_INTERLOCK]
            || !m_bLinkSignalToUpstream[lsPath][SIGNAL_SEND_ABLE] ) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 008");
         MaterialsType glassType = pGlass->getType();
         if (glassType == MaterialsType::G1 && putSlotType == MaterialsType::G2) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 009");
         if (glassType == MaterialsType::G2 && putSlotType == MaterialsType::G1) continue;
         if (m_nTestFlag == 1) LOGD("getProcessedSlot 00a");
         return &m_slot[i];
      }
@@ -1422,6 +1507,19 @@
      return &m_slot[index];
   }
   CSlot* CEquipment::getSlotWithNo(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;
      }
      return pSlot;
   }
   CGlass* CEquipment::getAnyGlass()
   {
      CSlot* pSlot = nullptr;
@@ -1442,6 +1540,13 @@
      if (m_slot[slotIndex].getContext() != nullptr) return FALSE;
      return TRUE;
   }
   BOOL CEquipment::slotHasGlass(int slotIndex/* = 0*/)
   {
      ASSERT(slotIndex < 8);
      CGlass* pGlass = (CGlass*)m_slot[slotIndex].getContext();
      return (pGlass != nullptr);
   }
   int CEquipment::removeGlass(int slotNo)
@@ -1484,6 +1589,34 @@
      CAttributeVector& attrubutes = pStep->attributeVector();
      processData.getAttributeVector(attrubutes, weight);
      onProcessData(&processData);
      // 找到玻璃,关联数据
      CGlass* pGlass = this->getGlassWithCassette(processData.getCassetteSequenceNo(),
         processData.getJobSequenceNo());
      if (pGlass == nullptr) {
         LOGE("<CEquipment-%s>找不到对应Glass, 关联工艺参数失败。CassetteSequenceNo:%d/%d",
            this->getName().c_str(),
            processData.getCassetteSequenceNo(),
            processData.getJobSequenceNo());
         return -1;
      }
      auto rawData = processData.getParamsRawData();
      std::vector<CParam> tempParams;
      this->parsingProcessData((const char*)rawData.data(), rawData.size(), tempParams);
      int n = processData.getTotalParameter();
      std::vector<CParam> params(tempParams.begin(), tempParams.begin() + min(n, (int)tempParams.size()));
      pGlass->addParams(params);
      // 关联的Glass也要更新
      CGlass* pBuddy = pGlass->getBuddy();
      LOGI("<Equipment-%s>decodeProcessDataReport pBuddy=%x %s", getName().c_str(), pBuddy, pGlass->getID().c_str());
      if (pBuddy != nullptr) {
         LOGI("<Equipment-%s>decodeProcessDataReport addParams pBuddy=%x %s", getName().c_str(), pBuddy, pGlass->getID().c_str());
         pBuddy->addParams(params);
      }
      return nRet;
   }
@@ -1654,19 +1787,29 @@
   int CEquipment::decodeVCREventReport(CStep* pStep, const char* pszData, size_t size)
   {
      CVcrEventReport vcrEventReport;
      vcrEventReport.unserialize(pszData, size);
      vcrEventReport.unserialize(pszData, (int)size);
      LOGI("<CEquipment-%s>decodeVCREventReport<Result:%d, GlassId:%s>\n", m_strName.c_str(),
         vcrEventReport.getVcrResult(),
         vcrEventReport.getGlassId().c_str());
      // 更新Glass的ID
      CGlass* pGlass = getGlassWithCassette(vcrEventReport.getCassetteSequenceNo(),
         vcrEventReport.getJobSequenceNo());
      if (pGlass != nullptr) {
         pGlass->setID(vcrEventReport.getGlassId().c_str());
      }
      // 缓存Attribute,用于调试时显示信息
      unsigned int weight = 201;
      CAttributeVector& attrubutes = pStep->attributeVector();
      vcrEventReport.getAttributeVector(attrubutes, weight);
      // 0426, 先固定返回1(OK)
      ((CReadStep*)pStep)->setReturnCode((short)VCR_Reply_Code::OK);
      return 0;
   }
@@ -1705,28 +1848,26 @@
            getName().c_str(), cassetteNo, jobSequenceNo);
         return -1;
      }
      pGlass->setInspResult(m_nID, 0, judgeStringToInspResult(strPanelJudgeData));
      auto result = judgeStringToInspResult(strPanelJudgeData);
      pGlass->setInspResult(m_nID, 0, result);
      if (m_listener.onPanelDataReport != nullptr) {
         m_listener.onPanelDataReport(this, pGlass);
      }
      return 0;
   }
   int CEquipment::decodeFacDataReport(CStep* pStep, const char* pszData, size_t size)
   {
      int index = 0;
      std::string strSvTimeRecord, strSvData;
      CToolUnits::convertString(&pszData[index], 8 * 2, strSvTimeRecord);
      index += 128 * 2;
      CToolUnits::convertString(&pszData[index], 640 * 2, strSvData);
      index += 256 * 2;
      CSVData svData;
      int nRet = svData.unserialize(&pszData[0], (int)size);
      if (nRet < 0) return nRet;
      m_svDatas.push_back(svData);
      // 缓存Attribute,用于调试时显示信息
      unsigned int weight = 201;
      pStep->addAttribute(new CAttribute("SV Time Record",
         strSvTimeRecord.c_str(), "", weight++));
      pStep->addAttribute(new CAttribute("SV Data",
         strSvData.c_str(), "", weight++));
      if (m_listener.onSVDataReport != nullptr) {
         m_listener.onSVDataReport(this, &svData);
      }
      return 0;
   }
@@ -1798,9 +1939,17 @@
         year, month, day, hour, minute, second
         );
      CGlass* pGlass = getGlassFromSlot(slotNo);
      if (pGlass == nullptr) {
         LOGE("<CEquipment-%s>decodeJobProcessStartReport, 找不到对应glass", getName().c_str());
      }
      if (slotNo <= 0 || slotNo > 8) return -1;
      if (m_processState != PROCESS_STATE::Processing) {
         setProcessState(PROCESS_STATE::Processing);
      if (m_processState[slotNo -1] != PROCESS_STATE::Processing) {
         Lock();
         m_svDatas.clear();
         Unlock();
         setProcessState(slotNo, PROCESS_STATE::Processing);
      }
@@ -1868,11 +2017,11 @@
      );
      if (m_processState != PROCESS_STATE::Complete) {
         setProcessState(PROCESS_STATE::Complete);
      }
      CGlass* pGlass = getGlassFromSlot(slotNo);
      if (m_processState[slotNo - 1] != PROCESS_STATE::Complete) {
         setProcessState(slotNo, PROCESS_STATE::Complete);
      }
      if (pGlass == nullptr) {
         LOGE("<CEquipment-%s>decodeJobProcessEndReport, 找不到对应glass", getName().c_str());
      }
@@ -1881,9 +2030,6 @@
         if (pJs->getCassetteSequenceNo() == cassetteNo
            && pJs->getJobSequenceNo() == jobSequenceNo) {
            pGlass->processEnd(m_nID, getSlotUnit(slotNo));
            if (m_processState != PROCESS_STATE::Complete) {
               setProcessState(PROCESS_STATE::Complete);
            }
         }
         else {
            LOGE("<CEquipment-%s>decodeJobProcessEndReport, jobSequenceNo或jobSequenceNo不匹配",
@@ -1990,19 +2136,19 @@
    */
   int CEquipment::onSendAble(int port)
   {
      LOGI("<CEquipment-%s>onSendAble.port:%d", m_strName.c_str(), port);
      // LOGI("<CEquipment-%s>onSendAble.port:%d", m_strName.c_str(), port);
      return 0;
   }
   int CEquipment::onReceiveAble(int port)
   {
      LOGI("<CEquipment-%s>onReceiveAble.port:%d", m_strName.c_str(), port);
      // LOGI("<CEquipment-%s>onReceiveAble.port:%d", m_strName.c_str(), port);
      return 0;
   }
   int CEquipment::onProcessStateChanged(PROCESS_STATE state)
   int CEquipment::onProcessStateChanged(int nSlotNo, PROCESS_STATE state)
   {
      return 0;
   }
@@ -2058,4 +2204,61 @@
      return InspResult::NotInspected;
   }
   float CEquipment::toFloat(const char* pszAddr)
   {
      BYTE szBuffer[4];
      szBuffer[0] = pszAddr[0];
      szBuffer[1] = pszAddr[1];
      szBuffer[2] = pszAddr[2];
      szBuffer[3] = pszAddr[3];
      float f = 0.0;
      memcpy(&f, szBuffer, 4);
      return f;
   }
   int CEquipment::parsingParams(const char* pszData, size_t size, std::string& strOut)
   {
      std::vector<CParam> params;
      int nRet = parsingParams(pszData, size, params);
      if (nRet <= 0) return nRet;
      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);
      }
      return 0;
   };
   void CEquipment::addFacDataReportStep(int dataDev, int writeSignalDev, int port)
   {
      CEqReadStep* pStep = new CEqReadStep(dataDev, 133 * 2,
         [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
            if (code == ROK && pszData != nullptr && size > 0) {
               decodeFacDataReport((CStep*)pFrom, pszData, size);
            }
            return -1;
         });
      pStep->setName(STEP_EQ_FAC_DATA_REPORT);
      pStep->setProp("Port", (void*)(__int64)port);
      pStep->setReadContinue(TRUE);
      pStep->setWriteSignalDev(writeSignalDev);
      if (addStep(STEP_ID_FAC_DATA_REPORT, pStep) != 0) {
         delete pStep;
      }
   }
   std::vector<SERVO::CSVData>& CEquipment::getSVDatas()
   {
      return m_svDatas;
   }
}