darker
2025-01-17 700ca509ba853d1615ea3e5c470d2532006f0e1e
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;
}