LAPTOP-SNT8I5JK\Boounion
2025-09-09 c119b8ef36718a8ca24b719cdbff86913cbca129
SourceCode/Bond/Servo/Model.cpp
@@ -5,6 +5,10 @@
#include "ToolUnits.h"
#include "CEqAlarmStep.h"
#include "AlarmManager.h"
#include "CGlassPool.h"
#include "TransferManager.h"
#include "RecipeManager.h"
#include "GlassLogDb.h"
CModel::CModel()
@@ -19,12 +23,47 @@
IObservable* CModel::getObservable()
{
   if (m_pObservable == nullptr) {
      m_pObservable = RX_AllocaObservable([&](IObservableEmitter* e) -> void {
         m_pObservableEmitter = e;         // 保存发射器
      });
   }
   return m_pObservable;
}
SERVO::CMaster& CModel::getMaster()
{
   return m_master;
}
void CModel::setWorkDir(const char* pszWorkDir)
{
   m_strWorkDir = pszWorkDir;
}
void CModel::loadPortParams()
{
   BOOL portEnable, autoChangeEnable;
   int portType, portMode, cassetteType, transferMode;
   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,
         transferMode, autoChangeEnable);
   }
}
void CModel::setPortCassetteType(unsigned int index, SERVO::CassetteType type)
{
   m_master.setPortCassetteType(index, type);
   m_configuration.setPortCassetteType(index, (int)type);
}
void CModel::setPortEnable(unsigned int index, BOOL bEnable)
{
   m_master.setPortEnable(index, bEnable);
   m_configuration.setPortEnable(index, bEnable);
}
int CModel::init()
@@ -36,9 +75,12 @@
   m_configuration.getUnitId(strUnitId);
   // 机器型号和软件版本号应从配置中读取,当前先固定值
   CString strModeType = _T("Bond2860");
   CString strModeType = _T("Master");
   CString strSoftRev = _T("1.0.2");
   // CGlassPool
   m_glassPool.initPool();
   // Log
@@ -47,17 +89,12 @@
   ::CreateDirectory(strLogDir, NULL);
   CLog::GetLog()->SetOnLogCallback([&](int level, const char* pszMessage) -> void {
      notifyTextAndInt(RX_CODE_LOG, pszMessage, level);
   });
      });
   CLog::GetLog()->SetAutoAppendTimeString(TRUE);
   CLog::GetLog()->SetOutputTarget(OT_FILE);
   CLog::GetLog()->SetLogsDir(strLogDir);
   CLog::GetLog()->SetEquipmentId((LPTSTR)(LPCTSTR)strUnitId);
   LOGI("\r\n\r\n~~~ Prog Start! ~~~");
   m_pObservable = RX_AllocaObservable([&](IObservableEmitter* e) -> void {
      m_pObservableEmitter = e;         // 保存发射器
   });
   SECSListener listener;
@@ -76,7 +113,7 @@
   listener.onEQConstantRequest = [&](void* pFrom, std::vector<EQConstant>& eqcs) -> void {
      // 在此填充常量值,目前仅是加1后返回
      for (auto& item : eqcs) {
         sprintf_s(item.szValue, 256, "Test%d", item.id+1);
         sprintf_s(item.szValue, 256, "Test%d", item.id + 1);
      }
   };
   listener.onEQConstantSend = [&](void* pFrom, std::vector<EQConstant>& eqcs) -> void {
@@ -85,82 +122,337 @@
         LOGI("onEQConstantRequest: %d, %s", item.id, item.szValue);
      }
   };
   listener.onDatetimeSync = [&](void* pFrom, SYSTEMTIME& time) -> void {
      LOGI("onDatetimeSync: %d%02d%02d%02d%02d%02d", time.wYear,
         time.wMonth, time.wDay, time.wHour, time.wMinute, time.wSecond);
      m_master.datetimeSync(time);
   };
   listener.onEnableDisableEventReport = [&](void* pFrom, bool bEnable, std::vector<unsigned int> ids) -> void {
      LOGI("EanbleDisableEventReport bEnable:%s", bEnable ? _T("YES") : _T("NO"));
      if (ids.empty()) {
         m_master.enableEventReport(bEnable);
      }
   };
   listener.onEnableDisableAlarmReport = [&](void* pFrom, bool bEnable, unsigned int id) -> void {
      LOGI("onEnableDisableAlarmReport bEnable:%s, id:%d", bEnable ? _T("YES") : _T("NO"), id);
      if (id == 0) {
         m_master.enableAlarmReport(bEnable);
      }
   };
   listener.onQueryPPIDList = [&](void* pFrom) ->std::vector<std::string> {
      std::vector<std::string> ppids;
      auto temp = RecipeManager::getInstance().getAllPPID();
      for (auto item : temp) {
         if (item.length() > PPID_NAME_MAX) {
            ppids.push_back(item.substr(0, PPID_NAME_MAX));
         }
         else {
            ppids.push_back(item);
         }
      }
      return ppids;
   };
   listener.onCarrierAction = [&](void* pFrom,
      unsigned int DATAID,
      const char* pszCarrierAction,
      const char* pszCarrierId,
      unsigned char PTN,
      std::string& strErrorTxt) -> unsigned int {
         if (PTN < 1 || 4 < PTN) {
            strErrorTxt = "invalid data or argument";
            return CAACK_3;
         }
         if (_strcmpi(pszCarrierAction, "ProceedWithCarrier") == 0) {
            m_master.proceedWithCarrier(PTN);
            return CAACK_0;
         }
         else if (_strcmpi(pszCarrierAction, "CarrierRelease") == 0) {
            m_master.carrierRelease(PTN);
            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) {
         LOGI("<Model>onPRJobMultiCreate %s %s", p->id().c_str(), p->recipeSpec().c_str());
      }
      int nRet = m_master.setProcessJobs(pjs);
      auto processJobs = m_master.getProcessJobs();
      std::vector<SERVO::CVariable> vars;
      for (auto pj : processJobs) {
         SERVO::CVariable var("", "PRJOBID", "A50", "PRJOBID");
         var.setValue(pj->id().c_str());
         vars.push_back(var);
      }
      m_hsmsPassive.setVariableValue("PJQueued", vars);
      m_hsmsPassive.requestEventReportSend_PJ_Queued();
      return nRet;
   };
   listener.onControlJobCreate = [&](void* pFrom, SERVO::CControlJob& controlJob) -> int {
      LOGI("<Model>onControlJobCreate %s %d", controlJob.id().c_str(), controlJob.priority());
      int nRet = m_master.setControlJob(controlJob);
      return nRet;
   };
   m_hsmsPassive.setListener(listener);
   m_hsmsPassive.setEquipmentModelType((LPTSTR)(LPCTSTR)strModeType);
   m_hsmsPassive.setSoftRev((LPTSTR)(LPCTSTR)strSoftRev);
   CString strVarialbleFile;
   strVarialbleFile.Format(_T("%s\\VariableList.txt"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   m_hsmsPassive.loadVarialbles((LPTSTR)(LPCTSTR)strVarialbleFile);
   m_hsmsPassive.init(this, "APP", 7000);
   strVarialbleFile.Format(_T("%s\\ReportList.txt"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   m_hsmsPassive.loadReports((LPTSTR)(LPCTSTR)strVarialbleFile);
   strVarialbleFile.Format(_T("%s\\CollectionEventList.txt"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   m_hsmsPassive.loadCollectionEvents((LPTSTR)(LPCTSTR)strVarialbleFile);
   strVarialbleFile.Format(_T("%s\\HsmsPassive.cache"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   m_hsmsPassive.loadCacheFromFile(strVarialbleFile);
   SERVO::MasterListener masterListener;
   masterListener.onMasterStateChanged = [&](void* pMaster, SERVO::MASTERSTATE state) -> void {
      LOGI("<CModel>Master state changed(%d)", (int)state);
      notify(RX_CODE_MASTER_STATE_CHANGED);
   };
   masterListener.onEqAlive = [&](void* pMaster, SERVO::CEquipment* pEquipment, BOOL bAlive) -> void {
      LOGI("<CModel>Equipment onAlive:%s(%s).\n", pEquipment->getName().c_str(),
      LOGI("<CModel>Equipment onAlive:%s(%s).", pEquipment->getName().c_str(),
         bAlive ? _T("ON") : _T("OFF"));
      notifyPtr(RX_CODE_EQ_ALIVE, pEquipment);
   };
   masterListener.onEqCimStateChanged = [&](void* pMaster, SERVO::CEquipment* pEquipment, BOOL bOn) -> void {
      LOGI("<CModel>Equipment Cim State:%s(%s).\n", pEquipment->getName().c_str(),
      LOGI("<CModel>Equipment Cim State:%s(%s).", pEquipment->getName().c_str(),
         bOn ? _T("ON") : _T("OFF"));
      notifyPtr(RX_CODE_EQ_ALIVE, pEquipment);
   };
   masterListener.onEqStepEvent = [&](SERVO::CStep* pStep, int code, void* pData) -> void {
      if (code == STEP_EVENT_READDATA) {
         LOGI("<CModel>onEqStepEvent,数据变化:%s(%s, 0x%x).\n", pStep->getEquipment()->getName().c_str(),
            pStep->getName().c_str(), pData);
         notifyPtr(RX_CODE_STEP_EVENT_READDATA, pStep);
         // 处理警告信息
         if (isAlarmStep(pStep)) {
            // 保存到数据库
            AlarmManager& alarmManager = AlarmManager::getInstance();
            std::string strAlarmText;
            SERVO::CEquipment* pEquipment = pStep->getEquipment();
            SERVO::CEqAlarmStep* pEqAlarmStep = (SERVO::CEqAlarmStep*)pStep;
            const AlarmInfo* pAlarmInfo = alarmManager.getAlarmInfoByID(pEqAlarmStep->getAlarmId());
            if (pAlarmInfo != nullptr) {
               strAlarmText = pAlarmInfo->strAlarmText;
            }
            int state = pEqAlarmStep->getAlarmState();
            if (state == 1) {
               AlarmData alarmData;
               alarmData.nId = pEqAlarmStep->getAlarmId();
               alarmData.nSeverityLevel = pEqAlarmStep->getAlarmLevel();
               alarmData.nDeviceId = pEqAlarmStep->getEquipment()->getID();
               alarmData.nUnitId = pEqAlarmStep->getUnitId();
               alarmData.strDeviceName = alarmManager.getDeviceNameById(alarmData.nDeviceId);
               alarmData.strUnitName = alarmManager.getUnitNameById(alarmData.nDeviceId, alarmData.nUnitId);
               alarmData.strStartTime = CToolUnits::timeToString2(CToolUnits::getTimestamp());
               alarmData.strEndTime = "";
   masterListener.onEqAlarm = [&](void* pMaster, SERVO::CEquipment* pEquipment, int state, int alarmId, int unitId, int level) -> void {
      AlarmManager& alarmManager = AlarmManager::getInstance();
      std::string strAlarmText;
      const AlarmInfo* pAlarmInfo = alarmManager.getAlarmInfoByID(alarmId);
      if (pAlarmInfo != nullptr) {
         strAlarmText = pAlarmInfo->strAlarmText;
      }
      if (state == 1) {
         AlarmData alarmData;
         alarmData.nId = alarmId;
         alarmData.nSeverityLevel = level;
         alarmData.nDeviceId = pEquipment->getID();
         alarmData.nUnitId = unitId;
         alarmData.strDeviceName = alarmManager.getDeviceNameById(alarmData.nDeviceId);
         alarmData.strUnitName = alarmManager.getUnitNameById(alarmData.nDeviceId, alarmData.nUnitId);
         alarmData.strStartTime = CToolUnits::timeToString2(CToolUnits::getTimestamp());
         alarmData.strEndTime = "";
               const AlarmInfo* alarmInfo = alarmManager.getAlarmInfoByID(alarmData.nId);
               alarmData.strDescription = alarmInfo != nullptr ? alarmInfo->strAlarmText : "";
               int nAlarmEventId = 0;
               bool result = alarmManager.addAlarm(alarmData, nAlarmEventId);
               if (result) {
                  LOGI("<CModel> Alarm added successfully!");
               }
               else {
                  LOGE("<CModel> Failed to add alarm.");
               }
            }
            else {
               alarmManager.clearAlarmByAttributes(pEqAlarmStep->getAlarmId(),
                  pEqAlarmStep->getEquipment()->getID(),
                  pEqAlarmStep->getUnitId(),
                  CToolUnits::getCurrentTimeString());
            }
         const AlarmInfo* alarmInfo = alarmManager.getAlarmInfoByID(alarmData.nId);
         alarmData.strDescription = alarmInfo != nullptr ? alarmInfo->strAlarmText : "";
            m_hsmsPassive.requestAlarmReport(pEqAlarmStep->getAlarmState(),
               pEquipment->getBaseAlarmId() + pEqAlarmStep->getAlarmId(),
               strAlarmText.c_str());
         int nAlarmEventId = 0;
         bool result = alarmManager.addAlarm(alarmData, nAlarmEventId);
         if (result) {
            LOGI("<CModel> Alarm added successfully!");
         }
         else {
            LOGE("<CModel> Failed to add alarm.");
         }
         notify(RX_CODE_ALARM_SET);
      }
      else {
         alarmManager.clearAlarmByAttributes(alarmId,
            pEquipment->getID(),
            unitId,
            CToolUnits::getCurrentTimeString());
         notify(RX_CODE_ALARM_CLEAR);
      }
      if (m_master.isAlarmReportEnable()) {
         m_hsmsPassive.requestAlarmReport(state,
            pEquipment->getBaseAlarmId() + alarmId,
            strAlarmText.c_str());
      }
   };
   masterListener.onEqVcrEventReport = [&](void* pMaster, SERVO::CEquipment* pEquipment, SERVO::CVcrEventReport* pReport) {
      LOGE("<CModel>onEqVcrEventReport.");
   };
   masterListener.onEqDataChanged = [&](void* pMaster, SERVO::CEquipment* pEquipment, int code) {
      LOGE("<CModel>onEqDataChanged.");
      notifyPtr(RX_CODE_EQ_DATA_CHANGED, pEquipment);
   };
   masterListener.onRobotTaskEvent = [&](void* pMaster, SERVO::CRobotTask* pTask, int code) {
      if (pTask == nullptr) {
         LOGE("<CModel>onRobotTaskEvent: 空任务指针,忽略事件 code=%d", code);
         return;
      }
      // 任务描述与 ID 用于日志
      SERVO::CGlass* pGlass = (SERVO::CGlass*)pTask->getContext();
      const std::string& strDesc = pTask->getDescription();
      std::string strClassID;
      if (pGlass != nullptr) {
         strClassID = pGlass->getID();
         if (pGlass->getBuddy() != nullptr) {
            strClassID += "/";
            strClassID += pGlass->getBuddy()->getID();
         }
      }
      // 日志输出与状态处理
      switch (code) {
      case ROBOT_EVENT_CREATE:
         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());
         break;
      case ROBOT_EVENT_ERROR:
         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());
         break;
      case ROBOT_EVENT_RESTORE:
         LOGE("<CModel>onRobotTaskEvent: 任务回撤(%s, ClassID=%s).", strDesc.c_str(), strClassID.c_str());
         break;
      default:
         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 确保线程安全
         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 data;
      data.strClassID = strClassID;
      data.strCreateTime = format_time(pTask->getCreateTime());
      data.strPickTime = format_time(pTask->getFetchoutTime());
      data.strPlaceTime = format_time(pTask->getStoredTime());
      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"
      };
      auto state = pTask->getState();
      int index = static_cast<int>(state);
      if (index >= 0 && index < static_cast<int>(std::size(STATUS_STR))) {
         data.strStatus = STATUS_STR[index];
      }
      else {
         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);
      }
      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);
      if (status == PORT_INUSE) {
         SERVO::CLoadPort* pLoadPort = dynamic_cast<SERVO::CLoadPort*>(pEquipment);
         if (pLoadPort != nullptr) {
            m_hsmsPassive.setVariableValue("CarrierID", pLoadPort->getCassetteId().c_str());
         }
         m_hsmsPassive.requestEventReportSend_CarrierID_Readed();
      }
      else if (status == PORT_BLOCKED) {
         SERVO::CLoadPort* pLoadPort = dynamic_cast<SERVO::CLoadPort*>(pEquipment);
         if (pLoadPort != nullptr) {
            m_hsmsPassive.setVariableValue("BlockedPortId", pLoadPort->getID());
         }
         m_hsmsPassive.requestEventReportSend_Port_Blocked();
      }
      else if (status == PORT_LOAD_READY) {
         SERVO::CLoadPort* pLoadPort = dynamic_cast<SERVO::CLoadPort*>(pEquipment);
         if (pLoadPort != nullptr) {
            m_hsmsPassive.setVariableValue("LoadReadyPortId", pLoadPort->getID());
         }
         m_hsmsPassive.requestEventReportSend_Port_Load_Ready();
      }
      else if (status == PORT_UNLOAD_READY) {
         SERVO::CLoadPort* pLoadPort = dynamic_cast<SERVO::CLoadPort*>(pEquipment);
         if (pLoadPort != nullptr) {
            m_hsmsPassive.setVariableValue("UnloadReadyPortId", pLoadPort->getID());
         }
         m_hsmsPassive.requestEventReportSend_Port_Unload_Ready();
      }
      notifyPtr(RX_CODE_LOADPORT_STATUS_CHANGED, pEquipment);
   };
   masterListener.onCTRoundEnd = [&](void* pMaster, int round) {
      m_configuration.setContinuousTransferCount(round);
   };
   masterListener.onCjStart = [&](void* pMaster, void* pj) {
      m_hsmsPassive.setVariableValue("CJStartID", ((SERVO::CControlJob*)pj)->id().c_str());
      m_hsmsPassive.requestEventReportSend_CJ_Start();
   };
   masterListener.onCjEnd = [&](void* pMaster, void* pj) {
      m_hsmsPassive.setVariableValue("CJEndID", ((SERVO::CControlJob*)pj)->id().c_str());
      m_hsmsPassive.requestEventReportSend_CJ_End();
      // 结批,保存ControlJob
      //
   };
   masterListener.onPjStart = [&](void* pMaster, void* pj) {
      m_hsmsPassive.setVariableValue("PJStartID", ((SERVO::CProcessJob*)pj)->id().c_str());
      m_hsmsPassive.requestEventReportSend_PJ_Start();
   };
   masterListener.onPjEnd = [&](void* pMaster, void* pj) {
      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());
      m_hsmsPassive.requestEventReportSend_Panel_Start();
   };
   masterListener.onPanelEnd = [&](void* pMaster, void* pj) {
      m_hsmsPassive.setVariableValue("PanelEndID", ((SERVO::CGlass*)pj)->getID().c_str());
      m_hsmsPassive.requestEventReportSend_Panel_End();
   };
   m_master.setListener(masterListener);
   m_master.setContinuousTransferCount(m_configuration.getContinuousTransferCount());
   // 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
   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文件失败.");
   }
   // 加载警告信息
@@ -170,15 +462,22 @@
   alarmManager.readAlarmFile(szBuffer);
   // Glass数据库
   strLogDir.Format(_T("%s\\db\\process.db"), (LPTSTR)(LPCTSTR)m_strWorkDir);
   std::string path((LPTSTR)(LPCTSTR)strLogDir);
   GlassLogDb::Init(path);
   return 0;
}
int CModel::term()
{
   m_hsmsPassive.saveCache();
   m_hsmsPassive.term();
   CLog::GetLog()->SetOnLogCallback(nullptr);
   m_master.term();
   m_glassPool.term();
   return 0;
}
@@ -386,9 +685,4 @@
   }
   return 0;
}
bool CModel::isAlarmStep(SERVO::CStep* pStep)
{
   return CToolUnits::startsWith(pStep->getName(), STEP_ALARM_START);
}