From 697fa6b857fe202fe2e5f50d4ecf2c7268e527cc Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期五, 15 八月 2025 15:22:19 +0800
Subject: [PATCH] 1.变量(代EAP查询的数据)增加列表类型; 2.实现ProcessJob Queued上报功能;

---
 SourceCode/Bond/Servo/CLoadPort.cpp |  279 ++++++++++++++++++++++++++++++++++++++++++++-----------
 1 files changed, 221 insertions(+), 58 deletions(-)

diff --git a/SourceCode/Bond/Servo/CLoadPort.cpp b/SourceCode/Bond/Servo/CLoadPort.cpp
index cee42a2..28ce403 100644
--- a/SourceCode/Bond/Servo/CLoadPort.cpp
+++ b/SourceCode/Bond/Servo/CLoadPort.cpp
@@ -2,27 +2,21 @@
 #include "CLoadPort.h"
 #include "CGlassPool.h"
 #include "Servo.h"
+#include "ServoCommo.h"
 
-
-#define CHECK_READ_STEP_SIGNAL2(addr, data, size) {							\
-	BOOL bFlag = isBitOn(data, size, addr);									\
-	SERVO::CStep* pStep = getStep(addr);									\
-	if (pStep != nullptr) {													\
-		((CReadStep*)pStep)->onReadSignal(bFlag ? addr : 0);				\
-	}																		\
-}
 
 namespace SERVO {
 	CLoadPort::CLoadPort() : CEquipment()
 	{
 		m_nIndex = 0;
-		m_portType = PortType::Loading;
-		m_portMode = PortMode::ReadyToLoad;
+		m_portType = PortType::Both;
+		m_portMode = PortMode::OutOfService;
 		m_cassetteType = CassetteType::G1;
 		m_transferMode = TransferMode::AGVMode;
 		m_bEnable = FALSE;
 		m_bAutoChangeEnable = FALSE;
 		m_nNextCassetteSequenceNo = 0;
+		m_isCompareMapsBeforeProceeding = FALSE;
 	}
 
 	CLoadPort::~CLoadPort()
@@ -75,15 +69,15 @@
 
 		{
 			// Cassette Ctrl Cmd
-			static char* pszName[] = { STEP_EQ_P1_CASSETTE_CTRL_CMD,	STEP_EQ_P2_CASSETTE_CTRL_CMD, STEP_EQ_P3_CASSETTE_CTRL_CMD,	STEP_EQ_P4_CASSETTE_CTRL_CMD };
-			static int writeSignalDev[] = { 0x120, 0x121, 0x122, 0x123 };
+			static char* pszName[] = { STEP_EQ_P1_CASSETTE_CTRL_CMD, STEP_EQ_P2_CASSETTE_CTRL_CMD, STEP_EQ_P3_CASSETTE_CTRL_CMD, STEP_EQ_P4_CASSETTE_CTRL_CMD };
+			static int writeSignalDev[] = { 0x130, 0x131, 0x132, 0x133 };
 			static int dev[] = { 0x45, 0x1a5, 0x305, 0x465 };
-			static int addr[] = { 0x480, 0x481, 0x482, 0x483 };
+			static int addr[] = { STEP_ID_PROT1_CASSETTE_CTR_CMD_REPLY, STEP_ID_PROT2_CASSETTE_CTR_CMD_REPLY, STEP_ID_PROT3_CASSETTE_CTR_CMD_REPLY, STEP_ID_PROT4_CASSETTE_CTR_CMD_REPLY };
 
-			CEqCassetteCtrlCmdStep* pStep = new CEqCassetteCtrlCmdStep();
+			CEqWriteStep* pStep = new CEqWriteStep();
 			pStep->setName(pszName[m_nIndex]);
 			pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
-			pStep->setCtrlCmdDev(dev[m_nIndex]);
+			pStep->setDataDev(dev[m_nIndex]);
 			if (addStep(addr[m_nIndex], pStep) != 0) {
 				delete pStep;
 			}
@@ -121,6 +115,7 @@
 				[&](void* pFrom, int code, const char* pszData, size_t size) -> int {
 					if (code == ROK && pszData != nullptr && size > 0) {
 						m_portMode = (PortMode)CToolUnits::toInt16(pszData);
+						LOGI("<LoadPort-%d>m_portMode:%d", m_nIndex, m_portMode);
 					}
 					return 0;
 				});
@@ -141,7 +136,7 @@
 			CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], sizeof(short),
 				[&](void* pFrom, int code, const char* pszData, size_t size) -> int {
 					if (code == ROK && pszData != nullptr && size > 0) {
-						m_cassetteType = (CassetteType)CToolUnits::toInt16(pszData);
+						//m_cassetteType = (CassetteType)CToolUnits::toInt16(pszData);
 					}
 					return 0;
 				});
@@ -316,12 +311,12 @@
 			};
 			static int dev[] = { 0x6050, 0x6070, 0x6090, 0x60b0 };
 			static int writeSignalDev[6][4] = {
+				{0xc8, 0xc9, 0xca, 0xcb},
+				{0xd0, 0xd1, 0xd2, 0xd3},
 				{0xd8, 0xd9, 0xda, 0xdb},
 				{0xe0, 0xe1, 0xe2, 0xe3},
 				{0xe8, 0xe9, 0xea, 0xeb},
-				{0xf0, 0xf1, 0xf2, 0xf3},
-				{0xf8, 0xf9, 0xfa, 0xfb},
-				{0x100, 0x101, 0x102, 0x103}
+				{0xf0, 0xf1, 0xf2, 0xf3}
 			};
 			static int addr[6][4] = {
 				{ STEP_ID_PORT1_EMPTY, STEP_ID_PORT2_EMPTY, STEP_ID_PORT3_EMPTY, STEP_ID_PORT4_EMPTY },
@@ -337,6 +332,7 @@
 					[&](void* pFrom, int code, const char* pszData, size_t size) -> int {
 						if (code == ROK && pszData != nullptr && size > 0) {
 							decodePortStatusReport((CStep*)pFrom, pszData, size);
+							return 0;
 						}
 						return -1;
 					});
@@ -353,6 +349,48 @@
 	void CLoadPort::onTimer(UINT nTimerid)
 	{
 		CEquipment::onTimer(nTimerid);
+
+
+		// 从配置读出的enable,初始化时写给efem
+		static int i_enable[4] = { 0 };
+		if ((++i_enable[m_nIndex]) == 10 + m_nIndex) {
+			eablePort(m_bEnable, [&](int code) -> int {
+				LOGI("<LoadPort-%d>eablePort:code=%d", m_nIndex, code);
+				return 0;
+				});
+		}
+
+
+
+		// 模拟测试
+		if (m_nIndex == 0) {
+			static int ii = 0;
+			ii++;
+			if (ii == 50) {
+				char szBuffer[64] = {0};
+				CStep* pStep = getStepWithName(STEP_EQ_PORT1_INUSE);
+				CPortStatusReport portStatusReport;
+				portStatusReport.setPortStatus(PORT_INUSE);
+				portStatusReport.setJobExistenceSlot(0xf);
+				portStatusReport.setCassetteId("CID1001");
+				int nRet = portStatusReport.serialize(szBuffer, 64);
+				decodePortStatusReport(pStep, szBuffer, 64);
+			}
+		}
+		if (m_nIndex == 1) {
+			static int ii = 0;
+			ii++;
+			if (ii == 55) {
+				char szBuffer[64] = { 0 };
+				CStep* pStep = getStepWithName(STEP_EQ_PORT2_INUSE);
+				CPortStatusReport portStatusReport;
+				portStatusReport.setPortStatus(PORT_INUSE);
+				portStatusReport.setJobExistenceSlot(0xf);
+				portStatusReport.setCassetteId("CID1004");
+				int nRet = portStatusReport.serialize(szBuffer, 64);
+				decodePortStatusReport(pStep, szBuffer, 64);
+			}
+		}
 	}
 
 	void CLoadPort::serialize(CArchive& ar)
@@ -361,23 +399,11 @@
 
 		if (ar.IsStoring()) {
 			ar << m_nIndex;
-			//ar << (int)m_portType;
-			//ar << (int)m_portMode;
-			//ar << (int)m_cassetteType;
-			//ar << (int)m_transferMode;
-			//ar << m_bEnable;
-			//ar << m_bAutoChangeEnable;
 			m_portStatusReport.serialize(ar);
 		}
 		else {
 			int temp;
 			ar >> m_nIndex;
-			//ar >> temp; m_portType = (PortType)temp;
-			//ar >> temp; m_portMode = (PortMode)temp;
-			//ar >> temp; m_cassetteType = (CassetteType)temp;
-			//ar >> temp; m_transferMode = (TransferMode)temp;
-			//ar >> m_bEnable;
-			//ar >> m_bAutoChangeEnable;
 			m_portStatusReport.serialize(ar);
 		}
 	}
@@ -414,17 +440,25 @@
 		int jobExistenceSize,
 		short slotProcess,
 		short jopCount,
-		CJobDataA* pJobDataA)
+		CJobDataA* pJobDataA,
+		ONWRITED onWritedBlock)
 	{
-		int id = getID();
-		if ( !(id == EQ_ID_LOADPORT1 || id == EQ_ID_LOADPORT2) ) {
-			return -1;
+		SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getCassetteCtrlCmdStep();
+		ASSERT(pStep);
+
+		char szBuffer[1024] = { 0 };
+		memcpy(&szBuffer[0], &cmd, sizeof(short));
+		if (jobExistence != nullptr && jobExistenceSize == 12) {
+			memcpy(&szBuffer[2], jobExistence, sizeof(short) * jobExistenceSize);
 		}
 
+		memcpy(&szBuffer[26], &slotProcess, sizeof(short));
+		memcpy(&szBuffer[36], &jopCount, sizeof(short));
+		if (pJobDataA != nullptr) {
+			pJobDataA->serialize(&szBuffer[38], 1024 - 38);
+		}
 
-		SERVO::CEqCassetteCtrlCmdStep* pStep = (SERVO::CEqCassetteCtrlCmdStep*)getCassetteCtrlCmdStep();
-		ASSERT(pStep);
-		return pStep->sendCtrlCmd(cmd, jobExistence, jobExistenceSize, slotProcess, jopCount, pJobDataA);
+		return pStep->writeDataEx(szBuffer, 352 * 2, onWritedBlock);
 	}
 
 	CStep* CLoadPort::getCassetteCtrlCmdStep()
@@ -846,12 +880,12 @@
 		static int autoType[] = { STEP_ID_PORT1_TYPE_AUTO_CHANGE, STEP_ID_PORT2_TYPE_AUTO_CHANGE,
 			STEP_ID_PORT3_TYPE_AUTO_CHANGE, STEP_ID_PORT4_TYPE_AUTO_CHANGE };
 
-		CHECK_READ_STEP_SIGNAL2(type[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(mode[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(cassetteType[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(transferMode[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(enable[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(autoType[m_nIndex], pszData, size);
+		CHECK_READ_STEP_SIGNAL(type[m_nIndex], pszData, size);
+		CHECK_READ_STEP_SIGNAL(mode[m_nIndex], pszData, size);
+		CHECK_READ_STEP_SIGNAL(cassetteType[m_nIndex], pszData, size);
+		CHECK_READ_STEP_SIGNAL(transferMode[m_nIndex], pszData, size);
+		CHECK_READ_STEP_SIGNAL(enable[m_nIndex], pszData, size);
+		CHECK_READ_STEP_SIGNAL(autoType[m_nIndex], pszData, size);
 
 
 		static int typeReply[] = { STEP_ID_PROT1_TYPE_CHANGE_REPLY, STEP_ID_PROT2_TYPE_CHANGE_REPLY,
@@ -867,12 +901,12 @@
 		static int cassetteTypeReply[] = { STEP_ID_PROT1_CASSETTE_TYPE_CHANGE_REPLY, STEP_ID_PROT2_CASSETTE_TYPE_CHANGE_REPLY,
 			STEP_ID_PROT3_CASSETTE_TYPE_CHANGE_REPLY, STEP_ID_PROT4_CASSETTE_TYPE_CHANGE_REPLY };
 
-		CHECK_READ_STEP_SIGNAL2(typeReply[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(modeReply[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(transferModeReply[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(enableModeReply[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(typeAutoReply[m_nIndex], pszData, size);
-		CHECK_READ_STEP_SIGNAL2(cassetteTypeReply[m_nIndex], pszData, size);
+		CHECK_WRITE_STEP_SIGNAL(typeReply[m_nIndex], pszData, size);
+		CHECK_WRITE_STEP_SIGNAL(modeReply[m_nIndex], pszData, size);
+		CHECK_WRITE_STEP_SIGNAL(transferModeReply[m_nIndex], pszData, size);
+		CHECK_WRITE_STEP_SIGNAL(enableModeReply[m_nIndex], pszData, size);
+		CHECK_WRITE_STEP_SIGNAL(typeAutoReply[m_nIndex], pszData, size);
+		CHECK_WRITE_STEP_SIGNAL(cassetteTypeReply[m_nIndex], pszData, size);
 	}
 
 	int CLoadPort::decodePortStatusReport(CStep* pStep, const char* pszData, size_t size)
@@ -883,15 +917,47 @@
 		m_portStatusReport.copyEx(portStatusReport);
 
 
+		// 当port状态为InUse, 比较map
+		if (m_portStatusReport.getPortStatus() == PORT_INUSE) {
+			if (m_isCompareMapsBeforeProceeding) {
+				short scanMap = getScanCassetteMap();
+				short downloadMap = getDownloadCassetteMap();
+				if (scanMap == downloadMap) {
+					generateGlassList(scanMap);
+					this->sendCassetteCtrlCmd(CCC_PROCESS_START, nullptr, 0, 0, 0, nullptr, nullptr);
+				}
+				else {
+					this->sendCassetteCtrlCmd(CCC_PROCESS_CANCEL, nullptr, 0, 0, 0, nullptr, nullptr);
+
+					// 抛出到应用层做提示
+					if (m_listener.onMapMismatch != nullptr) {
+						m_listener.onMapMismatch(this, scanMap, downloadMap);
+					}
+				}
+			}
+			else {
+				// 抛出到应用层做选择要加工的片子
+				generateGlassList(getScanCassetteMap());
+			}
+		}
+		if (m_listener.onPortStatusChanged != nullptr) {
+			m_listener.onPortStatusChanged(this, portStatusReport.getPortStatus(),
+				getScanCassetteMap());
+		}
+
+
 		// 缓存Attribute,用于调试时显示信息
 		unsigned int weight = 201;
-		CAttributeVector attrubutes;
+		CAttributeVector& attrubutes = pStep->attributeVector();
 		m_portStatusReport.getAttributeVector(attrubutes, weight);
-		pStep->addAttributeVector(attrubutes);
 
-
-		LOGI("<CCassetteTranserStateStep>decodePortStatusReport<Status:%d, CassetteSequenceNo:%d>",
-			m_portStatusReport.getPortStatus(), m_portStatusReport.getCassetteSequenceNo());
+		LOGI("<CCassetteTranserStateStep>decodePortStatusReport<Status:%d, CassetteSequenceNo:%d, CassetteId:%s>",
+			m_portStatusReport.getPortStatus(), m_portStatusReport.getCassetteSequenceNo(), 
+			m_portStatusReport.getCassetteId().c_str());
+		if (m_portStatusReport.getPortStatus() == 3) {
+			LOGI("<CCassetteTranserStateStep>InUse<JobExistenceSlot:%d>",
+				m_portStatusReport.getJobExistenceSlot());
+		}
 
 
 		return nRet;
@@ -987,6 +1053,7 @@
 
 	int CLoadPort::setCassetteType(CassetteType type, ONWRITED onWritedBlock/* = nullptr*/)
 	{
+		m_cassetteType = type;
 		static char* pszName[] = { STEP_PORT1_CASSETTE_TYPE_CHANGE, STEP_PORT2_CASSETTE_TYPE_CHANGE, STEP_PORT3_CASSETTE_TYPE_CHANGE, STEP_PORT4_CASSETTE_TYPE_CHANGE };
 		SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(pszName[m_nIndex]);
 		if (pStep == nullptr) {
@@ -999,7 +1066,6 @@
 			// test
 			code = WOK;
 			if (code == WOK) {
-				m_cassetteType = type;
 				LOGI("<CLoadPort-%d>设置Cassette Type成功.", m_nIndex);
 			}
 			else {
@@ -1102,6 +1168,18 @@
 		m_bAutoChangeEnable = bEnable;
 	}
 
+	short CLoadPort::getScanCassetteMap()
+	{
+		return m_portStatusReport.getJobExistenceSlot();
+	}
+
+	short CLoadPort::getDownloadCassetteMap()
+	{
+		// 暂时未实现此功能
+		short map = 0;
+		return map;
+	}
+
 	/*
 	 * 生成测试用的玻璃列表
 	 */
@@ -1117,18 +1195,18 @@
 
 
 		char szBuffer[64];
-		for (int i = 0; i < 1; i++) {
+		for (int i = 0; i < SLOT_MAX; i++) {
 			if (!m_slot[i].isEnable()) continue;
 
 			CJobDataS js;
 			js.setCassetteSequenceNo(getNextCassetteSequenceNo());
 			js.setJobSequenceNo(m_slot[i].getNo());
 			sprintf_s(szBuffer, 64, "%05d%05d", js.getCassetteSequenceNo(), js.getJobSequenceNo());
-			//js.setGlass1Id(szBuffer);
 			js.setJobType(1);
 			js.setMaterialsType((int)type);
 
 			CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
+			pGlass->setOriginPort(m_nIndex, i);
 			pGlass->addPath(m_nID, 0);
 			pGlass->processEnd(m_nID, 0);
 			pGlass->setID(szBuffer);
@@ -1140,4 +1218,89 @@
 		return 0;
 	}
 
+	/*
+	 * 根据efem扫描到的map,生成玻璃列表
+	 */
+	int CLoadPort::generateGlassList(short map)
+	{
+		// 先释放较早前的数据
+		Lock();
+		for (int i = 0; i < SLOT_MAX; i++) {
+			m_slot[i].setContext(nullptr);
+		}
+		Unlock();
+
+
+		// 根据map生成新的
+		char szBuffer[64];
+		for (int i = 0; i < SLOT_MAX; i++) {
+			if (!m_slot[i].isEnable()) continue;
+			if (!(map >> i) & 1) continue;
+
+			CJobDataS js;
+			js.setCassetteSequenceNo(getNextCassetteSequenceNo());
+			js.setJobSequenceNo(m_slot[i].getNo());
+			sprintf_s(szBuffer, 64, "%05d%05d", js.getCassetteSequenceNo(), js.getJobSequenceNo());
+			js.setJobType(1);
+			js.setMaterialsType((int)m_cassetteType);
+
+			CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
+			pGlass->setOriginPort(m_nIndex, i);
+			pGlass->setScheduledForProcessing(i % 2 == 1);
+			pGlass->addPath(m_nID, 0);
+			pGlass->processEnd(m_nID, 0);
+			pGlass->setID(szBuffer);
+			pGlass->setType(m_cassetteType);
+			pGlass->setJobDataS(&js);
+			m_slot[i].setContext(pGlass);
+		}
+
+		return 0;
+	}
+
+
+	int CLoadPort::testGenerateGlassListFromConfig(const SERVO::PortConfig& config)
+	{
+		char szBuffer[64];
+		for (const auto& slot : config.vecSlot) {
+			int nSlotIndex = slot.nSlotID - 1;
+			if (nSlotIndex < 0 || nSlotIndex >= SLOT_MAX) {
+				continue;
+			}
+			if (!slot.isEnabled) {
+				m_slot[nSlotIndex].setContext(nullptr);
+				continue;
+			}
+
+			CJobDataS js;
+			js.setCassetteSequenceNo(getNextCassetteSequenceNo());
+			js.setJobSequenceNo(m_slot[nSlotIndex].getNo());
+
+			sprintf_s(szBuffer, 64, "%05d%05d", js.getCassetteSequenceNo(), js.getJobSequenceNo());
+			js.setJobType(1);
+			js.setMaterialsType(config.nMaterialType);
+
+			js.setLotId(config.strLotID.c_str());
+			js.setProductId(config.strProductID.c_str());
+			js.setOperationId(config.strOperationID.c_str());
+			js.setGlass1Id(szBuffer);
+
+			CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
+			pGlass->setOriginPort(m_nIndex, nSlotIndex);
+			pGlass->addPath(m_nID, 0);
+			pGlass->processEnd(m_nID, 0);
+			pGlass->setID(szBuffer);
+			pGlass->setType(static_cast<SERVO::MaterialsType>(config.nMaterialType));
+			pGlass->setJobDataS(&js);
+
+			m_slot[nSlotIndex].setContext(pGlass);
+		}
+
+		return 0;
+	}
+
+	void CLoadPort::setCompareMapsBeforeProceeding(BOOL bCompare)
+	{
+		m_isCompareMapsBeforeProceeding = bCompare;
+	}
 }

--
Gitblit v1.9.3