SourceCode/Bond/Servo/CMaster.cpp
@@ -138,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) {
         notifyControlJobChanged();
      }
      // 定时器
      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()
   {
@@ -1675,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;