| | |
| | | #include "stdafx.h" |
| | | #include "CEFEM.h" |
| | | #include "Log.h" |
| | | |
| | | |
| | | #define ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(name,ws,index,psd) { \ |
| | | #define ADD_EQ_PORT_STATUS_STEP(name,ws,index,psd) { \ |
| | | CEqCassetteTransferStateStep* pStep = new CEqCassetteTransferStateStep(); \ |
| | | pStep->setName(name); \ |
| | | pStep->setWriteSignalDev(ws); \ |
| | |
| | | if (index < 2) { |
| | | m_pArmTray[index] = pArmTray; |
| | | } |
| | | } |
| | | |
| | | int CEFEM::robotCmd(ROBOT_CMD_PARAM& robotCmdParam, ONWRITED onWritedBlock/* = nullptr*/) |
| | | { |
| | | SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(STEP_EFEM_ROBOT_CMD); |
| | | if (pStep == nullptr) { |
| | | return -1; |
| | | } |
| | | |
| | | LOGI("<CEFEM-%s>准备发送RobotCmd<%d>", m_strName.c_str(), (int)robotCmdParam.rcmd); |
| | | if (onWritedBlock != nullptr) { |
| | | pStep->writeDataEx((const char*)&robotCmdParam, ROBOT_CMD_PARAM_SIZE, onWritedBlock); |
| | | } |
| | | else { |
| | | pStep->writeDataEx((const char*)&robotCmdParam, ROBOT_CMD_PARAM_SIZE, [&](int code) -> int { |
| | | if (code == WOK) { |
| | | LOGI("<CEFEM-%s>发送RobotCmd成功.", m_strName.c_str()); |
| | | } |
| | | else { |
| | | LOGI("<CEFEM-%s>发送RobotCmd失败,code:%d", m_strName.c_str(), code); |
| | | } |
| | | |
| | | return 0; |
| | | }); |
| | | } |
| | | |
| | | return 0; |
| | | } |
| | | |
| | | int CEFEM::robotCmds(ROBOT_CMD_PARAM* robotCmdParam, unsigned int count, ONWRITED onWritedBlock/* = nullptr*/) |
| | | { |
| | | SERVO::CEqWriteStep* pStep = (SERVO::CEqWriteStep*)getStepWithName(STEP_EFEM_ROBOT_CMD); |
| | | if (pStep == nullptr) { |
| | | return -1; |
| | | } |
| | | |
| | | |
| | | // 平铺到内存中,如果ROBOT_CMD_PARAM不是4的整数倍,只能一个一个复制 |
| | | std::string strLog = "准备发送RobotCmds<"; |
| | | char szBuffer[ROBOT_CMD_PARAM_SIZE * 4]; |
| | | for (int i = 0; i < min(4, count); i++) { |
| | | memcpy(&szBuffer[i * ROBOT_CMD_PARAM_SIZE], (robotCmdParam + i), ROBOT_CMD_PARAM_SIZE); |
| | | strLog += std::to_string((robotCmdParam + i)->rcmd); |
| | | strLog += ","; |
| | | LOGI("%d", (robotCmdParam + 1)->rcmd); |
| | | } |
| | | strLog += ">."; |
| | | LOGI("<CEFEM-%s>%s", m_strName.c_str(), strLog.c_str()); |
| | | |
| | | |
| | | if (onWritedBlock != nullptr) { |
| | | pStep->writeDataEx(szBuffer, ROBOT_CMD_PARAM_SIZE * min(4, count), onWritedBlock); |
| | | } |
| | | else { |
| | | pStep->writeDataEx(szBuffer, ROBOT_CMD_PARAM_SIZE * min(4, count), [&](int code) -> int { |
| | | if (code == WOK) { |
| | | LOGI("<CEquipment-%s>发送RobotCmdS成功.", m_strName.c_str()); |
| | | } |
| | | else { |
| | | LOGI("<CEquipment-%s>发送RobotCmds失败,code:%d", m_strName.c_str(), code); |
| | | } |
| | | |
| | | return 0; |
| | | }); |
| | | } |
| | | |
| | | return 0; |
| | | } |
| | | |
| | | int CEFEM::SendHome(int seq) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Robot_home); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendTransfer(int seq, int armNo, int fromPos, int toPos, int fromSlot, int toSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Transfer); |
| | | cmd.armNo = static_cast<short>(armNo); |
| | | cmd.getPosition = static_cast<short>(fromPos); |
| | | cmd.getSlotNo = static_cast<short>(fromSlot); |
| | | cmd.putPosition = static_cast<short>(toPos); |
| | | cmd.putSlotNo = static_cast<short>(toSlot); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendMoveToGet(int seq, int armNo, int pos, int slot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Move); |
| | | cmd.armNo = static_cast<short>(armNo); |
| | | cmd.getPosition = static_cast<short>(pos); |
| | | cmd.getSlotNo = static_cast<short>(slot); |
| | | cmd.subCmd = 1; |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendMoveToPut(int seq, int armNo, int pos, int slot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Move); |
| | | cmd.armNo = static_cast<short>(armNo); |
| | | cmd.putPosition = static_cast<short>(pos); |
| | | cmd.putSlotNo = static_cast<short>(slot); |
| | | cmd.subCmd = 2; |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendGet(int seq, int armNo, int pos, int slot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Get); |
| | | cmd.armNo = static_cast<short>(armNo); |
| | | cmd.getPosition = static_cast<short>(pos); |
| | | cmd.getSlotNo = static_cast<short>(slot); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendPut(int seq, int armNo, int pos, int slot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Put); |
| | | cmd.armNo = static_cast<short>(armNo); |
| | | cmd.putPosition = static_cast<short>(pos); |
| | | cmd.putSlotNo = static_cast<short>(slot); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendExchange(int seq, int armNo, int pos, int getSlot, int putSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::One_Action_Exchange); |
| | | cmd.armNo = static_cast<short>(armNo); |
| | | cmd.getPosition = static_cast<short>(pos); |
| | | cmd.putPosition = static_cast<short>(pos); |
| | | cmd.getSlotNo = static_cast<short>(getSlot); |
| | | cmd.putSlotNo = static_cast<short>(putSlot); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendCommandClear(int seq) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Command_Clear); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendBatchGet(int seq, int getPos, int getSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Batch_get); |
| | | cmd.armNo = ARM_ALL; |
| | | cmd.getPosition = static_cast<short>(getPos); |
| | | cmd.getSlotNo = static_cast<short>(getSlot); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendBatchPut(int seq, int putPos, int putSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmd = {}; |
| | | cmd.sequenceNo = static_cast<short>(seq); |
| | | cmd.rcmd = static_cast<short>(SERVO::RCMD::Batch_put); |
| | | cmd.armNo = ARM_ALL; |
| | | cmd.putPosition = static_cast<short>(putPos); |
| | | cmd.putSlotNo = static_cast<short>(putSlot); |
| | | return robotCmd(cmd); |
| | | } |
| | | |
| | | int CEFEM::SendMoveToGetAndHome(int seq, int armNo, int getPos, int getSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmds[2] = {}; |
| | | |
| | | // Move to Get |
| | | cmds[0].sequenceNo = static_cast<short>(seq); |
| | | cmds[0].rcmd = static_cast<short>(SERVO::RCMD::Move); |
| | | cmds[0].armNo = static_cast<short>(armNo); |
| | | cmds[0].getPosition = static_cast<short>(getPos); |
| | | cmds[0].getSlotNo = static_cast<short>(getSlot); |
| | | cmds[0].subCmd = 1; |
| | | |
| | | // Home |
| | | cmds[1].sequenceNo = static_cast<short>(seq + 1); |
| | | cmds[1].rcmd = static_cast<short>(SERVO::RCMD::Robot_home); |
| | | |
| | | return robotCmds(cmds, 2); |
| | | } |
| | | |
| | | int CEFEM::SendMoveToPutAndHome(int seq, int armNo, int putPos, int putSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmds[2] = {}; |
| | | |
| | | // Move to Put |
| | | cmds[0].sequenceNo = static_cast<short>(seq); |
| | | cmds[0].rcmd = static_cast<short>(SERVO::RCMD::Move); |
| | | cmds[0].armNo = static_cast<short>(armNo); |
| | | cmds[0].putPosition = static_cast<short>(putPos); |
| | | cmds[0].putSlotNo = static_cast<short>(putSlot); |
| | | cmds[0].subCmd = 2; |
| | | |
| | | // Home |
| | | cmds[1].sequenceNo = static_cast<short>(seq + 1); |
| | | cmds[1].rcmd = static_cast<short>(SERVO::RCMD::Robot_home); |
| | | |
| | | return robotCmds(cmds, 2); |
| | | } |
| | | |
| | | int CEFEM::SendTransferAndHome(int seq, int armNo, int fromPos, int toPos, int fromSlot, int toSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmds[2] = {}; |
| | | |
| | | // Transfer |
| | | cmds[0].sequenceNo = static_cast<short>(seq); |
| | | cmds[0].rcmd = static_cast<short>(SERVO::RCMD::Transfer); |
| | | cmds[0].armNo = static_cast<short>(armNo); |
| | | cmds[0].getPosition = static_cast<short>(fromPos); |
| | | cmds[0].getSlotNo = static_cast<short>(fromSlot); |
| | | cmds[0].putPosition = static_cast<short>(toPos); |
| | | cmds[0].putSlotNo = static_cast<short>(toSlot); |
| | | |
| | | // Home |
| | | cmds[1].sequenceNo = static_cast<short>(seq + 1); |
| | | cmds[1].rcmd = static_cast<short>(SERVO::RCMD::Robot_home); |
| | | |
| | | return robotCmds(cmds, 2); |
| | | } |
| | | |
| | | int CEFEM::SendGetAndPut(int seq, int armNo, int getPos, int getSlot, int putPos, int putSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmds[2] = {}; |
| | | |
| | | cmds[0].sequenceNo = static_cast<short>(seq); |
| | | cmds[0].rcmd = static_cast<short>(SERVO::RCMD::Get); |
| | | cmds[0].armNo = static_cast<short>(armNo); |
| | | cmds[0].getPosition = static_cast<short>(getPos); |
| | | cmds[0].getSlotNo = static_cast<short>(getSlot); |
| | | |
| | | cmds[1].sequenceNo = static_cast<short>(seq + 1); |
| | | cmds[1].rcmd = static_cast<short>(SERVO::RCMD::Put); |
| | | cmds[1].armNo = static_cast<short>(armNo); |
| | | cmds[1].putPosition = static_cast<short>(putPos); |
| | | cmds[1].putSlotNo = static_cast<short>(putSlot); |
| | | |
| | | return robotCmds(cmds, 2); |
| | | } |
| | | |
| | | int CEFEM::SendPutAndHome(int seq, int armNo, int putPos, int putSlot) |
| | | { |
| | | SERVO::ROBOT_CMD_PARAM cmds[2] = {}; |
| | | |
| | | // Put |
| | | cmds[0].sequenceNo = static_cast<short>(seq); |
| | | cmds[0].rcmd = static_cast<short>(SERVO::RCMD::Put); |
| | | cmds[0].armNo = static_cast<short>(armNo); |
| | | cmds[0].putPosition = static_cast<short>(putPos); |
| | | cmds[0].putSlotNo = static_cast<short>(putSlot); |
| | | |
| | | // Home |
| | | cmds[1].sequenceNo = static_cast<short>(seq + 1); |
| | | cmds[1].rcmd = static_cast<short>(SERVO::RCMD::Robot_home); |
| | | |
| | | return robotCmds(cmds, 2); |
| | | } |
| | | |
| | | void CEFEM::init() |
| | |
| | | // eq cim mode change |
| | | CEqCimModeChangeStep* pStep = new CEqCimModeChangeStep(); |
| | | pStep->setName(STEP_CIM_MODE_CHANGE); |
| | | pStep->setWriteSignalDev(0x70); |
| | | pStep->setWriteSignalDev(0x60); |
| | | pStep->setCimModeDev(0x15); |
| | | if (addStep(STEP_ID_CIMMODE_CHANGED_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | |
| | | // eq cim message |
| | | CEqCimMessageCmdStep* pStep = new CEqCimMessageCmdStep(); |
| | | pStep->setName(STEP_CIM_MESSAGE_CMD); |
| | | pStep->setWriteSignalDev(0x71); |
| | | pStep->setWriteSignalDev(0x61); |
| | | pStep->setCimMessageDev(0x0); |
| | | if (addStep(STEP_ID_CIM_MSG_SET_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | |
| | | // CIM Message Confirm |
| | | CEqReadIntStep* pStep = new CEqReadIntStep(__INT32, 0x5f80); |
| | | pStep->setName(STEP_EQ_CIM_MESSAGE_CONFIRM); |
| | | pStep->setWriteSignalDev(0x59); |
| | | pStep->setWriteSignalDev(0x49); |
| | | if (addStep(STEP_ID_CIM_MSG_CONFIRM_REPORT, pStep) != 0) { |
| | | delete pStep; |
| | | } |
| | | } |
| | | |
| | | { |
| | | // VCR1 Event Report |
| | | CEqVcrEventStep* pStep = new CEqVcrEventStep(); |
| | | // VCR Event Report |
| | | // 机器上报扫码结果,扫码器预计安装在巡边检机器上 |
| | | CEqReadStep* pStep = new CEqReadStep(0x5fef, 15 * 2, |
| | | [&](void* pFrom, int code, const char* pszData, size_t size) -> int { |
| | | if (code == ROK && pszData != nullptr && size > 0) { |
| | | decodeVCREventReport((CStep*)pFrom, pszData, size); |
| | | } |
| | | return -1; |
| | | }); |
| | | pStep->setName(STEP_EQ_VCR1_EVENT_REPORT); |
| | | pStep->setProp("Port", (void*)1); |
| | | pStep->setWriteSignalDev(0x4a); |
| | | pStep->setReturnDev(0x91e); |
| | | pStep->setVcrEventReportDev(0x5fef); |
| | | if (addStep(STEP_ID_VCR1_EVENT_REPORT, pStep) != 0) { |
| | | delete pStep; |
| | | } |
| | |
| | | // eq cim message clear |
| | | CEqCimMessageClearStep* pStep = new CEqCimMessageClearStep(); |
| | | pStep->setName(STEP_CIM_MESSAGE_CLEAR); |
| | | pStep->setWriteSignalDev(0x72); |
| | | pStep->setWriteSignalDev(0x62); |
| | | pStep->setClearCimMessageDev(0x13); |
| | | if (addStep(STEP_ID_CIM_MSG_CLEAR_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | |
| | | // datetime set cmd |
| | | CEqDateTimeSetCmdStep* pStep = new CEqDateTimeSetCmdStep(); |
| | | pStep->setName(STEP_DATETIME_SET_CMD); |
| | | pStep->setWriteSignalDev(0x73); |
| | | pStep->setWriteSignalDev(0x63); |
| | | pStep->setDateTimeDev(0x16); |
| | | if (addStep(STEP_ID_DATETIME_SET_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | |
| | | // vcr enable |
| | | CEqVCREnableStep* pStep = new CEqVCREnableStep(); |
| | | pStep->setName(STEP_EQ_VCR_ENABLE); |
| | | pStep->setWriteSignalDev(0x74); |
| | | pStep->setWriteSignalDev(0x64); |
| | | pStep->setEqVCRModeDev(0x1F); |
| | | if (addStep(STEP_ID_VCR_ENABLE_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | |
| | | // eq mode change |
| | | CEqModeChangeStep* pStep = new CEqModeChangeStep(); |
| | | pStep->setName(STEP_EQ_MODE_CHANGE); |
| | | pStep->setWriteSignalDev(0x75); |
| | | pStep->setWriteSignalDev(0x65); |
| | | pStep->setEqModeDev(0x1E); |
| | | if (addStep(STEP_ID_EQMODE_CHANGE_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | |
| | | } |
| | | } |
| | | |
| | | // CEqCassetteTranserStateStep |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P1_CASSETTE_EMPTY, 0xd8, |
| | | STEP_ID_PORT1_CASSETTIE_EMPTY, 0x6050); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P1_CASSETTE_LOAD_EADY, 0xe0, |
| | | STEP_ID_PORT1_CASSETTIE_LOAD_READY, 0x6050); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P1_CASSETTE_LOADED, 0xe8, |
| | | STEP_ID_PORT1_CASSETTIE_LOADED, 0x6050); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P1_CASSETTE_INUSE, 0xf0, |
| | | STEP_ID_PORT1_CASSETTIE_INUSE, 0x6050); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P1_CASSETTE_UNLOAD_EADY, 0xf8, |
| | | STEP_ID_PORT1_CASSETTIE_UNLOAD_READY, 0x60f50); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P1_CASSETTE_BLOCKED, 0x100, |
| | | STEP_ID_PORT1_CASSETTIE_BLOCKED, 0x6050); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P2_CASSETTE_EMPTY, 0xd9, |
| | | STEP_ID_PORT2_CASSETTIE_EMPTY, 0x6070); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P2_CASSETTE_LOAD_EADY, 0xe1, |
| | | STEP_ID_PORT2_CASSETTIE_LOAD_READY, 0x6070); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P2_CASSETTE_LOADED, 0xe9, |
| | | STEP_ID_PORT2_CASSETTIE_LOADED, 0x6070); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P2_CASSETTE_INUSE, 0xf1, |
| | | STEP_ID_PORT2_CASSETTIE_INUSE, 0x6070); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P2_CASSETTE_UNLOAD_EADY, 0xf9, |
| | | STEP_ID_PORT2_CASSETTIE_UNLOAD_READY, 0x6070); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P2_CASSETTE_BLOCKED, 0x101, |
| | | STEP_ID_PORT2_CASSETTIE_BLOCKED, 0x6070); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P3_CASSETTE_EMPTY, 0xda, |
| | | STEP_ID_PORT3_CASSETTIE_EMPTY, 0x6090); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P3_CASSETTE_LOAD_EADY, 0xe2, |
| | | STEP_ID_PORT3_CASSETTIE_LOAD_READY, 0x6090); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P3_CASSETTE_LOADED, 0xea, |
| | | STEP_ID_PORT3_CASSETTIE_INUSE, 0x6090); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P3_CASSETTE_INUSE, 0xf2, |
| | | STEP_ID_PORT3_CASSETTIE_INUSE, 0x6090); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P3_CASSETTE_UNLOAD_EADY, 0xfa, |
| | | STEP_ID_PORT3_CASSETTIE_UNLOAD_READY, 0x6090); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P3_CASSETTE_BLOCKED, 0x102, |
| | | STEP_ID_PORT3_CASSETTIE_BLOCKED, 0x6090); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P4_CASSETTE_EMPTY, 0xdb, |
| | | STEP_ID_PORT4_CASSETTIE_EMPTY, 0x60b0); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P4_CASSETTE_LOAD_EADY, 0xe3, |
| | | STEP_ID_PORT4_CASSETTIE_LOAD_READY, 0x60b0); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P4_CASSETTE_LOADED, 0xeb, |
| | | STEP_ID_PORT4_CASSETTIE_LOADED, 0x60b0); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P4_CASSETTE_INUSE, 0xf3, |
| | | STEP_ID_PORT4_CASSETTIE_INUSE, 0x60b0); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P4_CASSETTE_UNLOAD_EADY, 0xfb, |
| | | STEP_ID_PORT4_CASSETTIE_UNLOAD_READY, 0x60b0); |
| | | ADD_EQ_CASSETTE_TRANSFER_STATE_STEP(STEP_EQ_P4_CASSETTE_BLOCKED, 0x103, |
| | | STEP_ID_PORT4_CASSETTIE_BLOCKED, 0x60b0); |
| | | { |
| | | // Received Job Report Upstream#1~9 |
| | | char szBuffer[256]; |
| | | for (int i = 0; i < 9; i++) { |
| | | CEqReadStep* pStep = new CEqReadStep(0x4c90 + 320 * i, 320 * 2, |
| | | [&](void* pFrom, int code, const char* pszData, size_t size) -> int { |
| | | if (code == ROK && pszData != nullptr && size > 0) { |
| | | int port = (int)(__int64)((CEqReadStep*)pFrom)->getProp("Port"); |
| | | if (port > 0) { |
| | | decodeFetchedOutJobReport((CStep*)pFrom, port, pszData, size); |
| | | } |
| | | } |
| | | return -1; |
| | | }); |
| | | sprintf_s(szBuffer, "%s%d", STEP_EQ_RECEIVED_JOBn, i + 1); |
| | | pStep->setName(szBuffer); |
| | | pStep->setProp("Upstream", (void*)(__int64)(i + 1)); |
| | | pStep->setWriteSignalDev(0x0 + i); |
| | | if (addStep(STEP_ID_FETCHED_OUT_JOB_REPORT1 + i, pStep) != 0) { |
| | | delete pStep; |
| | | } |
| | | } |
| | | } |
| | | |
| | | { |
| | | // Fetched Out Job Report #1~15 |
| | |
| | | if (code == ROK && pszData != nullptr && size > 0) { |
| | | int port = (int)(__int64)((CEqReadStep*)pFrom)->getProp("Port"); |
| | | if (port > 0) { |
| | | decodeFetchedOutJobReport(port, pszData, size); |
| | | decodeFetchedOutJobReport((CStep*)pFrom, port, pszData, size); |
| | | } |
| | | } |
| | | return -1; |
| | |
| | | if (code == ROK && pszData != nullptr && size > 0) { |
| | | int port = (int)(__int64)((CEqReadStep*)pFrom)->getProp("Port"); |
| | | if (port > 0) { |
| | | decodeStoredJobReport(port, pszData, size); |
| | | decodeStoredJobReport((CStep*)pFrom, port, pszData, size); |
| | | } |
| | | } |
| | | return -1; |
| | |
| | | } |
| | | } |
| | | } |
| | | } |
| | | |
| | | int CEFEM::onStepEvent(CStep* pStep, int code) |
| | | { |
| | | int nRet = CEquipment::onStepEvent(pStep, code); |
| | | if (nRet > 0) return nRet; |
| | | |
| | | if (code == STEP_EVENT_READDATA) { |
| | | if (isCassetteTransferStateStep(pStep)) { |
| | | SERVO::CEqCassetteTransferStateStep* pEqCassetteStep = (SERVO::CEqCassetteTransferStateStep*)pStep; |
| | | int id = pEqCassetteStep->getID(); |
| | | if (id == STEP_ID_PORT1_CASSETTIE_EMPTY) { |
| | | |
| | | } |
| | | { |
| | | // Dispatching Mode Change Command |
| | | CEqWriteStep* pStep = new CEqWriteStep(); |
| | | pStep->setName(STEP_EQ_DISPATCHINT_MODE_CHANGE); |
| | | pStep->setWriteSignalDev(0x071); |
| | | pStep->setDataDev(0x5c6); |
| | | if (addStep(STEP_ID_DISPATCHING_MODE_CHANGE_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | | } |
| | | } |
| | | |
| | | { |
| | | // Robot CMD |
| | | CEqWriteStep* pStep = new CEqWriteStep(); |
| | | pStep->setName(STEP_EFEM_ROBOT_CMD); |
| | | pStep->setWriteSignalDev(0x14D); |
| | | pStep->setDataDev(0x90a); |
| | | if (addStep(STEP_ID_ROBOT_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | | } |
| | | } |
| | | |
| | | return 0; |
| | | { |
| | | // Indexer Operation Mode Change |
| | | CEqWriteStep* pStep = new CEqWriteStep(); |
| | | pStep->setName(STEP_EFEM_IN_OP_MODE_CHANGE); |
| | | pStep->setWriteSignalDev(0x070); |
| | | pStep->setDataDev(0x023); |
| | | if (addStep(STEP_ID_IN_OP_CMD_REPLY, pStep) != 0) { |
| | | delete pStep; |
| | | } |
| | | } |
| | | } |
| | | |
| | | void CEFEM::onTimer(UINT nTimerid) |
| | |
| | | } |
| | | } |
| | | |
| | | int CEFEM::onFetchedOut(int port, const char* pszGlassId) |
| | | int CEFEM::onReceivedJob(int port, CJobDataS* pJobDataS) |
| | | { |
| | | m_pPort[0]->onReceivedJob(port, pJobDataS); |
| | | m_pPort[1]->onReceivedJob(port, pJobDataS); |
| | | m_pPort[2]->onReceivedJob(port, pJobDataS); |
| | | m_pPort[3]->onReceivedJob(port, pJobDataS); |
| | | m_pArmTray[0]->onReceivedJob(port, pJobDataS); |
| | | m_pArmTray[1]->onReceivedJob(port, pJobDataS); |
| | | m_pAligner->onReceivedJob(port, pJobDataS); |
| | | m_pFliper->onReceivedJob(port, pJobDataS); |
| | | |
| | | return 0; |
| | | } |
| | | |
| | | int CEFEM::onSentOutJob(int port, CJobDataS* pJobDataS) |
| | | { |
| | | m_pPort[0]->onSentOutJob(port, pJobDataS); |
| | | m_pPort[1]->onSentOutJob(port, pJobDataS); |
| | | m_pPort[2]->onSentOutJob(port, pJobDataS); |
| | | m_pPort[3]->onSentOutJob(port, pJobDataS); |
| | | m_pArmTray[0]->onSentOutJob(port, pJobDataS); |
| | | m_pArmTray[1]->onSentOutJob(port, pJobDataS); |
| | | m_pAligner->onSentOutJob(port, pJobDataS); |
| | | m_pFliper->onSentOutJob(port, pJobDataS); |
| | | |
| | | return 0; |
| | | } |
| | | |
| | | int CEFEM::onFetchedOutJob(int port, CJobDataB* pJobDataB) |
| | | { |
| | | if (port == 1) { |
| | | return m_pPort[0]->fetchedOut(pszGlassId); |
| | | return m_pPort[0]->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | if (port == 2) { |
| | | return m_pPort[1]->fetchedOut(pszGlassId); |
| | | return m_pPort[1]->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | if (port == 3) { |
| | | return m_pPort[2]->fetchedOut(pszGlassId); |
| | | return m_pPort[2]->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | if (port == 4) { |
| | | return m_pPort[3]->fetchedOut(pszGlassId); |
| | | return m_pPort[3]->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | if (port == 5) { |
| | | return m_pArmTray[0]->fetchedOut(pszGlassId); |
| | | return m_pArmTray[0]->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | if (port == 6) { |
| | | return m_pArmTray[1]->fetchedOut(pszGlassId); |
| | | return m_pArmTray[1]->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | if (port == 7) { |
| | | return m_pAligner->fetchedOut(pszGlassId); |
| | | return m_pAligner->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | if (port == 8) { |
| | | return m_pFliper->fetchedOut(pszGlassId); |
| | | return m_pFliper->onFetchedOutJob(port, pJobDataB); |
| | | } |
| | | |
| | | return -1; |
| | | } |
| | | |
| | | int CEFEM::onStore(int port, const char* pszGlassId) |
| | | int CEFEM::onStoredJob(int port, CJobDataB* pJobDataB) |
| | | { |
| | | if (port == 1) { |
| | | return m_pPort[0]->storedJob(pszGlassId); |
| | | return m_pPort[0]->onStoredJob(port, pJobDataB); |
| | | } |
| | | if (port == 2) { |
| | | return m_pPort[1]->storedJob(pszGlassId); |
| | | return m_pPort[1]->onStoredJob(port, pJobDataB); |
| | | } |
| | | if (port == 3) { |
| | | return m_pPort[2]->storedJob(pszGlassId); |
| | | return m_pPort[2]->onStoredJob(port, pJobDataB); |
| | | } |
| | | if (port == 4) { |
| | | return m_pPort[3]->storedJob(pszGlassId); |
| | | return m_pPort[3]->onStoredJob(port, pJobDataB); |
| | | } |
| | | if (port == 5) { |
| | | return m_pArmTray[0]->storedJob(pszGlassId); |
| | | return m_pArmTray[0]->onStoredJob(port, pJobDataB); |
| | | } |
| | | if (port == 6) { |
| | | return m_pArmTray[1]->storedJob(pszGlassId); |
| | | return m_pArmTray[1]->onStoredJob(port, pJobDataB); |
| | | } |
| | | if (port == 7) { |
| | | return m_pAligner->storedJob(pszGlassId); |
| | | return m_pAligner->onStoredJob(port, pJobDataB); |
| | | } |
| | | if (port == 8) { |
| | | return m_pFliper->storedJob(pszGlassId); |
| | | return m_pFliper->onStoredJob(port, pJobDataB); |
| | | } |
| | | |
| | | return -1; |
| | | } |
| | | |
| | | int CEFEM::getIndexerOperationModeBaseValue() |
| | | { |
| | | return 10000; |
| | | } |
| | | } |