SourceCode/Bond/Servo/CMaster.cpp
@@ -3,10 +3,14 @@
#include "CMaster.h"
#include <future>
#include <vector>
#include <algorithm>
#include "RecipeManager.h"
#include <fstream>
#include "SerializeUtil.h"
#include "CServoUtilsTool.h"
#include "AlarmManager.h"
#include "ToolUnits.h"
#include "Model.h"
namespace SERVO {
@@ -71,6 +75,8 @@
      m_nContinuousWorkingPort = 0;
      m_nContinuousWorkingSlot = 0;
      m_pControlJob = nullptr;
      m_bPauseAlarmRaised = false;
      m_pModelCtx = nullptr;
      m_nTestFlag = 0;
      InitializeCriticalSection(&m_criticalSection);
   }
@@ -120,6 +126,11 @@
      m_listener = listener;
   }
   void CMaster::setModelCtx(CModel* pModel)
   {
      m_pModelCtx = pModel;
   }
   CRobotTask* CMaster::getActiveRobotTask()
   {
      return m_pActiveRobotTask;
@@ -127,128 +138,147 @@
   int CMaster::init()
   {
      const ULONGLONG boot_master_begin = GetTickCount64();
      LOGI("<Master>正在初始化...");
      LOGI("[BOOT][MASTER] init begin");
      //    cclink
      if (m_cclink.Connect(CC_LINK_IE_CONTROL_CHANNEL(1)) != 0) {
      const ULONGLONG boot_cclink_begin = GetTickCount64();
      const int cc_ret = m_cclink.Connect(CC_LINK_IE_CONTROL_CHANNEL(1));
      LOGI("[BOOT][MASTER] CC-Link connect ret=%d, cost=%llu ms",
         cc_ret,
         (unsigned long long)(GetTickCount64() - boot_cclink_begin));
      if (cc_ret != 0) {
         LOGE("连接CC-Link失败.");
      }
      else {
         LOGI("连接CC-Link成功.");
         BoardVersion version{};
         int nRet = m_cclink.GetBoardVersion(version);
         if (nRet == 0) {
            LOGD("版本信息:%s.", version.toString().c_str());
         }
         else {
            LOGE("获取CC-Link版本信息失败.");
            LOGI("连接CC-Link成功.");
            BoardVersion version{};
            int nRet = m_cclink.GetBoardVersion(version);
            if (nRet == 0) {
               LOGD("版本信息:%s.", version.toString().c_str());
            }
            else {
               LOGE("获取CC-Link版本信息失败.");
            }
            BoardStatus status;
            nRet = m_cclink.GetBoardStatus(status);
            if (nRet == 0) {
               LOGD("状态:%s.", status.toString().c_str());
            }
            else {
               LOGE("获取CC-Link状态失败.");
            }
         }
         BoardStatus status;
         nRet = m_cclink.GetBoardStatus(status);
         if (nRet == 0) {
            LOGD("状态:%s.", status.toString().c_str());
         // 初始化添加各子设备
         CLoadPort* pPort1, * pPort2, * pPort3, * pPort4;
         CBonder* pBonder1, * pBonder2;
         CEFEM* pEfem;
         CArm* pArm;
         CArmTray* pArmTray1, * pArmTray2;
         CFliper* pFliper;
         CVacuumBake* pVacuumBake;
         CAligner* pAligner;
         CBakeCooling* pBakeCooling;
         CMeasurement* pMeasurement;
         pPort1 = addLoadPort(0);
         pPort2 = addLoadPort(1);
         pPort3 = addLoadPort(2);
         pPort4 = addLoadPort(3);
         pEfem = addEFEM();
         pArm = addArm();
         pArmTray1 = addArmTray(0);
         pArmTray2 = addArmTray(1);
         pFliper = addFliper();
         pVacuumBake = addVacuumBake();
         pAligner = addAligner();
         pBonder1 = addBonder(0);
         pBonder2 = addBonder(1);
         pBakeCooling = addBakeCooling();
         pMeasurement = addMeasurement();
         ASSERT(pEfem);
         ASSERT(pFliper);
         ASSERT(pVacuumBake);
         ASSERT(pAligner);
         ASSERT(pBonder1);
         ASSERT(pBonder2);
         ASSERT(pBakeCooling);
         ASSERT(pMeasurement);
         pEfem->setPort(0, pPort1);
         pEfem->setPort(1, pPort2);
         pEfem->setPort(2, pPort3);
         pEfem->setPort(3, pPort4);
         pEfem->setFliper(pFliper);
         pEfem->setAligner(pAligner);
         pEfem->setArmTray(0, pArmTray1);
         pEfem->setArmTray(1, pArmTray2);
         pPort1->setArm(pArm);
         pPort2->setArm(pArm);
         pPort3->setArm(pArm);
         pPort4->setArm(pArm);
         pArmTray1->setArm(pArm);
         pArmTray2->setArm(pArm);
         pFliper->setArm(pArm);
         pVacuumBake->setArm(pArm);
         pAligner->setArm(pArm);
         pBonder1->setArm(pArm);
         pBonder2->setArm(pArm);
         pBakeCooling->setArm(pArm);
         pMeasurement->setArm(pArm);
         connectEquipments();
         // 读缓存数据
         const ULONGLONG boot_cache_begin = GetTickCount64();
         const ULONGLONG boot_read_begin = GetTickCount64();
         readCache();
         LOGI("[BOOT][MASTER] readCache finished, cost=%llu ms", (unsigned long long)(GetTickCount64() - boot_read_begin));
         const ULONGLONG boot_state_begin = GetTickCount64();
         loadState();
         LOGI("[BOOT][MASTER] loadState finished, cost=%llu ms", (unsigned long long)(GetTickCount64() - boot_state_begin));
         if (m_listener.onControlJobChanged) {
            notifyControlJobChanged();
         }
         else {
            LOGE("获取CC-Link状态失败.");
         }
         LOGI("[BOOT][MASTER] cache/state loaded, cost=%llu ms (since init %llu ms)",
            (unsigned long long)(GetTickCount64() - boot_cache_begin),
            (unsigned long long)(GetTickCount64() - boot_master_begin));
         // 定时器
         g_pMaster = this;
         SetTimer(NULL, 1, 250, (TIMERPROC)MasterTimerProc);
         // 调度线程
         m_hDispatchThreadHandle = (HANDLE)_beginthreadex(NULL, 0, SERVO::DispatchThreadFunction, this,
            0, &m_nDispatchThreadAddr);
         // 监控bit线程
         m_hReadBitsThreadHandle = (HANDLE)_beginthreadex(NULL, 0, SERVO::ReadBitsThreadFunction, this,
            0, &m_nReadBitsThreadAddr);
         // 曲线服务
         CreateDAQBridgeServer();
         LOGI("<Master>初始化完成.");
         LOGI("[BOOT][MASTER] init finished, total cost=%llu ms",
            (unsigned long long)(GetTickCount64() - boot_master_begin));
         return 0;
      }
      // 初始化添加各子设备
      CLoadPort* pPort1, * pPort2, * pPort3, * pPort4;
      CBonder* pBonder1, * pBonder2;
      CEFEM* pEfem;
      CArm* pArm;
      CArmTray* pArmTray1, * pArmTray2;
      CFliper* pFliper;
      CVacuumBake* pVacuumBake;
      CAligner* pAligner;
      CBakeCooling* pBakeCooling;
      CMeasurement* pMeasurement;
      pPort1 = addLoadPort(0);
      pPort2 = addLoadPort(1);
      pPort3 = addLoadPort(2);
      pPort4 = addLoadPort(3);
      pEfem = addEFEM();
      pArm = addArm();
      pArmTray1 = addArmTray(0);
      pArmTray2 = addArmTray(1);
      pFliper = addFliper();
      pVacuumBake = addVacuumBake();
      pAligner = addAligner();
      pBonder1 = addBonder(0);
      pBonder2 = addBonder(1);
      pBakeCooling = addBakeCooling();
      pMeasurement = addMeasurement();
      ASSERT(pEfem);
      ASSERT(pFliper);
      ASSERT(pVacuumBake);
      ASSERT(pAligner);
      ASSERT(pBonder1);
      ASSERT(pBonder2);
      ASSERT(pBakeCooling);
      ASSERT(pMeasurement);
      pEfem->setPort(0, pPort1);
      pEfem->setPort(1, pPort2);
      pEfem->setPort(2, pPort3);
      pEfem->setPort(3, pPort4);
      pEfem->setFliper(pFliper);
      pEfem->setAligner(pAligner);
      pEfem->setArmTray(0, pArmTray1);
      pEfem->setArmTray(1, pArmTray2);
      pPort1->setArm(pArm);
      pPort2->setArm(pArm);
      pPort3->setArm(pArm);
      pPort4->setArm(pArm);
      pArmTray1->setArm(pArm);
      pArmTray2->setArm(pArm);
      pFliper->setArm(pArm);
      pVacuumBake->setArm(pArm);
      pAligner->setArm(pArm);
      pBonder1->setArm(pArm);
      pBonder2->setArm(pArm);
      pBakeCooling->setArm(pArm);
      pMeasurement->setArm(pArm);
      connectEquipments();
      // 读缓存数据
      readCache();
      loadState();
      if (m_listener.onControlJobChanged) {
         m_listener.onControlJobChanged(this);
      }
      // 定时器
      g_pMaster = this;
      SetTimer(NULL, 1, 250, (TIMERPROC)MasterTimerProc);
      // 调度线程
      m_hDispatchThreadHandle = (HANDLE)_beginthreadex(NULL, 0, SERVO::DispatchThreadFunction, this,
         0, &m_nDispatchThreadAddr);
      // 监控bit线程
      m_hReadBitsThreadHandle = (HANDLE)_beginthreadex(NULL, 0, SERVO::ReadBitsThreadFunction, this,
         0, &m_nReadBitsThreadAddr);
      // 曲线服务
      CreateDAQBridgeServer();
      LOGI("<Master>初始化完成.");
      return 0;
   }
   int CMaster::term()
   {
@@ -878,6 +908,33 @@
                  m_pActiveRobotTask->place();
               }
               unlock(); // 等当前任务完成或中止后继续
               continue;
            }
            // 5.5) 暂停状态检查:若 CJ 或在制 PJ 处于 Paused,暂缓调度新的搬送
            bool pausedByEvent = false;
            if (m_pControlJob != nullptr && m_pControlJob->state() == CJState::Paused) {
               pausedByEvent = true;
            }
            for (auto pj : m_inProcesJobs) {
               if (pj != nullptr && pj->state() == PJState::Paused) {
                  pausedByEvent = true;
                  break;
               }
            }
            if (!pausedByEvent && m_bPauseAlarmRaised) {
               if (m_pModelCtx != nullptr) {
                  m_pModelCtx->clearSoftAlarm(ALID_SOFTWARE_PAUSE_EVENT, 0, 0);
               }
               else {
                  AlarmManager& alarmManager = AlarmManager::getInstance();
                  alarmManager.clearAlarmByAttributes(ALID_SOFTWARE_PAUSE_EVENT, 0, 0, CToolUnits::getCurrentTimeString());
               }
               m_bPauseAlarmRaised = false;
            }
            if (pausedByEvent) {
               LOGI("<Master>调度暂停:ControlJob/ProcessJob 处于 Paused 状态(可能由 PauseEvent 触发)");
               unlock();
               continue;
            }
@@ -1637,6 +1694,14 @@
         }
      };
      listener.onSVDataReport = [&](void* pEquipment, void* pData) {
         const bool allowSvLog =
            (m_state == MASTERSTATE::RUNNING ||
               m_state == MASTERSTATE::RUNNING_CONTINUOUS_TRANSFER ||
               m_state == MASTERSTATE::RUNNING_BATCH ||
               m_state == MASTERSTATE::STARTING);
         if (!allowSvLog) {
            return;
         }
         CSVData* pSVData = (CSVData*)pData;
         auto rawData = pSVData->getSVRawData();
         std::vector<CParam> params;
@@ -2858,7 +2923,7 @@
      this->saveState();
      if (m_listener.onControlJobChanged) {
         m_listener.onControlJobChanged(this);
         notifyControlJobChanged();
      }
      return (int)m_processJobs.size();
@@ -2918,7 +2983,7 @@
      m_pControlJob->setPJs(temps);
      this->saveState();
      if (m_listener.onControlJobChanged) {
         m_listener.onControlJobChanged(this);
         notifyControlJobChanged();
      }
@@ -2972,7 +3037,98 @@
   bool CMaster::ceidDefined(uint32_t ceid) const
   {
      return true;
      if (m_allowedCeids.empty()) return true; // backward compatible: treat as all allowed when not configured
      return m_allowedCeids.find(ceid) != m_allowedCeids.end();
   }
   bool CMaster::raiseSoftAlarm(int alarmId,
      const std::string& desc,
      int level/* = -1*/,
      int deviceId/* = 0*/,
      int unitId/* = 0*/,
      const char* deviceName/* = "Software"*/,
      const char* unitName/* = "App"*/)
   {
      AlarmManager& alarmManager = AlarmManager::getInstance();
      const AlarmInfo* info = alarmManager.getAlarmInfoByID(alarmId);
      int severity = level;
      if (severity < 0 && info != nullptr) {
         severity = info->nAlarmLevel;
      }
      if (severity < 0) severity = 0; // fallback
      std::string descText = desc;
      if (descText.empty() && info != nullptr) {
         descText = !info->strDescription.empty() ? info->strDescription : info->strAlarmText;
      }
      if (descText.empty()) {
         descText = CToolUnits::formatString("Alarm %d", alarmId);
      }
      AlarmData alarmData;
      alarmData.nId = alarmId;
      alarmData.nSeverityLevel = severity;
      alarmData.nDeviceId = deviceId;
      alarmData.nUnitId = unitId;
      alarmData.strDeviceName = deviceName;
      alarmData.strUnitName = unitName;
      alarmData.strStartTime = CToolUnits::timeToString2(CToolUnits::getTimestamp());
      alarmData.strEndTime = "";
      alarmData.strDescription = descText;
      int nAlarmEventId = 0;
      return alarmManager.addAlarm(alarmData, nAlarmEventId);
   }
   void CMaster::handleCollectionEvent(uint32_t ceid)
   {
      // 遍历当前 PJ,命中 pauseEvents 时可在此扩展暂停动作
      bool pausedAny = false;
      for (auto pj : m_processJobs) {
         if (pj == nullptr) continue;
         const auto& pauseList = pj->pauseEvents();
         if (std::find(pauseList.begin(), pauseList.end(), ceid) != pauseList.end()) {
            LOGW("<Master>PauseEvent hit: CEID=%u, PJ=%s, state=%d", ceid, pj->id().c_str(), (int)pj->state());
            if (pj->pause()) {
               LOGI("<Master>PJ paused by CEID=%u", ceid);
               pausedAny = true;
            }
            if (m_pControlJob != nullptr && m_pControlJob->state() == CJState::Executing) {
               if (m_pControlJob->pause()) {
                  LOGI("<Master>ControlJob paused by CEID=%u", ceid);
                  pausedAny = true;
               }
            }
         }
      }
      if (pausedAny && m_listener.onControlJobChanged) {
         // 通知应用层刷新 UI/按钮状态
         notifyControlJobChanged();
      }
      if (pausedAny && !m_bPauseAlarmRaised) {
         std::string desc = CToolUnits::formatString("<PauseEvent CEID=%u>", ceid);
         bool raised = false;
         if (m_pModelCtx != nullptr) {
            raised = m_pModelCtx->raiseSoftAlarm(ALID_SOFTWARE_PAUSE_EVENT, desc);
         }
         else {
            raised = raiseSoftAlarm(ALID_SOFTWARE_PAUSE_EVENT, desc);
         }
         if (raised) {
            LOGI("<Master>PauseEvent soft alarm raised, CEID=%u", ceid);
            m_bPauseAlarmRaised = true;
         }
      }
   }
   void CMaster::setAllowedCeids(const std::vector<unsigned int>& ceids)
   {
      m_allowedCeids.clear();
      m_allowedCeids.reserve(ceids.size());
      for (auto id : ceids) {
         m_allowedCeids.insert(id);
      }
   }
   bool CMaster::saveState() const
@@ -3263,7 +3419,7 @@
      saveState();
      if (m_listener.onControlJobChanged) {
         m_listener.onControlJobChanged(this);
         notifyControlJobChanged();
      }
      return true;
@@ -3300,7 +3456,7 @@
      saveState();
      if (m_listener.onControlJobChanged) {
         m_listener.onControlJobChanged(this);
         notifyControlJobChanged();
      }
      return true;