From e7a450d2fdc99bd501e1af7dd7c16c477cfea75e Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期六, 15 三月 2025 11:56:44 +0800
Subject: [PATCH] 1.CimMessageClear(清除Cim消息)测试通过； 2.增加VCREanbleStep(启用/禁用)VCR;
---
SourceCode/Bond/Servo/CEquipment.cpp | 288 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1 files changed, 285 insertions(+), 3 deletions(-)
diff --git a/SourceCode/Bond/Servo/CEquipment.cpp b/SourceCode/Bond/Servo/CEquipment.cpp
index 6f8cd0b..7ef517b 100644
--- a/SourceCode/Bond/Servo/CEquipment.cpp
+++ b/SourceCode/Bond/Servo/CEquipment.cpp
@@ -1,26 +1,120 @@
#include "stdafx.h"
#include "CEquipment.h"
+#include "ToolUnits.h"
+
namespace SERVO {
- CEquipment::CEquipment()
+ CEquipment::CEquipment() : m_nID(0), m_strName(""), m_strDescription(""), m_station(0, 255)
{
+ m_listener = { nullptr, nullptr };
+ m_alive = {FALSE, 0, FALSE};
+ m_bCimState = FALSE;
+ m_bUpstreamInline = FALSE;
+ m_bDownstreamInline = FALSE;
+ m_bLocalAlarm = FALSE;
+ m_bAutoRecipeChange = FALSE;
+ m_bVCREnable[0] = FALSE;
+ m_pCclink = nullptr;
+ m_nBaseAlarmId = 0;
InitializeCriticalSection(&m_criticalSection);
}
CEquipment::~CEquipment()
{
+ for (auto item : m_mapStep) {
+ delete item.second;
+ }
+ m_mapStep.clear();
+
DeleteCriticalSection(&m_criticalSection);
+ }
+
+ void CEquipment::setListener(EquipmentListener listener)
+ {
+ m_listener.onAlive = listener.onAlive;
+ m_listener.onCimStateChanged = listener.onCimStateChanged;
+ }
+
+ void CEquipment::setCcLink(CCCLinkIEControl* pCcLink)
+ {
+ m_pCclink = pCcLink;
+ }
+
+ void CEquipment::setBaseAlarmId(int nBaseId)
+ {
+ m_nBaseAlarmId = nBaseId;
+ }
+
+ int CEquipment::getBaseAlarmId()
+ {
+ return m_nBaseAlarmId;
+ }
+
+ void CEquipment::getProperties(std::vector<std::pair<std::string, std::string>>& container)
+ {
+ container.clear();
+ // 示例：将一些属性添加到容器
+ container.push_back(std::make_pair("DeviceName", "ServoMotor"));
+ container.push_back(std::make_pair("SerialNumber", "123456789"));
+ container.push_back(std::make_pair("Version", "1.0"));
+ }
+
+ std::map<unsigned int, CStep*>& CEquipment::getSteps()
+ {
+ return m_mapStep;
+ }
+
+ CStep* CEquipment::getStep(unsigned int addr)
+ {
+ auto iter = m_mapStep.find(addr);
+ if (iter == m_mapStep.end()) return nullptr;
+ return iter->second;
+ }
+
+ CStep* CEquipment::getStepWithName(const char* pszName)
+ {
+ for (auto item : m_mapStep) {
+ if (item.second->getName().compare(pszName) == 0) {
+ return item.second;
+ }
+ }
+
+ return nullptr;
+ }
+
+ int CEquipment::addStep(unsigned int addr, CStep* pStep)
+ {
+ auto iter = m_mapStep.find(addr);
+ if (iter != m_mapStep.end()) return -1;
+ pStep->setEquipment(this);
+ pStep->setCcLink(m_pCclink);
+ m_mapStep[addr] = pStep;
+ return 0;
}
void CEquipment::init()
{
-
+ for (auto item : m_mapStep) {
+ item.second->init();
+ }
}
void CEquipment::term()
{
+ for (auto item : m_mapStep) {
+ item.second->term();
+ }
+ }
+ void CEquipment::setID(int nID)
+ {
+ m_nID = nID;
+ }
+
+ int CEquipment::getID()
+ {
+ return m_nID;
}
void CEquipment::setName(const char* pszName)
@@ -54,12 +148,46 @@
return m_station;
}
+ void CEquipment::getAttributeVector(CAttributeVector& attrubutes)
+ {
+ attrubutes.clear();
+ attrubutes.addAttribute(new CAttribute("Network",
+ std::to_string(m_station.nNetNo).c_str(), ""));
+ attrubutes.addAttribute(new CAttribute("Station",
+ std::to_string(m_station.nStNo).c_str(), ""));
+ attrubutes.addAttribute(new CAttribute("ID",
+ std::to_string(m_nID).c_str(), ""));
+ attrubutes.addAttribute(new CAttribute("Name",
+ m_strName.c_str(), ""));
+ attrubutes.addAttribute(new CAttribute("Description",
+ m_strDescription.c_str(), ""));
+ attrubutes.addAttribute(new CAttribute("Alive",
+ this->isAlive() ? _T("TRUE") : _T("FALSE"), ""));
+ attrubutes.addAttribute(new CAttribute("CIM State",
+ m_bCimState ? _T("ON") : _T("OFF"), ""));
+ attrubutes.addAttribute(new CAttribute("Upstream",
+ m_bUpstreamInline ? _T("Inline") : _T("Offline"), ""));
+ attrubutes.addAttribute(new CAttribute("Downstream",
+ m_bDownstreamInline ? _T("Inline") : _T("Offline"), ""));
+ attrubutes.addAttribute(new CAttribute("Local Alarm",
+ m_bLocalAlarm ? _T("TRUE") : _T("FALSE"), ""));
+ attrubutes.addAttribute(new CAttribute("Auto Recipe Change",
+ m_bAutoRecipeChange ? _T("TRUE") : _T("FALSE"), ""));
+ char szTemp[256];
+ for (int i = 0; i < VCR_MAX; i++) {
+ sprintf_s(szTemp, 256, "VCR-%d", i + 1);
+ attrubutes.addAttribute(new CAttribute(szTemp,
+ m_bVCREnable[i] ? _T("Enable") : _T("Disable"), ""));
+ }
+ }
+
void CEquipment::setReadBitBlock(unsigned int start, unsigned int end)
{
- m_blockReadBit.type = (unsigned int)DeviceType::LB;;
+ m_blockReadBit.type = (unsigned int)DeviceType::B;
m_blockReadBit.start = start;
m_blockReadBit.end = end;
m_blockReadBit.size = (m_blockReadBit.end - m_blockReadBit.start + 1) / 8;
+ ASSERT(m_blockReadBit.size < BLOCK_BUFFER_MAX);
}
MemoryBlock& CEquipment::getReadBitBlock()
@@ -82,7 +210,19 @@
void CEquipment::onTimer(UINT nTimerid)
{
+ // 每隔一秒，检查一下ALIVE状态
+ static int tick = 0;
+ tick++;
+ if (tick % (4 * 1) == 0) {
+ m_alive.count++;
+ if (m_alive.alive && m_alive.count > ALIVE_TIMEOUT) {
+ m_alive.alive = FALSE;
+ if (m_listener.onAlive != nullptr) {
+ m_listener.onAlive(this, m_alive.alive);
+ }
+ }
+ }
}
void CEquipment::serialize(CArchive& ar)
@@ -90,4 +230,146 @@
}
+ void CEquipment::onReceiveLBData(const char* pszData, size_t size)
+ {
+ /*
+ TRACE("%s onReceiveLBData: %d bytes\n", m_strName.c_str(), size);
+ for (unsigned int i = 0; i < size; i++) {
+ if (pszData[i] != 0)
+ TRACE("%d[%x]\n", i, pszData[i]);
+ }
+ */
+
+ // 以下解释和处理数据
+ BOOL bFlag;
+ int index = 0x340;
+
+
+ // alive
+ bFlag = isBitOn(pszData, size, index);
+ if (!equalBool(m_alive.flag, bFlag)) {
+ m_alive.flag = bFlag;
+ m_alive.count = 0;
+
+ // 状态
+ if (!m_alive.alive) {
+ m_alive.alive = TRUE;
+ if (m_listener.onAlive != nullptr) {
+ m_listener.onAlive(this, m_alive.alive);
+ }
+ }
+ }
+
+ // CIM State
+ bFlag = isBitOn(pszData, size, ++index);
+ if (!equalBool(m_bCimState, bFlag)) {
+ m_bCimState = bFlag;
+ if (m_listener.onCimStateChanged != nullptr) {
+ m_listener.onCimStateChanged(this, m_bCimState);
+ }
+ }
+
+ // UpstreamInline
+ bFlag = isBitOn(pszData, size, ++index);
+ if (!equalBool(m_bUpstreamInline, bFlag)) {
+ m_bUpstreamInline = bFlag;
+ }
+
+ // DownstreamInline
+ bFlag = isBitOn(pszData, size, ++index);
+ if (!equalBool(m_bDownstreamInline, bFlag)) {
+ m_bDownstreamInline = bFlag;
+ }
+
+ // LocalAlarm
+ bFlag = isBitOn(pszData, size, ++index);
+ if (!equalBool(m_bLocalAlarm, bFlag)) {
+ m_bLocalAlarm = bFlag;
+ }
+
+ // AutoRecipeChange
+ bFlag = isBitOn(pszData, size, ++index);
+ if (!equalBool(m_bAutoRecipeChange, bFlag)) {
+ m_bAutoRecipeChange = bFlag;
+ }
+
+ // AutoRecipeChange
+ bFlag = isBitOn(pszData, size, ++index);
+ if (!equalBool(m_bVCREnable[0], bFlag)) {
+ m_bVCREnable[0] = bFlag;
+ }
+
+
+ // 以下根据信号做流程处理
+ CStep* pStep;
+
+ // Equipment Mode Change Report(0x360)
+ // Equipment Status Change Report(0x361)
+ // Equipment Alarm Change Report(0x362 ~ 0x366)
+ for (int i = 0; i < 7; i++) {
+ index = 0x360 + i;;
+ bFlag = isBitOn(pszData, size, index);
+ pStep = getStep(index);
+ if (pStep != nullptr) {
+ ((CReadStep*)pStep)->onReadSignal(bFlag);
+ }
+ }
+
+ index = 0x350;
+ bFlag = isBitOn(pszData, size, index);
+ pStep = getStep(index);
+ if (pStep != nullptr) {
+ ((CWriteStep*)pStep)->onRecvSignal(bFlag);
+ }
+ }
+
+ BOOL CEquipment::isBitOn(const char* pszData, size_t size, int index)
+ {
+ int byteIndex, bitIndex;
+ byteIndex = (index) / 8;
+ bitIndex = (index) % 8;
+
+ return CToolUnits::getBit(pszData[byteIndex], bitIndex);
+ }
+
+ BOOL CEquipment::equalBool(BOOL b1, BOOL b2)
+ {
+ return (b1 && b2) || (!b1 && !b2);
+ }
+
+ BOOL CEquipment::isAlive()
+ {
+ return m_alive.alive;
+ }
+
+ BOOL CEquipment::isCimOn()
+ {
+ return m_bCimState;
+ }
+
+ BOOL CEquipment::isUpstreamInline()
+ {
+ return m_bUpstreamInline;
+ }
+
+ BOOL CEquipment::isDownstreamInline()
+ {
+ return m_bDownstreamInline;
+ }
+
+ BOOL CEquipment::isLocalAlarm()
+ {
+ return m_bLocalAlarm;
+ }
+
+ BOOL CEquipment::isAutoRecipeChange()
+ {
+ return m_bAutoRecipeChange;
+ }
+
+ BOOL CEquipment::isVCREnable(unsigned int index)
+ {
+ if (index >= VCR_MAX) return FALSE;
+ return m_bVCREnable[index];
+ }
}
--
Gitblit v1.9.3