| | |
| | | import com.zy.core.model.command.ShuttleCommand; |
| | | import com.zy.core.model.protocol.LiftProtocol; |
| | | import com.zy.core.model.protocol.ShuttleProtocol; |
| | | import com.zy.core.model.protocol.StaProtocol; |
| | | import com.zy.core.thread.DevpThread; |
| | | import com.zy.core.thread.LiftThread; |
| | | import com.zy.core.thread.ShuttleThread; |
| | | import lombok.extern.slf4j.Slf4j; |
| | |
| | | if (shuttleProtocol == null) { |
| | | return false; |
| | | } |
| | | |
| | | DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1); |
| | | if (devpThread == null) { |
| | | return false; |
| | | } |
| | | StaProtocol staProtocol = devpThread.getStation().get(Utils.getLev(wrkMast.getSourceLocNo()) == 1 ? 1015 : 1026); |
| | | if (!staProtocol.isLoading()) { |
| | | log.info("{}任务,{}号输送线无物", wrkMast.getWrkNo(), wrkMast.getSourceStaNo()); |
| | | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}号输送线无物", wrkMast.getWrkNo(), wrkMast.getSourceLocNo()); |
| | | return false; |
| | | } |
| | | //TODO |
| | | // if (!staProtocol.getFinishWorkNo().equals(wrkMast.getWrkNo())) { |
| | | // log.info( "{}任务,{}号输送线的工作号和工作档不匹配", wrkMast.getWrkNo(), wrkMast.getSourceStaNo()); |
| | | // News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}号输送线的工作号和工作档不匹配", wrkMast.getWrkNo(), wrkMast.getSourceStaNo()); |
| | | // return false; |
| | | // } |
| | | //小车处于空闲状态 |
| | | if (!shuttleThread.isIdle()) { |
| | | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}小车,小车忙碌中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo()); |
| | |
| | | Date now = new Date(); |
| | | |
| | | //小车移动至站点 301.生成小车移库任务 ==> 302.小车移动至站点中 |
| | | if (wrkMast.getWrkSts() == WrkStsType.MOVE_IN_NO_LIFT_2.sts) { |
| | | if (wrkMast.getWrkSts() == WrkStsType.MOVE_IN_NO_LIFT_1.sts) { |
| | | //获取四向穿梭车线程 |
| | | ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo()); |
| | | if (shuttleThread == null) { |
| | |
| | | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}小车,小车忙碌中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo()); |
| | | return false; |
| | | } |
| | | |
| | | if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) { |
| | | return false; |
| | | } |
| | | |
| | | //获取穿梭车最近且空闲的提升机 |
| | | LiftThread liftThread = LiftUtils.getRecentLift(shuttleProtocol.getCurrentLocNo()); |
| | |
| | | List<ShuttleCommand> commands = new ArrayList<>(); |
| | | Integer mapType = NavigationMapType.NORMAL.id; |
| | | |
| | | if (!liftStandByLocNo.equals(wrkMast.getSourceLocNo())) { |
| | | //获取小车到提升机待机位行走命令 |
| | | List<ShuttleCommand> moveCommands = shuttleOperaUtils.getStartToTargetCommands(shuttleProtocol.getCurrentLocNo(), liftStandByLocNo, mapType, assignCommand, shuttleThread); |
| | | if (moveCommands == null) { |
| | | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}小车,路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo()); |
| | | return false;//路径解锁失败 |
| | | } |
| | | commands.addAll(moveCommands); |
| | | |
| | | //获取小车到提升机待机位行走命令 |
| | | List<ShuttleCommand> moveCommands = shuttleOperaUtils.getStartToTargetCommands(shuttleProtocol.getCurrentLocNo(), liftStandByLocNo, mapType, assignCommand, shuttleThread); |
| | | if (moveCommands == null) { |
| | | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}小车,路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo()); |
| | | return false;//路径解锁失败 |
| | | } |
| | | commands.addAll(moveCommands); |
| | | |
| | | List<ShuttleCommand> liftCommand = shuttleOperaUtils.getShuttleLiftCommand(assignCommand, shuttleThread, true); |
| | | if (liftCommand == null) { |
| | |
| | | return false;//提升机内无小车 |
| | | } |
| | | |
| | | //判断提升机内是否有托盘 |
| | | if (!liftProtocol.getHasTray()) { |
| | | News.info("{}任务,{}号提升机,提升机内无托盘,禁止派发", wrkMast.getWrkNo(), liftProtocol.getLiftNo()); |
| | | return false;//提升机内无小车 |
| | | } |
| | | |
| | | |
| | | //判断提升机楼层 |
| | | if (liftProtocol.getLev() == Utils.getLev(shuttleProtocol.getCurrentLocNo())) { |
| | |
| | | return false;//提升机内无小车 |
| | | } |
| | | |
| | | //判断提升机内是否有托盘 |
| | | if (!liftProtocol.getHasTray()) { |
| | | News.info("{}任务,{}号提升机,提升机内无托盘,禁止派发", wrkMast.getWrkNo(), liftProtocol.getLiftNo()); |
| | | return false;//提升机内无小车 |
| | | } |
| | | |
| | | |
| | | //判断提升机楼层 |
| | | if (liftProtocol.getLev() != Utils.getLev(shuttleProtocol.getCurrentLocNo())) { |
| | |
| | | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}小车,小车忙碌中,禁止派发", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo()); |
| | | return false; |
| | | } |
| | | DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, 1); |
| | | if (devpThread == null) { |
| | | return false; |
| | | } |
| | | StaProtocol staProtocol = devpThread.getStation().get(Utils.getLev(wrkMast.getSourceLocNo()) == 1 ? 1015 : 1026); |
| | | if (!staProtocol.isLoading()) { |
| | | log.error("{}任务,{}号输送线无物", wrkMast.getWrkNo(), wrkMast.getSourceStaNo()); |
| | | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}号输送线无物", wrkMast.getWrkNo(), wrkMast.getSourceStaNo()); |
| | | return false; |
| | | } |
| | | //TODO |
| | | // if (!staProtocol.getFinishWorkNo().equals(wrkMast.getWrkNo())) { |
| | | // log.error("{}任务,{}号输送线的工作号和工作档不匹配", wrkMast.getWrkNo(), wrkMast.getSourceStaNo()); |
| | | // News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}号输送线的工作号和工作档不匹配", wrkMast.getWrkNo(), wrkMast.getSourceStaNo()); |
| | | // return false; |
| | | // } |
| | | |
| | | if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())){ |
| | | if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) { |
| | | return false; |
| | | } |
| | | |