From 8f0460c03589056aec7643c8ef625a207ae49f4d Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期二, 18 二月 2025 16:07:36 +0800
Subject: [PATCH] 1.添加Cim State

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

diff --git a/SourceCode/Bond/Servo/CEquipment.cpp b/SourceCode/Bond/Servo/CEquipment.cpp
index 6534f88..29a448d 100644
--- a/SourceCode/Bond/Servo/CEquipment.cpp
+++ b/SourceCode/Bond/Servo/CEquipment.cpp
@@ -7,8 +7,9 @@
 
 	CEquipment::CEquipment()
 	{
+		m_listener = { nullptr, nullptr };
 		m_alive = {FALSE, 0, FALSE};
-		m_listener.onAlive = {nullptr};
+		m_bCimState = FALSE;
 		InitializeCriticalSection(&m_criticalSection);
 	}
 
@@ -20,6 +21,7 @@
 	void CEquipment::setListener(EquipmentListener listener)
 	{
 		m_listener.onAlive = listener.onAlive;
+		m_listener.onCimStateChanged = listener.onCimStateChanged;
 	}
 
 	void CEquipment::init()
@@ -121,7 +123,10 @@
 		}
 
 
-		// 解释数据
+		// 以下解释和处理数据
+
+		// alive
+		/*
 		BOOL bAliveFlag = isBitOn(pszData, size, 0x340);
 		if (m_alive.flag != bAliveFlag) {
 			m_alive.flag = bAliveFlag;
@@ -135,6 +140,15 @@
 				}
 			}
 		}
+		*/
+		// CIM State
+		BOOL bCimState = isBitOn(pszData, size, 0x341);
+		if ((bCimState && !m_bCimState) || (!bCimState && m_bCimState)) {
+			m_bCimState = bCimState;
+			if (m_listener.onCimStateChanged != nullptr) {
+				m_listener.onCimStateChanged(this, m_bCimState);
+			}
+		}
 	}
 
 	BOOL CEquipment::isBitOn(const char* pszData, size_t size, int index)

--
Gitblit v1.9.3