| | |
| | | LOGI("<CEquipment-%s>发送RobotCmdS成功.", m_strName.c_str()); |
| | | } |
| | | else { |
| | | LOGI("<CEquipment-%s>发送RobotCmds失败,code:%d", m_strName.c_str(), code); |
| | | LOGE("<CEquipment-%s>发送RobotCmds失败,code:%d", m_strName.c_str(), code); |
| | | } |
| | | |
| | | return 0; |
| | |
| | | void CEFEM::initPins() |
| | | { |
| | | // 加入Pin初始化代码 |
| | | LOGI("<CEFEM>initPins"); |
| | | LOGD("<CEFEM>initPins"); |
| | | } |
| | | |
| | | void CEFEM::initSteps() |
| | |
| | | // Reserved 15W |
| | | short ack = (short)JobDataRequestAck::NG; // 不存在jobData |
| | | char szBuffer[1024] = { 0 }; |
| | | LOGI("<CEFEM-%s>JobDataRequest received (code=%d, size=%zu)", m_strName.c_str(), code, size); |
| | | if (m_pActiveContext != nullptr) { |
| | | CJobDataS* pJobDataS = ((CGlass*)m_pActiveContext)->getJobDataS(); |
| | | LOGI("<CEFEM-%s>JobDataRequest GlassID=%s", m_strName.c_str(), ((CGlass*)m_pActiveContext)->getID().c_str()); |
| | | if (pJobDataS != nullptr) { |
| | | pJobDataS->serialize(szBuffer, 1024); |
| | | ack = (short)JobDataRequestAck::OK; |
| | | LOGI("<CEFEM-%s>JobDataRequest OK (CassetteSeq=%d, JobSeq=%d)", |
| | | m_strName.c_str(), |
| | | pJobDataS->getCassetteSequenceNo(), |
| | | pJobDataS->getJobSequenceNo()); |
| | | } |
| | | else { |
| | | LOGW("<CEFEM-%s>JobDataRequest NG (JobDataS is null)", m_strName.c_str()); |
| | | } |
| | | } |
| | | else { |
| | | LOGW("<CEFEM-%s>JobDataRequest NG (ActiveContext is null)", m_strName.c_str()); |
| | | } |
| | | memcpy(&szBuffer[320 * 2], &ack, sizeof(short)); |
| | | LOGI("<CEFEM-%s>JobDataRequest response ack=%d", m_strName.c_str(), (int)ack); |
| | | ((CEqReadStep*)pFrom)->setReturnData(szBuffer, 336 * 2); |
| | | } |
| | | return -1; |
| | |
| | | |
| | | void CEFEM::printDebugRobotState() |
| | | { |
| | | LOGI("<CEFEM>Robot status:%d, ARM1:%s, ARM2:%s", |
| | | LOGD("<CEFEM>Robot status:%d, ARM1:%s, ARM2:%s", |
| | | m_robotData.status, |
| | | m_robotData.armState[0] ? _T("ON") : _T("OFF"), |
| | | m_robotData.armState[1] ? _T("ON") : _T("OFF")); |