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


@@ -12,6 +12,14 @@


   }                                                      \


}




#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()


   {


@@ -22,6 +30,7 @@


      m_transferMode = TransferMode::AGVMode;


      m_bEnable = FALSE;


      m_bAutoChangeEnable = FALSE;


      m_nNextCassetteSequenceNo = 0;


   }




   CLoadPort::~CLoadPort()


@@ -74,15 +83,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;


         }


@@ -92,7 +101,7 @@


         // 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 writeSignalDev[] = { 0x90, 0x91, 0x92, 0x93 };


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


@@ -113,7 +122,7 @@


         // 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 writeSignalDev[] = { 0x98, 0x99, 0x9a, 0x9b };


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


@@ -134,7 +143,7 @@


         // 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 writeSignalDev[] = { 0xa0, 0xa1, 0xa2, 0xa3 };


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


@@ -155,7 +164,7 @@


         // 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 writeSignalDev[] = { 0xa8, 0xa9, 0xaa, 0xab };


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


@@ -176,7 +185,7 @@


         // 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 writeSignalDev[] = { 0xb0, 0xb1, 0xb2, 0xb3 };


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


@@ -299,7 +308,7 @@


         pStep->setName(pszName[m_nIndex]);


         pStep->setWriteSignalDev(0x128 + m_nIndex);


         pStep->setDataDev(dev[m_nIndex]);


         if (addStep(STEP_ID_PROT1_TYPE_AUTO_CHANGE_REPLY + m_nIndex, pStep) != 0) {


         if (addStep(STEP_ID_PROT1_CASSETTE_TYPE_CHANGE_REPLY + m_nIndex, pStep) != 0) {


            delete pStep;


         }


      }


@@ -315,12 +324,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 },


@@ -336,6 +345,7 @@


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


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


                     decodePortStatusReport((CStep*)pFrom, pszData, size);


                     return 0;


                  }


                  return -1;


               });


@@ -413,17 +423,22 @@


      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::CEqCassetteCtrlCmdStep* pStep = (SERVO::CEqCassetteCtrlCmdStep*)getCassetteCtrlCmdStep();


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


      ASSERT(pStep);


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




      ASSERT(jobExistenceSize == 12);


      ASSERT(pJobDataA);




      char szBuffer[1024] = { 0 };


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


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


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


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


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


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


   }




   CStep* CLoadPort::getCassetteCtrlCmdStep()


@@ -441,6 +456,16 @@


      Unlock();




      return pStep;


   }




   short CLoadPort::getNextCassetteSequenceNo()


   {


      m_nNextCassetteSequenceNo++;


      if (m_nNextCassetteSequenceNo >= 1000) {


         m_nNextCassetteSequenceNo = 0;


      }




      return (m_nIndex + 1) * 1000 + m_nNextCassetteSequenceNo;


   }




   void CLoadPort::setIndex(unsigned int index)


@@ -820,6 +845,8 @@




   void CLoadPort::onReceiveLBData(const char* pszData, size_t size)


   {


      __super::onReceiveLBData(pszData, 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,


@@ -854,12 +881,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_READ_STEP_SIGNAL2(typeReply[m_nIndex], pszData, size);


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


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


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


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


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


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


   }




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


@@ -872,15 +899,16 @@




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


      unsigned int weight = 201;


      CAttributeVector attrubutes;


      CAttributeVector& attrubutes = pStep->attributeVector();


      m_portStatusReport.getAttributeVector(attrubutes, weight);


      pStep->addAttributeVector(attrubutes);






      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;


   }




@@ -1092,13 +1120,8 @@


   /*


    * 生成测试用的玻璃列表


    */


   int CLoadPort::testGenerateGlassList(MaterialsType type, const char* pszPrefix, int startSuffix)


   int CLoadPort::testGenerateGlassList(MaterialsType type)


   {


      static unsigned short nJobSequenceNo = 0;


      static unsigned short nCassetteSequenceNo = 0;


      nCassetteSequenceNo++;






      // 如果非空就不生成了


      Lock();


      if (hasGlass()) {


@@ -1109,32 +1132,21 @@






      char szBuffer[64];


      int suffix = startSuffix;


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


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




         CJobDataB jb;


         CJobDataS js;




         sprintf_s(szBuffer, "%s%d", pszPrefix, suffix++);


         jb.setGlassId(szBuffer);


         jb.setCassetteSequenceNo(nCassetteSequenceNo);


         jb.setJobSequenceNo(++nJobSequenceNo);


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


         js.setCassetteSequenceNo(nCassetteSequenceNo);


         js.setJobSequenceNo(nJobSequenceNo);


         if (type == MaterialsType::G1) {


            js.setGlass1Id(szBuffer);


         }


         else if (type == MaterialsType::G2) {


            js.setGlass2Id(szBuffer);


         }




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


         pGlass->addPath(m_nID, 0);


         pGlass->processEnd(m_nID, 0);


         pGlass->setID(szBuffer);


         pGlass->setJobDataB(&jb);


         pGlass->setType(type);


         pGlass->setJobDataS(&js);


         m_slot[i].setContext(pGlass);


@@ -1143,4 +1155,42 @@


      return 0;


   }




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


   {


      char szBuffer[64];


      for (const auto& slot : config.vecSlot) {


         int nSlotIndex = slot.nSlotID - 1;


         if (nSlotIndex < 0 || nSlotIndex >= SLOT_MAX) {


            continue;


         }


         if (!slot.isEnabled) {


            m_slot[nSlotIndex].setContext(nullptr);


            continue;


         }




         CJobDataS js;


         js.setCassetteSequenceNo(getNextCassetteSequenceNo());


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




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


         js.setJobType(1);


         js.setMaterialsType(config.nMaterialType);




         js.setLotId(config.strLotID.c_str());


         js.setProductId(config.strProductID.c_str());


         js.setOperationId(config.strOperationID.c_str());


         js.setGlass1Id(szBuffer);




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


         pGlass->addPath(m_nID, 0);


         pGlass->processEnd(m_nID, 0);


         pGlass->setID(szBuffer);


         pGlass->setType(static_cast<SERVO::MaterialsType>(config.nMaterialType));


         pGlass->setJobDataS(&js);




         m_slot[nSlotIndex].setContext(pGlass);


      }




      return 0;


   }


}