Bond2
blame | 历史 | 补丁 | 提交 | 提交对比 | 忽略空白
LAPTOP-SNT8I5JK\Boounion
2025-08-14 a2209cc432cb9c80779d83e51ef090f782e8404a 
 SourceCode/Bond/Servo/CLoadPort.cpp


@@ -2,35 +2,21 @@


#include "CLoadPort.h"


#include "CGlassPool.h"


#include "Servo.h"


#include "ServoCommo.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);            \


   }                                                      \


}




#define CHECK_WRITE_STEP_SIGNAL2(addr, data, size) {                     \


   BOOL bFlag = isBitOn(data, size, addr);                           \


   SERVO::CStep* pStep = getStep(addr);                           \


   if (pStep != nullptr) {                                       \


      ((CWriteStep*)pStep)->onRecvSignal(bFlag ? addr : 0);            \


   }                                                      \


}




namespace SERVO {


   CLoadPort::CLoadPort() : CEquipment()


   {


      m_nIndex = 0;


      m_portType = PortType::Loading;


      m_portMode = PortMode::ReadyToLoad;


      m_portType = PortType::Both;


      m_portMode = PortMode::OutOfService;


      m_cassetteType = CassetteType::G1;


      m_transferMode = TransferMode::AGVMode;


      m_bEnable = FALSE;


      m_bAutoChangeEnable = FALSE;


      m_nNextCassetteSequenceNo = 0;


      m_isCompareMapsBeforeProceeding = FALSE;


   }




   CLoadPort::~CLoadPort()


@@ -83,15 +69,15 @@




      {


         // 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 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[] = { 0x130, 0x131, 0x132, 0x133 };


         static int dev[] = { 0x45, 0x1a5, 0x305, 0x465 };


         static int addr[] = { 0x480, 0x481, 0x482, 0x483 };


         static int addr[] = { STEP_ID_PROT1_CASSETTE_CTR_CMD_REPLY, STEP_ID_PROT2_CASSETTE_CTR_CMD_REPLY, STEP_ID_PROT3_CASSETTE_CTR_CMD_REPLY, STEP_ID_PROT4_CASSETTE_CTR_CMD_REPLY };




         CEqCassetteCtrlCmdStep* pStep = new CEqCassetteCtrlCmdStep();


         CEqWriteStep* pStep = new CEqWriteStep();


         pStep->setName(pszName[m_nIndex]);


         pStep->setWriteSignalDev(writeSignalDev[m_nIndex]);


         pStep->setCtrlCmdDev(dev[m_nIndex]);


         pStep->setDataDev(dev[m_nIndex]);


         if (addStep(addr[m_nIndex], pStep) != 0) {


            delete pStep;


         }


@@ -129,6 +115,7 @@


            [&](void* pFrom, int code, const char* pszData, size_t size) -> int {


               if (code == ROK && pszData != nullptr && size > 0) {


                  m_portMode = (PortMode)CToolUnits::toInt16(pszData);


                  LOGI("<LoadPort-%d>m_portMode:%d", m_nIndex, m_portMode);


               }


               return 0;


            });


@@ -149,7 +136,7 @@


         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_cassetteType = (CassetteType)CToolUnits::toInt16(pszData);


                  //m_cassetteType = (CassetteType)CToolUnits::toInt16(pszData);


               }


               return 0;


            });


@@ -324,12 +311,12 @@


         };


         static int dev[] = { 0x6050, 0x6070, 0x6090, 0x60b0 };


         static int writeSignalDev[6][4] = {


            {0xc8, 0xc9, 0xca, 0xcb},


            {0xd0, 0xd1, 0xd2, 0xd3},


            {0xd8, 0xd9, 0xda, 0xdb},


            {0xe0, 0xe1, 0xe2, 0xe3},


            {0xe8, 0xe9, 0xea, 0xeb},


            {0xf0, 0xf1, 0xf2, 0xf3},


            {0xf8, 0xf9, 0xfa, 0xfb},


            {0x100, 0x101, 0x102, 0x103}


            {0xf0, 0xf1, 0xf2, 0xf3}


         };


         static int addr[6][4] = {


            { STEP_ID_PORT1_EMPTY, STEP_ID_PORT2_EMPTY, STEP_ID_PORT3_EMPTY, STEP_ID_PORT4_EMPTY },


@@ -362,6 +349,48 @@


   void CLoadPort::onTimer(UINT nTimerid)


   {


      CEquipment::onTimer(nTimerid);






      // 从配置读出的enable，初始化时写给efem


      static int i_enable[4] = { 0 };


      if ((++i_enable[m_nIndex]) == 10 + m_nIndex) {


         eablePort(m_bEnable, [&](int code) -> int {


            LOGI("<LoadPort-%d>eablePort:code=%d", m_nIndex, code);


            return 0;


            });


      }








      // 模拟测试


      if (m_nIndex == 0) {


         static int ii = 0;


         ii++;


         if (ii == 50) {


            char szBuffer[64] = {0};


            CStep* pStep = getStepWithName(STEP_EQ_PORT1_INUSE);


            CPortStatusReport portStatusReport;


            portStatusReport.setPortStatus(PORT_INUSE);


            portStatusReport.setJobExistenceSlot(0xf);


            portStatusReport.setCassetteId("CID1001");


            int nRet = portStatusReport.serialize(szBuffer, 64);


            decodePortStatusReport(pStep, szBuffer, 64);


         }


      }


      if (m_nIndex == 1) {


         static int ii = 0;


         ii++;


         if (ii == 55) {


            char szBuffer[64] = { 0 };


            CStep* pStep = getStepWithName(STEP_EQ_PORT1_INUSE);


            CPortStatusReport portStatusReport;


            portStatusReport.setPortStatus(PORT_INUSE);


            portStatusReport.setJobExistenceSlot(0xf);


            portStatusReport.setCassetteId("CID1004");


            int nRet = portStatusReport.serialize(szBuffer, 64);


            decodePortStatusReport(pStep, szBuffer, 64);


         }


      }


   }




   void CLoadPort::serialize(CArchive& ar)


@@ -370,23 +399,11 @@




      if (ar.IsStoring()) {


         ar << m_nIndex;


         //ar << (int)m_portType;


         //ar << (int)m_portMode;


         //ar << (int)m_cassetteType;


         //ar << (int)m_transferMode;


         //ar << m_bEnable;


         //ar << m_bAutoChangeEnable;


         m_portStatusReport.serialize(ar);


      }


      else {


         int temp;


         ar >> m_nIndex;


         //ar >> temp; m_portType = (PortType)temp;


         //ar >> temp; m_portMode = (PortMode)temp;


         //ar >> temp; m_cassetteType = (CassetteType)temp;


         //ar >> temp; m_transferMode = (TransferMode)temp;


         //ar >> m_bEnable;


         //ar >> m_bAutoChangeEnable;


         m_portStatusReport.serialize(ar);


      }


   }


@@ -423,17 +440,25 @@


      int jobExistenceSize,


      short slotProcess,


      short jopCount,


      CJobDataA* pJobDataA)


      CJobDataA* pJobDataA,


      ONWRITED onWritedBlock)


   {


      int id = getID();


      if ( !(id == EQ_ID_LOADPORT1 || id == EQ_ID_LOADPORT2) ) {


         return -1;


      SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getCassetteCtrlCmdStep();


      ASSERT(pStep);




      char szBuffer[1024] = { 0 };


      memcpy(&szBuffer[0], &cmd, sizeof(short));


      if (jobExistence != nullptr && jobExistenceSize == 12) {


         memcpy(&szBuffer[2], jobExistence, sizeof(short) * jobExistenceSize);


      }




      memcpy(&szBuffer[26], &slotProcess, sizeof(short));


      memcpy(&szBuffer[36], &jopCount, sizeof(short));


      if (pJobDataA != nullptr) {


         pJobDataA->serialize(&szBuffer[38], 1024 - 38);


      }




      SERVO::CEqCassetteCtrlCmdStep* pStep = (SERVO::CEqCassetteCtrlCmdStep*)getCassetteCtrlCmdStep();


      ASSERT(pStep);


      return pStep->sendCtrlCmd(cmd, jobExistence, jobExistenceSize, slotProcess, jopCount, pJobDataA);


      return pStep->writeDataEx(szBuffer, 352 * 2, onWritedBlock);


   }




   CStep* CLoadPort::getCassetteCtrlCmdStep()


@@ -855,12 +880,12 @@


      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);


      CHECK_READ_STEP_SIGNAL(type[m_nIndex], pszData, size);


      CHECK_READ_STEP_SIGNAL(mode[m_nIndex], pszData, size);


      CHECK_READ_STEP_SIGNAL(cassetteType[m_nIndex], pszData, size);


      CHECK_READ_STEP_SIGNAL(transferMode[m_nIndex], pszData, size);


      CHECK_READ_STEP_SIGNAL(enable[m_nIndex], pszData, size);


      CHECK_READ_STEP_SIGNAL(autoType[m_nIndex], pszData, size);






      static int typeReply[] = { STEP_ID_PROT1_TYPE_CHANGE_REPLY, STEP_ID_PROT2_TYPE_CHANGE_REPLY,


@@ -876,12 +901,12 @@


      static int cassetteTypeReply[] = { STEP_ID_PROT1_CASSETTE_TYPE_CHANGE_REPLY, STEP_ID_PROT2_CASSETTE_TYPE_CHANGE_REPLY,


         STEP_ID_PROT3_CASSETTE_TYPE_CHANGE_REPLY, STEP_ID_PROT4_CASSETTE_TYPE_CHANGE_REPLY };




      CHECK_WRITE_STEP_SIGNAL2(typeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL2(modeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL2(transferModeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL2(enableModeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL2(typeAutoReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL2(cassetteTypeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL(typeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL(modeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL(transferModeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL(enableModeReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL(typeAutoReply[m_nIndex], pszData, size);


      CHECK_WRITE_STEP_SIGNAL(cassetteTypeReply[m_nIndex], pszData, size);


   }




   int CLoadPort::decodePortStatusReport(CStep* pStep, const char* pszData, size_t size)


@@ -892,13 +917,47 @@


      m_portStatusReport.copyEx(portStatusReport);






      // 当port状态为InUse, 比较map


      if (m_portStatusReport.getPortStatus() == PORT_INUSE) {


         if (m_isCompareMapsBeforeProceeding) {


            short scanMap = getScanCassetteMap();


            short downloadMap = getDownloadCassetteMap();


            if (scanMap == downloadMap) {


               generateGlassList(scanMap);


               this->sendCassetteCtrlCmd(CCC_PROCESS_START, nullptr, 0, 0, 0, nullptr, nullptr);


            }


            else {


               this->sendCassetteCtrlCmd(CCC_PROCESS_CANCEL, nullptr, 0, 0, 0, nullptr, nullptr);




               // 抛出到应用层做提示


               if (m_listener.onMapMismatch != nullptr) {


                  m_listener.onMapMismatch(this, scanMap, downloadMap);


               }


            }


         }


         else {


            // 抛出到应用层做选择要加工的片子


            generateGlassList(getScanCassetteMap());


         }


      }


      if (m_listener.onPortStatusChanged != nullptr) {


         m_listener.onPortStatusChanged(this, portStatusReport.getPortStatus(),


            getScanCassetteMap());


      }






      // 缓存Attribute，用于调试时显示信息


      unsigned int weight = 201;


      CAttributeVector& attrubutes = pStep->attributeVector();


      m_portStatusReport.getAttributeVector(attrubutes, weight);




      LOGI("<CCassetteTranserStateStep>decodePortStatusReport<Status:%d, CassetteSequenceNo:%d>",


         m_portStatusReport.getPortStatus(), m_portStatusReport.getCassetteSequenceNo());


      LOGI("<CCassetteTranserStateStep>decodePortStatusReport<Status:%d, CassetteSequenceNo:%d, CassetteId:%s>",


         m_portStatusReport.getPortStatus(), m_portStatusReport.getCassetteSequenceNo(), 


         m_portStatusReport.getCassetteId().c_str());


      if (m_portStatusReport.getPortStatus() == 3) {


         LOGI("<CCassetteTranserStateStep>InUse<JobExistenceSlot:%d>",


            m_portStatusReport.getJobExistenceSlot());


      }






      return nRet;


@@ -994,6 +1053,7 @@




   int CLoadPort::setCassetteType(CassetteType type, ONWRITED onWritedBlock/* = nullptr*/)


   {


      m_cassetteType = type;


      static char* pszName[] = { STEP_PORT1_CASSETTE_TYPE_CHANGE, STEP_PORT2_CASSETTE_TYPE_CHANGE, STEP_PORT3_CASSETTE_TYPE_CHANGE, STEP_PORT4_CASSETTE_TYPE_CHANGE };


      SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(pszName[m_nIndex]);


      if (pStep == nullptr) {


@@ -1006,7 +1066,6 @@


         // test


         code = WOK;


         if (code == WOK) {


            m_cassetteType = type;


            LOGI("<CLoadPort-%d>设置Cassette Type成功.", m_nIndex);


         }


         else {


@@ -1109,6 +1168,18 @@


      m_bAutoChangeEnable = bEnable;


   }




   short CLoadPort::getScanCassetteMap()


   {


      return m_portStatusReport.getJobExistenceSlot();


   }




   short CLoadPort::getDownloadCassetteMap()


   {


      // 暂时未实现此功能


      short map = 0;


      return map;


   }




   /*


    * 生成测试用的玻璃列表


    */


@@ -1124,18 +1195,18 @@






      char szBuffer[64];


      for (int i = 0; i < 1; i++) {


      for (int i = 0; i < SLOT_MAX; i++) {


         if (!m_slot[i].isEnable()) continue;




         CJobDataS js;


         js.setCassetteSequenceNo(getNextCassetteSequenceNo());


         js.setJobSequenceNo(m_slot[i].getNo());


         sprintf_s(szBuffer, 64, "%05d%05d", js.getCassetteSequenceNo(), js.getJobSequenceNo());


         //js.setGlass1Id(szBuffer);


         js.setJobType(1);


         js.setMaterialsType((int)type);




         CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();


         pGlass->setOriginPort(m_nIndex, i);


         pGlass->addPath(m_nID, 0);


         pGlass->processEnd(m_nID, 0);


         pGlass->setID(szBuffer);


@@ -1146,6 +1217,47 @@




      return 0;


   }




   /*


    * 根据efem扫描到的map，生成玻璃列表


    */


   int CLoadPort::generateGlassList(short map)


   {


      // 先释放较早前的数据


      Lock();


      for (int i = 0; i < SLOT_MAX; i++) {


         m_slot[i].setContext(nullptr);


      }


      Unlock();






      // 根据map生成新的


      char szBuffer[64];


      for (int i = 0; i < SLOT_MAX; i++) {


         if (!m_slot[i].isEnable()) continue;


         if (!(map >> i) & 1) continue;




         CJobDataS js;


         js.setCassetteSequenceNo(getNextCassetteSequenceNo());


         js.setJobSequenceNo(m_slot[i].getNo());


         sprintf_s(szBuffer, 64, "%05d%05d", js.getCassetteSequenceNo(), js.getJobSequenceNo());


         js.setJobType(1);


         js.setMaterialsType((int)m_cassetteType);




         CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();


         pGlass->setOriginPort(m_nIndex, i);


         pGlass->setScheduledForProcessing(i % 2 == 1);


         pGlass->addPath(m_nID, 0);


         pGlass->processEnd(m_nID, 0);


         pGlass->setID(szBuffer);


         pGlass->setType(m_cassetteType);


         pGlass->setJobDataS(&js);


         m_slot[i].setContext(pGlass);


      }




      return 0;


   }






   int CLoadPort::testGenerateGlassListFromConfig(const SERVO::PortConfig& config)


   {


@@ -1174,6 +1286,7 @@


         js.setGlass1Id(szBuffer);




         CGlass* pGlass = theApp.m_model.m_glassPool.allocaGlass();


         pGlass->setOriginPort(m_nIndex, nSlotIndex);


         pGlass->addPath(m_nID, 0);


         pGlass->processEnd(m_nID, 0);


         pGlass->setID(szBuffer);


@@ -1185,4 +1298,9 @@




      return 0;


   }




   void CLoadPort::setCompareMapsBeforeProceeding(BOOL bCompare)


   {


      m_isCompareMapsBeforeProceeding = bCompare;


   }


}