From eb70c6896aa6ed1b045cefd17baf3486f25e6806 Mon Sep 17 00:00:00 2001 From: Junjie <fallin.jie@qq.com> Date: 星期五, 20 十月 2023 16:50:46 +0800 Subject: [PATCH] # --- src/main/java/com/zy/core/thread/NyShuttleThread.java | 434 +++++++++++++++++++++++++++++++++++++++-------------- 1 files changed, 315 insertions(+), 119 deletions(-) diff --git a/src/main/java/com/zy/core/thread/NyShuttleThread.java b/src/main/java/com/zy/core/thread/NyShuttleThread.java index 6ba944e..3773fc7 100644 --- a/src/main/java/com/zy/core/thread/NyShuttleThread.java +++ b/src/main/java/com/zy/core/thread/NyShuttleThread.java @@ -11,6 +11,7 @@ import com.zy.asrs.utils.Utils; import com.zy.common.model.NavigateNode; import com.zy.common.model.NyShuttleOperaResult; +import com.zy.common.service.CommonService; import com.zy.common.utils.*; import com.zy.core.News; import com.zy.core.ThreadHandler; @@ -28,11 +29,13 @@ import lombok.Data; import lombok.extern.slf4j.Slf4j; +import javax.swing.*; import java.io.IOException; import java.net.Socket; import java.text.MessageFormat; import java.util.ArrayList; import java.util.Date; +import java.util.HashMap; import java.util.List; /** @@ -67,10 +70,10 @@ case 1: read(); break; - // 鍐欏叆鏁版嵁 - case 2: - write((NyShuttleHttpCommand) task.getData()); - break; +// // 鍐欏叆鏁版嵁 +// case 2: +// write((NyShuttleHttpCommand) task.getData()); +// break; //涓嬪彂浠诲姟 case 3: assignWork((ShuttleAssignCommand) task.getData()); @@ -95,9 +98,14 @@ //鍥涘悜绌挎杞︾┖闂层�佹湁浠诲姟銆佹爣璁颁负true銆佸瓨鍦ㄤ换鍔℃寚浠わ紝闇�瑕佹墽琛屼换鍔$殑涓嬩竴鏉℃寚浠� if (shuttleProtocol.getFree() == ShuttleStatusType.IDLE.id && shuttleProtocol.getTaskNo() != 0 - && shuttleProtocol.getPakMk()) { + && !shuttleProtocol.getPakMk()) { //鎵ц涓嬩竴姝ユ寚浠� executeWork(shuttleProtocol.getTaskNo().shortValue()); + } + + //灏忚溅绌洪棽涓旀湁璺戝簱绋嬪簭 + if (shuttleProtocol.isIdle() && shuttleProtocol.getMoveLoc()) { + moveLoc(); } } catch (Exception e) { e.printStackTrace(); @@ -173,23 +181,9 @@ //闈炶嚜鍔ㄧ姸鎬佹椂闂磋鏃� shuttleProtocol.setErrTime(jsonObject.getInteger("errTime")); - //灏忚溅澶勪簬杩愯涓紝灏嗘爣璁扮疆涓簍rue + //灏忚溅澶勪簬杩愯涓紝灏嗘爣璁扮疆涓篺alse if (shuttleProtocol.getFree() == 0) { - shuttleProtocol.setPakMk(true); - }else { - //灏忚溅澶勪簬绛夊緟纭涓旂┖闂茬姸鎬侊紝濡傛湁宸ヤ綔鍙峰垯娓呯┖璺緞 - if (shuttleProtocol.getTaskNo() != 0 && shuttleProtocol.getProtocolStatusType() == ShuttleProtocolStatusType.WAITING) { - Object o = redisUtil.get("shuttle_wrk_no_" + shuttleProtocol.getTaskNo()); - if (o != null) { - ShuttleRedisCommand redisCommand = JSON.parseObject(o.toString(), ShuttleRedisCommand.class); - ShuttleAssignCommand assignCommand = redisCommand.getAssignCommand(); - NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(shuttleProtocol.getCurrentLocNo())); - navigateMapData.writeNavigateNodeToRedisMap(assignCommand.getNodes(), false);//瑙i攣璺緞 - - //鍒犻櫎redis - redisUtil.del("shuttle_wrk_no_" + redisCommand.getWrkNo()); - } - } + shuttleProtocol.setPakMk(false); } //灏嗗洓鍚戠┛姊溅鐘舵�佷繚瀛樿嚦鏁版嵁搴� @@ -289,7 +283,7 @@ } - private boolean write(NyShuttleHttpCommand command){ + private boolean write(NyShuttleHttpCommand command, ShuttleAssignCommand assignCommand) { if (null == command) { News.error("鍥涘悜绌挎杞﹀啓鍏ュ懡浠や负绌�"); return false; @@ -322,10 +316,34 @@ throw new RuntimeException(ex); } } + + //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘� + BasShuttleOptService shuttleOptService = SpringUtils.getBean(BasShuttleOptService.class); + BasShuttleOpt opt = null; + if (shuttleOptService != null) { + 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, + JSON.toJSONString(shuttleProtocol) + ); + opt.setSend(1);//宸蹭笅鍙� + opt.setResponse(JSON.toJSONString(result));//璇锋眰鍝嶅簲 + opt.setDeviceWrk(command.getWrkNo().toString());//璁惧宸ヤ綔鍙� + shuttleOptService.insert(opt); + } + if (result == null) { return false;//璇锋眰澶辫触 } - return true; } @@ -353,6 +371,7 @@ } WrkMastMapper wrkMastMapper = SpringUtils.getBean(WrkMastMapper.class); + WrkMast wrkMast = wrkMastMapper.selectByWorkNo(wrkNo.intValue()); Object o = redisUtil.get("shuttle_wrk_no_" + wrkNo); if (o == null) { @@ -368,9 +387,16 @@ return false; } + checkIOSta(commands, commandStep);//妫�娴嬪皬杞︽槸鍚﹁繘鍑烘彁鍗囨満杈撻�佺珯 + NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(shuttleProtocol.getCurrentLocNo())); + + boolean isLock = false;//鏄惁瑙i攣璺緞 //鍙栧嚭鍛戒护 - NyShuttleHttpCommand command = commands.get(commandStep);//褰撳墠鍛戒护 + NyShuttleHttpCommand command = null; + if (commandStep < commands.size()) { + command = commands.get(commandStep);//褰撳墠鍛戒护 + } if (commandStep != 0) { //鍒ゆ柇涓婁竴鏉℃寚浠ゆ槸鍚﹀畬鎴� NyShuttleHttpCommand lastCommand = commands.get(commandStep - 1); @@ -381,10 +407,16 @@ if (shuttleProtocol.getPoint().equals(target)) { //涓婁竴鏉℃寚浠ょ殑鐩爣浣嶇疆鍜屽綋鍓嶅皬杞︿綅缃浉鍚岋紝鍒欒瀹氫笂涓�鏉′换鍔″畬鎴� lastCommand.setComplete(true); - //瑙i攣閿佸畾璺緞锛屼笂涓�鏉¤矾寰勫拰褰撳墠璺緞 + //瑙i攣閿佸畾璺緞锛屼笂涓�鏉¤矾寰� List<NavigateNode> nodes = lastCommand.getNodes(); - nodes.addAll(command.getNodes()); - navigateMapData.writeNavigateNodeToRedisMap(nodes, false);//瑙i攣璺緞 +// //瑙i攣褰撳墠璺緞 +// if (command != null && command.getNodes() != null) { +// nodes.addAll(command.getNodes()); +// } + if (nodes != null) { + navigateMapData.writeNavigateNodeToRedisMap(nodes, false);//瑙i攣璺緞 + isLock = true;//瑙i攣杩囪矾寰� + } } }else { lastCommand.setComplete(true);//鍏朵粬鍛戒护榛樿璁や负瀹屾垚 @@ -396,6 +428,23 @@ //涓婁竴鏉′换鍔℃湭瀹屾垚锛岀姝笅鍙戝懡浠� return false; } + + //鍒ゆ柇鏄惁涓烘渶鍚庝竴鏉″懡浠や笖鍛戒护鎵ц瀹屾垚锛屾姏鍑虹瓑寰呯‘璁ょ姸鎬� + NyShuttleHttpCommand endCommand = commands.get(commands.size() - 1); + if (endCommand.getComplete()) { + //鍒犻櫎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(commands)); + + return false;//绂佹鍐嶄笅鍙戝懡浠� + } } List<NavigateNode> nextNodes = null;//涓嬩竴姝ュ懡浠よ璧拌矾寰� @@ -405,7 +454,11 @@ } if (shuttleProtocol.getFree() == ShuttleStatusType.BUSY.id) { - return false;//灏忚溅鐘舵�佸繖锛岀姝㈡墽琛屽懡浠� + String requestType = command.getRequest().getBody().get("requestType").toString(); + //鍋滄鍏呯數 绠″埗鍛戒护 + if(!(requestType.equals("stopCharge") && shuttleProtocol.getChargState() == 1) && !requestType.equals("resume")){ + return false;//灏忚溅鐘舵�佸繖锛岀姝㈡墽琛屽懡浠� + } } // //妫�娴嬪皬杞︽槸鍚﹁杩涙彁鍗囨満锛屽闇�瑕佽繘鎻愬崌鏈哄垯璋冨害鎻愬崌鏈� @@ -418,74 +471,63 @@ return false; } - //妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋 - if (!checkPath(command.getNodes(), nextNodes, redisCommand)) { - return false; - } + if (command.getRequest().getBody().get("requestType").equals("move")) { + ArrayList<int[]> whiteList = new ArrayList<>();//璁剧疆鑺傜偣鐨勭櫧鍚嶅崟 + if (wrkMast != null && ((wrkMast.getIoType() > 100 && wrkMast.getIoType() < 200) || wrkMast.getIoType() == 11)) { + //鍑哄簱浠诲姟锛屼笉妫�娴嬮鑺傜偣 + int[] startArr = NavigatePositionConvert.positionToXY(wrkMast.getSourceLocNo());//寮�濮嬭妭鐐� + whiteList.add(startArr); + } - //閿佸畾璺緞锛岄攣瀹氬綋鍓嶈矾寰勫拰涓嬩竴姝ヨ矾寰� - List<NavigateNode> nodes = command.getNodes(); - if (nextNodes != null) { - nodes.addAll(nextNodes); + //瑙i攣杩囪矾寰勶紝鍙娴嬩笅涓�娈佃矾寰勬槸鍚﹀彲璧�(褰撳墠璺緞宸茬粡琚攣瀹氭棤闇�鍐嶆娴�) + if (isLock) { + //鍙娴嬩笅涓�娈佃矾寰勬槸鍚﹀彲璧�(褰撳墠璺緞宸茬粡琚攣瀹氭棤闇�鍐嶆娴�) + //妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋 + if (!checkPath(nextNodes == null ? command.getNodes() : nextNodes, null, whiteList)) { + return false; + } + }else { + //妫�娴嬪綋鍓嶈矾寰勫拰涓嬩竴娈佃矾寰� + //妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋 + if (!checkPath(command.getNodes(), nextNodes, whiteList)) { + return false; + } + } + + //閿佸畾璺緞锛岄攣瀹氬綋鍓嶈矾寰勫拰涓嬩竴姝ヨ矾寰� + List<NavigateNode> nodes = command.getNodes(); + if (nextNodes != null) { + nodes.addAll(nextNodes); + } + if (nodes != null) { + boolean result = navigateMapData.writeNavigateNodeToRedisMap(nodes, true);//鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� + if (!result) { + return false;//璺緞閿佸畾澶辫触 + } + } } - navigateMapData.writeNavigateNodeToRedisMap(nodes, true);//鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢� //鍙墽琛屽懡浠� - if (!write(command)) { + if (!write(command, assignCommand)) { News.error("鍥涘悜绌挎杞﹀懡浠や笅鍙戝け璐ワ紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); return false; } News.info("鍥涘悜绌挎杞﹀懡浠や笅鍙戞垚鍔燂紝绌挎杞﹀彿={}锛屼换鍔℃暟鎹�={}", shuttleProtocol.getShuttleNo(), JSON.toJSON(command)); //灏嗘爣璁扮疆涓篺alse(闃叉閲嶅彂) - shuttleProtocol.setPakMk(false); + shuttleProtocol.setPakMk(true); - //淇濆瓨鏁版嵁鍒版暟鎹簱鍋氭祦姘� - 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, - JSON.toJSONString(shuttleProtocol) - ); - shuttleOptService.insert(opt); + String requestType = command.getRequest().getBody().get("requestType").toString(); + if (requestType.equals("updateFloor")) { + //鏇存柊妤煎眰鍛戒护 + shuttleProtocol.setPakMk(false);//鎭㈠鏍囪 } - //鍒ゆ柇鏁版嵁鏄惁鎵ц瀹屾垚 - if (commandStep < commands.size() - 1) { - //鏇存柊redis鏁版嵁 - //姝ュ簭澧炲姞 - commandStep++; - redisCommand.setCommandStep(commandStep); - //浠诲姟鏁版嵁淇濆瓨鍒皉edis - redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); - }else { - //宸叉墽琛屽畬鎴� - - //鏈�鍚庝竴娈靛懡浠や负绉诲姩鍛戒护锛屽垯鏆傜紦鍒犻櫎redis绛夊緟娓呴櫎璺緞鏃朵竴娆℃�у垹闄� - //鏈�鍚庝竴娈靛懡浠や负涓嶆槸绉诲姩鍛戒护锛屽垯鍒犻櫎redis - if (!command.getRequest().getBody().get("requestType").equals("move")) { - //鍒犻櫎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)); - } + commandStep++; + //鏇存柊redis鏁版嵁 + redisCommand.setCommandStep(commandStep); + //浠诲姟鏁版嵁淇濆瓨鍒皉edis + redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); return true; } @@ -621,56 +663,210 @@ * 妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋 * 濡傛灉璺緞涓虹洰鏍囧簱浣嶏紝浣嗕笉鍙璧帮紝绯荤粺灏嗗皾璇曢噸鏂拌绠楄矾寰� */ - private boolean checkPath(List<NavigateNode> currentNodes, List<NavigateNode> nextNodes, ShuttleRedisCommand redisCommand) { + private boolean checkPath(List<NavigateNode> currentNodes, List<NavigateNode> nextNodes, List<int[]> whitePoints) { //妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋(妫�鏌ヨ矾寰勯攣瀹氱姸鎬侊紝妫�娴嬭矾寰勬槸鍚︽湁鍏朵粬灏忚溅) //妫�娴嬪綋鍓嶈璧拌矾寰勶紝鍜屼笅涓�姝ヨ矾寰� - boolean checkPathIsAvailable = NavigateUtils.checkPathIsAvailable(currentNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo())); + boolean checkPathIsAvailable = NavigateUtils.checkPathIsAvailable(currentNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo()), whitePoints); if (nextNodes == null) { if (checkPathIsAvailable) { return true;//鍙璧� } + return false; }else { - boolean checkPathIsAvailable2 = NavigateUtils.checkPathIsAvailable(nextNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo())); + boolean checkPathIsAvailable2 = NavigateUtils.checkPathIsAvailable(nextNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo()), whitePoints); if (checkPathIsAvailable && checkPathIsAvailable2) { return true;//鍙璧� } } - ShuttleAssignCommand assignCommand = redisCommand.getAssignCommand(); - NavigateNode currentTarget = currentNodes.get(currentNodes.size() - 1); - String currentLocNo = NavigatePositionConvert.nodeToLocNo(currentTarget); - NavigateNode nextTarget = nextNodes.get(nextNodes.size() - 1); - String nextLocNo = NavigatePositionConvert.nodeToLocNo(nextTarget); - if (assignCommand.getLocNo().equals(currentLocNo) || assignCommand.getLocNo().equals(nextLocNo)) { - //褰撳墠璺緞鏈�鍚庝竴涓妭鐐规槸鐩爣搴撲綅锛岃繘琛岃矾寰勬娴嬶紝濡傛灉涓嶅彲琛岃蛋锛岄噸鏂拌绠楄矾寰� - //涓嶅彲琛岃蛋锛岄噸鏂拌绠楄矾寰� - NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleProtocol.getShuttleNo().intValue(), shuttleProtocol.getTaskNo(), shuttleProtocol.getCurrentLocNo(), assignCommand.getLocNo()); - if (result == null) { - return false;//璺緞璁$畻澶辫触锛屼笉鍙璧� - } - - List<NyShuttleHttpCommand> newCommands = result.getCommands();//鏂拌矾寰� - - //褰撳墠姝ュ簭 - int commandStep = redisCommand.getCommandStep(); - List<NyShuttleHttpCommand> commands = assignCommand.getCommands(); - - commands.remove(commandStep);//绉婚櫎褰撳墠姝ュ簭鎸囦护 - if (assignCommand.getLocNo().equals(currentLocNo)) { - //褰撳墠璺緞锛岄渶瑕佸啀澶氱Щ闄や笅涓�姝ユ寚浠� - commands.remove(commandStep + 1); - } - - //灏嗘柊璺緞娣诲姞杩涙寚浠ら泦鍚� - commands.addAll(commandStep, newCommands); - assignCommand.setCommands(commands); - redisCommand.setAssignCommand(assignCommand); - //浠诲姟鏁版嵁淇濆瓨鍒皉edis - redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); - return false;//褰撳墠涓嶅彲琛岃蛋锛岀瓑寰呬笅涓�娆℃墽琛岃蛋鏂拌矾寰� - } +// ShuttleAssignCommand assignCommand = redisCommand.getAssignCommand(); +// NavigateNode currentTarget = currentNodes.get(currentNodes.size() - 1); +// String currentLocNo = NavigatePositionConvert.nodeToLocNo(currentTarget); +// NavigateNode nextTarget = nextNodes.get(nextNodes.size() - 1); +// String nextLocNo = NavigatePositionConvert.nodeToLocNo(nextTarget); +// if (assignCommand.getLocNo().equals(currentLocNo) || assignCommand.getLocNo().equals(nextLocNo)) { +// //褰撳墠璺緞鏈�鍚庝竴涓妭鐐规槸鐩爣搴撲綅锛岃繘琛岃矾寰勬娴嬶紝濡傛灉涓嶅彲琛岃蛋锛岄噸鏂拌绠楄矾寰� +// //涓嶅彲琛岃蛋锛岄噸鏂拌绠楄矾寰� +// NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleProtocol.getShuttleNo().intValue(), shuttleProtocol.getTaskNo(), shuttleProtocol.getCurrentLocNo(), assignCommand.getLocNo()); +// if (result == null) { +// return false;//璺緞璁$畻澶辫触锛屼笉鍙璧� +// } +// +// List<NyShuttleHttpCommand> newCommands = result.getCommands();//鏂拌矾寰� +// +// //褰撳墠姝ュ簭 +// int commandStep = redisCommand.getCommandStep(); +// List<NyShuttleHttpCommand> commands = assignCommand.getCommands(); +// +// commands.remove(commandStep);//绉婚櫎褰撳墠姝ュ簭鎸囦护 +// if (assignCommand.getLocNo().equals(currentLocNo)) { +// //褰撳墠璺緞锛岄渶瑕佸啀澶氱Щ闄や笅涓�姝ユ寚浠� +// commands.remove(commandStep + 1); +// } +// +// //灏嗘柊璺緞娣诲姞杩涙寚浠ら泦鍚� +// commands.addAll(commandStep, newCommands); +// assignCommand.setCommands(commands); +// redisCommand.setAssignCommand(assignCommand); +// //浠诲姟鏁版嵁淇濆瓨鍒皉edis +// redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand)); +// return false;//褰撳墠涓嶅彲琛岃蛋锛岀瓑寰呬笅涓�娆℃墽琛岃蛋鏂拌矾寰� +// } return false;//涓嶅彲琛岃蛋 } + /** + * 璺戝簱绋嬪簭 + */ + private void moveLoc() { + LocMastService locMastService = SpringUtils.getBean(LocMastService.class); + ShuttleDispatchUtils shuttleDispatchUtils = SpringUtils.getBean(ShuttleDispatchUtils.class); + CommonService commonService = SpringUtils.getBean(CommonService.class); + WrkMastMapper wrkMastMapper = SpringUtils.getBean(WrkMastMapper.class); + int lev = Utils.getLev(shuttleProtocol.getCurrentLocNo());//灏忚溅褰撳墠妤煎眰 + if (!shuttleProtocol.isIdle()) { + return; + } + + WrkMast wrkMast = wrkMastMapper.selectShuttleHasMoveWorking(shuttleProtocol.getShuttleNo().intValue()); + if (wrkMast != null) { + return; + } + + if (shuttleProtocol.getYCurrent() > shuttleProtocol.getYTarget()) { + //璺戝簱缁撴潫 + shuttleProtocol.setMoveLoc(false); + shuttleProtocol.setMoveType(0); + shuttleProtocol.setXStart(0); + shuttleProtocol.setXTarget(0); + shuttleProtocol.setXCurrent(0); + shuttleProtocol.setYStart(0); + shuttleProtocol.setYTarget(0); + shuttleProtocol.setYCurrent(0); + return; + } + + if (shuttleProtocol.getMoveType() == 0) {//璺戣建閬� + ArrayList<String> locs = new ArrayList<>(); + for (int i = shuttleProtocol.getXCurrent(); i <= shuttleProtocol.getXTarget(); i++) { + String locNo = Utils.getLocNo(i, shuttleProtocol.getYCurrent(), lev); + locs.add(locNo); + } + List<LocMast> locMasts = locMastService.selectEmptyLocNos(locs); + if (locMasts.isEmpty()) { + //绌哄簱浣� + shuttleProtocol.setYCurrent(shuttleProtocol.getYCurrent() + 1); + return; + } + + LocMast start = locMasts.get(0); + LocMast target = locMasts.get(locMasts.size() - 1); + //鍒ゆ柇灏忚溅鏄惁鍦ㄨ捣鐐逛綅缃� + if (!shuttleProtocol.getCurrentLocNo().equals(start.getLocNo())) {//涓嶅湪璧风偣浣嶇疆锛岃皟搴﹀幓璧风偣浣嶇疆 + shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(3), start.getLocNo()); + }else { + //鍦ㄨ捣鐐逛綅缃紝璋冨害鍘荤洰鏍囦綅缃� + if (shuttleProtocol.getCurrentLocNo().equals(target.getLocNo())) { + shuttleProtocol.setYCurrent(shuttleProtocol.getYCurrent() + 1);//灏忚溅鍜岀洰鏍囦綅缃竴鑷达紝璺宠繃 + }else { + boolean result = shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(3), target.getLocNo()); + if (result) {//璋冨害鎴愬姛 + shuttleProtocol.setYCurrent(shuttleProtocol.getYCurrent() + 1); + } + } + } + }else {//璺戝簱浣� + Integer xCurrent = shuttleProtocol.getXCurrent(); + if (xCurrent > shuttleProtocol.getXTarget()) {//褰揦鍊煎ぇ浜嶺鐩爣鍊硷紝杩涜褰掗浂涓擸鏂瑰悜+1 + shuttleProtocol.setXCurrent(shuttleProtocol.getXStart()); + shuttleProtocol.setYCurrent(shuttleProtocol.getYCurrent() + 1); + return; + } + + Integer yCurrent = shuttleProtocol.getYCurrent(); + String locNo = Utils.getLocNo(xCurrent, yCurrent, lev); + LocMast target = locMastService.selectById(locNo); + if (target == null) { + shuttleProtocol.setXCurrent(shuttleProtocol.getXCurrent() + 1); + return; + } + + if (!target.getLocSts().equals("O")) { + shuttleProtocol.setXCurrent(shuttleProtocol.getXCurrent() + 1); + return; + } + + //璋冨害鍘荤洰鏍囦綅缃� + if (shuttleProtocol.getCurrentLocNo().equals(target.getLocNo())) { + shuttleProtocol.setXCurrent(shuttleProtocol.getXCurrent() + 1);//灏忚溅鍜岀洰鏍囦綅缃竴鑷达紝璺宠繃 + }else { + boolean result = shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(3), target.getLocNo()); + if (result) {//璋冨害鎴愬姛 + shuttleProtocol.setXCurrent(shuttleProtocol.getXCurrent() + 1); + } + } + } + } + + //妫�娴嬪皬杞︽槸鍚﹁繘鍑烘彁鍗囨満杈撻�佺珯 + public void checkIOSta(List<NyShuttleHttpCommand> commands, int commandStep) { + if (commandStep != 0) { + NyShuttleHttpCommand lastCommand = commands.get(commandStep - 1);//涓婁竴姝ュ懡浠� + if (lastCommand.getRequest().getBody().get("requestType").equals("move")) { + //妫�娴嬭捣鐐规槸鍚︿负鎻愬崌鏈鸿緭閫佺珯鐐� + NyShuttleProtocol.NyShuttlePointClass start = JSON.parseObject(lastCommand.getRequest().getBody().get("start").toString(), NyShuttleProtocol.NyShuttlePointClass.class); + int[] startPoint = NavigatePositionConvert.NyXyzToWCSXyz(start.getX(), start.getY(), start.getZ()); + if (startPoint[0] == 13 && (startPoint[1] == 22 || startPoint[1] == 38 || startPoint[1] == 57)) { + //杈撻�佺珯鐐逛綅缃� + + int liftNo; + if (startPoint[1] == 22) { + liftNo = 1; + } else if (startPoint[1] == 38) { + liftNo = 2; + } else { + liftNo = 3; + } + + HashMap<String, Object> data = new HashMap<>(); + data.put("lev", startPoint[2]); + data.put("status", false);//鍑鸿緭閫佺珯 + + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Lift, liftNo, new Task(4, data)); + } + } + } + + if (commands.size() == commandStep) { + return; + } + NyShuttleHttpCommand command = commands.get(commandStep);//褰撳墠鍛戒护 + if (command.getRequest().getBody().get("requestType").equals("move")) { + NyShuttleProtocol.NyShuttlePointClass target = JSON.parseObject(command.getRequest().getBody().get("target").toString(), NyShuttleProtocol.NyShuttlePointClass.class); + int[] targetPoint = NavigatePositionConvert.NyXyzToWCSXyz(target.getX(), target.getY(), target.getZ()); + //妫�娴嬬洰鏍囦綅缃槸鍚︿负鎻愬崌鏈鸿緭閫佺珯鐐� + if (targetPoint[0] == 13 && (targetPoint[1] == 22 || targetPoint[1] == 38 || targetPoint[1] == 57)) { + //杈撻�佺珯鐐逛綅缃� + + int liftNo; + if (targetPoint[1] == 22) { + liftNo = 1; + } else if (targetPoint[1] == 38) { + liftNo = 2; + } else { + liftNo = 3; + } + + HashMap<String, Object> data = new HashMap<>(); + data.put("lev", targetPoint[2]); + data.put("status", true);//杩涜緭閫佺珯 + + //涓嬪彂浠诲姟 + MessageQueue.offer(SlaveType.Lift, liftNo, new Task(4, data)); + } + } + } + } -- Gitblit v1.9.1