1.LoadPort状态获取； 2.LoadPort Event 由原CReadIntStep修改为CReadStep

LAPTOP-SNT8I5JK\Boounion

2025-05-21 83c4b402947892eafe9ec9d732d3159d07d6228a

 SourceCode/Bond/Servo/CLoadPort.cpp

@@ -1,14 +1,25 @@
#include "stdafx.h"
#include "CLoadPort.h"
#include "CGlassPool.h"
#include "Servo.h"


#define CHECK_READ_STEP_SIGNAL2(addr, data, size) {                     \
   BOOL bFlag = isBitOn(data, size, addr);                           \
   SERVO::CStep* pStep = getStep(addr);                           \
   if (pStep != nullptr) {                                       \
      ((CReadStep*)pStep)->onReadSignal(bFlag ? addr : 0);            \
   }                                                      \
}

namespace SERVO {
   CLoadPort::CLoadPort() : CEquipment()
   {
      m_nType = 0;
      m_nMode = 0;
      m_nCassetteType = 0;
      m_nTransferMode = 4;
      m_nIndex = 0;
      m_nType = 1;
      m_nMode = 1;
      m_nCassetteType = 1;
      m_nTransferMode = 1;
      m_bEnable = FALSE;
      m_bAutoChangeEnable = FALSE;
   }
@@ -44,6 +55,200 @@
      addPin(SERVO::PinType::OUTPUT, _T("Out2"));
   }

   void CLoadPort::initSteps()
   {
      CEquipment::initSteps();


      ASSERT(m_nIndex == 0 || m_nIndex == 1 || m_nIndex == 2 || m_nIndex == 3);

      {
         // Cassette Ctrl Cmd
         static char* pszName[] = { STEP_EQ_P1_CASSETTE_CTRL_CMD,   STEP_EQ_P2_CASSETTE_CTRL_CMD, STEP_EQ_P3_CASSETTE_CTRL_CMD,   STEP_EQ_P4_CASSETTE_CTRL_CMD };
         static int writeSignalDev[] = { 0x120, 0x121, 0x122, 0x123 };
         static int dev[] = { 0x45, 0x1a5, 0x305, 0x465 };
         static int addr[] = { 0x480, 0x481, 0x482, 0x483 };

         CEqCassetteCtrlCmdStep* pStep = new CEqCassetteCtrlCmdStep();
         pStep->setName(pszName[m_nIndex]);
         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
         pStep->setCtrlCmdDev(dev[m_nIndex]);
         if (addStep(addr[m_nIndex], pStep) != 0) {
            delete pStep;
         }
      }

      {
         // Type
         static char* pszName[] = { STEP_EQ_PORT1_TYPE, STEP_EQ_PORT2_TYPE, STEP_EQ_PORT3_TYPE, STEP_EQ_PORT4_TYPE };
         static int dev[] = { 0x6010 , 0x6020, 0x6030, 0x6040 };
         static int writeSignalDev[] = { 0xa0, 0xa1, 0xa2, 0xa3 };
         static int addr[] = { STEP_ID_PORT1_TYPE_CHANGE, STEP_ID_PORT2_TYPE_CHANGE, STEP_ID_PORT3_TYPE_CHANGE, STEP_ID_PORT4_TYPE_CHANGE };

         CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], sizeof(short),
            [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
               if (code == ROK && pszData != nullptr && size > 0) {
                  m_nType = (unsigned int)CToolUnits::toInt16(pszData);
               }
               return 0;
            });
         pStep->setName(pszName[m_nIndex]);
         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
         if (addStep(addr[m_nIndex], pStep) != 0) {
            delete pStep;
         }
      }

      {
         // Mode
         static char* pszName[] = { STEP_EQ_PORT1_MODE, STEP_EQ_PORT2_MODE, STEP_EQ_PORT3_MODE, STEP_EQ_PORT4_MODE };
         static int dev[] = { 0x6011, 0x6021, 0x6031, 0x6041 };
         static int writeSignalDev[] = { 0xa8, 0xa9, 0xaa, 0xab };
         static int addr[] = { STEP_ID_PORT1_MODE_CHANGE, STEP_ID_PORT2_MODE_CHANGE, STEP_ID_PORT3_MODE_CHANGE, STEP_ID_PORT4_MODE_CHANGE };

         CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], sizeof(short),
            [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
               if (code == ROK && pszData != nullptr && size > 0) {
                  m_nMode = (unsigned int)CToolUnits::toInt16(pszData);
               }
               return 0;
            });
         pStep->setName(pszName[m_nIndex]);
         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
         if (addStep(addr[m_nIndex], pStep) != 0) {
            delete pStep;
         }
      }

      {
         // Cassette type
         static char* pszName[] = { STEP_EQ_PORT1_CASSETTE_TYPE, STEP_EQ_PORT2_CASSETTE_TYPE, STEP_EQ_PORT3_CASSETTE_TYPE, STEP_EQ_PORT4_CASSETTE_TYPE };
         static int dev[] = { 0x6012, 0x6022, 0x6032, 0x6042 };
         static int writeSignalDev[] = { 0xb0, 0xb1, 0xb2, 0xb3 };
         static int addr[] = { STEP_ID_PORT1_CASSETTE_TYPE_CHANGE, STEP_ID_PORT2_CASSETTE_TYPE_CHANGE, STEP_ID_PORT3_CASSETTE_TYPE_CHANGE, STEP_ID_PORT4_CASSETTE_TYPE_CHANGE };

         CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], sizeof(short),
            [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
               if (code == ROK && pszData != nullptr && size > 0) {
                  m_nCassetteType = (unsigned int)CToolUnits::toInt16(pszData);
               }
               return 0;
            });
         pStep->setName(pszName[m_nIndex]);
         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
         if (addStep(addr[m_nIndex], pStep) != 0) {
            delete pStep;
         }
      }

      {
         // Transfer type
         static char* pszName[] = { STEP_EQ_PORT1_TRANSFER_MODE, STEP_EQ_PORT2_TRANSFER_MODE, STEP_EQ_PORT3_TRANSFER_MODE, STEP_EQ_PORT4_TRANSFER_MODE };
         static int dev[] = { 0x6014, 0x6024, 0x6034, 0x6044 };
         static int writeSignalDev[] = { 0xb8, 0xb9, 0xba, 0xbb };
         static int addr[] = { STEP_ID_PORT1_TRANSFER_MODE_CHANGE, STEP_ID_PORT2_TRANSFER_MODE_CHANGE, STEP_ID_PORT3_TRANSFER_MODE_CHANGE, STEP_ID_PORT4_TRANSFER_MODE_CHANGE };

         CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], sizeof(short),
            [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
               if (code == ROK && pszData != nullptr && size > 0) {
                  m_nTransferMode = (unsigned int)CToolUnits::toInt16(pszData);
               }
               return 0;
            });
         pStep->setName(pszName[m_nIndex]);
         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
         if (addStep(addr[m_nIndex], pStep) != 0) {
            delete pStep;
         }
      }

      {
         // Port enable
         static char* pszName[] = { STEP_EQ_PORT1_ENABLE, STEP_EQ_PORT2_ENABLE, STEP_EQ_PORT3_ENABLE, STEP_EQ_PORT4_ENABLE };
         static int dev[] = { 0x6015, 0x6025, 0x6035, 0x6045 };
         static int writeSignalDev[] = { 0xc0, 0xc1, 0xc2, 0xc3 };
         static int addr[] = { STEP_ID_PORT1_ENABLE_MODE_CHANGE, STEP_ID_PORT2_ENABLE_MODE_CHANGE, STEP_ID_PORT3_ENABLE_MODE_CHANGE, STEP_ID_PORT4_ENABLE_MODE_CHANGE };

         CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], sizeof(short),
            [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
               if (code == ROK && pszData != nullptr && size > 0) {
                  m_bEnable = (unsigned int)CToolUnits::toInt16(pszData) == 1;
               }
               return 0;
            });
         pStep->setName(pszName[m_nIndex]);
         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
         if (addStep(addr[m_nIndex], pStep) != 0) {
            delete pStep;
         }
      }

      {
         // Type auto change
         char* pszName[] = { STEP_EQ_PORT1_TYPE_ATUO, STEP_EQ_PORT2_TYPE_ATUO, STEP_EQ_PORT3_TYPE_ATUO, STEP_EQ_PORT4_TYPE_ATUO };
         static int dev[] = { 0x6016, 0x6026, 0x6036, 0x6046 };
         static int writeSignalDev[] = { 0xc8, 0xc9, 0xca, 0xcb };
         static int addr[] = { STEP_ID_PORT1_TYPE_AUTO_CHANGE, STEP_ID_PORT2_TYPE_AUTO_CHANGE, STEP_ID_PORT3_TYPE_AUTO_CHANGE, STEP_ID_PORT4_TYPE_AUTO_CHANGE };

         CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], sizeof(short),
            [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
               if (code == ROK && pszData != nullptr && size > 0) {
                  m_bAutoChangeEnable = (unsigned int)CToolUnits::toInt16(pszData) == 1;
               }
               return 0;
            });
         pStep->setName(pszName[m_nIndex]);
         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);
         if (addStep(addr[m_nIndex], pStep) != 0) {
            delete pStep;
         }
      }

      {
         char* pszName[6][4] = { 
            {STEP_EQ_PORT1_EMPTY, STEP_EQ_PORT2_EMPTY, STEP_EQ_PORT3_EMPTY, STEP_EQ_PORT4_EMPTY},
            {STEP_EQ_PORT1_LOAD_EADY, STEP_EQ_PORT2_LOAD_EADY, STEP_EQ_PORT3_LOAD_EADY, STEP_EQ_PORT4_LOAD_EADY},
            {STEP_EQ_PORT1_LOADED, STEP_EQ_PORT2_LOADED, STEP_EQ_PORT3_LOADED, STEP_EQ_PORT4_LOADED},
            {STEP_EQ_PORT1_INUSE, STEP_EQ_PORT2_INUSE, STEP_EQ_PORT3_INUSE, STEP_EQ_PORT4_INUSE},
            {STEP_EQ_PORT1_UNLOAD_EADY, STEP_EQ_PORT2_UNLOAD_EADY, STEP_EQ_PORT3_UNLOAD_EADY, STEP_EQ_PORT4_UNLOAD_EADY},
            {STEP_EQ_PORT1_BLOCKED, STEP_EQ_PORT2_BLOCKED, STEP_EQ_PORT3_BLOCKED, STEP_EQ_PORT4_BLOCKED}
         };
         static int dev[] = { 0x6050, 0x6070, 0x6090, 0x60b0 };
         static int writeSignalDev[6][4] = {
            {0xd8, 0xd9, 0xda, 0xdb},
            {0xe0, 0xe1, 0xe2, 0xe3},
            {0xe8, 0xe9, 0xea, 0xeb},
            {0xf0, 0xf1, 0xf2, 0xf3},
            {0xf8, 0xf9, 0xfa, 0xfb},
            {0x100, 0x101, 0x102, 0x103}
         };
         static int addr[6][4] = {
            { STEP_ID_PORT1_EMPTY, STEP_ID_PORT2_EMPTY, STEP_ID_PORT3_EMPTY, STEP_ID_PORT4_EMPTY },
            { STEP_ID_PORT1_LOAD_READY, STEP_ID_PORT2_LOAD_READY, STEP_ID_PORT3_LOAD_READY, STEP_ID_PORT4_LOAD_READY },
            { STEP_ID_PORT1_LOADED, STEP_ID_PORT2_LOADED, STEP_ID_PORT3_LOADED, STEP_ID_PORT4_LOADED },
            { STEP_ID_PORT1_INUSE, STEP_ID_PORT2_INUSE, STEP_ID_PORT3_INUSE, STEP_ID_PORT4_INUSE },
            { STEP_ID_PORT1_UNLOAD_READY, STEP_ID_PORT2_UNLOAD_READY, STEP_ID_PORT3_UNLOAD_READY, STEP_ID_PORT4_UNLOAD_READY },
            { STEP_ID_PORT1_BLOCKED, STEP_ID_PORT2_BLOCKED, STEP_ID_PORT3_BLOCKED, STEP_ID_PORT4_BLOCKED },
         };

         for (int i = 0; i < 6; i++) {
            CEqReadStep* pStep = new CEqReadStep(dev[m_nIndex], 32 * 2,
               [&](void* pFrom, int code, const char* pszData, size_t size) -> int {
                  if (code == ROK && pszData != nullptr && size > 0) {
                     decodePortStatusReport((CStep*)pFrom, pszData, size);
                  }
                  return -1;
               });
            pStep->setName(pszName[i][m_nIndex]);
            pStep->setProp("Port", (void*)(__int64)(m_nIndex + 1));
            pStep->setWriteSignalDev(writeSignalDev[i][m_nIndex]);
            if (addStep(addr[i][m_nIndex], pStep) != 0) {
               delete pStep;
            }
         }
      }
   }

   void CLoadPort::onTimer(UINT nTimerid)
   {
      CEquipment::onTimer(nTimerid);
@@ -57,6 +262,23 @@
   void CLoadPort::getAttributeVector(CAttributeVector& attrubutes)
   {
      __super::getAttributeVector(attrubutes);

      unsigned int weight = 101;
      std::string strTemp;
      attrubutes.addAttribute(new CAttribute("Index",
         std::to_string(m_nIndex).c_str(), "", weight++));
      attrubutes.addAttribute(new CAttribute("Type",
         getPortTypeDescription(m_nType, strTemp).c_str(), "", weight++));
      attrubutes.addAttribute(new CAttribute("Mode",
         getPortModeDescription(m_nMode, strTemp).c_str(), "", weight++));
      attrubutes.addAttribute(new CAttribute("CassetteType",
         getPortCassetteTypeDescription(m_nCassetteType, strTemp).c_str(), "", weight++));
      attrubutes.addAttribute(new CAttribute("TransferMode",
         getPortTransferModeDescription(m_nTransferMode, strTemp).c_str(), "", weight++));
      attrubutes.addAttribute(new CAttribute("Enable",
         m_bEnable ? "Eanble" : "Disable", "", weight++));
      attrubutes.addAttribute(new CAttribute("Auto Change",
         m_bAutoChangeEnable ? "Eanble" : "Disable", "", weight++));
   }

   int CLoadPort::recvIntent(CPin* pPin, CIntent* pIntent)
@@ -66,19 +288,6 @@

   int CLoadPort::outputGlass(int port)
   {
      // 如果列表中没有Panel,模拟生成10张
      if (m_glassList.empty()) {
         static int ii = 0;
         char szBuffer[64];
         LOGI("<CLoadPort>模拟生成10张PANEL");
         for (int i = 0; i < 10; i++) {
            sprintf_s(szBuffer, "P20250320A1A%d", ++ii);
            CGlass* pGlass = new CGlass();
            pGlass->setID(szBuffer);
            addGlassToList(pGlass);
         }
      }

      return __super::outputGlass(port);
   }

@@ -125,6 +334,16 @@
      Unlock();

      return pStep;
   }

   void CLoadPort::setIndex(unsigned int index)
   {
      m_nIndex = index;
   }

   unsigned int CLoadPort::getIndex()
   {
      return m_nIndex;
   }

   BOOL CLoadPort::isEnable()
@@ -306,4 +525,91 @@

      return strDescription;
   }

   void CLoadPort::onReceiveLBData(const char* pszData, size_t size)
   {
      static int type[] = { STEP_ID_PORT1_TYPE_CHANGE, STEP_ID_PORT2_TYPE_CHANGE,
         STEP_ID_PORT3_TYPE_CHANGE, STEP_ID_PORT4_TYPE_CHANGE };
      static int mode[] = { STEP_ID_PORT1_MODE_CHANGE, STEP_ID_PORT2_MODE_CHANGE,
         STEP_ID_PORT3_MODE_CHANGE, STEP_ID_PORT4_MODE_CHANGE };
      static int cassetteType[] = { STEP_ID_PORT1_CASSETTE_TYPE_CHANGE, STEP_ID_PORT2_CASSETTE_TYPE_CHANGE,
         STEP_ID_PORT3_CASSETTE_TYPE_CHANGE, STEP_ID_PORT4_CASSETTE_TYPE_CHANGE };
      static int transferMode[] = { STEP_ID_PORT1_TRANSFER_MODE_CHANGE, STEP_ID_PORT2_TRANSFER_MODE_CHANGE,
         STEP_ID_PORT3_TRANSFER_MODE_CHANGE, STEP_ID_PORT4_TRANSFER_MODE_CHANGE };
      static int enable[] = { STEP_ID_PORT1_ENABLE_MODE_CHANGE, STEP_ID_PORT2_ENABLE_MODE_CHANGE,
         STEP_ID_PORT3_ENABLE_MODE_CHANGE, STEP_ID_PORT4_ENABLE_MODE_CHANGE };
      static int autoType[] = { STEP_ID_PORT1_TYPE_AUTO_CHANGE, STEP_ID_PORT2_TYPE_AUTO_CHANGE,
         STEP_ID_PORT3_TYPE_AUTO_CHANGE, STEP_ID_PORT4_TYPE_AUTO_CHANGE };

      CHECK_READ_STEP_SIGNAL2(type[m_nIndex], pszData, size);
      CHECK_READ_STEP_SIGNAL2(mode[m_nIndex], pszData, size);
      CHECK_READ_STEP_SIGNAL2(cassetteType[m_nIndex], pszData, size);
      CHECK_READ_STEP_SIGNAL2(transferMode[m_nIndex], pszData, size);
      CHECK_READ_STEP_SIGNAL2(enable[m_nIndex], pszData, size);
      CHECK_READ_STEP_SIGNAL2(autoType[m_nIndex], pszData, size);
   }

   int CLoadPort::decodePortStatusReport(CStep* pStep, const char* pszData, size_t size)
   {
      CPortStatusReport portStatusReport;
      int nRet = portStatusReport.unserialize(&pszData[0], (int)size);
      if (nRet < 0) return nRet;
      m_portStatusReport.copyEx(portStatusReport);


      // 缓存Attribute，用于调试时显示信息
      unsigned int weight = 201;
      CAttributeVector attrubutes;
      m_portStatusReport.getAttributeVector(attrubutes, weight);
      pStep->addAttributeVector(attrubutes);


      LOGI("<CCassetteTranserStateStep>decodePortStatusReport<Status:%d, CassetteSequenceNo:%d>",
         m_portStatusReport.getPortStatus(), m_portStatusReport.getCassetteSequenceNo());


      return nRet;
   }

   /*
    * 生成测试用的玻璃列表
    */
   int CLoadPort::testGenerateGlassList(MaterialsType type, int count, const char* pszPrefix, int startSuffix)
   {
      // 如果非空就不生成了
      Lock();
      if (!m_glassList.empty()) {
         Unlock();
         return -1;
      }
      Unlock();


      char szBuffer[64];
      int suffix = startSuffix;
      for (int i = 0; i < count; i++) {
         CJobDataB jb;
         CJobDataS js;

         sprintf_s(szBuffer, "%s%d", pszPrefix, suffix++);
         jb.setGlassId(szBuffer);
         js.setMaterialsType((int)type);
         if (type == MaterialsType::G1) {
            js.setGlass1Id(szBuffer);
         }
         else if (type == MaterialsType::G2) {
            js.setGlass2Id(szBuffer);
         }

         CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();
         pGlass->setID(szBuffer);
         pGlass->setJobDataB(&jb);
         pGlass->setType(type);
         pGlass->setJobDataS(&js);
         addGlassToList(pGlass);
      }

      return 0;
   }

}