From 4e1a8e484888b3d3f28dc9629904e6e54d90ebc5 Mon Sep 17 00:00:00 2001 From: Junjie <fallin.jie@qq.com> Date: 星期五, 28 七月 2023 16:26:40 +0800 Subject: [PATCH] 穿梭车命令封装 --- src/main/java/com/zy/core/thread/NyShuttleThread.java | 708 +++++++++++++--------------------------------------------- 1 files changed, 165 insertions(+), 543 deletions(-) diff --git a/src/main/java/com/zy/core/thread/NyShuttleThread.java b/src/main/java/com/zy/core/thread/NyShuttleThread.java index 44bcc59..f5c3500 100644 --- a/src/main/java/com/zy/core/thread/NyShuttleThread.java +++ b/src/main/java/com/zy/core/thread/NyShuttleThread.java @@ -1,5 +1,6 @@ package com.zy.core.thread; +import com.alibaba.fastjson.JSON; import com.alibaba.fastjson.JSONObject; import com.core.common.DateUtils; import com.core.common.SpringUtils; @@ -11,12 +12,15 @@ import com.zy.core.ThreadHandler; import com.zy.core.cache.MessageQueue; import com.zy.core.cache.OutputQueue; +import com.zy.core.cache.SlaveConnection; import com.zy.core.enums.*; import com.zy.core.model.ShuttleSlave; import com.zy.core.model.Task; import com.zy.core.model.command.NyShuttleHttpCommand; import com.zy.core.model.command.ShuttleAssignCommand; import com.zy.core.model.command.ShuttleCommand; +import com.zy.core.model.command.ShuttleRedisCommand; +import com.zy.core.model.protocol.LiftProtocol; import com.zy.core.model.protocol.NyShuttleProtocol; import lombok.Data; import lombok.extern.slf4j.Slf4j; @@ -24,6 +28,7 @@ import java.text.MessageFormat; import java.util.ArrayList; import java.util.Date; +import java.util.List; /** * 鐗涚溂鍥涘悜绌挎杞︾嚎绋� @@ -58,7 +63,7 @@ break; // 鍐欏叆鏁版嵁 case 2: - write((ShuttleCommand) task.getData()); + write((NyShuttleHttpCommand) task.getData()); break; //涓嬪彂浠诲姟 case 3: @@ -82,7 +87,7 @@ && shuttleProtocol.getTaskNo() != 0 && shuttleProtocol.getPakMk()) { //鎵ц涓嬩竴姝ユ寚浠� - executeWork(shuttleProtocol.getTaskNo()); + executeWork(shuttleProtocol.getTaskNo().shortValue()); } } catch (Exception e) { e.printStackTrace(); @@ -242,7 +247,7 @@ } - private boolean write(ShuttleCommand command){ + private boolean write(NyShuttleHttpCommand command){ if (null == command) { News.error("鍥涘悜绌挎杞﹀啓鍏ュ懡浠や负绌�"); return false; @@ -258,558 +263,175 @@ News.error("鍥涘悜绌挎杞︿笉瀛樺湪"); return false; } -// command.setShuttleNo(slave.getId().shortValue()); -// short[] array = getCommandArr(command);//鑾峰彇鍛戒护鎶ユ枃 -// OperateResult result = modbusTcpNet.Write("0", array); -// if (result != null && result.IsSuccess) { -// News.info("鍥涘悜绌挎杞﹀懡浠や笅鍙慬id:{}] >>>>> {}", slave.getId(), JSON.toJSON(command)); -// OutputQueue.SHUTTLE.offer(MessageFormat.format("銆恵0}銆慬id:{1}] >>>>> 鍛戒护涓嬪彂锛� {2}", DateUtils.convert(new Date()), slave.getId(), JSON.toJSON(command))); -// -// try { -// Thread.sleep(3000);//鍛戒护涓嬪彂鍚庝紤鐪� -// } catch (InterruptedException e) { -// throw new RuntimeException(e); -// } -// -// for (int i = 0; i < 5; i++) { -// if (command.getCommandWord().intValue() == 5 || command.getCommandWord().intValue() == 6) { -// break;//鍏呯數寮�鍏冲拰绯荤粺澶嶄綅涓嶉渶瑕侀噸鍙戞満鍒� -// } -// readStatus();//閲嶆柊璇诲彇鐘舵�� -// if (shuttleProtocol.getBusyStatusType().equals(ShuttleStatusType.BUSY)) { -// break; -// } -// -// //鍒ゆ柇鏄惁杩愯涓紝濡備笉杩愯锛岄噸鏂颁笅鍙戝懡浠� -// result = modbusTcpNet.Write("0", array); -// News.info("鍥涘悜绌挎杞﹀懡浠や笅鍙慬id:{}] >>>>> {},娆℃暟锛歿}", slave.getId(), JSON.toJSON(command), i); -// OutputQueue.SHUTTLE.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.SHUTTLE.offer(MessageFormat.format("銆恵0}銆戝啓鍏ュ洓鍚戠┛姊溅plc鏁版嵁澶辫触 ===>> [id:{1}] [ip:{2}] [port:{3}],娆℃暟锛歿}", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort())); -// News.error("鍐欏叆鍥涘悜绌挎杞lc鏁版嵁澶辫触 ===>> [id:{}] [ip:{}] [port:{}]", slave.getId(), slave.getIp(), slave.getPort()); -// return false; -// } - return false; + //鍙戝嚭璇锋眰 + JSONObject result = NyHttpUtils.requestCommand(command); + if (result == null) { + return false;//璇锋眰澶辫触 + } + + return true; } //鍒嗛厤浠诲姟 private void assignWork(ShuttleAssignCommand assignCommand) { -// ShuttleRedisCommand redisCommand = new ShuttleRedisCommand(); -// -// if (!assignCommand.getAuto()) { -// List<NavigateNode> allNode = new ArrayList<>(); -// List<ShuttleCommand> commands = new ArrayList<>(); -// LocMastService locMastService = SpringUtils.getBean(LocMastService.class); -// BasShuttleService shuttleService = SpringUtils.getBean(BasShuttleService.class); -// NavigateMapData navigateMapData; -// -// //鑾峰彇灏忚溅绉诲姩閫熷害 -// BasShuttle basShuttle = shuttleService.selectById(slave.getId()); -// Integer runSpeed = 1000; -// if (basShuttle != null) { -// Integer runSpeed1 = basShuttle.getRunSpeed(); -// if (runSpeed1 != null) { -// runSpeed = runSpeed1; -// } -// } -// -// LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1); -// LiftProtocol liftProtocol = liftThread.getLiftProtocol(); -// -// switch (assignCommand.getTaskMode()) { -// case 1://鍏ュ簱 -// case 2://鍑哄簱 -// //灏忚溅绉诲姩鍒版彁鍗囨満鍙o紝璁$畻璺緞 -// //璁$畻灏忚溅璧风偣鍒颁腑鐐规墍闇�鍛戒护 -// LocMast currentLocMast = locMastService.queryByQrCode(shuttleProtocol.getCurrentCode().toString()); -// List<NavigateNode> firstMastResult = NavigateUtils.calc(currentLocMast.getLocNo(), assignCommand.getSourceLocNo(), NavigationMapType.NORMAL.id, Utils.getShuttlePoints(assignCommand.getShuttleNo().intValue(), Utils.getLev(currentLocMast.getLocNo())));//灏忚溅鍒颁腑鐐癸紝澶勪簬鏃犺揣鐘舵�侊紝浣跨敤姝e父閫氶亾鍦板浘 -// boolean checkResult = Utils.checkShuttlePath(firstMastResult, shuttleProtocol.getShuttleNo().intValue()); -// if (firstMastResult != null && checkResult) { -// allNode.addAll(firstMastResult);//灏嗚妭鐐硅繘琛屼繚瀛� -// //鑾峰彇鍒嗘璺緞 -// ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(firstMastResult); -// //灏嗘瘡涓�娈佃矾寰勫垎鎴恈ommand鎸囦护 -// for (ArrayList<NavigateNode> nodes : data) { -// //寮�濮嬭矾寰� -// NavigateNode startPath = nodes.get(0); -// //涓棿璺緞 -// NavigateNode middlePath = nodes.get(nodes.size() - 2); -// //鐩爣璺緞 -// NavigateNode endPath = nodes.get(nodes.size() - 1); -// Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� -// Integer middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, middlePath);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂� -// -// //姝e父绉诲姩鍛戒护 -// Short startCode = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());//寮�濮嬩簩缁寸爜 -// Short middleCode = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());//鐩爣浜岀淮鐮� -// Short distCode = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());//鐩爣浜岀淮鐮� -// commands.add(getMoveCommand(startCode, distCode, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id, middleCode, middleToDistDistance, runSpeed)); -// } -// -// //鎵樼洏椤跺崌 -// commands.add(getPalletCommand((short) 1)); -// }else { -// //娌℃湁璁$畻鍒拌矾寰勶紝鍙兘瀛樺湪灏忚溅浣嶇疆灏辨槸璧风偣浣嶇疆 -// if (currentLocMast.getLocNo().equals(assignCommand.getSourceLocNo())) { -// //灏忚溅浣嶇疆灏辨槸璧风偣浣嶇疆锛屾棤闇�绉诲姩锛岀洿鎺ラ《鍗� -// //鎵樼洏椤跺崌 -// commands.add(getPalletCommand((short) 1)); -// } -// } -// -// //璁$畻涓偣鍒扮粓鐐硅矾寰� -// List<NavigateNode> secMastResult = NavigateUtils.calc(assignCommand.getSourceLocNo(), assignCommand.getLocNo(), NavigationMapType.DFX.id, Utils.getShuttlePoints(assignCommand.getShuttleNo().intValue(), Utils.getLev(assignCommand.getSourceLocNo())));//灏忚溅浠庝腑鐐瑰埌缁堢偣锛屽浜庢湁璐х姸鎬侊紝浣跨敤DFX鍦板浘 -// boolean checkResult2 = Utils.checkShuttlePath(secMastResult, shuttleProtocol.getShuttleNo().intValue()); -// if (secMastResult != null && checkResult2) { -// allNode.addAll(secMastResult);//灏嗚妭鐐硅繘琛屼繚瀛� -// //鑾峰彇鍒嗘璺緞 -// ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(secMastResult); -// //灏嗘瘡涓�娈佃矾寰勫垎鎴恈ommand鎸囦护 -// for (ArrayList<NavigateNode> nodes : data) { -// //寮�濮嬭矾寰� -// NavigateNode startPath = nodes.get(0); -// //涓棿璺緞 -// NavigateNode middlePath = nodes.get(nodes.size() - 2); -// //鐩爣璺緞 -// NavigateNode endPath = nodes.get(nodes.size() - 1); -// Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� -// Integer middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, middlePath);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂� -// -// //姝e父绉诲姩鍛戒护 -// Short startCode = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());//寮�濮嬩簩缁寸爜 -// Short middleCode = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());//涓棿浜岀淮鐮� -// Short distCode = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());//鐩爣浜岀淮鐮� -// commands.add(getMoveCommand(startCode, distCode, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id, middleCode, middleToDistDistance, runSpeed)); -// } -// -// //鎵樼洏涓嬮檷 -// commands.add(getPalletCommand((short) 2)); -// } -// -// if (firstMastResult == null || secMastResult == null) { -// throw new CoolException(MessageFormat.format( "鍥涘悜绌挎杞﹀嚭鍏ュ簱璺緞鎼滅储澶辫触 ===>> [id:{0}] [ip:{1}] [port:{2}]", slave.getId(), slave.getIp(), slave.getPort())); -// } -// -// navigateMapData = new NavigateMapData(Utils.getLev(currentLocMast.getLocNo())); -// //鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� -// navigateMapData.writeNavigateNodeToRedisMap(firstMastResult, true);////鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� -// navigateMapData.writeNavigateNodeToRedisMap(secMastResult, true);////鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� -// break; -// case 3://鎵樼洏椤跺崌 -// case 4://鎵樼洏涓嬮檷 -// commands.add(getPalletCommand(assignCommand.getTaskMode() == 3 ? (short) 1 : (short) 2)); -// break; -// case 5://寮哄埗宸︾Щ -// commands.add(getForceMoveCommand((short) 2)); -// break; -// case 6://寮哄埗鍙崇Щ -// commands.add(getForceMoveCommand((short) 1)); -// break; -// case 7://寮哄埗涓婄Щ -// commands.add(getForceMoveCommand((short) 3)); -// break; -// case 8://寮哄埗涓嬬Щ -// commands.add(getForceMoveCommand((short) 4)); -// break; -// case 9://鐘舵�佸浣� -// ShuttleCommand reset = getResetCommand(); -// commands.add(reset); -// break; -// case 10://姝f柟鍚�(鍙�)瀵诲簱浣� -// commands.add(getFindLocCommand((short) 1)); -// break; -// case 11://璐熸柟鍚�(宸�)瀵诲簱浣� -// commands.add(getFindLocCommand((short) 2)); -// break; -// case 12://鍚戞鏂瑰悜(鍓�)瀵诲簱浣� -// commands.add(getFindLocCommand((short) 4)); -// break; -// case 13://鍚戣礋鏂瑰悜(鍚�)瀵诲簱浣� -// commands.add(getFindLocCommand((short) 3)); -// break; -// case 14://绉诲姩鍒扮洰鏍囧簱浣� -// String startQr = shuttleProtocol.getCurrentCode().toString();//璧峰浣嶇疆 -// //濡傛灉绌挎杞﹀湪鎻愬崌鏈哄唴锛岀Щ鍔ㄦ椂闇�瑕佸厛涓嬪彂鍑烘彁鍗囨満鍛戒护 -// if (liftProtocol.getBarcode().intValue() == shuttleProtocol.getCurrentCode().intValue()) { -// //绌挎杞﹀嚭鎻愬崌鏈� -// Short liftArrival = liftProtocol.getPositionArrivalFeedback();//鎻愬崌鏈轰綅缃弽棣� -// String liftSiteLocNo = Utils.liftArrivalToOutInStaLocNo(liftArrival); -// LocMast locMast1 = locMastService.selectById(liftSiteLocNo); -// ShuttleCommand moveCommand = getMoveCommand(liftProtocol.getBarcode(), Short.parseShort(locMast1.getQrCodeValue()), 1600, ShuttleRunDirection.BOTTOM.id, null, null, runSpeed); -// commands.add(moveCommand); -// -// //璧峰浣嶇疆淇敼涓烘彁鍗囨満鍙g珯鐐逛綅缃� -// startQr = locMast1.getQrCodeValue(); -// } -// -// LocMast locMast = locMastService.queryByQrCode(startQr); -// List<NavigateNode> result = NavigateUtils.calc(locMast.getLocNo(), assignCommand.getLocNo(), NavigationMapType.NONE.id, Utils.getShuttlePoints(assignCommand.getShuttleNo().intValue(), Utils.getLev(locMast.getLocNo())));//鎵嬪姩鍛戒护-绉诲姩鍛戒护锛屼娇鐢ㄦ棤杩囨护鍦板浘 -// boolean checkResult3 = Utils.checkShuttlePath(result, shuttleProtocol.getShuttleNo().intValue()); -// if (result != null && checkResult3) { -// //鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� -// navigateMapData = new NavigateMapData(Utils.getLev(locMast.getLocNo())); -// navigateMapData.writeNavigateNodeToRedisMap(result, true);////鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� -// -// allNode.addAll(result);//灏嗚妭鐐硅繘琛屼繚瀛� -// //鑾峰彇鍒嗘璺緞 -// ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(result); -// //灏嗘瘡涓�娈佃矾寰勫垎鎴恈ommand鎸囦护 -// for (ArrayList<NavigateNode> nodes : data) { -// //寮�濮嬭矾寰� -// NavigateNode startPath = nodes.get(0); -// //涓棿璺緞 -// NavigateNode middlePath = nodes.get(nodes.size() - 2); -// //鐩爣璺緞 -// NavigateNode endPath = nodes.get(nodes.size() - 1); -// Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� -// Integer middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, middlePath);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂� -// Short startCode = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());//寮�濮嬩簩缁寸爜 -// Short middleCode = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());//涓棿浜岀淮鐮� -// Short distCode = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());//鐩爣浜岀淮鐮� -// //姝e父绉诲姩鍛戒护 -// commands.add(getMoveCommand(startCode, distCode, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id, middleCode, middleToDistDistance, runSpeed)); -// } -// } -// break; -// case 15://鍏呯數寮�鍏� -// commands.add(getChargeSwitchCommand()); -// break; -// case 16://绉诲姩鍒版彁鍗囨満 -// LocMast locMast1 = locMastService.queryByQrCode(shuttleProtocol.getCurrentCode().toString()); -// int lev = Utils.getLev(locMast1.getLocNo());//绌挎杞﹀綋鍓嶉珮搴� -// String liftSiteLocNo = Utils.levToOutInStaLocNo(lev);//褰撳墠妤煎眰绔欑偣搴撲綅鍙� -// LocMast liftSitelocMast = locMastService.selectById(liftSiteLocNo); -// List<NavigateNode> result1 = NavigateUtils.calc(locMast1.getLocNo(), liftSiteLocNo, NavigationMapType.NONE.id, Utils.getShuttlePoints(assignCommand.getShuttleNo().intValue(), Utils.getLev(locMast1.getLocNo())));//绉诲姩鍒版彁鍗囨満锛屼娇鐢ㄦ棤杩囨护鍦板浘 -// boolean checkResult4 = Utils.checkShuttlePath(result1, shuttleProtocol.getShuttleNo().intValue()); -// Short endStartCode = null; -// if (result1 != null && checkResult4) { -// //鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� -// navigateMapData = new NavigateMapData(Utils.getLev(locMast1.getLocNo())); -// navigateMapData.writeNavigateNodeToRedisMap(result1, true);////鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� -// -// allNode.addAll(result1);//灏嗚妭鐐硅繘琛屼繚瀛� -// //鑾峰彇鍒嗘璺緞 -// ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(result1); -// //灏嗘瘡涓�娈佃矾寰勫垎鎴恈ommand鎸囦护 -// for (ArrayList<NavigateNode> nodes : data) { -// //寮�濮嬭矾寰� -// NavigateNode startPath = nodes.get(0); -// //涓棿璺緞 -// NavigateNode middlePath = nodes.get(nodes.size() - 2); -// //鐩爣璺緞 -// NavigateNode endPath = nodes.get(nodes.size() - 1); -// Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂� -// Integer middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, middlePath);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂� -// Short startCode = NavigatePositionConvert.xyToPosition(startPath.getX(), startPath.getY(), startPath.getZ());//寮�濮嬩簩缁寸爜 -// Short middleCode = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ());//涓棿浜岀淮鐮� -// Short distCode = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ());//鐩爣浜岀淮鐮� -// endStartCode = distCode; -// //姝e父绉诲姩鍛戒护 -// commands.add(getMoveCommand(startCode, distCode, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id, middleCode, middleToDistDistance, runSpeed)); -// } -// } -// -// if (endStartCode == null && shuttleProtocol.getCurrentCode() == Short.parseShort(liftSitelocMast.getQrCodeValue())) { -// //绌挎杞﹀凡缁忓湪鎻愬崌鏈虹珯鐐瑰彛 -// endStartCode = shuttleProtocol.getCurrentCode(); -// } -// -// //澧炲姞绉诲姩杩涙彁鍗囨満鍛戒护 -// ShuttleCommand moveCommand = getMoveCommand(endStartCode, liftProtocol.getBarcode(), 1600, ShuttleRunDirection.TOP.id, null, null, runSpeed); -// commands.add(moveCommand); -// break; -// default: -// } -// assignCommand.setCommands(commands); -// assignCommand.setNodes(allNode);//褰撳墠浠诲姟鎵�鍗犵敤鐨勮妭鐐筶ist -// } -// -// redisCommand.setShuttleNo(assignCommand.getShuttleNo());//鍥涘悜绌挎杞﹀彿 -// redisCommand.setWrkNo(assignCommand.getTaskNo());//宸ヤ綔鍙� -// redisCommand.setCommandStep(0);//鍛戒护鎵ц姝ュ簭 -// redisCommand.setAssignCommand(assignCommand);//鍛戒护 -// redisCommand.setErrorCommands(new ArrayList<ShuttleCommand>());//鍙戠敓閿欒鏃跺皾璇曟墽琛岀殑鎸囦护锛屼紭鍏堢骇鏈�楂� -// shuttleProtocol.setTaskNo(assignCommand.getTaskNo()); -// shuttleProtocol.setAssignCommand(assignCommand); -// shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.WORKING); -// //浠诲姟鏁版嵁淇濆瓨鍒皉edis -// redisUtil.set("shuttle_wrk_no_" + assignCommand.getTaskNo(), JSON.toJSONString(redisCommand)); -// //鎵ц涓嬪彂浠诲姟 -// executeWork(assignCommand.getTaskNo()); + ShuttleRedisCommand redisCommand = new ShuttleRedisCommand(); + redisCommand.setShuttleNo(assignCommand.getShuttleNo());//鍥涘悜绌挎杞﹀彿 + redisCommand.setWrkNo(assignCommand.getTaskNo());//宸ヤ綔鍙� + redisCommand.setCommandStep(0);//鍛戒护鎵ц姝ュ簭 + redisCommand.setAssignCommand(assignCommand);//鍛戒护 + shuttleProtocol.setTaskNo(assignCommand.getTaskNo().intValue()); + shuttleProtocol.setAssignCommand(assignCommand); + shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.WORKING); + //浠诲姟鏁版嵁淇濆瓨鍒皉edis + redisUtil.set("shuttle_wrk_no_" + assignCommand.getTaskNo(), JSON.toJSONString(redisCommand)); + //鎵ц涓嬪彂浠诲姟 + executeWork(assignCommand.getTaskNo()); } //鎵ц涓嬪彂鐨勬寚浠� - private boolean executeWork(Integer wrkNo) { -// //璇诲彇redis鏁版嵁 -// if (wrkNo == null) { -// return false; -// } -// -// WrkMastService wrkMastService = SpringUtils.getBean(WrkMastService.class); -// -// Object o = redisUtil.get("shuttle_wrk_no_" + wrkNo); -// if (o == null) { -// return false; -// } -// ShuttleRedisCommand redisCommand = JSON.parseObject(o.toString(), ShuttleRedisCommand.class); -// -// if (shuttleProtocol.getBusyStatus().intValue() == ShuttleStatusType.BUSY.id) { -// return false;//灏忚溅鐘舵�佸繖 -// } -// -// if (!checkLiftStation(wrkNo)) {//妫�娴嬫槸鍚︽湁鎻愬崌鏈虹珯鐐癸紝鏈夊垯璋冨害鎻愬崌鏈� -// return false; -// } -// -// LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1); -// LiftProtocol liftProtocol = liftThread.getLiftProtocol(); -// -// List<ShuttleCommand> commands = redisCommand.getAssignCommand().getCommands(); -// //褰撳墠姝ュ簭 -// int commandStep = redisCommand.getCommandStep(); -// //path璺緞鏁扮洰 -// int size = commands.size(); -// ShuttleAssignCommand assignCommand = redisCommand.getAssignCommand(); -// -// if (commandStep != 0) { -// //鍒ゆ柇涓婁竴鏉℃寚浠ゆ槸鍚﹀畬鎴� -// ShuttleCommand command = commands.get(commandStep - 1); -// if (command.getCommandWord().intValue() == 1) { -// //绉诲姩鍛戒护 -// if (command.getDistCodeNum().intValue() == shuttleProtocol.getCurrentCode().intValue()) { -// //涓婁竴鏉℃寚浠ょ殑鐩爣浣嶇疆鍜屽綋鍓嶅皬杞︿綅缃浉鍚岋紝鍒欒瀹氫笂涓�鏉′换鍔″畬鎴� -// command.setComplete(true); -// -// //涓婁竴鏉℃寚浠よ捣鐐规槸鎻愬崌鏈轰簩缁寸爜锛屽垯娓呴浂鎻愬崌鏈轰换鍔″彿 -// if (command.getStartCodeNum().intValue() == liftProtocol.getBarcode().intValue()) { -// //鍒ゆ柇鎻愬崌鏈烘槸鍚﹀浜庣┖闂� -// if (liftProtocol.isIdleNoTask() && liftProtocol.getTaskNo().intValue() == redisCommand.getWrkNo().intValue()) { -// liftProtocol.setTaskNo((short) 0);//娓呯┖浠诲姟鍙� -// WrkMast wrkMast = wrkMastService.selectById(wrkNo); -// if (wrkMast != null) { -// wrkMast.setLiftNo(null);//瑙i攣鎻愬崌鏈� -// wrkMastService.updateById(wrkMast); -// } -// } -// } -// -// //鍏ュ簱鍛戒护锛屽綋灏忚溅鍙栧畬璐у悗锛岄渶瑕佸皢鎻愬崌鏈洪噴鏀� -// if (assignCommand.getTaskMode().intValue() == ShuttleTaskModeType.PAK_IN.id) { -// //鍒ゆ柇涓婁竴鏉℃寚浠ょ殑璧风偣鏄惁涓鸿緭閫佺珯鐐逛笖鐩爣鐐逛笉鏄彁鍗囨満鍐呴儴浜岀淮鐮� -// Short startCodeNum = command.getStartCodeNum(); -// BasDevpService basDevpService = SpringUtils.getBean(BasDevpService.class); -// BasDevp basDevp = basDevpService.queryByQrCode(startCodeNum.intValue());//鐩爣绔欑偣 -// if (basDevp != null && command.getDistCodeNum().intValue() != liftProtocol.getBarcode().intValue()) { -// //涓婁竴鏉℃寚浠ょ殑璧风偣涓鸿緭閫佺珯鐐逛笖鐩爣鐐逛笉鏄彁鍗囨満鍐呴儴浜岀淮鐮� -// //姝ゆ椂灏忚溅搴旇宸茬粡绂诲紑杈撻�佺珯鐐癸紝鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂蹭笖鏈夊伐浣滃彿 -// if (liftProtocol.isIdleNoTask() && liftProtocol.getTaskNo().intValue() == redisCommand.getWrkNo().intValue()) { -// liftProtocol.setTaskNo((short) 0);//娓呯┖浠诲姟鍙� -// WrkMast wrkMast = wrkMastService.selectById(wrkNo); -// if (wrkMast != null) { -// wrkMast.setLiftNo(null);//瑙i攣鎻愬崌鏈� -// wrkMastService.updateById(wrkMast); -// } -// } -// } -// } -// -// } -// } else if (command.getCommandWord().intValue() == 2) { -// //鎵樼洏椤跺崌鍛戒护 -// if (command.getPalletLift().intValue() == 1) { -// //椤跺崌 -// //鍒ゆ柇鏄惁椤跺崌鍒颁綅 -// if (shuttleProtocol.getPlcOutputLift()) { -// //鑷姩妯″紡 -// if (assignCommand.getAuto() && shuttleProtocol.getPlcInputStatus().intValue() == 1) { -// //椤跺崌鍒颁綅,涓旀墭鐩橀浄杈炬湁鐗╋紝璁ゅ畾浠诲姟瀹屾垚 -// command.setComplete(true); -// }else { -// //鎵嬪姩妯″紡锛屼笉鍒ゆ柇鎵樼洏闆疯揪 -// //椤跺崌鍒颁綅锛岃瀹氫换鍔″畬鎴� -// command.setComplete(true); -// } -// } -// }else { -// //涓嬮檷 -// //鍒ゆ柇鏄惁涓嬮檷鍒颁綅锛屽垽鏂墭鐩橀浄杈炬槸鍚︽棤鐗� -// if (!shuttleProtocol.getPlcOutputLift() && !shuttleProtocol.getPlcOutputTransfer()) { -// //鑷姩妯″紡 -// if (assignCommand.getAuto() && shuttleProtocol.getPlcInputStatus().intValue() == 0) { -// //涓嬮檷鍒颁綅锛屼笖鎵樼洏闆疯揪鏃犵墿锛岃瀹氫换鍔″畬鎴� -// command.setComplete(true); -// }else { -// //鎵嬪姩妯″紡锛屼笉鍒ゆ柇鎵樼洏闆疯揪 -// //涓嬮檷鍒颁綅锛屼笖鎵樼洏闆疯揪鏃犵墿锛岃瀹氫换鍔″畬鎴� -// command.setComplete(true); -// } -// } -// } -// } else if (command.getCommandWord().intValue() == 5) { -// //鍏呯數鍛戒护 -// //鍒ゆ柇灏忚溅鍏呯數寮�鍏� -// if (shuttleProtocol.getPlcOutputCharge()) { -// //姝e父鍏呯數锛岃瀹氫换鍔″畬鎴� -// command.setComplete(true); + private boolean executeWork(Short wrkNo) { + //璇诲彇redis鏁版嵁 + if (wrkNo == null) { + return false; + } + + WrkMastService wrkMastService = SpringUtils.getBean(WrkMastService.class); + + Object o = redisUtil.get("shuttle_wrk_no_" + wrkNo); + if (o == null) { + return false; + } + ShuttleRedisCommand redisCommand = JSON.parseObject(o.toString(), ShuttleRedisCommand.class); + List<NyShuttleHttpCommand> commands = redisCommand.getAssignCommand().getCommands(); + ShuttleAssignCommand assignCommand = redisCommand.getAssignCommand(); + //褰撳墠姝ュ簭 + int commandStep = redisCommand.getCommandStep(); + if (commands.size() == 0) { + return false; + } + //鍙栧嚭鍛戒护 + NyShuttleHttpCommand command = commands.get(commandStep); + + if (shuttleProtocol.getFree() == ShuttleStatusType.BUSY.id) { + return false;//灏忚溅鐘舵�佸繖锛岀姝㈡墽琛屽懡浠� + } + + //妫�娴嬪皬杞︽槸鍚﹁杩涙彁鍗囨満锛屽闇�瑕佽繘鎻愬崌鏈哄垯璋冨害鎻愬崌鏈� + if (!checkLiftStation(wrkNo)) { + return false; + } + + //妫�鏌ヨ矾寰勬槸鍚﹀彲琛岃蛋(妫�鏌ヨ矾寰勯攣瀹氱姸鎬侊紝妫�娴嬭矾寰勬槸鍚︽湁鍏朵粬灏忚溅) + + + //鍙墽琛屽懡浠� + if (!write(command)) { + News.error("鍥涘悜绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); + return false; + } + + News.info("鍥涘悜绌挎杞﹀懡浠や笅鍙戞垚鍔燂紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); + //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂) + shuttleProtocol.setPakMk(false); + + //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘� + BasShuttleOptService shuttleOptService = SpringUtils.getBean(BasShuttleOptService.class); + if (shuttleOptService != null) { + BasShuttleOpt opt = new BasShuttleOpt( + assignCommand.getTaskNo().intValue(), + assignCommand.getShuttleNo().intValue(), + new Date(), + ShuttleTaskModeType.get(assignCommand.getTaskMode()).desc, + assignCommand.getSourceLocNo(), + assignCommand.getLocNo(), + null, + null, + null, + JSON.toJSONString(command), + null + ); + shuttleOptService.insert(opt); + } + + //鍒ゆ柇鏁版嵁鏄惁鎵ц瀹屾垚 + if (commandStep < commands.size() - 1) { + //鏇存柊redis鏁版嵁 + //姝ュ簭澧炲姞 + commandStep++; + redisCommand.setCommandStep(commandStep); + //浠诲姟鏁版嵁淇濆瓨鍒皉edis + redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); + }else { + //宸叉墽琛屽畬鎴� + +// if (redisCommand.getLiftSecurityMk()) { +// //鏇鹃攣瀹氳繃鎻愬崌鏈猴紝闇�瑕佽繘琛岃В閿� +// if (liftProtocol != null) { +// liftProtocol.setSecurityMk(false); // } // } -// //浠诲姟鏁版嵁淇濆瓨鍒皉edis -// redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); -// -// if (!command.getComplete()) { -// //涓婁竴鏉′换鍔℃湭瀹屾垚锛岀姝笅鍙戝懡浠� -// return false; + +// String locNo = shuttleProtocol.getLocNo() == null ? shuttleProtocol.getSourceLocNo() : shuttleProtocol.getLocNo(); +// if (locNo != null) { +// //瑙i櫎閿佸畾鐨勫簱浣嶈矾寰� +// NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(locNo)); +// navigateMapData.writeNavigateNodeToRedisMap(redisCommand.getAssignCommand().getNodes(), false); // } -// } -// -// if (commands.size() == 0) { -// return false; -// } -// -// //鍙栧嚭鍛戒护 -// ShuttleCommand command = commands.get(commandStep); -// -// if (assignCommand.getTaskMode() == ShuttleTaskModeType.PAK_IN.id.shortValue() -// || assignCommand.getTaskMode() == ShuttleTaskModeType.PAK_OUT.id.shortValue() -// ) { -// //灏忚溅澶卞幓鍧愭爣锛岀姝笅鍙戝懡浠� -// if (shuttleProtocol.getCurrentCode() == 0) { -// return false; -// } -// } -// -// -// //鍒ゆ柇灏忚溅褰撳墠浜岀淮鐮佹槸鍚︿负鎻愬崌鏈轰簩缁寸爜 -// if (shuttleProtocol.getCurrentCode().intValue() == liftProtocol.getBarcode().intValue()) { -// //灏忚溅褰撳墠鍛戒护璧峰浣嶇疆灏辨槸鎻愬崌鏈轰簩缁寸爜锛岃鏄庡皬杞﹂渶瑕佸悜鎻愬崌鏈哄绉诲姩锛屽垯闇�瑕佸垽鏂姸鎬佹槸鍚︽弧瓒� -// if (command.getStartCodeNum().intValue() == liftProtocol.getBarcode().intValue()){ -// //鎻愬崌鏈烘槸鍚︾┖闂诧紝鎻愬崌鏈烘槸鍚﹀埌杈剧洰鏍囨ゼ灞傦紝鐩爣妤煎眰鏄惁缁欏嚭鎻愬崌鏈哄埌浣嶄俊鍙蜂綅 -// if (!liftProtocol.isIdleNoTask()) { -// return false;//鎻愬崌鏈哄繖锛岀姝笅鍙戝懡浠� -// } -// if (liftProtocol.getTaskNo().intValue() != 0 && liftProtocol.getTaskNo().intValue() != wrkNo) { -// //鎻愬崌鏈哄伐浣滃彿鍜屽綋鍓嶅伐浣滀笉鐩稿悓锛岀姝笅鍙戝懡浠� -// return false; -// } -// -// Short distCodeNum = command.getDistCodeNum();//鐩爣浜岀淮鐮� -// BasDevpService basDevpService = SpringUtils.getBean(BasDevpService.class); -// BasDevp basDevp = basDevpService.queryByQrCode(distCodeNum.intValue());//鐩爣绔欑偣 -// if (basDevp == null) { -// return false;//鎵句笉鍒扮洰鏍囩珯锛岀姝笅鍙戝懡浠� -// } -// -// int lev = Utils.getLev(basDevp.getLocNo());//鐩爣浜岀淮鐮佹墍鍦ㄦゼ灞� -// int liftLev = liftProtocol.getLev().intValue();//鎻愬崌鏈烘墍鍦ㄦゼ灞� -// if (liftLev != lev) { -// return false;//鎻愬崌鏈轰笉鍦ㄧ洰鏍囨ゼ灞傦紝绂佹涓嬪彂鍛戒护 -// } -// -// //鑾峰彇鐩爣绔欎俊鎭� -// SiemensDevpThread devpThread = (SiemensDevpThread) SlaveConnection.get(SlaveType.Devp, 1); -// StaProtocol staProtocol = devpThread.getStation().get(basDevp.getDevNo()); -// if (staProtocol == null) { -// return false;//绔欑偣淇℃伅涓嶅瓨鍦紝绂佹涓嬪彂鍛戒护 -// } -// if (!staProtocol.isLiftArrival()) { -// return false;//绔欑偣鎻愬崌鏈哄埌浣嶄俊鍙穎alse锛岀姝笅鍙戝懡浠� -// } -// -// //鏉′欢婊¤冻锛屽崰鐢ㄦ彁鍗囨満 -// liftProtocol.setTaskNo(wrkNo); -// } -// } -// -// //涓嬪彂鍛戒护 -// if (!write(command)) { -// News.error("鍥涘悜绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); -// return false; -// } else { -// News.info("鍥涘悜绌挎杞﹀懡浠や笅鍙戞垚鍔燂紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); -// -// //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂) -// shuttleProtocol.setPakMk(false); -// -// //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘� -// BasShuttleOptService shuttleOptService = SpringUtils.getBean(BasShuttleOptService.class); -// if (shuttleOptService != null) { -// short[] commandArr = getCommandArr(command);//鑾峰彇鍛戒护鎶ユ枃 -// BasShuttleOpt opt = new BasShuttleOpt( -// assignCommand.getTaskNo().intValue(), -// assignCommand.getShuttleNo().intValue(), -// new Date(), -// ShuttleTaskModeType.get(assignCommand.getTaskMode()).desc, -// assignCommand.getSourceLocNo(), -// assignCommand.getLocNo(), -// null, -// null, -// null, -// JSON.toJSONString(command), -// JSON.toJSONString(commandArr) -// ); -// shuttleOptService.insert(opt); -// } -// -// //鍒ゆ柇鏁版嵁鏄惁鎵ц瀹屾垚 -// if (commandStep < size - 1) { -// //鏇存柊redis鏁版嵁 -// //姝ュ簭澧炲姞 -// commandStep++; -// redisCommand.setCommandStep(commandStep); -// //浠诲姟鏁版嵁淇濆瓨鍒皉edis -// redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); -// }else { -// //宸叉墽琛屽畬鎴� -// -// if (redisCommand.getLiftSecurityMk()) { -// //鏇鹃攣瀹氳繃鎻愬崌鏈猴紝闇�瑕佽繘琛岃В閿� -// if (liftProtocol != null) { -// liftProtocol.setSecurityMk(false); -// } -// } -// -// String locNo = shuttleProtocol.getLocNo() == null ? shuttleProtocol.getSourceLocNo() : shuttleProtocol.getLocNo(); -// if (locNo != null) { -// //瑙i櫎閿佸畾鐨勫簱浣嶈矾寰� -// NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(locNo)); -// navigateMapData.writeNavigateNodeToRedisMap(redisCommand.getAssignCommand().getNodes(), false); -// } -// -// //鍒犻櫎redis -// redisUtil.del("shuttle_wrk_no_" + redisCommand.getWrkNo()); -// -// if (!assignCommand.getAuto()) { -// //鎵嬪姩妯″紡涓嶆姏鍑虹瓑寰呯姸鎬侊紝鐩存帴澶嶄綅 -// //璁剧疆鍥涘悜绌挎杞︿负绌洪棽鐘舵�� -// shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE); -// //浠诲姟鍙锋竻闆� -// shuttleProtocol.setTaskNo((short) 0); -// //鏍囪澶嶄綅 -// shuttleProtocol.setPakMk(true); -// News.info("鍥涘悜绌挎杞︽墜鍔ㄤ换鍔℃墽琛屽畬鎴愶紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); -// }else { -// if (!assignCommand.getCharge()) { -// //瀵逛富绾跨▼鎶涘嚭绛夊緟纭鐘舵�亀aiting -// shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.WAITING); -// }else { -// shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING_WAITING); -// } -// News.info("鍥涘悜绌挎杞︿换鍔℃墽琛屼笅鍙戝畬鎴愮瓑寰呮墽琛岀粨鏉燂紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); -// } -// -// } -// -// } + + //鍒犻櫎redis + redisUtil.del("shuttle_wrk_no_" + redisCommand.getWrkNo()); + + if (!assignCommand.getCharge()) { + //瀵逛富绾跨▼鎶涘嚭绛夊緟纭鐘舵�亀aiting + shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.WAITING); + }else { + shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING_WAITING); + } + News.info("鍥涘悜绌挎杞︿换鍔℃墽琛屼笅鍙戝畬鎴愮瓑寰呮墽琛岀粨鏉燂紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); + } + return true; } + //妫�娴嬪皬杞︽槸鍚﹁杩涙彁鍗囨満锛屽闇�瑕佽繘鎻愬崌鏈哄垯璋冨害鎻愬崌鏈� + private boolean checkLiftStation(Short wrkNo) { + //璇诲彇redis鏁版嵁 + if (wrkNo == null) { + return false; + } + + Object o = redisUtil.get("shuttle_wrk_no_" + wrkNo); + if (o == null) { + return false; + } + + //鎷垮埌鎻愬崌鏈虹嚎绋� + LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, 1); + if (liftThread == null) { + return false; + } + LiftProtocol liftProtocol = liftThread.getLiftProtocol(); + if (liftProtocol == null) { + return false; + } + + ShuttleRedisCommand redisCommand = JSON.parseObject(o.toString(), ShuttleRedisCommand.class); + //褰撳墠姝ュ簭 + int commandStep = redisCommand.getCommandStep(); + + //妫�娴嬫槸鍚﹀瓨鍦ㄦ彁鍗囨満鍙g殑鎸囦护 + List<NyShuttleHttpCommand> commands = redisCommand.getAssignCommand().getCommands(); + if (commands.size() == 0) { + return false; + } + + if (!commands.get(commandStep).getMsgType().equals("move")) { + return true;//涓嶆槸琛岃蛋鍛戒护锛岀洿鎺ユ斁琛� + } + + + return false;//榛樿涓嶆斁琛� + } + } -- Gitblit v1.9.1