1.继续完善模拟测试等

chenluhua1980

2026-01-08 9c9100b078e9ac4ee7ed61500b4d7c7a74207549

 SourceCode/Bond/Servo/Model.cpp

@@ -1,4 +1,4 @@
#include "stdafx.h"
#include "stdafx.h"
#include "Model.h"
#include "Log.h"
#include "Common.h"
@@ -9,6 +9,7 @@
#include "TransferManager.h"
#include "RecipeManager.h"
#include "GlassLogDb.h"
#include <map>


CModel::CModel()
@@ -21,11 +22,20 @@
{
}

void CModel::refreshDerivedSVs()
{
   // CJobSpace: how many ControlJobs can be created (current implementation supports 0/1).
   m_hsmsPassive.setVariableValue("CJobSpace", (__int64)(m_master.canCreateControlJob() ? 1 : 0));

   // PJobSpace: how many ProcessJobs can be created (current implementation supports 0/1).
   m_hsmsPassive.setVariableValue("PJobSpace", (__int64)(m_master.isProcessJobsEmpty() ? 1 : 0));
}

IObservable* CModel::getObservable()
{
   if (m_pObservable == nullptr) {
      m_pObservable = RX_AllocaObservable([&](IObservableEmitter* e) -> void {
         m_pObservableEmitter = e;         // 保存发射器
         m_pObservableEmitter = e;         // 保存发射器
      });
   }

@@ -49,9 +59,18 @@
   for (int i = 0; i < 4; i++) {
      m_configuration.getPortParms(i, portEnable, portType, portMode,
         cassetteType, transferMode, autoChangeEnable);
      m_master.setPortType(i, portEnable, portType, portMode, cassetteType,
      m_master.setPortTypeEx(i, portEnable, portType, portMode, cassetteType,
         transferMode, autoChangeEnable);

      int seed = m_configuration.getPortCassetteSnSeed(i + 1);
      m_master.setPortCassetteSnSeed(i + 1, seed);
   }
}

void CModel::setPortType(unsigned int index, SERVO::PortType type)
{
   m_master.setPortType(index, (int)type);
   m_configuration.setPortType(index, (int)type);
}

void CModel::setPortCassetteType(unsigned int index, SERVO::CassetteType type)
@@ -74,7 +93,7 @@
   m_configuration.setFilepath((LPTSTR)(LPCTSTR)strIniFile);
   m_configuration.getUnitId(strUnitId);

   // 机器型号和软件版本号应从配置中读取，当前先固定值
   // 机器型号和软件版本号应从配置中读取，当前先固定值
   CString strModeType = _T("Master");
   CString strSoftRev = _T("1.0.2");

@@ -99,10 +118,10 @@

   SECSListener listener;
   listener.onEQOffLine = [&](void* pFrom) -> void {
      LOGI("远程请求OffLine");
      LOGI("远程请求OffLine");
   };
   listener.onEQOnLine = [&](void* pFrom) -> void {
      LOGI("远程请求OnLine");
      LOGI("远程请求OnLine");
   };
   listener.onCommand = [&](void* pFrom, const char* pszName, std::vector<CommandParameter>& params) -> void {
      LOGI("onCommand:%s", pszName);
@@ -111,13 +130,13 @@
      }
   };
   listener.onEQConstantRequest = [&](void* pFrom, std::vector<EQConstant>& eqcs) -> void {
      // 在此填充常量值，目前仅是加1后返回
      // 在此填充常量值，目前仅是加1后返回
      for (auto& item : eqcs) {
         sprintf_s(item.szValue, 256, "Test%d", item.id + 1);
         sprintf_s(item.szValue, EQCONSTANT_VALUE_MAX, "Test%d", item.id + 1);
      }
   };
   listener.onEQConstantSend = [&](void* pFrom, std::vector<EQConstant>& eqcs) -> void {
      // 在此保存和设置机器常量值
      // 在此保存和设置机器常量值
      for (auto& item : eqcs) {
         LOGI("onEQConstantRequest: %d, %s", item.id, item.szValue);
      }
@@ -163,18 +182,48 @@
            return CAACK_3;
         }

         const unsigned int portIndex = PTN - 1;
         SERVO::CLoadPort* pLoadPort = (SERVO::CLoadPort*)m_master.getEquipment(EQ_ID_LOADPORT1 + portIndex);
         LOGI("<Model>onCarrierAction %d, %s, %d, %d", DATAID, pszCarrierAction, pszCarrierId, PTN);

         if (_strcmpi(pszCarrierAction, "ProceedWithCarrier") == 0) {
            m_master.proceedWithCarrier(PTN);
            // 文档流程：ProceedWithCarrier 之后设备进入 Check SlotMap（WFH），
            // 真正的“开始”由 ProceedWithSlotMap 决策触发。
            // 仅当未开启 CompareMapsBeforeProceeding 时，才沿用旧逻辑直接 Start。
            LOGI("<CModel>ProceedWithCarrier");
            if (pLoadPort == nullptr || !pLoadPort->isCompareMapsBeforeProceeding()) {
               m_master.proceedWithCarrier(portIndex);
            }
            return CAACK_0;
         }
         else if (_strcmpi(pszCarrierAction, "ProceedWithSlotMap") == 0) {
            // TODO(Host协商):
            // 文档中 ProceedWithSlotMap 可能会携带 LotID / PanelIDList / SlotMap 等数据（最多13片）用于格式校验与绑定。
            // 当前 S3F17 解析结构仅支持 {DATAID, CarrierAction, CarrierID, PTN}，尚未实现上述扩展字段的解析/校验。
            // 未来若客户确认 SECS-II 结构，需要在 CHsmsPassive::replyCarrierAction() 扩展解析并在此处落库/校验。
            // 仅在 CompareMapsBeforeProceeding 启用（Host 模式）下允许此动作
            LOGI("<CModel>ProceedWithSlotMap");
            if (pLoadPort == nullptr || !pLoadPort->isCompareMapsBeforeProceeding()) {
               strErrorTxt = "rejected - SlotMap check disabled";
               return CAACK_5;
            }

            m_hsmsPassive.setVariableValue("SlotMapScan", pLoadPort->getScanCassetteMap());
            m_hsmsPassive.setVariableValue("SlotMapDownload", pLoadPort->getDownloadCassetteMap());
            m_hsmsPassive.requestEventReportSend_SlotMapVerificationOK();

            // Host 确认 SlotMap 后再开始加工/流程
            m_master.proceedWithCarrier(portIndex);
            return CAACK_0;
         }
         else if (_strcmpi(pszCarrierAction, "CarrierRelease") == 0) {
            m_master.carrierRelease(PTN);
            LOGI("<CModel>CarrierRelease");
            m_master.carrierRelease(portIndex);
            return CAACK_0;
         }

         strErrorTxt = "rejected - invalid state";
         return CAACK_5;
         LOGI("<Model>onCarrierAction %d, %s, %d, %d", DATAID, pszCarrierAction, pszCarrierId, PTN);
   };
   listener.onPRJobMultiCreate = [&](void* pFrom, std::vector<SERVO::CProcessJob*>& pjs) -> int {
      for (auto p : pjs) {
@@ -204,6 +253,7 @@
   CString strVarialbleFile;
   strVarialbleFile.Format(_T("%s\\VariableList.txt"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   m_hsmsPassive.loadVarialbles((LPTSTR)(LPCTSTR)strVarialbleFile);
   refreshDerivedSVs();
   m_hsmsPassive.init(this, "APP", 7000);
   strVarialbleFile.Format(_T("%s\\ReportList.txt"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   m_hsmsPassive.loadReports((LPTSTR)(LPCTSTR)strVarialbleFile);
@@ -218,6 +268,10 @@
      LOGI("<CModel>Master state changed(%d)", (int)state);
      notify(RX_CODE_MASTER_STATE_CHANGED);
   };
   masterListener.onControlJobChanged = [this](void* pMaster) {
      (void)pMaster;
      this->refreshDerivedSVs();
      };
   masterListener.onEqAlive = [&](void* pMaster, SERVO::CEquipment* pEquipment, BOOL bAlive) -> void {
      LOGI("<CModel>Equipment onAlive:%s(%s).", pEquipment->getName().c_str(),
         bAlive ? _T("ON") : _T("OFF"));
@@ -247,9 +301,18 @@
         alarmData.strUnitName = alarmManager.getUnitNameById(alarmData.nDeviceId, alarmData.nUnitId);
         alarmData.strStartTime = CToolUnits::timeToString2(CToolUnits::getTimestamp());
         alarmData.strEndTime = "";

         alarmData.strDescription = "";
			
         const AlarmInfo* alarmInfo = alarmManager.getAlarmInfoByID(alarmData.nId);
         alarmData.strDescription = alarmInfo != nullptr ? alarmInfo->strAlarmText : "";
         if (alarmInfo != nullptr) {
            if (alarmInfo->strDescription.empty()) {
               alarmData.strDescription = alarmInfo->strAlarmText;
            }
            else {
               alarmData.strDescription = alarmInfo->strAlarmText + "," + alarmInfo->strDescription + ".";
            }
         }


         int nAlarmEventId = 0;
         bool result = alarmManager.addAlarm(alarmData, nAlarmEventId);
@@ -278,6 +341,13 @@
   };
   masterListener.onEqVcrEventReport = [&](void* pMaster, SERVO::CEquipment* pEquipment, SERVO::CVcrEventReport* pReport) {
      LOGE("<CModel>onEqVcrEventReport.");
      if (pReport != nullptr) {
         m_hsmsPassive.setVariableValue("VCRPanelID", pReport->getGlassId().c_str());
         int nRet = m_hsmsPassive.requestEventReportSend_OCR_PanelID_Read_OK();
         if (nRet != ER_NOERROR) {
            LOGE("<CModel>requestEventReportSend_OCR_PanelID_Read_OK failed, ret=%d", nRet);
         }
      }
   };
   masterListener.onEqDataChanged = [&](void* pMaster, SERVO::CEquipment* pEquipment, int code) {
      LOGE("<CModel>onEqDataChanged.");
@@ -285,11 +355,11 @@
   };
   masterListener.onRobotTaskEvent = [&](void* pMaster, SERVO::CRobotTask* pTask, int code) {
      if (pTask == nullptr) {
         LOGE("<CModel>onRobotTaskEvent: 空任务指针，忽略事件 code=%d", code);
         LOGE("<CModel>onRobotTaskEvent: 空任务指针，忽略事件 code=%d", code);
         return;
      }

      // 任务描述与 ID 用于日志
      // 任务描述与 ID 用于日志
      SERVO::CGlass* pGlass = (SERVO::CGlass*)pTask->getContext();
      const std::string& strDesc = pTask->getDescription();
      std::string strClassID;
@@ -301,48 +371,48 @@
         }
      }

      // 日志输出与状态处理
      // 日志输出与状态处理
      switch (code) {
      case ROBOT_EVENT_CREATE:
         LOGI("<CModel>onRobotTaskEvent: 新任务创建(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         LOGI("<CModel>onRobotTaskEvent: 新任务创建(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         break;
      case ROBOT_EVENT_FINISH:
         LOGI("<CModel>onRobotTaskEvent: 任务完成(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         LOGI("<CModel>onRobotTaskEvent: 任务完成(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         break;
      case ROBOT_EVENT_ERROR:
         LOGE("<CModel>onRobotTaskEvent: 任务错误(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         LOGE("<CModel>onRobotTaskEvent: 任务错误(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         break;
      case ROBOT_EVENT_ABORT:
         LOGE("<CModel>onRobotTaskEvent: 任务停止(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         LOGE("<CModel>onRobotTaskEvent: 任务停止(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         break;
      case ROBOT_EVENT_RESTORE:
         LOGE("<CModel>onRobotTaskEvent: 任务回撤(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         LOGE("<CModel>onRobotTaskEvent: 任务回撤(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         break;
      default:
         LOGE("<CModel>onRobotTaskEvent: 未知事件 code=%d, 任务=%s", code, strDesc.c_str());
         LOGE("<CModel>onRobotTaskEvent: 未知事件 code=%d, 任务=%s", code, strDesc.c_str());
         break;
      }

      // 安全格式化时间
      // 安全格式化时间
      auto format_time = [](time_t t) -> std::string {
         if (t <= 0 || t == _I64_MIN || t == _I64_MAX) { 
            return "";
         }

         // 使用 localtime_s 确保线程安全
         // 使用 localtime_s 确保线程安全
         tm tmBuf{};
         errno_t err = localtime_s(&tmBuf, &t);
         if (err != 0 || tmBuf.tm_mon < 0 || tmBuf.tm_mon > 11) {
            return "";
         }

         // 格式化时间字符串
         // 格式化时间字符串
         char buf[64] = {};
         strftime(buf, sizeof(buf), "%Y-%m-%d %H:%M:%S", &tmBuf);
         return std::string(buf);
      };

      // 构造 TransferData 数据结构
      // 构造 TransferData 数据结构
      TransferData data;
      data.strClassID = strClassID;
      data.strCreateTime = format_time(pTask->getCreateTime());
@@ -351,7 +421,7 @@
      data.strEndTime = format_time(pTask->getFinishTime());
      data.strDescription = pTask->getSimpleDescription();

      // 状态映射
      // 状态映射
      static const char* STATUS_STR[] = {
         "Ready", "Running", "Picking", "Picked", "Placing", "Restoring", "Error", "Abort", "Restored", "Completed"
      };
@@ -364,22 +434,32 @@
         data.strStatus = "Unknown";
      }

      // 写入数据库
      // 写入数据库
      if (code == ROBOT_EVENT_FINISH || code == ROBOT_EVENT_ERROR
         || code == ROBOT_EVENT_ABORT || code == ROBOT_EVENT_RESTORE) {
         int nRecordId = 0;
         TransferManager::getInstance().addTransferRecord(data, nRecordId);
         LOGI("<CModel>onRobotTaskEvent: 任务记录已保存，RecordID=%d", nRecordId);
         LOGI("<CModel>onRobotTaskEvent: 任务记录已保存，RecordID=%d", nRecordId);
      }
      notifyPtrAndInt(RX_CODE_EQ_ROBOT_TASK, pTask, nullptr, code);

   };
   masterListener.onLoadPortStatusChanged = [&] (void* pMaster, SERVO::CEquipment* pEquipment, short status, __int64 data) {
      LOGE("<CModel>onLoadPortStatusChanged. status = %d", status);
      static std::map<int, short> s_prevPortStatus;
      const int eqId = (pEquipment != nullptr) ? pEquipment->getID() : 0;
      const short prevStatus = s_prevPortStatus[eqId];
      s_prevPortStatus[eqId] = status;
      if (status == PORT_INUSE) {
         SERVO::CLoadPort* pLoadPort = dynamic_cast<SERVO::CLoadPort*>(pEquipment);
         if (pLoadPort != nullptr) {
            m_hsmsPassive.setVariableValue("CarrierID", pLoadPort->getCassetteId().c_str());
            if (prevStatus != PORT_INUSE && pLoadPort->isCompareMapsBeforeProceeding()) {
               // TODO(Host协商):
               // 文档中标明：1-Empty，3-Exist，因此我们可能需要将uint的map转换为list上传 
               m_hsmsPassive.setVariableValue("SlotMap", pLoadPort->getScanCassetteMap());
               m_hsmsPassive.requestEventReportSend_CheckSlotMap();
            }
         }
         m_hsmsPassive.requestEventReportSend_CarrierID_Readed();
      }
@@ -401,10 +481,35 @@
         SERVO::CLoadPort* pLoadPort = dynamic_cast<SERVO::CLoadPort*>(pEquipment);
         if (pLoadPort != nullptr) {
            m_hsmsPassive.setVariableValue("UnloadReadyPortId", pLoadPort->getID());
            if (prevStatus == PORT_INUSE) {
               m_hsmsPassive.setVariableValue("ReadyToReleasePortId", pLoadPort->getID());
               m_hsmsPassive.requestEventReportSend_Port_Ready_To_Release();
            }
         }
         m_hsmsPassive.requestEventReportSend_Port_Unload_Ready();
      }
      else if (status == PORT_EMPTY) {
         SERVO::CLoadPort* pLoadPort = dynamic_cast<SERVO::CLoadPort*>(pEquipment);
         if (pLoadPort != nullptr) {
            m_hsmsPassive.setVariableValue("LoadPortNotAssocPortId", pLoadPort->getID());
         }
         m_hsmsPassive.requestEventReportSend_LoadPortNotAssoc();
      }
      notifyPtr(RX_CODE_LOADPORT_STATUS_CHANGED, pEquipment);
   };
   masterListener.onProcessStateChanged = [&](void* pMaster, SERVO::CEquipment* pEquipment, int slotNo, SERVO::PROCESS_STATE state) {
      // SubEqpStart/SubEqpEnd: align to log's EV_SubEqpStart/EV_SubEqpEnd stage (no report payload required).
      (void)pMaster;
      if (pEquipment != nullptr) {
         m_hsmsPassive.setVariableValue("SubEqpName", pEquipment->getName().c_str());
      }
      m_hsmsPassive.setVariableValue("SubEqpSlot", slotNo);
      if (state == SERVO::PROCESS_STATE::Processing) {
         m_hsmsPassive.requestEventReportSend_SubEqpStart();
      }
      else if (state == SERVO::PROCESS_STATE::Complete) {
         m_hsmsPassive.requestEventReportSend_SubEqpEnd();
      }
   };
   masterListener.onCTRoundEnd = [&](void* pMaster, int round) {
      m_configuration.setContinuousTransferCount(round);
@@ -417,7 +522,7 @@
      m_hsmsPassive.setVariableValue("CJEndID", ((SERVO::CControlJob*)pj)->id().c_str());
      m_hsmsPassive.requestEventReportSend_CJ_End();

      // 结批，保存ControlJob
      // 结批，保存ControlJob
      // 
   };
   masterListener.onPjStart = [&](void* pMaster, void* pj) {
@@ -428,41 +533,49 @@
      m_hsmsPassive.setVariableValue("PJEndID", ((SERVO::CProcessJob*)pj)->id().c_str());
      m_hsmsPassive.requestEventReportSend_PJ_End();
   };
   masterListener.onPanelStart = [&](void* pMaster, void* pj) {
      m_hsmsPassive.setVariableValue("PanelStartID", ((SERVO::CGlass*)pj)->getID().c_str());
   masterListener.onPanelStart = [&](void* pMaster, void* pPanel) {
      m_hsmsPassive.setVariableValue("PanelStartID", ((SERVO::CGlass*)pPanel)->getID().c_str());
      m_hsmsPassive.requestEventReportSend_Panel_Start();
   };
   masterListener.onPanelEnd = [&](void* pMaster, void* pj) {
      m_hsmsPassive.setVariableValue("PanelEndID", ((SERVO::CGlass*)pj)->getID().c_str());
   masterListener.onPanelEnd = [&](void* pMaster, void* pPanel) {
      m_hsmsPassive.setVariableValue("PanelEndID", ((SERVO::CGlass*)pPanel)->getID().c_str());
      m_hsmsPassive.requestEventReportSend_Panel_End();
      // Placeholder payload to match log shape: EV_PROCESS_DATA_REPORT can carry a single A-string (may be empty).
      m_hsmsPassive.setVariableValue("ProcessDataReportText", "");
      m_hsmsPassive.requestEventReportSend_ProcessDataReport();
      auto& db = GlassLogDb::Instance();
      db.insertFromCGlass((*(SERVO::CGlass*)pPanel));
      SERVO::CGlass* pBuddy = ((SERVO::CGlass*)pPanel)->getBuddy();
      if (pBuddy != nullptr) {
         db.insertFromCGlass(*pBuddy);
      }
   };
   m_master.setListener(masterListener);
   m_master.setContinuousTransferCount(m_configuration.getContinuousTransferCount());


   // master 设置缓存文件
   // master 设置缓存文件
   CString strMasterDataFile;
   strMasterDataFile.Format(_T("%s\\Master.dat"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   m_master.setCacheFilepath((LPTSTR)(LPCTSTR)strMasterDataFile);
   m_master.setCompareMapsBeforeProceeding(m_configuration.isCompareMapsBeforeProceeding());
   m_master.setJobMode(m_configuration.isJobMode());

   // 加截Job
   // 加截Job
   strMasterDataFile.Format(_T("%s\\MasterState.dat"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   std::string strPath = std::string((LPTSTR)(LPCTSTR)strMasterDataFile);
   if (!m_master.loadState(strPath)) {
      LOGE("<Master>加载MasterState.dat文件失败.");
   }
   m_master.setStateFile(strPath);


   // 加载警告信息

   // 加载警告信息
   AlarmManager& alarmManager = AlarmManager::getInstance();
   char szBuffer[MAX_PATH];
   sprintf_s(szBuffer, MAX_PATH, "%s\\AlarmList.csv", (LPTSTR)(LPCTSTR)m_strWorkDir);
   alarmManager.readAlarmFile(szBuffer);


   // Glass数据库
   // Glass数据库
   strLogDir.Format(_T("%s\\db\\process.db"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   std::string path((LPTSTR)(LPCTSTR)strLogDir);
   GlassLogDb::Init(path);
@@ -473,6 +586,10 @@

int CModel::term()
{
   m_configuration.setPortCassetteSnSeed(1, m_master.getPortCassetteSnSeed(1));
   m_configuration.setPortCassetteSnSeed(2, m_master.getPortCassetteSnSeed(2));
   m_configuration.setPortCassetteSnSeed(3, m_master.getPortCassetteSnSeed(3));
   m_configuration.setPortCassetteSnSeed(4, m_master.getPortCassetteSnSeed(4));
   m_hsmsPassive.saveCache();
   m_hsmsPassive.term();
   CLog::GetLog()->SetOnLogCallback(nullptr);