From 3896bd8be7e7db15e5e1b9f3c07469ad614c8a74 Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期五, 19 九月 2025 17:01:33 +0800
Subject: [PATCH] 1.结批处理； 2.Process Job修复未绑定context的问题；
---
SourceCode/Bond/Servo/CMaster.cpp | 308 ++++++++++++++++++++++++++++++++++++++++++++------
1 files changed, 269 insertions(+), 39 deletions(-)
diff --git a/SourceCode/Bond/Servo/CMaster.cpp b/SourceCode/Bond/Servo/CMaster.cpp
index 259991d..ac0a419 100644
--- a/SourceCode/Bond/Servo/CMaster.cpp
+++ b/SourceCode/Bond/Servo/CMaster.cpp
@@ -53,7 +53,7 @@
m_ullRunTime = 0;
m_state = MASTERSTATE::READY;
m_pActiveRobotTask = nullptr;
- m_nLastError = 0;
+ m_nLastError = ER_CODE_NOERROR;
m_isCompareMapsBeforeProceeding = FALSE;
m_bJobMode = FALSE;
m_bEnableEventReport = true;
@@ -62,6 +62,8 @@
m_bBatch = false;
m_nContinuousTransferCount = 0;
m_nContinuousTransferStep = CTStep_Unknow;
+ m_nContinuousWorkingPort = 0;
+ m_nContinuousWorkingSlot = 0;
m_pControlJob = nullptr;
m_nTestFlag = 0;
InitializeCriticalSection(&m_criticalSection);
@@ -131,7 +133,7 @@
BoardVersion version{};
int nRet = m_cclink.GetBoardVersion(version);
if (nRet == 0) {
- LOGI("版本信息：%s.", version.toString().c_str());
+ LOGD("版本信息：%s.", version.toString().c_str());
}
else {
LOGE("获取CC-Link版本信息失败.");
@@ -140,7 +142,7 @@
BoardStatus status;
nRet = m_cclink.GetBoardStatus(status);
if (nRet == 0) {
- LOGI("状态：%s.", status.toString().c_str());
+ LOGD("状态：%s.", status.toString().c_str());
}
else {
LOGE("获取CC-Link状态失败.");
@@ -307,7 +309,7 @@
return 0;
}
- int CMaster::stop()
+ int CMaster::stop(int nErCode/* = ER_CODE_NOERROR*/)
{
// 运行时间为累加结果，本次停止时刷新；
lock();
@@ -321,6 +323,7 @@
// 更新状态
+ m_nLastError = nErCode;
setState(MASTERSTATE::STOPPING);
@@ -422,7 +425,8 @@
TRACE("a0001\n", writeCode, retCode);
});
if (nRet != 0) {
- LOGI("<Master>EFEM切换Start状态失败");
+ LOGE("<Master>EFEM切换Start状态失败");
+ m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
m_strLastError = "EFEM切换Start状态失败.";
goto WAIT;
}
@@ -435,7 +439,8 @@
TRACE("a0002\n");
});
if (nRet != 0) {
- LOGI("<Master>Bonder1切换Start状态失败");
+ LOGE("<Master>Bonder1切换Start状态失败");
+ m_nLastError = ER_CODE_BONDER_OPERATION_MODE_FAIL;
m_strLastError = "Bonder1切换Start状态失败.";
goto WAIT;
}
@@ -448,7 +453,8 @@
TRACE("a0003\n");
});
if (nRet != 0) {
- LOGI("<Master>Bonder2切换Start状态失败");
+ LOGE("<Master>Bonder2切换Start状态失败");
+ m_nLastError = ER_CODE_BONDER_OPERATION_MODE_FAIL;
m_strLastError = "Bonder2切换Start状态失败.";
goto WAIT;
}
@@ -461,7 +467,8 @@
TRACE("a0004\n");
});
if (nRet != 0) {
- LOGI("<Master>BakeCooling切换Start状态失败");
+ LOGE("<Master>BakeCooling切换Start状态失败");
+ m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
m_strLastError = "BakeCooling切换Start状态失败.";
goto WAIT;
}
@@ -474,7 +481,8 @@
TRACE("a0005\n");
});
if (nRet != 0) {
- LOGI("<Master>VacuumBake切换Start状态失败");
+ LOGE("<Master>VacuumBake切换Start状态失败");
+ m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
m_strLastError = "VacuumBake切换Start状态失败.";
goto WAIT;
}
@@ -487,7 +495,8 @@
TRACE("a0006\n");
});
if (nRet != 0) {
- LOGI("<Master>Measurement切换Start状态失败");
+ LOGE("<Master>Measurement切换Start状态失败");
+ m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
m_strLastError = "Measurement切换Start状态失败.";
goto WAIT;
}
@@ -501,7 +510,7 @@
for (int i = 0; i < 6; i++) {
if (!bIomcOk[i]) {
bIomcOk[6] = FALSE;
- LOGI("<Master>%s切换Start状态失败", pEq[i]->getName().c_str());
+ LOGE("<Master>%s切换Start状态失败", pEq[i]->getName().c_str());
}
}
@@ -545,7 +554,8 @@
TRACE("s000%d: ret=%d\n", i + 1, retCode);
});
if (nRet != 0) {
- LOGI("<Master>%s切换Stop状态发送失败", pEq[i]->getName().c_str());
+ LOGE("<Master>%s切换Stop状态发送失败", pEq[i]->getName().c_str());
+ m_nLastError = ER_CODE_OPERATION_MODE_FAIL;
m_strLastError = pEq[i]->getName() + "切换Stop状态发送失败.";
bIomcOk[i] = FALSE;
promises[i].set_value(); // 避免 wait 阻塞
@@ -560,7 +570,7 @@
for (int i = 0; i < 6; ++i) {
if (!bIomcOk[i]) {
bIomcOk[6] = FALSE;
- LOGI("<Master>%s切换Stop状态失败", pEq[i]->getName().c_str());
+ LOGE("<Master>%s切换Stop状态失败", pEq[i]->getName().c_str());
}
}
@@ -570,7 +580,11 @@
}
LOGI("<Master>所有设备成功切换到 Stop 模式");
- setState(MASTERSTATE::READY);
+ if(m_nLastError == ER_CODE_NOERROR)
+ setState(MASTERSTATE::READY);
+ else
+ setState(MASTERSTATE::ATHERERROR);
+
continue;
}
@@ -734,7 +748,7 @@
if (!rmd.armState[0]) {
// m_nTestFlag = 1;
- if (m_nTestFlag == 1) LOGI("createTransferTask 004df %d, %d", MaterialsType::G1, secondaryType);
+ if (m_nTestFlag == 1) LOGD("createTransferTask 004df %d, %d", MaterialsType::G1, secondaryType);
m_pActiveRobotTask = createTransferTask(pAligner, pVacuumBake, MaterialsType::G1, secondaryType);
CHECK_RUN_ACTIVE_ROBOT_TASK(m_pActiveRobotTask);
m_nTestFlag = 0;
@@ -767,6 +781,15 @@
&& pLoadPorts[s]->getPortStatus() == PORT_INUSE) {
m_pActiveRobotTask = createTransferTask(pLoadPorts[s], pAligner, primaryType, secondaryType, 1, m_bJobMode);
if (m_pActiveRobotTask != nullptr) {
+ CGlass* pGlass = (CGlass*)m_pActiveRobotTask->getContext();
+ if (pGlass->getBuddy() != nullptr) {
+ delete m_pActiveRobotTask;
+ m_pActiveRobotTask = nullptr;
+ continue;
+ }
+
+ pGlass->queue();
+ pGlass->start();
pEFEM->setContext(m_pActiveRobotTask->getContext());
goto PORT_GET;
}
@@ -791,7 +814,7 @@
CJState state = m_pControlJob->state();
if (state == CJState::Completed || state == CJState::Aborted || state == CJState::Failed) {
// ConrolJpb已完成
- LOGI("<Master>ControlJob已经完成或失败中断");
+ LOGE("<Master>ControlJob已经完成或失败中断");
unlock();
continue;
}
@@ -828,7 +851,7 @@
}
}
if (m_inProcesJobs.empty()) {
- LOGI("<Master>选择当前ProcessJob失败！");
+ LOGE("<Master>选择当前ProcessJob失败！");
unlock();
continue;
}
@@ -880,7 +903,7 @@
// Measurement -> LoadPort
if (rmd.armState[0] || rmd.armState[1]) {
- LOGI("Arm1 %s, Arm2 %s.", rmd.armState[0] ? _T("不可用") : _T("可用"),
+ LOGD("Arm1 %s, Arm2 %s.", rmd.armState[0] ? _T("不可用") : _T("可用"),
rmd.armState[1] ? _T("不可用") : _T("可用"));
}
for (int s = 0; s < 4; s++) {
@@ -1043,15 +1066,17 @@
}
// Measurement -> LoadPort
- for (int s = 0; s < 4; s++) {
- PortType pt = pLoadPorts[s]->getPortType();
+ for (int p = 0; p < 4; p++) {
+ if (p != m_nContinuousWorkingPort) continue;
+ PortType pt = pLoadPorts[p]->getPortType();
if ((m_nContinuousTransferStep == CTStep_Unknow || m_nContinuousTransferStep == CTStep_BakeCooling_Measurement)
- && !rmd.armState[0] && pLoadPorts[s]->isEnable()
+ && !rmd.armState[0] && pLoadPorts[p]->isEnable()
&& (pt == PortType::Unloading || pt == PortType::Both)
- && pLoadPorts[s]->getPortStatus() == PORT_INUSE) {
+ && pLoadPorts[p]->getPortStatus() == PORT_INUSE) {
for (int slot = 0; slot < SLOT_MAX; slot++) {
+ if (slot != m_nContinuousWorkingSlot) continue;
m_pActiveRobotTask = createTransferTask_continuous_transfer(pMeasurement,
- 0, pLoadPorts[s], slot);
+ 0, pLoadPorts[p], slot);
if (m_pActiveRobotTask != nullptr) {
m_nContinuousTransferStep = CTStep_Measurement_LoadPort;
m_nContinuousTransferStep = CTStep_end;
@@ -1183,17 +1208,19 @@
}
// LoadPort -> Aligner
- for (int s = 0; s < 4; s++) {
- PortType pt = pLoadPorts[s]->getPortType();
+ for (int p = 0; p < 4; p++) {
+ PortType pt = pLoadPorts[p]->getPortType();
if ((m_nContinuousTransferStep == CTStep_Unknow || m_nContinuousTransferStep == CTStep_end)
- && !rmd.armState[0] && pLoadPorts[s]->isEnable()
+ && !rmd.armState[0] && pLoadPorts[p]->isEnable()
&& (pt == PortType::Loading || pt == PortType::Both)
- && pLoadPorts[s]->getPortStatus() == PORT_INUSE) {
+ && pLoadPorts[p]->getPortStatus() == PORT_INUSE) {
for (int slot = 0; slot < SLOT_MAX; slot++) {
- m_pActiveRobotTask = createTransferTask_continuous_transfer(pLoadPorts[s],
+ m_pActiveRobotTask = createTransferTask_continuous_transfer(pLoadPorts[p],
slot, pAligner, 0);
if (m_pActiveRobotTask != nullptr) {
m_nContinuousTransferStep = CTStep_LoadPort_Aligner;
+ m_nContinuousWorkingPort = p;
+ m_nContinuousWorkingSlot = slot;
LOGI("<ContinuousTransfer>千传测试，开始搬送任务(LoadPort -> Aligner)...");
pEFEM->setContext(m_pActiveRobotTask->getContext());
goto CT_PORT_GET;
@@ -1305,22 +1332,22 @@
BOOL bOk = FALSE;
lock();
if (m_pActiveRobotTask != nullptr) {
- LOGI("<CMaster>onPreFethedOutJob 0001.");
+ LOGD("<CMaster>onPreFethedOutJob 0001.");
if (m_pActiveRobotTask->getSrcPosition() == p->getID()) {
- LOGI("<CMaster>onPreFethedOutJob 0002.");
+ LOGD("<CMaster>onPreFethedOutJob 0002.");
CGlass* pGlass = p->getGlassFromSlot(m_pActiveRobotTask->getSrcSlot());
if (pGlass != nullptr) {
- LOGI("<CMaster>onPreFethedOutJob 0003.");
+ LOGD("<CMaster>onPreFethedOutJob 0003.");
CJobDataS* pJobDataS = pGlass->getJobDataS();
if (pJobDataS != nullptr
&& pJobDataS->getCassetteSequenceNo() == pJobDataB->getCassetteSequenceNo()
&& pJobDataS->getJobSequenceNo() == pJobDataB->getJobSequenceNo()) {
bOk = TRUE;
- LOGI("<CMaster>onPreFethedOutJob, 已校验数据一致性.");
+ LOGD("<CMaster>onPreFethedOutJob, 已校验数据一致性.");
}
- LOGI("<CMaster>onPreFethedOutJob 0004.");
+ LOGD("<CMaster>onPreFethedOutJob 0004.");
if (pJobDataS != nullptr) {
- LOGI("<CMaster>onPreFethedOutJob 0005. %d,%d,%d,%d",
+ LOGD("<CMaster>onPreFethedOutJob 0005. %d,%d,%d,%d",
pJobDataS->getCassetteSequenceNo(),
pJobDataB->getCassetteSequenceNo(),
pJobDataS->getJobSequenceNo(),
@@ -1442,6 +1469,8 @@
if (m_pActiveRobotTask->getSrcPosition() == EQ_ID_MEASUREMENT) {
CGlass* pGlass = (CGlass*)m_pActiveRobotTask->getContext();
pGlass->complete();
+ CGlass* pBuddy = pGlass->getBuddy();
+ if (pBuddy != nullptr) pBuddy->complete();
this->saveState();
bool bMoved = glassFromInPorcessToComplete(pGlass);
if (bMoved) {
@@ -1544,6 +1573,45 @@
if (m_listener.onLoadPortStatusChanged != nullptr) {
m_listener.onLoadPortStatusChanged(this, (CEquipment*)pEquipment, status, data);
}
+ };
+ listener.onSVDataReport = [&](void* pEquipment, void* pData) {
+ CSVData* pSVData = (CSVData*)pData;
+ auto rawData = pSVData->getSVRawData();
+ std::vector<CParam> params;
+ ((CEquipment*)pEquipment)->parsingSVData((const char*)rawData.data(), rawData.size(), params);
+
+ std::string strOut;
+ 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);
+ }
+ LOGD("<CMaster-%s>SVDataReport:%s", ((CEquipment*)pEquipment)->getName().c_str(), strOut.c_str());
+ };
+ listener.onPanelDataReport = [&](void* pEquipment, void* pContext) {
+ LOGD("<CMaster-%s>onPanelDataReport", ((CEquipment*)pEquipment)->getName().c_str());
+
+ CEquipment* pEq = (CEquipment*)pEquipment;
+ CGlass* pGlass = (CGlass*)pContext;
+
+ // 如果AOI检测失败，要停机
+ if (pEq->getID() == EQ_ID_MEASUREMENT) {
+ LOGD("<CMaster-%s>onPanelDataReport 01", ((CEquipment*)pEquipment)->getName().c_str());
+ if (pGlass->getAOIInspResult() == InspResult::Fail) {
+ LOGD("<CMaster-%s>onPanelDataReport 02", ((CEquipment*)pEquipment)->getName().c_str());
+ if (stop() == 0) {
+ m_nLastError = ER_CODE_AOI_NG;
+ m_strLastError = "AOI检测未通过.";
+ }
+ }
+ }
+
};
pEquipment->setListener(listener);
pEquipment->setCcLink(&m_cclink);
@@ -1805,6 +1873,8 @@
if (!m_inProcesGlasses.empty()) {
CGlass* pGlass = m_inProcesGlasses.front();
pGlass->complete();
+ CGlass* pBuddy = pGlass->getBuddy();
+ if (pBuddy != nullptr) pBuddy->complete();
glassFromInPorcessToComplete(pGlass);
this->saveState();
@@ -2011,12 +2081,12 @@
pSrcEq->m_nTestFlag = m_nTestFlag;
pTarSlot = pTarEq->getAvailableSlotForGlass(primaryType);
pSrcSlot = pSrcEq->getProcessedSlot(primaryType, bJobMode);
- if (m_nTestFlag == 1) LOGI("createTransferTask 003 %x, %x", pTarSlot, pSrcSlot);
- if (pSrcSlot == nullptr || nullptr == pTarSlot && secondaryType != SERVO::MaterialsType::G0) {
+ if (m_nTestFlag == 1) LOGD("createTransferTask 003 %x, %x", pTarSlot, pSrcSlot);
+ if ((pSrcSlot == nullptr || nullptr == pTarSlot) && secondaryType != SERVO::MaterialsType::G0) {
pTarSlot = pTarEq->getAvailableSlotForGlass(secondaryType);
pSrcSlot = pSrcEq->getProcessedSlot(secondaryType, bJobMode);
}
- if (m_nTestFlag == 1) LOGI("createTransferTask 004 %x, %x", pTarSlot, pSrcSlot);
+ if (m_nTestFlag == 1) LOGD("createTransferTask 004 %x, %x", pTarSlot, pSrcSlot);
if (pSrcSlot != nullptr && nullptr != pTarSlot) {
pTask = new CRobotTask();
@@ -2251,6 +2321,22 @@
pPort->localEanblePort(bEnable);
}
+ int CMaster::getPortCassetteSnSeed(int port)
+ {
+ ASSERT(1 <= port && port <= 4);
+ int eqid[] = { EQ_ID_LOADPORT1, EQ_ID_LOADPORT2, EQ_ID_LOADPORT3, EQ_ID_LOADPORT4 };
+ CLoadPort* pPort = (CLoadPort*)getEquipment(eqid[port - 1]);
+ return pPort->getPortCassetteSnSeed();
+ }
+
+ void CMaster::setPortCassetteSnSeed(int port, int seed)
+ {
+ ASSERT(1 <= port && port <= 4);
+ int eqid[] = { EQ_ID_LOADPORT1, EQ_ID_LOADPORT2, EQ_ID_LOADPORT3, EQ_ID_LOADPORT4 };
+ CLoadPort* pPort = (CLoadPort*)getEquipment(eqid[port - 1]);
+ return pPort->setPortCassetteSnSeed(seed);
+ }
+
void CMaster::setCompareMapsBeforeProceeding(BOOL bCompare)
{
m_isCompareMapsBeforeProceeding = bCompare;
@@ -2323,8 +2409,31 @@
temp.push_back(p);
}
}
-
m_processJobs = temp;
+
+
+ // 更新context
+ std::vector<uint8_t> newSlots;
+ std::vector<void*> newContexts;
+ for (auto pj : m_processJobs) {
+ for (auto& c : pj->carriers()) {
+ auto pPort = getPortWithCarrierId(c.carrierId);
+ if (pPort == nullptr) continue;
+
+ for (auto s : c.slots) {
+ auto pGlass = pPort->getGlassFromSlot(s);
+ if (pGlass == nullptr) continue;
+
+ newSlots.push_back(s);
+ newContexts.push_back(pGlass);
+ }
+
+ pj->setCarrierSlotsAndContexts(c.carrierId, newSlots, newContexts);
+ }
+ }
+
+
+
this->saveState();
return (int)m_processJobs.size();
@@ -2499,7 +2608,9 @@
m_pControlJob = new CControlJob();
if (!CControlJob::deserialize(ifs, *m_pControlJob)) return false;
}
-
+ else {
+ return false;
+ }
// 读取 ProcessJob 列表
uint32_t count = 0;
@@ -2669,4 +2780,123 @@
return nullptr;
}
+
+
+ bool CMaster::completeControlJob(std::string description)
+ {
+ if (m_pControlJob == nullptr || m_state != SERVO::MASTERSTATE::READY) {
+ return false;
+ }
+ for (auto item : m_processJobs) {
+ item->abort(description);
+ }
+ m_pControlJob->abort(description);
+
+
+ // 释放Job相关
+ for (auto item : m_processJobs) {
+ delete item;
+ }
+ m_processJobs.clear();
+ if (m_pControlJob != nullptr) {
+ delete m_pControlJob;
+ m_pControlJob = nullptr;
+ }
+
+ saveState();
+
+ return true;
+ }
+
+ bool CMaster::canCreateControlJob()
+ {
+ return m_pControlJob == nullptr;
+ }
+
+ bool CMaster::canCompleteControlJob()
+ {
+ return m_pControlJob != nullptr && m_state == SERVO::MASTERSTATE::READY;
+ }
+
+ bool CMaster::canDeleteControlJob()
+ {
+ return m_pControlJob != nullptr
+ && m_pControlJob->state() == CJState::NoState
+ && m_state == SERVO::MASTERSTATE::READY;
+ }
+
+ int CMaster::getWipGlasses(std::vector<CGlass*>& glasses)
+ {
+ for (auto eq : m_listEquipment) {
+ auto p = dynamic_cast<CLoadPort*>(eq);
+ if (p == nullptr) {
+ eq->getAllGlass(glasses);
+ }
+
+ }
+
+ return (int)glasses.size();
+ }
+
+ int CMaster::getLastError()
+ {
+ return m_nLastError;
+ }
+
+ std::string& CMaster::getLastErrorText()
+ {
+ return m_strLastError;
+ }
+
+ void CMaster::test()
+ {
+ if (stop() == 0) {
+ m_nLastError = ER_CODE_AOI_NG;
+ m_strLastError = "AOI检测未通过.";
+ }
+ }
+
+ bool CMaster::moveGlassToBuf(int eqid, int slotNo)
+ {
+ CEquipment* pEquipment = getEquipment(eqid);
+ if (pEquipment == nullptr) return false;
+
+ CSlot* pSlot = pEquipment->getSlotWithNo(slotNo);
+ if (pSlot == nullptr) return false;
+
+ CGlass* pGlass = (CGlass*)pSlot->getContext();
+ m_bufGlass.push_back(pGlass);
+ pGlass->addRef();
+ pSlot->setContext(nullptr);
+
+ m_bDataModify = TRUE;
+ if (m_listener.onEqDataChanged != nullptr) {
+ m_listener.onEqDataChanged(this, pEquipment, 0);
+ }
+
+ return true;
+ }
+
+ bool CMaster::moveGlassToSlot(int eqid, int slotNo)
+ {
+ CEquipment* pEquipment = getEquipment(eqid);
+ if (pEquipment == nullptr) return false;
+
+ CSlot* pSlot = pEquipment->getSlotWithNo(slotNo);
+ if (pSlot == nullptr) return false;
+ if (m_bufGlass.empty()) return false;
+
+ CGlass* pGlass = m_bufGlass.front();
+ m_bufGlass.pop_front();
+ if (pGlass == nullptr) return false;
+ pSlot->setContext(pGlass);
+ pGlass->release();
+
+ m_bDataModify = TRUE;
+ if (m_listener.onEqDataChanged != nullptr) {
+ m_listener.onEqDataChanged(this, pEquipment, 0);
+ }
+
+ return true;
+ }
}
--
Gitblit v1.9.3