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