| | |
| | | crnCommand.setTaskNo((short)999); // 工作号 |
| | | crnCommand.setAckFinish((short) 0); // 任务完成确认位 |
| | | crnCommand.setTaskMode(CrnTaskModeType.GO_ORIGIN); // 任务模式: 站位移转4 |
| | | crnCommand.setSourcePosX((short) 1); // 源库位排 |
| | | Integer crnNo = crnProtocol.getCrnNo(); |
| | | int row1 = crnNo * 4; |
| | | if (crnNo>2){ |
| | | row1 = row1-2; |
| | | } |
| | | crnCommand.setSourcePosX((short) row1); // 源库位排 |
| | | crnCommand.setSourcePosY((short) 1); // 源库位列 |
| | | crnCommand.setSourcePosZ((short) 1); // 源库位层 |
| | | crnCommand.setDestinationPosX((short) 1); // 目标库位排 |
| | | crnCommand.setDestinationPosX((short) row1); // 目标库位排 |
| | | crnCommand.setDestinationPosY((short) 1); // 目标库位层 |
| | | crnCommand.setDestinationPosZ((short) 1); // 目标库位列 |
| | | if (!MessageQueue.offer(SlaveType.Crn, crnProtocol.getCrnNo(), new Task(2, crnCommand))) { |