1.CCollectionEvent，CLoadPort， CVariable类实现； 2.从.txt或csv中加载CVariable列表； 3.添加...

LAPTOP-SNT8I5JK\Boounion

2025-07-14 375342c11638685d6b7fecc2a979825c56d770f9

 SourceCode/Bond/Servo/HsmsPassive.cpp

@@ -8,7 +8,12 @@
#include <time.h>  
#include <stdlib.h>  
#include <string.h>  
#include <regex>


const char ACK[2] = {0, 1};
const char* ACK0 = &ACK[0];
const char* ACK1 = &ACK[1];

unsigned __stdcall CimWorkThreadFunction(LPVOID lpParam)
{
@@ -38,6 +43,11 @@
   m_bCimWorking = FALSE;
   m_hCimWorkEvent = ::CreateEvent(NULL, TRUE, FALSE, NULL);
   m_nSessionId = 1;
   m_listener.onEQOffLine = nullptr;
   m_listener.onEQOnLine = nullptr;
   m_listener.onCommand = nullptr;
   m_listener.onEQConstantRequest = nullptr;
   m_listener.onEQConstantSend = nullptr;
   InitializeCriticalSection(&m_criticalSection);
}

@@ -61,6 +71,11 @@
   DeleteCriticalSection(&m_criticalSection);
}

void CHsmsPassive::setListener(SECSListener listener)
{
   m_listener = listener;
}

void CHsmsPassive::setActionTimeout(int nSecond)
{
   m_nActionTimeout = max(3, nSecond);
@@ -81,6 +96,63 @@
      m_strSoftRev = m_strSoftRev.substr(0, 20);
   }

}

void CHsmsPassive::addReport(unsigned int id, const char* pszName)
{
   Lock();
   REPORT report;
   report.id = id;
   strcpy_s(report.szName, REPORT_NAME_MAX, pszName);
   m_mapReport[id] = report;
   Unlock();
}

void CHsmsPassive::linkEventReport(unsigned int RPTID, unsigned int CEID)
{
   m_mapReportIdToCEID[RPTID] = CEID;
}

void CHsmsPassive::unlinkEventReport(unsigned int CEID)
{
   for (auto it = m_mapReportIdToCEID.begin(); it != m_mapReportIdToCEID.end(); ) {
      if (it->second == CEID) {
         m_mapReportIdToCEID.erase(it++);  // 更新迭代器
      }
      else {
         ++it;
      }
   }

}

unsigned int CHsmsPassive::getCEID(int RPTID)
{
   auto iter = m_mapReportIdToCEID.find(RPTID);
   if (iter != m_mapReportIdToCEID.end()) return iter->second;
   return 0;
}

void CHsmsPassive::deleteReport(unsigned int RPTID)
{
   for (auto it = m_mapValueIdToPRTID.begin(); it != m_mapValueIdToPRTID.end(); ) {
      if (it->second == RPTID) {
         m_mapValueIdToPRTID.erase(it++);  // 更新迭代器
      }
      else {
         ++it;
      }
   }
}

void CHsmsPassive::deleteAllReport()
{
   m_mapValueIdToPRTID.clear();
}

void CHsmsPassive::defineReport(unsigned int VID, unsigned int RPTID)
{
   m_mapValueIdToPRTID[VID] = RPTID;
}

void CHsmsPassive::OnTimer(UINT nTimerid)
@@ -122,6 +194,64 @@


   return 0;
}

int CHsmsPassive::loadVarialbleList(const char* pszFilepath)
{
   CStdioFile file;
   if (!file.Open(pszFilepath, CFile::modeRead)) {
      return -1;
   }

   std::regex pattern("^\\d+,.*");  // 匹配以数字+逗号开头的字符串
   std::vector<SERVO::CVariable*> variables;
   int index, last;
   CString strLine;
   CString strId, strName, strFormat, strRemark;
   while (file.ReadString(strLine)) {
      if (!std::regex_match((LPTSTR)(LPCTSTR)strLine, pattern)) {
         continue;
      }

      last = 0;
      index = strLine.Find(",", last);
      if (index < 0) continue;
      strId = strLine.Left(index);
      last = index + 1;

      index = strLine.Find(",", last);
      if (index < 0) continue;
      strName = strLine.Mid(last, index - last);
      last = index + 1;

      index = strLine.Find(",", last);
      if (index < 0) continue;
      strFormat = strLine.Mid(last, index - last);
      strRemark = strLine.Right(strLine.GetLength() - index - 1);

      SERVO::CVariable* pVarialble = new SERVO::CVariable(
         (LPTSTR)(LPCTSTR)strId, (LPTSTR)(LPCTSTR)strName, (LPTSTR)(LPCTSTR)strFormat, (LPTSTR)(LPCTSTR)strRemark);
      variables.push_back(pVarialble);
   }

   if (!variables.empty()) {
      clearAllVariabel();
      for (auto item : variables) {
         m_variabels.push_back(item);
      }
   }


   file.Close();
   return 0;
}

void CHsmsPassive::clearAllVariabel()
{
   for (auto item : m_variabels) {
      delete item;
   }
   m_variabels.clear();
}

int CHsmsPassive::init(CModel* pModel, const char* pszName, unsigned int port)
@@ -182,11 +312,32 @@
      else if (nStream == 1 && pHeader->function == 13) {
         replyEstablishCommunications(pMessage);
      }
      else if (nStream == 1 && pHeader->function == 15) {
         replyOffLine(pMessage);
      }
      else if (nStream == 1 && pHeader->function == 17) {
         replyOnLine(pMessage);
      }
      else if (nStream == 2 && pHeader->function == 13) {
         replyEquipmentConstantRequest(pMessage);
      }
      else if (nStream == 2 && pHeader->function == 15) {
         replyEquipmentConstantSend(pMessage);
      }
      else if (nStream == 2 && pHeader->function == 31) {
         replyDatetime(pMessage);
      }
      else if (nStream == 2 && pHeader->function == 33) {
         replyDefineReport(pMessage);
      }
      else if (nStream == 2 && pHeader->function == 35) {
         replyLinkEventReport(pMessage);
      }
      else if (nStream == 2 && pHeader->function == 37) {
         replyEanbleDisableEventReport(pMessage);
      }
      else if (nStream == 2 && pHeader->function == 41) {
         replyCommand(pMessage);
      }
      else if (nStream == 5 && pHeader->function == 3) {
         replyEanbleDisableAlarmReport(pMessage);
@@ -233,6 +384,8 @@
      HSMS_DestroyPassive(m_pPassive);
      m_pPassive = NULL;
   }

   clearAllVariabel();

   return 0;
}
@@ -305,7 +458,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);
@@ -353,7 +506,44 @@
   return 0;
}

// S1F14
// S1F15
int CHsmsPassive::replyOffLine(IMessage* pRecv)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
      return ER_NOTSELECT;
   }


   // 交由上层应用来获取机器常量值
   if (m_listener.onEQOffLine != nullptr) {
      m_listener.onEQOffLine(this);
   }


   // 回复
   replyAck(1, 16, pRecv->getHeader()->systemBytes, BYTE(0), "OFLACK");
   return 0;
}

// S1F17
int CHsmsPassive::replyOnLine(IMessage* pRecv)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
      return ER_NOTSELECT;
   }


   // 交由上层应用来获取机器常量值
   if (m_listener.onEQOnLine != nullptr) {
      m_listener.onEQOnLine(this);
   }


   // 回复
   replyAck(1, 18, pRecv->getHeader()->systemBytes, BYTE(0), "ONLACK");
   return 0;
}

int CHsmsPassive::replyEstablishCommunications(IMessage* pRecv)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
@@ -365,14 +555,104 @@
   ASSERT(pMessage);

   ISECS2Item* pItem = pMessage->getBody();
   pItem->addBinaryItem(BYTE(0), "COMMACK");
   pItem->addBinaryItem(ACK0, 1, "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);
   LOGI("<HSMS>[SECS Msg SEND]%s", pMessage->toString());
   HSMS_Destroy1Message(pMessage);

   return 0;
}

// S2F13
int CHsmsPassive::replyEquipmentConstantRequest(IMessage* pRecv)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
      return ER_NOTSELECT;
   }


   // 要获取的常量表表
   BOOL bCheckData = FALSE;
   std::vector<EQConstant> eqcs;
   {
      ISECS2Item* pItem = pRecv->getBody();
      int ecidSize = pItem->getSubItemSize();
      for (int i = 0; i < ecidSize; i++) {
         EQConstant eqc;
         unsigned short id;
         if (pItem->getSubItemU2(i, id)) {
            eqc.id = id;
            eqcs.push_back(eqc);
         }
      }
   }


   // 交由上层应用来获取机器常量值
   if (m_listener.onEQConstantRequest != nullptr) {
      m_listener.onEQConstantRequest(this, eqcs);
   }


   // 回复
   IMessage* pMessage = NULL;
   HSMS_Create1Message(pMessage, m_nSessionId, 1, 14, pRecv->getHeader()->systemBytes);
   ASSERT(pMessage);
   ISECS2Item* pItem = pMessage->getBody();
   for (auto& item : eqcs) {
      pItem->addItem(item.szValue, "ECV");
   }

   m_pPassive->sendMessage(pMessage);
   LOGI("<HSMS>[SECS Msg SEND]S2F14 (SysByte=%u)", pMessage->getHeader()->systemBytes);
   HSMS_Destroy1Message(pMessage);

   return 0;
}

// S2F15
int CHsmsPassive::replyEquipmentConstantSend(IMessage* pRecv)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
      return ER_NOTSELECT;
   }


   // 要设置的常量表表
   BOOL bCheckData = FALSE;
   std::vector<EQConstant> eqcs;
   {
      ISECS2Item* pItem = pRecv->getBody();
      int ecidSize = pItem->getSubItemSize();
      for (int i = 0; i < ecidSize; i++) {
         ISECS2Item* pItemEqc = pItem->getSubItem(i);
         if (pItemEqc != nullptr) {
            EQConstant eqc;
            unsigned short eqcid;
            const char* pszValue;
            if (pItemEqc->getSubItemU2(0, eqcid)
               && pItemEqc->getSubItemString(1, pszValue)) {
               eqc.id = eqcid;
               strcpy_s(eqc.szValue, EQCONSTANT_VALUE_MAX, pszValue);
               eqcs.push_back(eqc);
            }
         }
      }
   }


   // 交由上层应用来保存和设置机器常量值
   std::vector<unsigned int> ecvs;
   if (m_listener.onEQConstantSend != nullptr) {
      m_listener.onEQConstantSend(this, eqcs);
   }


   // 回复
   replyAck(2, 16, pRecv->getHeader()->systemBytes, BYTE(0), "EACK");
   return 0;
}

@@ -384,7 +664,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;
@@ -404,9 +684,106 @@
      time.wYear = atoi(&szBuffer[0]);
      time.wMilliseconds = 0;
      SetLocalTime(&time);
      if (m_listener.onDatetimeSync != nullptr) {
         m_listener.onDatetimeSync(this, time);
      }
   }

   replyAck(2, 32, pRecv->getHeader()->systemBytes, BYTE(0), "TIACK");
   return 0;
}

// S2F33
int CHsmsPassive::replyDefineReport(IMessage* pRecv)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
      return ER_NOTSELECT;
   }


   ISECS2Item* pBody = pRecv->getBody();
   ISECS2Item* defineItem, *rptListItem, * vidListItem;
   unsigned int dataId, rptid, vid;
   if (!pBody->getSubItemU4(0, dataId)) goto MYREPLY;
   rptListItem = pBody->getSubItem(1);
   if (rptListItem == nullptr) goto MYREPLY;
   if (rptListItem->getSubItemSize() == 0) {
      deleteAllReport();
      goto MYREPLY;
   }
   for (int i = 0; i < rptListItem->getSubItemSize(); i++) {
      defineItem = rptListItem->getSubItem(i);
      if (defineItem == nullptr) continue;
      vidListItem = defineItem->getSubItem(1);
      if (defineItem->getSubItemU4(0, rptid)
         && vidListItem != nullptr) {
         int vidCount = vidListItem->getSubItemSize();
         if (vidCount == 0) {
            deleteReport(rptid);
         }
         else {
            for (int k = 0; k < vidCount; k++) {
               if (vidListItem->getSubItemU4(k, vid)) {
                  defineReport(vid, rptid);
               }
            }
         }
      }
   }


MYREPLY:
   // 检验结果是否正确
   for (auto item : m_mapValueIdToPRTID) {
      LOGE("=== vid:%d, prtid:%d", item.first, item.second);
   }

   replyAck(2, 34, pRecv->getHeader()->systemBytes, BYTE(0), "DRACK");
   return 0;
}

// S2F35
int CHsmsPassive::replyLinkEventReport(IMessage* pRecv)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
      return ER_NOTSELECT;
   }


   ISECS2Item* pBody = pRecv->getBody();
   ISECS2Item* linkItem, *ceidListItem, *rptListItem;
   unsigned int dataId, ceid, rptid;
   if (!pBody->getSubItemU4(0, dataId)) goto MYREPLY;
   ceidListItem = pBody->getSubItem(1);
   if (ceidListItem == nullptr) goto MYREPLY;
   for (int i = 0; i < ceidListItem->getSubItemSize(); i++) {
      linkItem = ceidListItem->getSubItem(i);
      if (linkItem == nullptr) continue;
      rptListItem = linkItem->getSubItem(1);
      if (linkItem->getSubItemU4(0, ceid)
         && rptListItem != nullptr) {
         int prtCount = rptListItem->getSubItemSize();
         if (prtCount == 0) {
            unlinkEventReport(ceid);
         }
         else {
            for (int k = 0; k < prtCount; k++) {
               if (rptListItem->getSubItemU4(k, rptid)) {
                  linkEventReport(rptid, ceid);
               }
            }
         }
      }
   }


   // 检验结果是否正确
   for (auto item : m_mapReportIdToCEID) {
      LOGE("=== prtid:%d, ceid:%d", item.first, item.second);
   }

MYREPLY:
   replyAck(2, 36, pRecv->getHeader()->systemBytes, BYTE(0), "LRACK");
   return 0;
}

@@ -438,15 +815,64 @@
         }
      }
      bCheckData = TRUE;
      LOGI("EanbleDisableAlarm bEnable:%s", bEnable ? _T("YES") : _T("NO"));
      for (auto item : ids) {
         LOGI("ID:%u", item);
      if (m_listener.onEnableDisableEventReport != nullptr) {
         m_listener.onEnableDisableEventReport(this, bEnable, ids);
      }
   }


MYREPLY:
   replyAck(2, 38, pRecv->getHeader()->systemBytes, BYTE(0), "ERACK");
   replyAck(2, 38, pRecv->getHeader()->systemBytes, 
      bCheckData ? BYTE(0) : BYTE(1), "ERACK");
   return 0;
}

// S2F41
int CHsmsPassive::replyCommand(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;
   const char* pszCmdName;
   std::vector<CommandParameter> params;
   {
      ISECS2Item* pItemParams, *pItemParam;
      ISECS2Item* pItem = pRecv->getBody();
      if (pItem->getSubItemSize() < 2) goto MYREPLY;
      if (!pItem->getSubItemString(0, pszCmdName)) goto MYREPLY;
      pItemParams = pItem->getSubItem(1);
      if (pItemParams == nullptr || pItemParams->getType() != SITYPE::L) goto MYREPLY;
      for (int i = 0; i < pItemParams->getSubItemSize(); i++) {
         const char* pszParamName, * pszParamValue;
         pItemParam = pItemParams->getSubItem(i);
         if (pItemParam != nullptr 
            && pItemParam->getSubItemString(0, pszParamName)
            && pItemParam->getSubItemString(1, pszParamValue)) {
            CommandParameter cp;
            strcpy_s(cp.szName, COMMAND_NAME_MAX, pszParamName);
            strcpy_s(cp.szValue, COMMAND_VALUE_MAX, pszParamValue);
            params.push_back(cp);
         }
      }
      bCheckData = TRUE;
   }


   // 回调到应用层
   if (bCheckData) {
      if (m_listener.onCommand != nullptr) {
         m_listener.onCommand(this, pszCmdName, params);
      }
   }

MYREPLY:
   replyAck(2, 42, pRecv->getHeader()->systemBytes, BYTE(0), "ERACK");
   return 0;
}

@@ -462,15 +888,19 @@


   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);
      if (m_listener.onEnableDisableAlarmReport != nullptr) {
         m_listener.onEnableDisableAlarmReport(this, ALED[0] != 0, ALID);
      }
   }


@@ -494,6 +924,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 +947,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);
   }

@@ -538,6 +973,9 @@
      return ER_NOTSELECT;
   }

   char szALCD[1];
   szALCD[0] = ALCD & 0xff;

   Lock();
   CHsmsAction* pAction = new CHsmsAction(ACTION_ALARM_REPORT, TRUE, m_nActionTimeout);
   m_listAction.push_back(pAction);
@@ -545,7 +983,7 @@
   HSMS_Create1Message(pMessage, m_nSessionId, 5 | REPLY, 1, ++m_nSystemByte);
   ASSERT(pMessage);
   ISECS2Item* pItem = pMessage->getBody();
   pItem->addBinaryItem(BYTE(ALCD & 0xff), "ALCD");
   pItem->addBinaryItem(szALCD, 1, "ALCD");
   pItem->addU4Item(ALID, "ALID");
   pItem->addItem(ALTX, "ALTX");
   pAction->setSendMessage(pMessage);
@@ -556,4 +994,36 @@
   return ER_NOERROR;
}

// S6F11
int CHsmsPassive::requestEventReportSend(unsigned int DATAID, unsigned int RPTID, const std::vector<std::string>& values)
{
   if (m_pPassive == NULL || STATE::SELECTED != m_pPassive->getState()) {
      return ER_NOTSELECT;
   }

   Lock();
   CHsmsAction* pAction = new CHsmsAction(ACTION_EVENT_REPORT, TRUE, m_nActionTimeout);
   m_listAction.push_back(pAction);
   IMessage* pMessage = NULL;
   HSMS_Create1Message(pMessage, m_nSessionId, 6 | REPLY, 11, ++m_nSystemByte);
   ASSERT(pMessage);
   ISECS2Item* pItem = pMessage->getBody();
   pItem->addU4Item(DATAID, "DATAID");
   pItem->addU4Item(getCEID(RPTID), "CEID");
   ISECS2Item* pItemList1 = pItem->addItem();
   ISECS2Item* pItemList2 = pItemList1->addItem();
   pItemList2->addU4Item(RPTID, "RPTID");
   ISECS2Item* pItemList3 = pItemList2->addItem();
   for (auto item : values) {
      pItemList3->addItem(item.c_str(), "V");
   }
   pAction->setSendMessage(pMessage);

   SetEvent(m_hCimWorkEvent);
   Unlock();
	
   return ER_NOERROR;
}