|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | import com.alibaba.fastjson.JSON; | 
|---|
|  |  |  | import com.baomidou.mybatisplus.mapper.EntityWrapper; | 
|---|
|  |  |  | import com.core.common.SpringUtils; | 
|---|
|  |  |  | import com.zy.asrs.domain.enums.NotifyMsgType; | 
|---|
|  |  |  | import com.zy.asrs.entity.*; | 
|---|
|  |  |  | import com.zy.asrs.service.*; | 
|---|
|  |  |  | 
|---|
|  |  |  | public synchronized boolean shuttleInExecuteStep1(WrkMast wrkMast) { | 
|---|
|  |  |  | if (wrkMast.getWrkSts() == WrkStsType.INBOUND_LIFT_RUN_COMPLETE.sts) { | 
|---|
|  |  |  | //获取目标站 | 
|---|
|  |  |  | ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo()); | 
|---|
|  |  |  | LiftStaProtocol liftSta = LiftUtils.getLiftStaByStaNo(wrkMast.getStaNo()); | 
|---|
|  |  |  | if (liftSta == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,缺少站点信息,禁止派发", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | 
|---|
|  |  |  | assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号 | 
|---|
|  |  |  | assignCommand.setTaskMode(ShuttleTaskModeType.TRANSPORT.id);//小车移库任务 | 
|---|
|  |  |  | assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号 | 
|---|
|  |  |  | assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位 | 
|---|
|  |  |  | assignCommand.setLocNo(wrkMast.getLocNo());//目标库位 | 
|---|
|  |  |  | assignCommand.setAuto(true);//自动模式 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取小车到输送站点行走命令 | 
|---|
|  |  |  | //获取小车到目标库位命令 | 
|---|
|  |  |  | List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(liftSta.getLocNo(), wrkMast.getLocNo(), NavigationMapType.getDfxWithDevice(), assignCommand, shuttleThread); | 
|---|
|  |  |  | if (commands == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}小车,路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo()); | 
|---|
|  |  |  | 
|---|
|  |  |  | Integer liftNo = wrkMast.getLiftNo(); | 
|---|
|  |  |  | if (liftNo == null) { | 
|---|
|  |  |  | //通过输送线站号获取提升机号 | 
|---|
|  |  |  | liftNo = ForkLiftUtils.getConveyorBindLiftNo(wrkMast.getStaNo()); | 
|---|
|  |  |  | liftNo = LiftUtils.getConveyorBindLiftNo(wrkMast.getStaNo()); | 
|---|
|  |  |  | if (liftNo == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,未找到匹配的提升机", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, liftNo); | 
|---|
|  |  |  | if (forkLiftThread == null) { | 
|---|
|  |  |  | LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftNo); | 
|---|
|  |  |  | if (liftThread == null) { | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus(); | 
|---|
|  |  |  | if (forkLiftProtocol == null) { | 
|---|
|  |  |  | LiftProtocol liftProtocol = liftThread.getStatus(); | 
|---|
|  |  |  | if (liftProtocol == null) { | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //判断提升机是否处于出库模式 | 
|---|
|  |  |  | if (!forkLiftProtocol.getIOModeType().equals(ForkLiftIoModeType.OUT)) { | 
|---|
|  |  |  | if (!liftProtocol.getIOModeType().equals(LiftIoModeType.OUT)) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,提升机不处于出库模式,禁止出库", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取源站 | 
|---|
|  |  |  | ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByLev(liftNo, Utils.getLev(wrkMast.getSourceLocNo())); | 
|---|
|  |  |  | LiftStaProtocol liftSta = LiftUtils.getLiftStaByLev(liftNo, Utils.getLev(wrkMast.getSourceLocNo())); | 
|---|
|  |  |  | if (liftSta == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,缺少站点信息,禁止派发", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (liftSta.getHasCar()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}站点存在小车,禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo()); | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}站点存在小车,禁止派发", wrkMast.getWrkNo(), liftSta.getSiteId()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (liftSta.getHasTray()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}站点有托盘,禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo()); | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}站点有托盘,禁止派发", wrkMast.getWrkNo(), liftSta.getSiteId()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号 | 
|---|
|  |  |  | assignCommand.setTaskMode(ShuttleTaskModeType.TRANSPORT.id);//小车移库任务 | 
|---|
|  |  |  | assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号 | 
|---|
|  |  |  | assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位 | 
|---|
|  |  |  | assignCommand.setLocNo(liftSta.getLocNo());//目标库位 | 
|---|
|  |  |  | assignCommand.setAuto(true);//自动模式 | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取小车到输送站点行走命令 | 
|---|
|  |  |  | 
|---|
|  |  |  | assignCommand.setCommands(commands); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | wrkMast.setWrkSts(WrkStsType.OUTBOUND_SHUTTLE_RUN.sts);//小车搬运中  101.生成出库任务 ==> 102.小车搬运中 | 
|---|
|  |  |  | wrkMast.setSourceStaNo(liftSta.getStaNo()); | 
|---|
|  |  |  | wrkMast.setSourceStaNo(liftSta.getSiteId()); | 
|---|
|  |  |  | wrkMast.setModiTime(new Date()); | 
|---|
|  |  |  | wrkMast.setSystemMsg("");//清空消息 | 
|---|
|  |  |  | if (wrkMastService.updateById(wrkMast)) { | 
|---|
|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //判断小车是否到达货物库位 | 
|---|
|  |  |  | if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) { | 
|---|
|  |  |  | //任务被避障取消 | 
|---|
|  |  |  | Object cancelLock = redisUtil.get(RedisKeyType.TRAFFIC_CONTROL_SHUTTLE_OBSTACLE_CANCEL_TASK_LOCK.key + wrkMast.getShuttleNo()); | 
|---|
|  |  |  | if(cancelLock != null) { | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //小车未到达取货位置 | 
|---|
|  |  |  | shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在库位进行取货 | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,小车未到达取货位置", wrkMast.getWrkNo(), wrkMast.getSourceLocNo()); | 
|---|
|  |  |  | 
|---|
|  |  |  | assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号 | 
|---|
|  |  |  | assignCommand.setTaskMode(ShuttleTaskModeType.TRANSPORT.id);//小车移库任务 | 
|---|
|  |  |  | assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号 | 
|---|
|  |  |  | assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位 | 
|---|
|  |  |  | assignCommand.setLocNo(wrkMast.getLocNo());//目标库位 | 
|---|
|  |  |  | assignCommand.setAuto(true);//自动模式 | 
|---|
|  |  |  | assignCommand.setLocNo(wrkMast.getLocNo()); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取小车到输送站点行走命令 | 
|---|
|  |  |  | List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(wrkMast.getSourceLocNo(), wrkMast.getLocNo(), NavigationMapType.getMapTypes(NavigationMapType.DFX), assignCommand, shuttleThread); | 
|---|
|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //1.生成入库任务 ==> 3.提升机搬运中 | 
|---|
|  |  |  | if (wrkMast.getWrkSts() == WrkStsType.NEW_INBOUND.sts) { | 
|---|
|  |  |  | //获取源输送站 | 
|---|
|  |  |  | LiftStaProtocol sourceLiftSta = LiftUtils.getLiftStaByStaNo(wrkMast.getSourceStaNo()); | 
|---|
|  |  |  | if (sourceLiftSta == null) { | 
|---|
|  |  |  | return false;//找不到站点 | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (!sourceLiftSta.getHasTray()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,源站无托盘", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取目标输送站 | 
|---|
|  |  |  | ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo()); | 
|---|
|  |  |  | LiftStaProtocol liftSta = LiftUtils.getLiftStaByStaNo(wrkMast.getStaNo()); | 
|---|
|  |  |  | if (liftSta == null) { | 
|---|
|  |  |  | return false;//找不到站点 | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (liftSta.getHasTray()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,目标站存在托盘", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (liftSta.getHasCar()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,目标站存在小车", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取小车待机位 | 
|---|
|  |  |  | String standbyLocNo = Utils.getShuttleStandbyLocNo(liftSta.getLocNo()); | 
|---|
|  |  |  | if (standbyLocNo == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,获取小车待机位失败", wrkMast.getWrkNo()); | 
|---|
|  |  |  | String targetLocNo = navigateUtils.calcEndLocation(wrkMast.getLocNo(), liftSta.getLocNo(), NavigationMapType.getMapTypes(NavigationMapType.NORMAL), null, null, 2); | 
|---|
|  |  |  | if (targetLocNo == null) {//出输送线站点计算失败 | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,调度小车去入库层近点计算失败", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //调度小车去待机位 | 
|---|
|  |  |  | boolean dispatchShuttle = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), standbyLocNo); | 
|---|
|  |  |  | boolean dispatchShuttle = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), targetLocNo); | 
|---|
|  |  |  | if (!dispatchShuttle) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,调度小车失败", wrkMast.getWrkNo()); | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,调度小车去入库层失败", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取提升机命令 | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getPickAndPutCommand(wrkMast.getWrkNo(), wrkMast.getSourceStaNo(), liftSta.getLev()); | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getPickAndPutCommand(wrkMast.getWrkNo(), wrkMast.getSourceStaNo(), liftSta.getSiteId()); | 
|---|
|  |  |  | ArrayList<LiftCommand> commands = new ArrayList<>(); | 
|---|
|  |  |  | commands.add(liftCommand); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | assignCommand.setCommands(commands); | 
|---|
|  |  |  | assignCommand.setLiftNo(liftNo); | 
|---|
|  |  |  | assignCommand.setTaskNo(wrkMast.getWrkNo()); | 
|---|
|  |  |  | assignCommand.setTaskMode(ForkLiftTaskModeType.PICK_PUT.id); | 
|---|
|  |  |  | assignCommand.setTaskMode(LiftTaskModeType.PICK_PUT.id); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | wrkMast.setWrkSts(WrkStsType.INBOUND_LIFT_RUN.sts);//提升机搬运中  1.生成入库任务 ==> 3.提升机搬运中 | 
|---|
|  |  |  | wrkMast.setSystemMsg("");//清空消息 | 
|---|
|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (shuttleProtocol.getCurrentLocNo().equals(liftSta.getLocNo())) { | 
|---|
|  |  |  | //小车还在输送站点 | 
|---|
|  |  |  | //获取小车待机位 | 
|---|
|  |  |  | String standbyLocNo = Utils.getShuttleStandbyLocNo(liftSta.getLocNo()); | 
|---|
|  |  |  | if (standbyLocNo == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,获取小车待机位失败", wrkMast.getWrkNo()); | 
|---|
|  |  |  | //小车出提升机近点距离 | 
|---|
|  |  |  | int shuttleOutLiftLocationDistance = 2; | 
|---|
|  |  |  | Config shuttleOutLiftLocationDistanceConfig = configService.selectOne(new EntityWrapper<Config>().eq("code", "shuttleOutLiftLocationDistance")); | 
|---|
|  |  |  | if (shuttleOutLiftLocationDistanceConfig != null) { | 
|---|
|  |  |  | shuttleOutLiftLocationDistance = Integer.parseInt(shuttleOutLiftLocationDistanceConfig.getValue()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | String targetLocNo = navigateUtils.calcFirstLocation(shuttleProtocol.getCurrentLocNo(), wrkMast.getSourceLocNo(), NavigationMapType.getMapTypes(NavigationMapType.NORMAL), null, null, shuttleOutLiftLocationDistance); | 
|---|
|  |  |  | if (targetLocNo == null) {//出输送线站点计算失败 | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}小车,出输送线站点计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //调度小车去待机位 | 
|---|
|  |  |  | boolean dispatchShuttle = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), standbyLocNo, wrkMast.getShuttleNo()); | 
|---|
|  |  |  | boolean dispatchShuttle = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), targetLocNo, wrkMast.getShuttleNo()); | 
|---|
|  |  |  | if (!dispatchShuttle) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,小车在输送站点调度小车避让失败", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (liftSta.getHasCar()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}站点存在小车,禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (!liftSta.getHasTray()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}站点无托盘,禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo()); | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}站点无托盘,禁止派发", wrkMast.getWrkNo(), liftSta.getSiteId()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | if (liftNo == null) { | 
|---|
|  |  |  | //未分配提升机 | 
|---|
|  |  |  | Integer staNo = wrkMast.getStaNo(); | 
|---|
|  |  |  | liftNo = ForkLiftUtils.getConveyorBindLiftNo(staNo); | 
|---|
|  |  |  | liftNo = LiftUtils.getConveyorBindLiftNo(staNo); | 
|---|
|  |  |  | if(liftNo == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,未找到匹配的提升机", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取提升机命令 | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getPickAndPutCommand(wrkMast.getWrkNo(), liftSta.getLev(), wrkMast.getStaNo()); | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getPickAndPutCommand(wrkMast.getWrkNo(), liftSta.getSiteId(), wrkMast.getStaNo()); | 
|---|
|  |  |  | ArrayList<LiftCommand> commands = new ArrayList<>(); | 
|---|
|  |  |  | commands.add(liftCommand); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | assignCommand.setCommands(commands); | 
|---|
|  |  |  | assignCommand.setLiftNo(liftNo); | 
|---|
|  |  |  | assignCommand.setTaskNo(wrkMast.getWrkNo()); | 
|---|
|  |  |  | assignCommand.setTaskMode(ForkLiftTaskModeType.PICK_PUT.id); | 
|---|
|  |  |  | assignCommand.setTaskMode(LiftTaskModeType.PICK_PUT.id); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | wrkMast.setWrkSts(WrkStsType.OUTBOUND_LIFT_RUN.sts);//提升机搬运中  103.生成入库任务 ==> 104.提升机搬运中 | 
|---|
|  |  |  | wrkMast.setShuttleNo(null);//释放小车 | 
|---|
|  |  |  | 
|---|
|  |  |  | } | 
|---|
|  |  |  | LiftProtocol liftProtocol = liftThread.getStatus(); | 
|---|
|  |  |  | if (liftProtocol == null) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (!liftThread.isDeviceIdle()) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | News.error("提升机已确认且任务完成状态,复位失败,但未找到工作档。提升机号={},工作号={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | }else { | 
|---|
|  |  |  | boolean checkPreviewDispatchForkLift = commonService.checkWorkNoContainMk(liftProtocol.getTaskNo(), WrkIoType.PREVIEW_LIFT_MOVE.id); | 
|---|
|  |  |  | if (checkPreviewDispatchForkLift) { | 
|---|
|  |  |  | boolean checkPreviewDispatchLift = commonService.checkWorkNoContainMk(liftProtocol.getTaskNo(), WrkIoType.PREVIEW_LIFT_MOVE.id); | 
|---|
|  |  |  | if (checkPreviewDispatchLift) { | 
|---|
|  |  |  | //属于提升机预调度移动任务 | 
|---|
|  |  |  | //无工作档支撑,直接确认完成 | 
|---|
|  |  |  | liftThread.setSyncTaskNo(0); | 
|---|
|  |  |  | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | private void recLiftErr() { | 
|---|
|  |  |  | Date now = new Date(); | 
|---|
|  |  |  | List<DeviceConfig> forkliftList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>() | 
|---|
|  |  |  | .eq("device_type", String.valueOf(SlaveType.ForkLift))); | 
|---|
|  |  |  | for (DeviceConfig device : forkliftList) { | 
|---|
|  |  |  | List<DeviceConfig> liftList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>() | 
|---|
|  |  |  | .eq("device_type", String.valueOf(SlaveType.Lift))); | 
|---|
|  |  |  | for (DeviceConfig device : liftList) { | 
|---|
|  |  |  | // 获取提升机信息 | 
|---|
|  |  |  | ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, device.getDeviceNo()); | 
|---|
|  |  |  | if (forkLiftThread == null) { | 
|---|
|  |  |  | LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, device.getDeviceNo()); | 
|---|
|  |  |  | if (liftThread == null) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus(); | 
|---|
|  |  |  | if (forkLiftProtocol == null) { | 
|---|
|  |  |  | LiftProtocol liftProtocol = liftThread.getStatus(); | 
|---|
|  |  |  | if (liftProtocol == null) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (forkLiftProtocol.getTaskNo() != 0) { | 
|---|
|  |  |  | if (liftProtocol.getTaskNo() != 0) { | 
|---|
|  |  |  | //有任务 | 
|---|
|  |  |  | BasLiftErrLog latest = basLiftErrLogService.findLatestByTaskNo(device.getDeviceNo(), forkLiftProtocol.getTaskNo()); | 
|---|
|  |  |  | BasLiftErrLog latest = basLiftErrLogService.findLatestByTaskNo(device.getDeviceNo(), liftProtocol.getTaskNo()); | 
|---|
|  |  |  | // 有异常 | 
|---|
|  |  |  | if (latest == null) { | 
|---|
|  |  |  | if (forkLiftProtocol.getErrorCode() != null && forkLiftProtocol.getErrorCode() != 0) { | 
|---|
|  |  |  | WrkMast wrkMast = wrkMastService.selectByWorkNo(forkLiftProtocol.getWrkNo()); | 
|---|
|  |  |  | if (liftProtocol.getErrorCode() != null && liftProtocol.getErrorCode() != 0) { | 
|---|
|  |  |  | WrkMast wrkMast = wrkMastService.selectByWorkNo(liftProtocol.getTaskNo()); | 
|---|
|  |  |  | if (wrkMast == null) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | BasLiftErr basLiftErr = basLiftErrService.queryByCode(forkLiftProtocol.getErrorCode()); | 
|---|
|  |  |  | BasLiftErr basLiftErr = basLiftErrService.queryByCode(liftProtocol.getErrorCode()); | 
|---|
|  |  |  | String errName = basLiftErr==null? "未知异常":basLiftErr.getErrName(); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | BasLiftErrLog basLiftErrLog = new BasLiftErrLog( | 
|---|
|  |  |  | 
|---|
|  |  |  | now,    // 修改时间 | 
|---|
|  |  |  | null,    // 修改人员 | 
|---|
|  |  |  | "任务中异常",    // 备注 | 
|---|
|  |  |  | JSON.toJSONString(forkLiftProtocol)    // 系统状态数据 | 
|---|
|  |  |  | JSON.toJSONString(liftProtocol)    // 系统状态数据 | 
|---|
|  |  |  | ); | 
|---|
|  |  |  | if (!basLiftErrLogService.insert(basLiftErrLog)) { | 
|---|
|  |  |  | News.error("提升机plc异常记录失败 ===>> [id:{}] [error:{}]", device.getDeviceNo(), errName); | 
|---|
|  |  |  | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } else { | 
|---|
|  |  |  | // 异常修复 | 
|---|
|  |  |  | if (forkLiftProtocol.getErrorCode() == null || forkLiftProtocol.getErrorCode() == 0) { | 
|---|
|  |  |  | if (liftProtocol.getErrorCode() == null || liftProtocol.getErrorCode() == 0) { | 
|---|
|  |  |  | latest.setEndTime(now); | 
|---|
|  |  |  | latest.setUpdateTime(now); | 
|---|
|  |  |  | latest.setStatus(2); | 
|---|
|  |  |  | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | Object limitObj = redisUtil.get(RedisKeyType.TASK_RUN_LIMIT.key + wrkMast.getWrkNo()); | 
|---|
|  |  |  | if (limitObj != null) { | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //小车已经在充电桩位置,下发停止充电命令 | 
|---|
|  |  |  | ShuttleAssignCommand assignCommand = new ShuttleAssignCommand(); | 
|---|
|  |  |  | assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号 | 
|---|
|  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //下发任务 | 
|---|
|  |  |  | shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand); | 
|---|
|  |  |  | redisUtil.set(RedisKeyType.TASK_RUN_LIMIT.key + wrkMast.getWrkNo(), "limit", 10); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | return true; | 
|---|
|  |  |  | 
|---|
|  |  |  | //小车已在近点位置无需前往 | 
|---|
|  |  |  | if (shuttleProtocol.getCurrentLocNo().equals(endLocation)) { | 
|---|
|  |  |  | wrkMast.setWrkSts(WrkStsType.MOVE_NEARBY_COMPLETE.sts);//小车移动到提升机中  301.生成小车移库任务 ==> 303.小车移动至近点完成 | 
|---|
|  |  |  | wrkMast.setSourceStaNo(recentLiftStation.getStaNo()); | 
|---|
|  |  |  | wrkMast.setStaNo(targetLiftSta.getStaNo()); | 
|---|
|  |  |  | wrkMast.setSourceStaNo(recentLiftStation.getSiteId()); | 
|---|
|  |  |  | wrkMast.setStaNo(targetLiftSta.getSiteId()); | 
|---|
|  |  |  | wrkMast.setModiTime(now); | 
|---|
|  |  |  | wrkMast.setSystemMsg("");//清空消息 | 
|---|
|  |  |  | wrkMastService.updateById(wrkMast); | 
|---|
|  |  |  | 
|---|
|  |  |  | assignCommand.setCommands(commands); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | wrkMast.setWrkSts(WrkStsType.MOVE_NEARBY.sts);//小车移动到提升机中  301.生成小车移库任务 ==> 302.小车移动至近点中 | 
|---|
|  |  |  | wrkMast.setSourceStaNo(recentLiftStation.getStaNo()); | 
|---|
|  |  |  | wrkMast.setStaNo(targetLiftSta.getStaNo()); | 
|---|
|  |  |  | wrkMast.setSourceStaNo(recentLiftStation.getSiteId()); | 
|---|
|  |  |  | wrkMast.setStaNo(targetLiftSta.getSiteId()); | 
|---|
|  |  |  | wrkMast.setModiTime(now); | 
|---|
|  |  |  | wrkMast.setSystemMsg("");//清空消息 | 
|---|
|  |  |  | if (wrkMastService.updateById(wrkMast)) { | 
|---|
|  |  |  | 
|---|
|  |  |  | int targetLev = Utils.getLev(shuttleProtocol.getCurrentLocNo()); | 
|---|
|  |  |  | if (object == null || liftProtocol.getLev() != targetLev) { | 
|---|
|  |  |  | //获取提升机命令 | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getMoveCommand(wrkMast.getWrkNo(), liftProtocol.getLev(), targetLev); | 
|---|
|  |  |  | LiftStaProtocol startSta = LiftUtils.getLiftStaByLev(liftProtocol.getLiftNo(), liftProtocol.getLev()); | 
|---|
|  |  |  | LiftStaProtocol targetSta = LiftUtils.getLiftStaByLev(liftProtocol.getLiftNo(), targetLev); | 
|---|
|  |  |  | if (startSta == null || targetSta == null) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}号提升机,站点数据不存在", wrkMast.getWrkNo(), wrkMast.getLiftNo()); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getMoveCommand(commonService.getWorkNo(WrkIoType.PREVIEW_LIFT_MOVE.id), startSta.getSiteId(), targetSta.getSiteId()); | 
|---|
|  |  |  | ArrayList<LiftCommand> commands = new ArrayList<>(); | 
|---|
|  |  |  | commands.add(liftCommand); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | liftAction.assignWork(wrkMast.getLiftNo(), assignCommand); | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,{}号提升机在{}层,提升机不在小车层,调度移动中", wrkMast.getWrkNo(), liftProtocol.getLev(), wrkMast.getLiftNo()); | 
|---|
|  |  |  | redisUtil.set(RedisKeyType.LIFT_MOVE_TO_SHUTTLE_LIMIT.key + wrkMast.getWrkNo(), "lift_moving", 60 * 3); | 
|---|
|  |  |  | redisUtil.set(RedisKeyType.TASK_RUN_LIMIT.key + wrkMast.getWrkNo(), "lock", 8); | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | Object limitObj = redisUtil.get(RedisKeyType.TASK_RUN_LIMIT.key + wrkMast.getWrkNo()); | 
|---|
|  |  |  | if (limitObj != null) { | 
|---|
|  |  |  | return false; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | return false;//缺少站点信息 | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (liftSta.getHasTray()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,目标站存在托盘,禁止派发", wrkMast.getWrkNo()); | 
|---|
|  |  |  | if (liftSta.getHasCar()) { | 
|---|
|  |  |  | News.taskInfo(wrkMast.getWrkNo(), "{}任务,目标站存在小车,禁止派发", wrkMast.getWrkNo()); | 
|---|
|  |  |  | return false;//有托盘跳过 | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取提升机命令 | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getShuttleSwitchCommand(wrkMast.getWrkNo(), sourceLiftSta.getLev(), liftSta.getLev()); | 
|---|
|  |  |  | LiftCommand liftCommand = liftThread.getShuttleSwitchCommand(wrkMast.getWrkNo(), sourceLiftSta.getSiteId(), liftSta.getSiteId()); | 
|---|
|  |  |  | ArrayList<LiftCommand> commands = new ArrayList<>(); | 
|---|
|  |  |  | commands.add(liftCommand); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | 
|---|
|  |  |  | return true; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //自动切换出入库模式 | 
|---|
|  |  |  | public void autoSwitchLiftIOMode() { | 
|---|
|  |  |  | List<DeviceConfig> liftList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>() | 
|---|
|  |  |  | .eq("device_type", String.valueOf(SlaveType.Lift))); | 
|---|
|  |  |  | for (DeviceConfig device : liftList) { | 
|---|
|  |  |  | Integer liftNo = device.getDeviceNo(); | 
|---|
|  |  |  | LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftNo); | 
|---|
|  |  |  | if (liftThread == null) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  | LiftProtocol liftProtocol = liftThread.getStatus(); | 
|---|
|  |  |  | if (liftProtocol == null) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | List<Integer> liftAllStaNo = LiftUtils.getLiftAllStaNo(liftNo); | 
|---|
|  |  |  | if (liftAllStaNo.isEmpty()) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | List<Integer> conveyorBindLiftAllStaNo = LiftUtils.getConveyorBindLiftAllStaNo(liftNo); | 
|---|
|  |  |  | if (conveyorBindLiftAllStaNo.isEmpty()) { | 
|---|
|  |  |  | continue; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取入库任务 | 
|---|
|  |  |  | List<WrkMast> inWrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>() | 
|---|
|  |  |  | .in("sta_no", liftAllStaNo) | 
|---|
|  |  |  | .in("wrk_sts" | 
|---|
|  |  |  | , WrkStsType.NEW_INBOUND.sts | 
|---|
|  |  |  | , WrkStsType.INBOUND_DEVICE_RUN.sts | 
|---|
|  |  |  | , WrkStsType.INBOUND_LIFT_RUN.sts | 
|---|
|  |  |  | , WrkStsType.INBOUND_LIFT_RUN_COMPLETE.sts | 
|---|
|  |  |  | , WrkStsType.INBOUND_SHUTTLE_RUN.sts | 
|---|
|  |  |  | , WrkStsType.INBOUND_SHUTTLE_RUN_COMPLETE.sts | 
|---|
|  |  |  | )); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //获取出库任务 | 
|---|
|  |  |  | List<WrkMast> outWrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>() | 
|---|
|  |  |  | .in("sta_no", conveyorBindLiftAllStaNo) | 
|---|
|  |  |  | .in("wrk_sts" | 
|---|
|  |  |  | , WrkStsType.NEW_OUTBOUND.sts | 
|---|
|  |  |  | , WrkStsType.OUTBOUND_SHUTTLE_RUN.sts | 
|---|
|  |  |  | , WrkStsType.OUTBOUND_SHUTTLE_RUN_COMPLETE.sts | 
|---|
|  |  |  | , WrkStsType.OUTBOUND_LIFT_RUN.sts | 
|---|
|  |  |  | , WrkStsType.OUTBOUND_LIFT_RUN_COMPLETE.sts | 
|---|
|  |  |  | )); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | if (liftProtocol.getIOModeType().equals(LiftIoModeType.NONE)) { | 
|---|
|  |  |  | //未知模式 | 
|---|
|  |  |  | if (!inWrkMasts.isEmpty()) { | 
|---|
|  |  |  | liftThread.switchIOMode(LiftIoModeType.IN); | 
|---|
|  |  |  | } else if (!outWrkMasts.isEmpty()) { | 
|---|
|  |  |  | liftThread.switchIOMode(LiftIoModeType.OUT); | 
|---|
|  |  |  | }else { | 
|---|
|  |  |  | liftThread.switchIOMode(LiftIoModeType.IN); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } else if (liftProtocol.getIOModeType().equals(LiftIoModeType.IN)) { | 
|---|
|  |  |  | //入库模式 | 
|---|
|  |  |  | if (inWrkMasts.isEmpty() && !outWrkMasts.isEmpty()) { | 
|---|
|  |  |  | liftThread.switchIOMode(LiftIoModeType.OUT); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } else if (liftProtocol.getIOModeType().equals(LiftIoModeType.OUT)) { | 
|---|
|  |  |  | //出库模式 | 
|---|
|  |  |  | if (outWrkMasts.isEmpty() && !inWrkMasts.isEmpty()) { | 
|---|
|  |  |  | liftThread.switchIOMode(LiftIoModeType.IN); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | } | 
|---|