| | |
| | | // log.error("小车复位失败,小车号{}!",rgvProtocol.getRgvNo()); |
| | | // break; |
| | | // } |
| | | rgvAvoidanceXYWrkMast(rgvProtocol.getRgvNo()); |
| | | rgvAvoidanceXYWrkMast(rgvProtocol.getRgvNo(),wrkMastSta.getWrkNo().shortValue()); |
| | | continue; |
| | | } |
| | | if (wrkMastSta.getWrkType()==6){ |
| | |
| | | /* |
| | | * 小车XY移动 避让 |
| | | * */ |
| | | public synchronized boolean rgvAvoidanceXYWrkMast(Integer rgvId){ |
| | | public synchronized boolean rgvAvoidanceXYWrkMast(Integer rgvId,short wrkNo1){ |
| | | if (rgvId==2){ |
| | | try{ |
| | | BasRgvMap basRgvMap = basRgvMapMapper.selectById(rgvId); |
| | | // 命令下发区 -------------------------------------------------------------------------- |
| | | RgvCommand rgvCommand = new RgvCommand(); |
| | | rgvCommand.setRgvNo(rgvId); // RGV编号 |
| | | rgvCommand.setTaskNo1((short) 0); // 工作号 |
| | | rgvCommand.setTaskNo1(wrkNo1); // 工作号 |
| | | rgvCommand.setAckFinish1((short) 1); // 任务完成确认位 |
| | | rgvCommand.setTaskMode1(RgvTaskModeType.NONE); // 任务模式 |
| | | rgvCommand.setSourceStaNo1((short)0); // 源站 |
| | |
| | | rgvCommand.setTaskMode2(RgvTaskModeType.X_MOVE); // 工位2任务模式: 回原点 |
| | | rgvCommand.setSourceStaNo2((short)121); |
| | | rgvCommand.setCommand((short) 2); //工位2任务确认 |
| | | if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(5, rgvCommand))) { |
| | | if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(10, rgvCommand))) { |
| | | //step=2,工位1、2写任务; step=4,工位1写任务; step=5,工位2写任务 step=9,回原点 9999任务号 |
| | | log.error("RGV命令下发失败,RGV号={},任务数据={}", rgvId, JSON.toJSON(rgvCommand)); |
| | | return false; |
| | |
| | | // 命令下发区 -------------------------------------------------------------------------- |
| | | RgvCommand rgvCommand = new RgvCommand(); |
| | | rgvCommand.setRgvNo(rgvId); // RGV编号 |
| | | rgvCommand.setTaskNo1((short) 0); // 工作号 |
| | | rgvCommand.setTaskNo1(wrkNo1); // 工作号 |
| | | rgvCommand.setAckFinish1((short) 1); // 任务完成确认位 |
| | | rgvCommand.setTaskMode1(RgvTaskModeType.NONE); // 任务模式 |
| | | rgvCommand.setSourceStaNo1((short)0); // 源站 |
| | |
| | | rgvCommand.setTaskMode2(RgvTaskModeType.X_MOVE); // 工位2任务模式: 回原点 |
| | | rgvCommand.setSourceStaNo2((short)118); |
| | | rgvCommand.setCommand((short) 2); //工位2任务确认 |
| | | if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(5, rgvCommand))) { |
| | | if (!MessageQueue.offer(SlaveType.Rgv, rgvId, new Task(10, rgvCommand))) { |
| | | //step=2,工位1、2写任务; step=4,工位1写任务; step=5,工位2写任务 step=9,回原点 9999任务号 |
| | | log.error("RGV命令下发失败,RGV号={},任务数据={}", rgvId, JSON.toJSON(rgvCommand)); |
| | | return false; |