| | |
| | | import com.core.exception.CoolException; |
| | | import com.zy.asrs.entity.BasLift; |
| | | import com.zy.asrs.entity.BasLiftOpt; |
| | | import com.zy.asrs.entity.WrkMast; |
| | | import com.zy.asrs.mapper.WrkMastMapper; |
| | | import com.zy.asrs.service.BasLiftOptService; |
| | | import com.zy.asrs.service.BasLiftService; |
| | | import com.zy.asrs.utils.Utils; |
| | | import com.zy.common.utils.CommonUtils; |
| | | import com.zy.common.utils.RedisUtil; |
| | | import com.zy.core.DevpThread; |
| | |
| | | switch (step) { |
| | | // 读数据 |
| | | case 1: |
| | | readStatus(); |
| | | read(); |
| | | break; |
| | | // 写入数据 |
| | | case 2: |
| | |
| | | modbusTcpNet.ConnectClose(); |
| | | } |
| | | |
| | | private void read() { |
| | | try { |
| | | readStatus(); |
| | | |
| | | //提升机处于运行状态,将标记置为true |
| | | if (liftProtocol.getRunning()) { |
| | | liftProtocol.setPakMk(true); |
| | | } |
| | | |
| | | //提升机处于未运行、就绪、标记true、有任务号 |
| | | if (!liftProtocol.getRunning() |
| | | && liftProtocol.getPakMk() |
| | | && liftProtocol.getTaskNo() != 0) { |
| | | //还有未完成的命令 |
| | | executeWork(liftProtocol.getTaskNo()); |
| | | } |
| | | } catch (Exception e) { |
| | | OutputQueue.LIFT.offer(MessageFormat.format("【{0}】提升机plc状态信息失败 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort())); |
| | | initLift(); |
| | | } |
| | | } |
| | | |
| | | private void readStatus() { |
| | | try { |
| | | OperateResultExOne<byte[]> result = modbusTcpNet.Read("41117", (short) 50); |
| | |
| | | liftProtocol.setLiftLock(CommonUtils.shortToBoolean(modbusTcpNet.getByteTransform().TransInt16(content, 0))); |
| | | //位置到达反馈 |
| | | liftProtocol.setPositionArrivalFeedback(modbusTcpNet.getByteTransform().TransInt16(content,2)); |
| | | |
| | | byte by = modbusTcpNet.getByteTransform().TransByte(content, 5); |
| | | int[] datas = CommonUtils.byteToBits(by); |
| | | //准备就绪 |
| | | liftProtocol.setReady(CommonUtils.intToBoolean(datas[0])); |
| | | //运行中 |
| | | liftProtocol.setRunning(CommonUtils.intToBoolean(datas[1])); |
| | | //联机/单机 |
| | | liftProtocol.setMode(CommonUtils.intToBoolean(datas[2])); |
| | | //输送线前端光电有货 |
| | | liftProtocol.setLineFrontHasStock(CommonUtils.intToBoolean(datas[3])); |
| | | //输送线正转反馈 |
| | | liftProtocol.setForwardRotationFeedback(CommonUtils.intToBoolean(datas[4])); |
| | | //输送线反转反馈 |
| | | liftProtocol.setReverseFeedback(CommonUtils.intToBoolean(datas[5])); |
| | | //输送线电机过载 |
| | | liftProtocol.setMotorOverload(CommonUtils.intToBoolean(datas[6])); |
| | | //输送线末端光电有货 |
| | | liftProtocol.setLineEndHasStock(CommonUtils.intToBoolean(datas[7])); |
| | | //进输送线卡托盘报警 |
| | | liftProtocol.setInConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas[8])); |
| | | //出输送线卡托盘报警 |
| | | liftProtocol.setOutConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas[9])); |
| | | //平台位置偏差报警 |
| | | liftProtocol.setPlatPositionDeviationAlarm(CommonUtils.intToBoolean(datas[10])); |
| | | //平台扭矩偏差报警 |
| | | liftProtocol.setPlatTorqueDeviationAlarm(CommonUtils.intToBoolean(datas[11])); |
| | | //平台四向车检测 |
| | | liftProtocol.setPlatShuttleCheck(CommonUtils.intToBoolean(datas[12])); |
| | | |
| | | |
| | | byte b1 = modbusTcpNet.getByteTransform().TransByte(content, 5); |
| | | byte b2 = modbusTcpNet.getByteTransform().TransByte(content, 4); |
| | | int[] datas1 = CommonUtils.byteToBits(b1); |
| | | int[] datas2 = CommonUtils.byteToBits(b2); |
| | | //准备就绪 |
| | | liftProtocol.setReady(CommonUtils.intToBoolean(datas1[0])); |
| | | //运行中 |
| | | liftProtocol.setRunning(CommonUtils.intToBoolean(datas1[1])); |
| | | //联机/单机 |
| | | liftProtocol.setMode(CommonUtils.intToBoolean(datas1[2])); |
| | | //输送线前端光电有货 |
| | | liftProtocol.setLineFrontHasStock(CommonUtils.intToBoolean(datas1[3])); |
| | | //输送线正转反馈 |
| | | liftProtocol.setForwardRotationFeedback(CommonUtils.intToBoolean(datas1[4])); |
| | | //输送线反转反馈 |
| | | liftProtocol.setReverseFeedback(CommonUtils.intToBoolean(datas1[5])); |
| | | //输送线电机过载 |
| | | liftProtocol.setMotorOverload(CommonUtils.intToBoolean(datas1[6])); |
| | | //输送线末端光电有货 |
| | | liftProtocol.setLineEndHasStock(CommonUtils.intToBoolean(datas1[7])); |
| | | //进输送线卡托盘报警 |
| | | liftProtocol.setInConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas2[0])); |
| | | //出输送线卡托盘报警 |
| | | liftProtocol.setOutConveyLineCardTrayAlarm(CommonUtils.intToBoolean(datas2[1])); |
| | | //平台位置偏差报警 |
| | | liftProtocol.setPlatPositionDeviationAlarm(CommonUtils.intToBoolean(datas2[2])); |
| | | //平台扭矩偏差报警 |
| | | liftProtocol.setPlatTorqueDeviationAlarm(CommonUtils.intToBoolean(datas2[3])); |
| | | //平台四向车检测 |
| | | liftProtocol.setPlatShuttleCheck(CommonUtils.intToBoolean(datas2[4])); |
| | | |
| | | //未就绪状态 |
| | | liftProtocol.setNotReady(modbusTcpNet.getByteTransform().TransInt16(content,6)); |
| | |
| | | liftProtocol.setLiftActualSpeed(modbusTcpNet.getByteTransform().TransInt16(content,16)); |
| | | |
| | | ///读取提升机状态-end |
| | | |
| | | //提升机处于运行状态,将标记置为true |
| | | if (liftProtocol.getRunning()) { |
| | | liftProtocol.setPakMk(true); |
| | | } |
| | | |
| | | //提升机处于未运行、就绪、标记true、有任务号 |
| | | if (!liftProtocol.getRunning() |
| | | && liftProtocol.getPakMk() |
| | | && liftProtocol.getTaskNo() != 0) { |
| | | //还有未完成的命令 |
| | | executeWork(liftProtocol.getTaskNo()); |
| | | } |
| | | |
| | | //将提升机状态保存至数据库 |
| | | BasLiftService liftService = SpringUtils.getBean(BasLiftService.class); |
| | |
| | | } |
| | | |
| | | command.setLiftNo(slave.getId().shortValue()); |
| | | short[] array = getCommandArr(command);//获取命令报文 |
| | | |
| | | try { |
| | | Thread.sleep(500);//命令下发前休眠 |
| | | } catch (InterruptedException e) { |
| | | throw new RuntimeException(e); |
| | | } |
| | | |
| | | OperateResult result = modbusTcpNet.Write("41088", array); |
| | | if (result != null && result.IsSuccess) { |
| | | News.info("提升机命令下发[id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command)); |
| | | OutputQueue.LIFT.offer(MessageFormat.format("【{0}】[id:{1}] >>>>> 命令下发: {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command))); |
| | | |
| | | try { |
| | | Thread.sleep(500);//命令下发后休眠 |
| | | } catch (InterruptedException e) { |
| | | throw new RuntimeException(e); |
| | | } |
| | | |
| | | for (int i = 0; i < 5; i++) { |
| | | if (command.getRun().intValue() == 4 || command.getRun().intValue() == 5) { |
| | | break;//系统复位和链条停止转动不需要重发 |
| | | } |
| | | readStatus();//重新读取状态 |
| | | if (liftProtocol.getRunning()) { |
| | | break; |
| | | } |
| | | |
| | | //判断是否运行中,如不运行,重新下发命令 |
| | | result = modbusTcpNet.Write("41088", array); |
| | | News.info("提升机命令下发[id:{}] >>>>> {},次数:{}", slave.getId(), JSON.toJSON(command), i); |
| | | OutputQueue.LIFT.offer(MessageFormat.format("【{0}】[id:{1}] >>>>> 命令下发: {2},次数:{}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command), i)); |
| | | try { |
| | | Thread.sleep(300);//命令下发后休眠 |
| | | } catch (InterruptedException e) { |
| | | throw new RuntimeException(e); |
| | | } |
| | | } |
| | | return true; |
| | | } else { |
| | | OutputQueue.LIFT.offer(MessageFormat.format("【{0}】写入提升机plc数据失败 ===>> [id:{1}] [ip:{2}] [port:{3}],次数:{}", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort())); |
| | | News.error("写入提升机plc数据失败 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); |
| | | return false; |
| | | } |
| | | } |
| | | |
| | | //获取命令报文 |
| | | private short[] getCommandArr(LiftCommand command) { |
| | | // 开始任务 |
| | | short[] array = new short[30]; |
| | | //开始运行 |
| | |
| | | tmp[1] = array[1]; |
| | | array = tmp; |
| | | } |
| | | |
| | | OperateResult result = modbusTcpNet.Write("41088", array);; |
| | | if (result != null && result.IsSuccess) { |
| | | News.info("提升机命令下发[id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command)); |
| | | OutputQueue.LIFT.offer(MessageFormat.format("【{0}】[id:{1}] >>>>> 命令下发: {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command))); |
| | | return true; |
| | | } else { |
| | | OutputQueue.LIFT.offer(MessageFormat.format("【{0}】写入提升机plc数据失败 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort())); |
| | | News.error("写入提升机plc数据失败 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); |
| | | return false; |
| | | } |
| | | return array; |
| | | } |
| | | |
| | | //分配任务 |
| | |
| | | return false; |
| | | } |
| | | |
| | | //将标记置为false(防止重发) |
| | | liftProtocol.setPakMk(false); |
| | | |
| | | WrkMastMapper wrkMastMapper = SpringUtils.getBean(WrkMastMapper.class); |
| | | Object o = redisUtil.get("lift_wrk_no_" + wrkNo); |
| | | if (o == null) { |
| | | return false; |
| | |
| | | int size = commands.size(); |
| | | LiftAssignCommand assignCommand = redisCommand.getAssignCommand(); |
| | | |
| | | if (commandStep != 0) { |
| | | //判断上一条指令是否完成 |
| | | LiftCommand command = commands.get(commandStep - 1); |
| | | if (command.getRun().intValue() == 1) { |
| | | //提升机升降命令 |
| | | if (command.getDistPosition().intValue() == liftProtocol.getPositionArrivalFeedback().intValue()) { |
| | | //提升机目标楼层和实际楼层相同,则认定命令完成 |
| | | command.setComplete(true); |
| | | } |
| | | } else if (command.getRun().intValue() == 2 || command.getRun().intValue() == 3) { |
| | | //无货正转,有货正转 |
| | | if (!liftProtocol.getForwardRotationFeedback()) { |
| | | //输送线正转反馈不在运行中,认定命令完成 |
| | | command.setComplete(true); |
| | | } |
| | | } else if (command.getRun().intValue() == 6 || command.getRun().intValue() == 7) { |
| | | //有货反转,无货反转 |
| | | if (!liftProtocol.getReverseFeedback()) { |
| | | //输送线反转反馈不在运行中,认定命令完成 |
| | | command.setComplete(true); |
| | | } |
| | | } else if (command.getRun().intValue() == 4) { |
| | | //输送线停止 |
| | | if (!liftProtocol.getForwardRotationFeedback() && !liftProtocol.getReverseFeedback()) { |
| | | //输送线正转反转都不在运行中,认定命令完成 |
| | | command.setComplete(true); |
| | | } |
| | | } |
| | | //任务数据保存到redis |
| | | redisUtil.set("lift_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); |
| | | |
| | | if (!command.getComplete()) { |
| | | //上一条任务未完成,禁止下发命令 |
| | | return false; |
| | | } |
| | | } |
| | | |
| | | //取出命令 |
| | | LiftCommand command = commands.get(commandStep); |
| | | if (command.getOperaStaNo() != null && command.getDevpId() != null) { |
| | | //站点和输送线ID不为null,需要下发站点指令调度指定站点进行链条转动 |
| | | DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, command.getDevpId()); |
| | | StaProtocol staProtocol = devpThread.getStation().get(command.getOperaStaNo().intValue()); |
| | | staProtocol = staProtocol.clone(); |
| | | if (!staProtocol.isLiftArrival()) {//链条转动条件,需要有提升机到位信号 |
| | | liftProtocol.setPakMk(true); |
| | | return false; |
| | |
| | | boolean result1 = MessageQueue.offer(SlaveType.Devp, devpId, new Task(3, staProtocol));//下发命令使输送线链条运转 |
| | | } |
| | | |
| | | WrkMast wrkMast = wrkMastMapper.selectByWorkNo(wrkNo.intValue()); |
| | | if (wrkMast != null) { |
| | | if (wrkMast.getWrkSts() == 28) {//28.提升机搬运中 |
| | | if (command.getRun().intValue() == 1 && command.getDistPosition().intValue() == LiftLevType.TWO.lev) { |
| | | //提升机移动且位置是到输送线楼层,需要判断站点货物是否无物,提升机是否有物 |
| | | DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, command.getDevpId()); |
| | | //工作档源库位楼层 |
| | | int wrkMastLocNoLey = Utils.getLev(wrkMast.getSourceLocNo()); |
| | | StaProtocol staProtocol = devpThread.getStation().get(Utils.levToOutInStaNo(wrkMastLocNoLey >= 2 ? wrkMastLocNoLey + 1 : wrkMastLocNoLey));//起始站点 |
| | | //判断输送站点是否有物,只有无物情况才能继续调度提升机 |
| | | if (staProtocol.isLoading()) { |
| | | //有物禁止调度 |
| | | return false; |
| | | } |
| | | } |
| | | } |
| | | } |
| | | |
| | | //下发命令 |
| | | if (!write(command)) { |
| | | News.error("提升机命令下发失败,提升机号={},任务数据={}", command.getLiftNo(), JSON.toJSON(command)); |
| | |
| | | News.info("提升机命令下发成功,提升机号={},任务数据={}", command.getLiftNo(), JSON.toJSON(command)); |
| | | liftProtocol.setWrkTime(new Date());//更新工作时间 |
| | | |
| | | try { |
| | | Thread.sleep(1000);//命令下发完成后休眠1s |
| | | } catch (InterruptedException e) { |
| | | throw new RuntimeException(e); |
| | | //将标记置为false(防止重发) |
| | | liftProtocol.setPakMk(false); |
| | | |
| | | //保存数据到数据库做流水 |
| | | BasLiftOptService liftOptService = SpringUtils.getBean(BasLiftOptService.class); |
| | | if (liftOptService != null) { |
| | | short[] commandArr = getCommandArr(command);//获取命令报文 |
| | | BasLiftOpt opt = new BasLiftOpt( |
| | | redisCommand.getWrkNo().intValue(), |
| | | redisCommand.getLiftNo().intValue(), |
| | | new Date(), |
| | | null, |
| | | null, |
| | | null, |
| | | JSON.toJSONString(command), |
| | | JSON.toJSONString(commandArr) |
| | | ); |
| | | liftOptService.insert(opt); |
| | | } |
| | | |
| | | //判断数据是否执行完成 |
| | |
| | | redisUtil.set("lift_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); |
| | | }else { |
| | | //已执行完成 |
| | | //保存数据到数据库做流水 |
| | | BasLiftOptService liftOptService = SpringUtils.getBean(BasLiftOptService.class); |
| | | if (liftOptService != null) { |
| | | BasLiftOpt opt = new BasLiftOpt( |
| | | redisCommand.getWrkNo().intValue(), |
| | | redisCommand.getLiftNo().intValue(), |
| | | new Date(), |
| | | null, |
| | | null, |
| | | null, |
| | | JSON.toJSONString(assignCommand) |
| | | ); |
| | | liftOptService.insert(opt); |
| | | } |
| | | //删除redis |
| | | redisUtil.del("lift_wrk_no_" + redisCommand.getWrkNo()); |
| | | |
| | | //对主线程抛出等待确认状态waiting |
| | | liftProtocol.setProtocolStatus(LiftProtocolStatusType.WAITING); |
| | | News.info("提升机任务执行完成等待确认中,提升机号={},任务数据={}", command.getLiftNo(), JSON.toJSON(command)); |
| | | |
| | | News.info("提升机任务执行下发完成等待执行结束,提升机号={},任务数据={}", command.getLiftNo(), JSON.toJSON(command)); |
| | | } |
| | | } |
| | | |
| | |
| | | * 初始化提升机 |
| | | */ |
| | | private void initLift() { |
| | | this.connect(); |
| | | if (null == liftProtocol) { |
| | | liftProtocol = new LiftProtocol(); |
| | | } |