From 0ac6ae25833b16d25e5380176f66d35aa947f85c Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期四, 05 六月 2025 17:17:05 +0800
Subject: [PATCH] 1.EFEM更新信号到LoadPort, Robot, Aligner, Fliper 2.搬送条件,增加Upstream Inline、Upstream Trouble、Interlock、Send Able信号的检测。

---
 SourceCode/Bond/Servo/CEquipment.cpp |   42 ++++++++++++++++++++++++++++++++++++++++--
 1 files changed, 40 insertions(+), 2 deletions(-)

diff --git a/SourceCode/Bond/Servo/CEquipment.cpp b/SourceCode/Bond/Servo/CEquipment.cpp
index 03f4b5d..ad72643 100644
--- a/SourceCode/Bond/Servo/CEquipment.cpp
+++ b/SourceCode/Bond/Servo/CEquipment.cpp
@@ -35,6 +35,7 @@
 		m_bLocalAlarm = FALSE;
 		m_bAutoRecipeChange = FALSE;
 		m_bVCREnable[0] = FALSE;
+		memset(m_bLinkSignal, 0, sizeof(m_bLinkSignal));
 		m_pCclink = nullptr;
 		m_nBaseAlarmId = 0;
 		m_pArm = nullptr;
@@ -363,9 +364,20 @@
 		}
 		*/
 
-		// 以下解释和处理数据
+		// 连接信号解释和保存
 		BOOL bFlag;
-		int index = 0x540;
+		int index = 0;
+		for (int i = 0; i < 8; i++) {
+			m_bLinkSignal[i][SIGNAL_UPSTREAM_INLINE] = isBitOn(pszData, size, index + 0);
+			m_bLinkSignal[i][SIGNAL_UPSTREAM_TROUBLE] = isBitOn(pszData, size, index + 1);
+			m_bLinkSignal[i][SIGNAL_INTERLOCK] = isBitOn(pszData, size, index + 2);
+			m_bLinkSignal[i][SIGNAL_SEND_ABLE] = isBitOn(pszData, size, index + 3);
+			index += 0x40;
+		}		 
+
+
+		// 其它信号及响应
+		index = 0x540;
 
 
 		// alive
@@ -580,6 +592,28 @@
 	{
 		if (index >= VCR_MAX) return FALSE;
 		return m_bVCREnable[index];
+	}
+
+	BOOL CEquipment::isLinkSignalOn(unsigned int path, unsigned int signal)
+	{
+		if (path >= PATH_MAX) return FALSE;
+		if (signal >= SIGNAL_MAX) return FALSE;
+		return m_bLinkSignal[path][signal];
+	}
+
+	void CEquipment::setLinkSignal(unsigned int path, unsigned int signal, BOOL bOn)
+	{
+		if (path >= PATH_MAX) return;
+		if (signal >= SIGNAL_MAX) return;
+		m_bLinkSignal[path][signal] = bOn;
+	}
+
+	void CEquipment::setLinkSignalBlock(unsigned int path, BOOL* pSignal)
+	{
+		if (path >= PATH_MAX) return;
+		for (int i = 0; i < SIGNAL_MAX; i++) {
+			m_bLinkSignal[path][i] = pSignal[i];
+		}
 	}
 
 	int CEquipment::onStepEvent(CStep* pStep, int code)
@@ -1114,6 +1148,10 @@
 			if (m_slot[i].isLock()) continue;
 			CGlass* pGlass = (CGlass*)m_slot[i].getContext();
 			if (pGlass == nullptr) continue;
+			if(!m_bLinkSignal[i][SIGNAL_UPSTREAM_INLINE]
+				|| m_bLinkSignal[i][SIGNAL_UPSTREAM_TROUBLE]
+				|| !m_bLinkSignal[i][SIGNAL_INTERLOCK]
+				|| !m_bLinkSignal[i][SIGNAL_SEND_ABLE] ) continue;
 
 			MaterialsType glassType = pGlass->getType();
 			if (glassType == MaterialsType::G1 && putSlotType == MaterialsType::G2) continue;

--
Gitblit v1.9.3