From da2736b59a27593fdac0295a9e6606dbf3dc59db Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期二, 14 一月 2025 17:34:55 +0800
Subject: [PATCH] 1.secs部分单个通讯的回复；
---
SourceCode/Bond/Servo/HsmsPassive.cpp | 241 ++++++++++++++++++++++++++++++++++++++++++++++-
1 files changed, 234 insertions(+), 7 deletions(-)
diff --git a/SourceCode/Bond/Servo/HsmsPassive.cpp b/SourceCode/Bond/Servo/HsmsPassive.cpp
index 22d340d..ab08dae 100644
--- a/SourceCode/Bond/Servo/HsmsPassive.cpp
+++ b/SourceCode/Bond/Servo/HsmsPassive.cpp
@@ -3,6 +3,11 @@
#include "Log.h"
#include "Model.h"
#include "Common.h"
+#include <time.h>
+#include <iostream>
+#include <time.h>
+#include <stdlib.h>
+#include <string.h>
unsigned __stdcall CimWorkThreadFunction(LPVOID lpParam)
@@ -26,11 +31,13 @@
m_pModel = nullptr;
m_nActionTimeout = 6;
m_nSystemByte = 0;
+ m_strEquipmentModelType = "2860";
m_strSoftRev = _T("1.0.1");
m_hCimWorkThreadHandle = NULL;
m_nCimWorkThrdaddr = 0;
m_bCimWorking = FALSE;
m_hCimWorkEvent = ::CreateEvent(NULL, TRUE, FALSE, NULL);
+ m_nSessionId = 1;
InitializeCriticalSection(&m_criticalSection);
}
@@ -59,6 +66,23 @@
m_nActionTimeout = max(3, nSecond);
}
+void CHsmsPassive::setEquipmentModelType(const char* pszMode)
+{
+ m_strEquipmentModelType = pszMode;
+ if (m_strEquipmentModelType.length() > 20) {
+ m_strEquipmentModelType = m_strEquipmentModelType.substr(0, 20);
+ }
+}
+
+void CHsmsPassive::setSoftRev(const char* pszRev)
+{
+ m_strSoftRev = pszRev;
+ if (m_strSoftRev.length() > 20) {
+ m_strSoftRev = m_strSoftRev.substr(0, 20);
+ }
+
+}
+
void CHsmsPassive::OnTimer(UINT nTimerid)
{
// 所有已发送的Action自加1
@@ -78,6 +102,7 @@
int CHsmsPassive::onRecvMsg(IMessage* pMessage)
{
+ LOGI("onRecvMsg:%s", pMessage->toString());
Lock();
CHsmsAction* pAction = nullptr;
for (auto iter = m_listActionSent.begin(); iter != m_listActionSent.end(); iter++) {
@@ -109,7 +134,9 @@
auto onStatusChanged = [&](void* pFrom, STATE state) -> void {
m_pModel->notifyInt(RX_CODE_PASSIVE_STATUS_CHANGED, (int)state);
- // 连上之后发S1F1,
+ // 连上之后发S1F1
+ // 修改为不主动发送，而是响应
+ /*
if (STATE::SELECTED == state) {
m_bAreYouThereRequest = FALSE;
if (!m_bAreYouThereRequest) {
@@ -117,17 +144,20 @@
secsAreYouThereRequest();
}
}
+ */
};
auto onRecvSysMessage = [&](void* pFrom, IMessage* pMessage) -> void {
LOGI("<HSMS>onRecvSysMessage:sessionId:%d, sType:%d systemBytes:%d",
pMessage->getHeader()->sessionId, pMessage->getHeader()->sType, pMessage->getHeader()->systemBytes);
onRecvMsg(pMessage);
if (MSG_LINKTEST_REQ == pMessage->getHeader()->sType) {
+ /*
Sleep(10);
if (!m_bAreYouThereRequest) {
m_bAreYouThereRequest = TRUE;
- secsAreYouThereRequest();
+ requestYouThere();
}
+ */
}
};
@@ -147,7 +177,19 @@
LOGI("<HSMS>收到消息 S%dF%d", nStream, pHeader->function);
if (nStream == 1 && pHeader->function == 1) {
// S1F1
- secsAreYouThereReply(pHeader->sessionId, pHeader->systemBytes);
+ replyAreYouThere(pHeader->systemBytes);
+ }
+ else if (nStream == 1 && pHeader->function == 13) {
+ replyEstablishCommunications(pHeader->systemBytes);
+ }
+ else if (nStream == 2 && pHeader->function == 31) {
+ replyDatetime(pMessage);
+ }
+ else if (nStream == 2 && pHeader->function == 37) {
+ replyEanbleDisableEventReport(pMessage);
+ }
+ else if (nStream == 5 && pHeader->function == 3) {
+ replyEanbleDisableAlarmReport(pMessage);
}
};
@@ -251,7 +293,7 @@
}
// S1F1
-int CHsmsPassive::secsAreYouThereRequest()
+int CHsmsPassive::requestAreYouThere()
{
if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
return ER_NOTSELECT;
@@ -261,7 +303,7 @@
CHsmsAction* pAction = new CHsmsAction(ACTION_HELLO, FALSE, m_nActionTimeout);
m_listAction.push_back(pAction);
IMessage* pMessage = NULL;
- HSMS_Create1Message(pMessage, 0xffff, 1 | REPLY, 1, ++m_nSystemByte);
+ HSMS_Create1Message(pMessage, m_nSessionId, 1 | REPLY, 1, ++m_nSystemByte);
ASSERT(pMessage);
pAction->setSendMessage(pMessage);
@@ -272,14 +314,14 @@
}
// S1F2
-int CHsmsPassive::secsAreYouThereReply(unsigned int sessionId, unsigned int systemBytes)
+int CHsmsPassive::replyAreYouThere(unsigned int systemBytes)
{
if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
return ER_NOTSELECT;
}
IMessage* pMessage = NULL;
- HSMS_Create1Message(pMessage, sessionId, 1, 2, systemBytes);
+ HSMS_Create1Message(pMessage, m_nSessionId, 1, 2, systemBytes);
ASSERT(pMessage);
ISECS2Item* pItem = pMessage->getBody();
@@ -291,3 +333,188 @@
return 0;
}
+
+// S1F14
+int CHsmsPassive::replyEstablishCommunications(unsigned int systemBytes)
+{
+ if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
+ return ER_NOTSELECT;
+ }
+
+ IMessage* pMessage = NULL;
+ HSMS_Create1Message(pMessage, m_nSessionId, 1, 14, systemBytes);
+ ASSERT(pMessage);
+
+ ISECS2Item* pItem = pMessage->getBody();
+ pItem->addBinaryItem(BYTE(0), "COMMACK");
+ ISECS2Item* pList = pItem->addItem();
+ pList->addItem(m_strEquipmentModelType.c_str(), "MDLN");
+ pList->addItem(m_strSoftRev.c_str(), "SOFTREV");
+ m_pPassive->sendMessage(pMessage);
+ LOGI("<HSMS>[SECS Msg SEND]S1F14 (SysByte=%u)", pMessage->getHeader()->systemBytes);
+ HSMS_Destroy1Message(pMessage);
+
+ return 0;
+}
+
+// S2F31
+int CHsmsPassive::replyDatetime(IMessage* pRecv)
+{
+ if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
+ return ER_NOTSELECT;
+ }
+ ISECS2Item* pBody = pRecv->getBody();
+ if (pBody == nullptr || pBody->getType() != SITYPE::A) ER_PARAM_ERROR;
+ char* pszMessage;
+ if (pBody->getString(pszMessage)) {
+ // 更新时间
+ SYSTEMTIME time;
+ char szBuffer[20];
+ memcpy(szBuffer, pszMessage, 16);
+ szBuffer[14] = '\0';
+ time.wSecond = atoi(&szBuffer[12]);
+ szBuffer[12] = '\0';
+ time.wMinute = atoi(&szBuffer[10]);
+ szBuffer[10] = '\0';
+ time.wHour = atoi(&szBuffer[8]);
+ szBuffer[8] = '\0';
+ time.wDay = atoi(&szBuffer[6]);
+ szBuffer[6] = '\0';
+ time.wMonth = atoi(&szBuffer[4]);
+ szBuffer[4] = '\0';
+ time.wYear = atoi(&szBuffer[0]);
+ time.wMilliseconds = 0;
+ SetLocalTime(&time);
+ }
+
+
+ IMessage* pMessage = NULL;
+ HSMS_Create1Message(pMessage, m_nSessionId, 2, 32, pRecv->getHeader()->systemBytes);
+ ASSERT(pMessage);
+
+ ISECS2Item* pItem = pMessage->getBody();
+ pItem->setBinary(BYTE(0), "TIACK");
+ m_pPassive->sendMessage(pMessage);
+ LOGI("<HSMS>[SECS Msg SEND]S2F32 (SysByte=%u)", pRecv->getHeader()->systemBytes);
+ HSMS_Destroy1Message(pMessage);
+
+ return 0;
+}
+
+// S2F37
+int CHsmsPassive::replyEanbleDisableEventReport(IMessage* pRecv)
+{
+ if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
+ return ER_NOTSELECT;
+ }
+ ISECS2Item* pBody = pRecv->getBody();
+ if (pBody == nullptr || pBody->getType() != SITYPE::A) ER_PARAM_ERROR;
+
+
+
+ BOOL bCheckData = FALSE;
+ bool bEnable;
+ std::vector<unsigned int> ids;
+ {
+ ISECS2Item* pItemIds;
+ ISECS2Item* pItem = pRecv->getBody();
+ if (pItem->getSubItemSize() < 2) goto MYREPLY;
+ if (!pItem->getSubItemBool(0, bEnable)) goto MYREPLY;
+ pItemIds = pItem->getSubItem(1);
+ if (pItemIds == nullptr || pItemIds->getType() != SITYPE::L) goto MYREPLY;
+ for (int i = 0; i < pItemIds->getSubItemSize(); i++) {
+ unsigned int id;
+ if (pItemIds->getSubItemU4(i, id)) {
+ ids.push_back(id);
+ }
+ }
+ bCheckData = TRUE;
+ LOGI("EanbleDisableAlarm bEnable:%s", bEnable ? _T("YES") : _T("NO"));
+ for (auto item : ids) {
+ LOGI("ID:%u", item);
+ }
+ }
+
+
+MYREPLY:
+ int s = 2;
+ int f = 38;
+ IMessage* pMessage = NULL;
+ HSMS_Create1Message(pMessage, m_nSessionId, s, f, pRecv->getHeader()->systemBytes);
+ ASSERT(pMessage);
+ ISECS2Item* pItem = pMessage->getBody();
+ pItem->setBinary(BYTE(0), "ERACK");
+ m_pPassive->sendMessage(pMessage);
+ LOGI("<HSMS>[SECS Msg SEND]S%dF%d (SysByte=%u)", s, f, pRecv->getHeader()->systemBytes);
+ HSMS_Destroy1Message(pMessage);
+
+
+ return 0;
+}
+
+// S5F3
+int CHsmsPassive::replyEanbleDisableAlarmReport(IMessage* pRecv)
+{
+ if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
+ return ER_NOTSELECT;
+ }
+ ISECS2Item* pBody = pRecv->getBody();
+ if (pBody == nullptr || pBody->getType() != SITYPE::A) ER_PARAM_ERROR;
+
+
+
+ BOOL bCheckData = FALSE;
+ BYTE ALED;
+ unsigned int ALID;
+ {
+ ISECS2Item* pItem = pRecv->getBody();
+ if (pItem->getSubItemSize() < 2) goto MYREPLY;
+ if (!pItem->getSubItemBinary(0, ALED)) goto MYREPLY;
+ if (!pItem->getSubItemU4(1, ALID)) goto MYREPLY;
+ bCheckData = TRUE;
+ LOGI("EanbleDisableAlarmReport ALED:%d, ALID:%d", ALED, ALID);
+ }
+
+
+MYREPLY:
+ int s = 5;
+ int f = 4;
+ IMessage* pMessage = NULL;
+ HSMS_Create1Message(pMessage, m_nSessionId, s, f, pRecv->getHeader()->systemBytes);
+ ASSERT(pMessage);
+ ISECS2Item* pItem = pMessage->getBody();
+ pItem->setBinary(BYTE(0), "ACKC5");
+ m_pPassive->sendMessage(pMessage);
+ LOGI("<HSMS>[SECS Msg SEND]S%dF%d (SysByte=%u)", s, f, pRecv->getHeader()->systemBytes);
+ HSMS_Destroy1Message(pMessage);
+
+
+ return 0;
+}
+
+// S5F1
+int CHsmsPassive::requestAlarmReport(int ALCD, int ALID, const char* ALTX)
+{
+ if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
+ return ER_NOTSELECT;
+ }
+
+ Lock();
+ CHsmsAction* pAction = new CHsmsAction(ACTION_ALARM_REPORT, TRUE, m_nActionTimeout);
+ m_listAction.push_back(pAction);
+ IMessage* pMessage = NULL;
+ HSMS_Create1Message(pMessage, m_nSessionId, 5 | REPLY, 1, ++m_nSystemByte);
+ ASSERT(pMessage);
+ ISECS2Item* pItem = pMessage->getBody();
+ pItem->addBinaryItem(BYTE(ALCD & 0xff), "ALCD");
+ pItem->addU4Item(ALID, "ALID");
+ pItem->addItem(ALTX, "ALTX");
+ pAction->setSendMessage(pMessage);
+
+ SetEvent(m_hCimWorkEvent);
+ Unlock();
+
+ return ER_NOERROR;
+}
+
+
--
Gitblit v1.9.3