From 2d25068c16bd644c24754eb42086a24a415b7837 Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期一, 20 一月 2025 16:22:01 +0800
Subject: [PATCH] 1.SECS通讯, 实现S2F13（Equipment Constant Request）的回复，目前仅返回模拟结果，真实数据待机器端确认后再返回真实数据。
---
SourceCode/Bond/Servo/HsmsPassive.cpp | 109 ++++++++++++++++++++++++++++++++++++++++++++++++++----
1 files changed, 100 insertions(+), 9 deletions(-)
diff --git a/SourceCode/Bond/Servo/HsmsPassive.cpp b/SourceCode/Bond/Servo/HsmsPassive.cpp
index 0362da8..4bf20df 100644
--- a/SourceCode/Bond/Servo/HsmsPassive.cpp
+++ b/SourceCode/Bond/Servo/HsmsPassive.cpp
@@ -38,6 +38,7 @@
m_bCimWorking = FALSE;
m_hCimWorkEvent = ::CreateEvent(NULL, TRUE, FALSE, NULL);
m_nSessionId = 1;
+ m_listener.onEQConstantRequest = nullptr;
InitializeCriticalSection(&m_criticalSection);
}
@@ -59,6 +60,11 @@
m_hCimWorkEvent = NULL;
}
DeleteCriticalSection(&m_criticalSection);
+}
+
+void CHsmsPassive::setListener(SECSListener listener)
+{
+ m_listener.onEQConstantRequest = listener.onEQConstantRequest;
}
void CHsmsPassive::setActionTimeout(int nSecond)
@@ -181,6 +187,9 @@
}
else if (nStream == 1 && pHeader->function == 13) {
replyEstablishCommunications(pMessage);
+ }
+ else if (nStream == 2 && pHeader->function == 13) {
+ replyEquipmentConstant(pMessage);
}
else if (nStream == 2 && pHeader->function == 31) {
replyDatetime(pMessage);
@@ -305,7 +314,7 @@
HSMS_Create1Message(pMessage, m_nSessionId, s, f, systemBytes);
ASSERT(pMessage);
ISECS2Item* pItem = pMessage->getBody();
- pItem->setBinary(ack, pszAckName);
+ pItem->setBinary((const char*)&ack, 1, pszAckName);
m_pPassive->sendMessage(pMessage);
LOGI("<HSMS>[SECS Msg SEND]S%dF%d (SysByte=%u)", s, f, systemBytes);
HSMS_Destroy1Message(pMessage);
@@ -376,6 +385,52 @@
return 0;
}
+// S2F13
+int CHsmsPassive::replyEquipmentConstant(IMessage* pRecv)
+{
+ if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
+ return ER_NOTSELECT;
+ }
+
+
+ // 要获取的常量表表
+ BOOL bCheckData = FALSE;
+ std::vector<unsigned int> ecids;
+ {
+ ISECS2Item* pItem = pRecv->getBody();
+ int ecidSize = pItem->getSubItemSize();
+ for (int i = 0; i < ecidSize; i++) {
+ unsigned short id;
+ if (pItem->getSubItemU2(i, id)) {
+ ecids.push_back((int)id);
+ }
+ }
+ }
+
+
+ // 交由上层应用来获取机器常量值
+ std::vector<unsigned int> ecvs;
+ if (m_listener.onEQConstantRequest != nullptr) {
+ m_listener.onEQConstantRequest(this, ecids, ecvs);
+ }
+
+
+ // 回复
+ IMessage* pMessage = NULL;
+ HSMS_Create1Message(pMessage, m_nSessionId, 1, 14, pRecv->getHeader()->systemBytes);
+ ASSERT(pMessage);
+ ISECS2Item* pItem = pMessage->getBody();
+ for (auto item : ecvs) {
+ pItem->addU2Item(item, "ECV");
+ }
+
+ m_pPassive->sendMessage(pMessage);
+ LOGI("<HSMS>[SECS Msg SEND]S2F14 (SysByte=%u)", pMessage->getHeader()->systemBytes);
+ HSMS_Destroy1Message(pMessage);
+
+ return 0;
+}
+
// S2F31
int CHsmsPassive::replyDatetime(IMessage* pRecv)
{
@@ -384,7 +439,7 @@
}
ISECS2Item* pBody = pRecv->getBody();
if (pBody == nullptr || pBody->getType() != SITYPE::A) ER_PARAM_ERROR;
- char* pszMessage;
+ const char* pszMessage;
if (pBody->getString(pszMessage)) {
// 更新时间
SYSTEMTIME time;
@@ -462,15 +517,46 @@
BOOL bCheckData = FALSE;
- BYTE ALED;
+ const char* ALED;
unsigned int ALID;
+ unsigned int ALEDLEN;
{
ISECS2Item* pItem = pRecv->getBody();
if (pItem->getSubItemSize() < 2) goto MYREPLY;
- if (!pItem->getSubItemBinary(0, ALED)) goto MYREPLY;
+ if (!pItem->getSubItemBinary(0, ALED, ALEDLEN)) goto MYREPLY;
if (!pItem->getSubItemU4(1, ALID)) goto MYREPLY;
bCheckData = TRUE;
- LOGI("EanbleDisableAlarmReport ALED:%d, ALID:%d", ALED, ALID);
+ LOGI("EanbleDisableAlarmReport ALED:0x%02x, ALID:%d", ALED[0], ALID);
+
+ double d;
+ float f;
+ pItem->getSubItemF4(2, f);
+ pItem->getSubItemF8(3, d);
+ LOGI("EanbleDisableAlarmReport d:%lf, f:%f",
+ d, f);
+ /*
+ unsigned long long n1;
+ unsigned int n2;
+ unsigned short n3;
+ unsigned char n4;
+ long long sn1;
+ int sn2;
+ short sn3;
+ char sn4;
+ pItem->getSubItemU8(2, n1);
+ pItem->getSubItemU4(3, n2);
+ pItem->getSubItemU2(4, n3);
+ pItem->getSubItemU1(5, n4);
+ pItem->getSubItemI8(6, sn1);
+ pItem->getSubItemI4(7, sn2);
+ pItem->getSubItemI2(8, sn3);
+ pItem->getSubItemI1(9, sn4);
+
+ LOGI("EanbleDisableAlarmReport n1:%llu, n2:%u, n3:%hu, n4:%hhu",
+ n1, n2, n3, n4);
+ LOGI("EanbleDisableAlarmReport sn1:%lld, sn2:%d, sn3:%hd, sn4:%hhd",
+ sn1, sn2, sn3, sn4);
+ */
}
@@ -494,6 +580,10 @@
ISECS2Item* pItem = pMessage->getBody();
pItem->addItem("banana1", "PPID1");
pItem->addItem("banana2", "PPID2");
+ pItem->addF8Item(-123.45, "PPID2");
+ pItem->addF4Item(-568.99f, "PPID2");
+ pItem->addF8Item(456.456, "PPID2");
+ pItem->addF4Item(123.123f, "PPID2");
m_pPassive->sendMessage(pMessage);
LOGI("<HSMS>[SECS Msg SEND]S7F20 (SysByte=%u)", pMessage->getHeader()->systemBytes);
HSMS_Destroy1Message(pMessage);
@@ -513,15 +603,16 @@
BOOL bCheckData = FALSE;
- BYTE tid;
- char* pszText = nullptr;;
+ const char* tid;
+ unsigned int tidlen;
+ const char* pszText = nullptr;;
{
ISECS2Item* pItem = pRecv->getBody();
if (pItem->getSubItemSize() < 2) goto MYREPLY;
- if (!pItem->getSubItemBinary(0, tid)) goto MYREPLY;
+ if (!pItem->getSubItemBinary(0, tid, tidlen)) goto MYREPLY;
if (!pItem->getSubItemString(1, pszText)) goto MYREPLY;
bCheckData = TRUE;
- LOGI("TerminalDisplay tid:%d, pszText:%s", tid, pszText);
+ LOGI("TerminalDisplay tid:0x%02x, pszText:%s", tid[0], pszText);
m_pModel->notifyText(RX_HSMS_TERMINAL_TEXT, pszText);
}
--
Gitblit v1.9.3