From aac4bc5bdfd808fa7d33ee04924741a4c03944fc Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期二, 19 九月 2023 11:18:53 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/core/thread/NyShuttleThread.java |  147 ++++++++++++++++++++++++++++++++++++++++++------
 1 files changed, 127 insertions(+), 20 deletions(-)

diff --git a/src/main/java/com/zy/core/thread/NyShuttleThread.java b/src/main/java/com/zy/core/thread/NyShuttleThread.java
index 73dd3ae..6ba944e 100644
--- a/src/main/java/com/zy/core/thread/NyShuttleThread.java
+++ b/src/main/java/com/zy/core/thread/NyShuttleThread.java
@@ -10,6 +10,7 @@
 
 import com.zy.asrs.utils.Utils;
 import com.zy.common.model.NavigateNode;
+import com.zy.common.model.NyShuttleOperaResult;
 import com.zy.common.utils.*;
 import com.zy.core.News;
 import com.zy.core.ThreadHandler;
@@ -27,6 +28,8 @@
 import lombok.Data;
 import lombok.extern.slf4j.Slf4j;
 
+import java.io.IOException;
+import java.net.Socket;
 import java.text.MessageFormat;
 import java.util.ArrayList;
 import java.util.Date;
@@ -42,6 +45,7 @@
     private ShuttleSlave slave;
     private NyShuttleProtocol shuttleProtocol;
     private RedisUtil redisUtil;
+    private Socket socket;
 
     public NyShuttleThread(ShuttleSlave slave,RedisUtil redisUtil) {
         this.slave = slave;
@@ -83,6 +87,10 @@
 
     private void read() {
         try {
+            if (this.socket == null || this.socket.isClosed()) {
+                //閾炬帴鏂紑閲嶆柊閾炬帴
+                this.connect();
+            }
             readStatus();
             //鍥涘悜绌挎杞︾┖闂层�佹湁浠诲姟銆佹爣璁颁负true銆佸瓨鍦ㄤ换鍔℃寚浠わ紝闇�瑕佹墽琛屼换鍔$殑涓嬩竴鏉℃寚浠�
             if (shuttleProtocol.getFree() == ShuttleStatusType.IDLE.id
@@ -107,9 +115,10 @@
 
             //----------璇诲彇鍥涘悜绌挎杞︾姸鎬�-----------
             NyShuttleHttpCommand readStatusCommand = NyHttpUtils.getReadStatusCommand(slave.getId());
-            JSONObject jsonObject = NyHttpUtils.requestCommand(readStatusCommand);
+            JSONObject jsonObject = NyHttpUtils.requestCommand(socket, readStatusCommand);
             if (jsonObject == null) {
-                OutputQueue.SHUTTLE.offer(MessageFormat.format("銆恵0}銆戝洓鍚戠┛姊溅plc鐘舵�佷俊鎭け璐� ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
+                shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.OFFLINE);
+                OutputQueue.SHUTTLE.offer(MessageFormat.format("銆恵0}銆戝洓鍚戠┛姊溅Socket鐘舵�佷俊鎭け璐� ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
             }else {
                 //鎵嬪姩鐘舵��/鑷姩鐘舵��
                 shuttleProtocol.setWorkingMode(jsonObject.getInteger("workingMode"));
@@ -158,7 +167,7 @@
                     errCode.add(Integer.parseInt(o.toString()));
                 }
                 //鏁呴殰鐮�
-                shuttleProtocol.setErrCode(errCode);
+                shuttleProtocol.setErrCode(errCode.get(0));
                 //鎬婚噷绋嬫暟
                 shuttleProtocol.setStatusSum(jsonObject.getObject("statusSum", NyShuttleProtocol.StatusSumClass.class));
                 //闈炶嚜鍔ㄧ姸鎬佹椂闂磋鏃�
@@ -167,6 +176,20 @@
                 //灏忚溅澶勪簬杩愯涓紝灏嗘爣璁扮疆涓簍rue
                 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());
+                        }
+                    }
                 }
 
                 //灏嗗洓鍚戠┛姊溅鐘舵�佷繚瀛樿嚦鏁版嵁搴�
@@ -235,12 +258,29 @@
             }
         } catch (Exception e) {
             e.printStackTrace();
-            OutputQueue.SHUTTLE.offer(MessageFormat.format("銆恵0}銆戝洓鍚戠┛姊溅plc鐘舵�佷俊鎭け璐� ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
+            OutputQueue.SHUTTLE.offer(MessageFormat.format("銆恵0}銆戝洓鍚戠┛姊溅Socket鐘舵�佷俊鎭け璐� ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
+            try {
+                this.socket.close();
+                this.socket = null;
+                Thread.sleep(1000);
+                this.connect();
+            } catch (IOException | InterruptedException exception) {
+                e.printStackTrace();
+            }
         }
     }
 
     @Override
     public boolean connect() {
+        try {
+            Socket socket = new Socket(slave.getIp(),slave.getPort());
+            socket.setSoTimeout(60000);
+            socket.setKeepAlive(true);
+            this.socket = socket;
+            log.info(MessageFormat.format("銆恵0}銆戝洓鍚戠┛姊溅Socket閾炬帴鎴愬姛 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
+        } catch (IOException e) {
+            OutputQueue.SHUTTLE.offer(MessageFormat.format("銆恵0}銆戝洓鍚戠┛姊溅Socket閾炬帴澶辫触 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), slave.getId(), slave.getIp(), slave.getPort()));
+        }
         return true;
     }
 
@@ -267,7 +307,21 @@
         }
 
         //鍙戝嚭璇锋眰
-        JSONObject result = NyHttpUtils.requestCommand(command);
+        JSONObject result = null;
+        try {
+            result = NyHttpUtils.requestCommand(socket, command);
+        } catch (IOException e) {
+            try {
+                this.socket.close();
+                this.socket = null;
+                Thread.sleep(1000);
+                this.connect();
+            } catch (IOException exception) {
+                exception.printStackTrace();
+            } catch (InterruptedException ex) {
+                throw new RuntimeException(ex);
+            }
+        }
         if (result == null) {
             return false;//璇锋眰澶辫触
         }
@@ -306,8 +360,8 @@
         }
 
         ShuttleRedisCommand redisCommand = JSON.parseObject(o.toString(), ShuttleRedisCommand.class);
-        List<NyShuttleHttpCommand> commands = redisCommand.getAssignCommand().getCommands();
         ShuttleAssignCommand assignCommand = redisCommand.getAssignCommand();
+        List<NyShuttleHttpCommand> commands = redisCommand.getAssignCommand().getCommands();
         //褰撳墠姝ュ簭
         int commandStep = redisCommand.getCommandStep();
         if (commands.size() == 0) {
@@ -354,10 +408,10 @@
             return false;//灏忚溅鐘舵�佸繖锛岀姝㈡墽琛屽懡浠�
         }
 
-        //妫�娴嬪皬杞︽槸鍚﹁杩涙彁鍗囨満锛屽闇�瑕佽繘鎻愬崌鏈哄垯璋冨害鎻愬崌鏈�
-        if (!checkLiftStation(wrkNo)) {
-            return false;
-        }
+//        //妫�娴嬪皬杞︽槸鍚﹁杩涙彁鍗囨満锛屽闇�瑕佽繘鎻愬崌鏈哄垯璋冨害鎻愬崌鏈�
+//        if (!checkLiftStation(wrkNo)) {
+//            return false;
+//        }
 
         //妫�娴嬬┛姊溅鏄惁鍦ㄦ彁鍗囨満鍐�
         if (!checkShuttleInTheLift(wrkNo)) {
@@ -365,13 +419,15 @@
         }
 
         //妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋
-        if (!checkPath(command.getNodes(), nextNodes)) {
+        if (!checkPath(command.getNodes(), nextNodes, redisCommand)) {
             return false;
         }
 
         //閿佸畾璺緞锛岄攣瀹氬綋鍓嶈矾寰勫拰涓嬩竴姝ヨ矾寰�
         List<NavigateNode> nodes = command.getNodes();
-        nodes.addAll(nextNodes);
+        if (nextNodes != null) {
+            nodes.addAll(nextNodes);
+        }
         navigateMapData.writeNavigateNodeToRedisMap(nodes, true);//鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢�
 
         //鍙墽琛屽懡浠�
@@ -398,7 +454,8 @@
                     null,
                     null,
                     JSON.toJSONString(command),
-                    null
+                    null,
+                    JSON.toJSONString(shuttleProtocol)
             );
             shuttleOptService.insert(opt);
         }
@@ -414,8 +471,12 @@
         }else {
             //宸叉墽琛屽畬鎴�
 
-            //鍒犻櫎redis
-            redisUtil.del("shuttle_wrk_no_" + redisCommand.getWrkNo());
+            //鏈�鍚庝竴娈靛懡浠や负绉诲姩鍛戒护锛屽垯鏆傜紦鍒犻櫎redis绛夊緟娓呴櫎璺緞鏃朵竴娆℃�у垹闄�
+            //鏈�鍚庝竴娈靛懡浠や负涓嶆槸绉诲姩鍛戒护锛屽垯鍒犻櫎redis
+            if (!command.getRequest().getBody().get("requestType").equals("move")) {
+                //鍒犻櫎redis
+                redisUtil.del("shuttle_wrk_no_" + redisCommand.getWrkNo());
+            }
 
             if (!assignCommand.getCharge()) {
                 //瀵逛富绾跨▼鎶涘嚭绛夊緟纭鐘舵�亀aiting
@@ -532,7 +593,9 @@
             if (basLift == null) {
                 continue;
             }
-            if (basLift.getPoint().equals(shuttleProtocol.getPoint())) {
+            Integer liftX = basLift.getPoint$().getX();
+            Integer liftY = basLift.getPoint$().getY();
+            if (liftX.equals(shuttleProtocol.getPoint().getX()) && liftY.equals(shuttleProtocol.getPoint().getY())) {
                 //灏忚溅鍦ㄦ彁鍗囨満鍐�
                 //鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
                 LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
@@ -547,6 +610,8 @@
                     //鎻愬崌鏈哄浜庣┖闂诧紝鏀捐
                     return true;
                 }
+            }else {
+                return true;//涓嶅湪鎻愬崌鏈哄唴锛屾斁琛�
             }
         }
         return false;//榛樿涓嶆斁琛�
@@ -554,15 +619,57 @@
 
     /**
      * 妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋
+     * 濡傛灉璺緞涓虹洰鏍囧簱浣嶏紝浣嗕笉鍙璧帮紝绯荤粺灏嗗皾璇曢噸鏂拌绠楄矾寰�
      */
-    private boolean checkPath(List<NavigateNode> currentNodes, List<NavigateNode> nextNodes) {
+    private boolean checkPath(List<NavigateNode> currentNodes, List<NavigateNode> nextNodes, ShuttleRedisCommand redisCommand) {
         //妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋(妫�鏌ヨ矾寰勯攣瀹氱姸鎬侊紝妫�娴嬭矾寰勬槸鍚︽湁鍏朵粬灏忚溅)
         //妫�娴嬪綋鍓嶈璧拌矾寰勶紝鍜屼笅涓�姝ヨ矾寰�
         boolean checkPathIsAvailable = NavigateUtils.checkPathIsAvailable(currentNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo()));
-        boolean checkPathIsAvailable2 = NavigateUtils.checkPathIsAvailable(nextNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo()));
-        if (checkPathIsAvailable && checkPathIsAvailable2) {
-            return true;//鍙璧�
+        if (nextNodes == null) {
+            if (checkPathIsAvailable) {
+                return true;//鍙璧�
+            }
+        }else {
+            boolean checkPathIsAvailable2 = NavigateUtils.checkPathIsAvailable(nextNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo()));
+            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;//褰撳墠涓嶅彲琛岃蛋锛岀瓑寰呬笅涓�娆℃墽琛岃蛋鏂拌矾寰�
+        }
+
         return false;//涓嶅彲琛岃蛋
     }
 

--
Gitblit v1.9.1