From 3f48e38eeaf31f85ec8b68489c8079800ca65e0f Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期一, 04 九月 2023 08:28:12 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/core/thread/NyShuttleThread.java |  259 +++++++++++++++++++++++++++++++++++++++------------
 1 files changed, 197 insertions(+), 62 deletions(-)

diff --git a/src/main/java/com/zy/core/thread/NyShuttleThread.java b/src/main/java/com/zy/core/thread/NyShuttleThread.java
index 7fc995a..7ec573f 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;
@@ -17,17 +18,18 @@
 import com.zy.core.cache.OutputQueue;
 import com.zy.core.cache.SlaveConnection;
 import com.zy.core.enums.*;
+import com.zy.core.model.LiftSlave;
 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.command.*;
 import com.zy.core.model.protocol.LiftProtocol;
 import com.zy.core.model.protocol.NyShuttleProtocol;
+import com.zy.core.properties.SlaveProperties;
 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;
@@ -43,6 +45,7 @@
     private ShuttleSlave slave;
     private NyShuttleProtocol shuttleProtocol;
     private RedisUtil redisUtil;
+    private Socket socket;
 
     public NyShuttleThread(ShuttleSlave slave,RedisUtil redisUtil) {
         this.slave = slave;
@@ -84,6 +87,10 @@
 
     private void read() {
         try {
+            if (this.socket == null || !this.socket.isConnected()) {
+                //閾炬帴鏂紑閲嶆柊閾炬帴
+                this.connect();
+            }
             readStatus();
             //鍥涘悜绌挎杞︾┖闂层�佹湁浠诲姟銆佹爣璁颁负true銆佸瓨鍦ㄤ换鍔℃寚浠わ紝闇�瑕佹墽琛屼换鍔$殑涓嬩竴鏉℃寚浠�
             if (shuttleProtocol.getFree() == ShuttleStatusType.IDLE.id
@@ -108,7 +115,7 @@
 
             //----------璇诲彇鍥涘悜绌挎杞︾姸鎬�-----------
             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()));
             }else {
@@ -159,7 +166,7 @@
                     errCode.add(Integer.parseInt(o.toString()));
                 }
                 //鏁呴殰鐮�
-                shuttleProtocol.setErrCode(errCode);
+                shuttleProtocol.setErrCode(errCode.get(0));
                 //鎬婚噷绋嬫暟
                 shuttleProtocol.setStatusSum(jsonObject.getObject("statusSum", NyShuttleProtocol.StatusSumClass.class));
                 //闈炶嚜鍔ㄧ姸鎬佹椂闂磋鏃�
@@ -242,6 +249,14 @@
 
     @Override
     public boolean connect() {
+        try {
+            Socket socket = new Socket(slave.getIp(),slave.getPort());
+            socket.setSoTimeout(60000);
+            socket.setKeepAlive(true);
+            this.socket = socket;
+        } 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;
     }
 
@@ -268,7 +283,7 @@
         }
 
         //鍙戝嚭璇锋眰
-        JSONObject result = NyHttpUtils.requestCommand(command);
+        JSONObject result = NyHttpUtils.requestCommand(socket, command);
         if (result == null) {
             return false;//璇锋眰澶辫触
         }
@@ -299,15 +314,16 @@
             return false;
         }
 
-        WrkMastService wrkMastService = SpringUtils.getBean(WrkMastService.class);
+        WrkMastMapper wrkMastMapper = SpringUtils.getBean(WrkMastMapper.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();
+        List<NyShuttleHttpCommand> commands = redisCommand.getAssignCommand().getCommands();
         //褰撳墠姝ュ簭
         int commandStep = redisCommand.getCommandStep();
         if (commands.size() == 0) {
@@ -317,59 +333,62 @@
         NavigateMapData navigateMapData = new NavigateMapData(Utils.getLev(shuttleProtocol.getCurrentLocNo()));
         //鍙栧嚭鍛戒护
         NyShuttleHttpCommand command = commands.get(commandStep);//褰撳墠鍛戒护
-        if (commandStep != 0) {
-            //鍒ゆ柇涓婁竴鏉℃寚浠ゆ槸鍚﹀畬鎴�
-            NyShuttleHttpCommand lastCommand = commands.get(commandStep - 1);
-            String requestType = lastCommand.getRequest().getBody().get("requestType").toString();
-            if (requestType.equals("move") || requestType.equals("intoLift") || requestType.equals("outLift")) {
-                //绉诲姩鍛戒护銆佸嚭鍏ユ彁鍗囨満鍛戒护
-                NyShuttleProtocol.NyShuttlePointClass target = JSON.parseObject(lastCommand.getRequest().getBody().get("target").toString(), NyShuttleProtocol.NyShuttlePointClass.class);
-                if (shuttleProtocol.getPoint().equals(target)) {
-                    //涓婁竴鏉℃寚浠ょ殑鐩爣浣嶇疆鍜屽綋鍓嶅皬杞︿綅缃浉鍚岋紝鍒欒瀹氫笂涓�鏉′换鍔″畬鎴�
-                    lastCommand.setComplete(true);
-                    //瑙i攣閿佸畾璺緞锛屼笂涓�鏉¤矾寰勫拰褰撳墠璺緞
-                    List<NavigateNode> nodes = lastCommand.getNodes();
-                    nodes.addAll(command.getNodes());
-                    navigateMapData.writeNavigateNodeToRedisMap(nodes, false);//瑙i攣璺緞
-                }
-            }else {
-                lastCommand.setComplete(true);//鍏朵粬鍛戒护榛樿璁や负瀹屾垚
-            }
-            //浠诲姟鏁版嵁淇濆瓨鍒皉edis
-            redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand));
-
-            if (!lastCommand.getComplete()) {
-                //涓婁竴鏉′换鍔℃湭瀹屾垚锛岀姝笅鍙戝懡浠�
-                return false;
-            }
-        }
-
-        List<NavigateNode> nextNodes = null;//涓嬩竴姝ュ懡浠よ璧拌矾寰�
-        if (commandStep + 1 < commands.size()) {
-            NyShuttleHttpCommand nextCommand = commands.get(commandStep + 1);//涓嬩竴姝ュ懡浠�
-            nextNodes = nextCommand.getNodes();//涓嬩竴姝ュ懡浠よ璧拌矾寰�
-        }
-
-        if (shuttleProtocol.getFree() == ShuttleStatusType.BUSY.id) {
-            return false;//灏忚溅鐘舵�佸繖锛岀姝㈡墽琛屽懡浠�
-        }
-
-        //妫�娴嬪皬杞︽槸鍚﹁杩涙彁鍗囨満锛屽闇�瑕佽繘鎻愬崌鏈哄垯璋冨害鎻愬崌鏈�
-        if (!checkLiftStation(wrkNo)) {
-            return false;
-        }
-
-        //妫�鏌ヨ矾寰勬槸鍚﹀彲琛岃蛋(妫�鏌ヨ矾寰勯攣瀹氱姸鎬侊紝妫�娴嬭矾寰勬槸鍚︽湁鍏朵粬灏忚溅)
-        //妫�娴嬪綋鍓嶈璧拌矾寰勶紝鍜屼笅涓�姝ヨ矾寰�
-        boolean checkPathIsAvailable = NavigateUtils.checkPathIsAvailable(command.getNodes(), shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo()));
-        boolean checkPathIsAvailable2 = NavigateUtils.checkPathIsAvailable(nextNodes, shuttleProtocol.getShuttleNo().intValue(), Utils.getLev(shuttleProtocol.getCurrentLocNo()));
-        if (!checkPathIsAvailable && !checkPathIsAvailable2) {
-            return false;
-        }
-        //閿佸畾璺緞锛岄攣瀹氬綋鍓嶈矾寰勫拰涓嬩竴姝ヨ矾寰�
-        List<NavigateNode> nodes = command.getNodes();
-        nodes.addAll(nextNodes);
-        navigateMapData.writeNavigateNodeToRedisMap(nodes, true);//鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢�
+//        if (commandStep != 0) {
+//            //鍒ゆ柇涓婁竴鏉℃寚浠ゆ槸鍚﹀畬鎴�
+//            NyShuttleHttpCommand lastCommand = commands.get(commandStep - 1);
+//            String requestType = lastCommand.getRequest().getBody().get("requestType").toString();
+//            if (requestType.equals("move") || requestType.equals("intoLift") || requestType.equals("outLift")) {
+//                //绉诲姩鍛戒护銆佸嚭鍏ユ彁鍗囨満鍛戒护
+//                NyShuttleProtocol.NyShuttlePointClass target = JSON.parseObject(lastCommand.getRequest().getBody().get("target").toString(), NyShuttleProtocol.NyShuttlePointClass.class);
+//                if (shuttleProtocol.getPoint().equals(target)) {
+//                    //涓婁竴鏉℃寚浠ょ殑鐩爣浣嶇疆鍜屽綋鍓嶅皬杞︿綅缃浉鍚岋紝鍒欒瀹氫笂涓�鏉′换鍔″畬鎴�
+//                    lastCommand.setComplete(true);
+//                    //瑙i攣閿佸畾璺緞锛屼笂涓�鏉¤矾寰勫拰褰撳墠璺緞
+//                    List<NavigateNode> nodes = lastCommand.getNodes();
+//                    nodes.addAll(command.getNodes());
+//                    navigateMapData.writeNavigateNodeToRedisMap(nodes, false);//瑙i攣璺緞
+//                }
+//            }else {
+//                lastCommand.setComplete(true);//鍏朵粬鍛戒护榛樿璁や负瀹屾垚
+//            }
+//            //浠诲姟鏁版嵁淇濆瓨鍒皉edis
+//            redisUtil.set("shuttle_wrk_no_" + redisCommand.getWrkNo(), JSON.toJSONString(redisCommand));
+//
+//            if (!lastCommand.getComplete()) {
+//                //涓婁竴鏉′换鍔℃湭瀹屾垚锛岀姝笅鍙戝懡浠�
+//                return false;
+//            }
+//        }
+//
+//        List<NavigateNode> nextNodes = null;//涓嬩竴姝ュ懡浠よ璧拌矾寰�
+//        if (commandStep + 1 < commands.size()) {
+//            NyShuttleHttpCommand nextCommand = commands.get(commandStep + 1);//涓嬩竴姝ュ懡浠�
+//            nextNodes = nextCommand.getNodes();//涓嬩竴姝ュ懡浠よ璧拌矾寰�
+//        }
+//
+//        if (shuttleProtocol.getFree() == ShuttleStatusType.BUSY.id) {
+//            return false;//灏忚溅鐘舵�佸繖锛岀姝㈡墽琛屽懡浠�
+//        }
+//
+//        //妫�娴嬪皬杞︽槸鍚﹁杩涙彁鍗囨満锛屽闇�瑕佽繘鎻愬崌鏈哄垯璋冨害鎻愬崌鏈�
+//        if (!checkLiftStation(wrkNo)) {
+//            return false;
+//        }
+//
+//        //妫�娴嬬┛姊溅鏄惁鍦ㄦ彁鍗囨満鍐�
+//        if (!checkShuttleInTheLift(wrkNo)) {
+//            return false;
+//        }
+//
+//        //妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋
+//        if (!checkPath(command.getNodes(), nextNodes, redisCommand)) {
+//            return false;
+//        }
+//
+//        //閿佸畾璺緞锛岄攣瀹氬綋鍓嶈矾寰勫拰涓嬩竴姝ヨ矾寰�
+//        List<NavigateNode> nodes = command.getNodes();
+//        nodes.addAll(nextNodes);
+//        navigateMapData.writeNavigateNodeToRedisMap(nodes, true);//鎵�浣跨敤鐨勮矾寰勮繘琛岄攣瀹氱鐢�
 
         //鍙墽琛屽懡浠�
         if (!write(command)) {
@@ -438,6 +457,8 @@
             return false;
         }
 
+        WrkMastMapper wrkMastMapper = SpringUtils.getBean(WrkMastMapper.class);
+
         ShuttleRedisCommand redisCommand = JSON.parseObject(o.toString(), ShuttleRedisCommand.class);
         //褰撳墠姝ュ簭
         int commandStep = redisCommand.getCommandStep();
@@ -480,7 +501,121 @@
             return true;//鎻愬崌鏈鸿揪鍒板皬杞︽ゼ灞傦紝鏀捐
         }
 
+        //鎼滅储鏄惁鏈夊叾浠栦换鍔″崰鐢ㄤ簡鎻愬崌鏈猴紝濡傛灉鍗犵敤鎻愬崌鏈虹殑浠诲姟鍜屽綋鍓嶄换鍔$浉鍚岋紝鍒欒繍琛屾墽琛�
+        WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue());
+        if (wrkMast1 != null && wrkMast1.getWrkNo() != wrkNo.intValue()) {
+            return false;
+        }
+
+        //鎻愬崌鏈烘湭鍒拌揪灏忚溅妤煎眰锛屽懠鍙彁鍗囨満
+        //鑾峰彇鎻愬崌鏈哄懡浠�
+        NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_CAR.id, null, basDevp.getDevNo(), wrkNo.intValue());
+        ArrayList<NyLiftCommand> liftCommands = new ArrayList<>();
+        liftCommands.add(liftCommand);
+
+        //鎻愪氦鍒扮嚎绋嬪幓宸ヤ綔
+        LiftAssignCommand assignCommand = new LiftAssignCommand();
+        assignCommand.setCommands(liftCommands);
+        assignCommand.setLiftNo(liftProtocol.getLiftNo());
+        assignCommand.setTaskNo(wrkNo);
+        assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_CAR.id.shortValue());
+
+        //涓嬪彂浠诲姟
+        MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
+
         return false;//榛樿涓嶆斁琛�
     }
 
+    /**
+     * 妫�娴嬬┛姊溅鏄惁鍦ㄦ彁鍗囨満鍐�
+     * 濡傜┛姊溅鍦ㄦ彁鍗囨満鍐咃紝蹇呴』绛夊緟鎻愬崌鏈虹┖闂叉墠鍙墽琛岀┛姊溅鍛戒护
+     */
+    private boolean checkShuttleInTheLift(Short wrkNo) {
+        //璇诲彇redis鏁版嵁
+        if (wrkNo == null) {
+            return false;
+        }
+
+        Object o = redisUtil.get("shuttle_wrk_no_" + wrkNo);
+        if (o == null) {
+            return false;
+        }
+
+        SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class);
+        BasLiftService liftService = SpringUtils.getBean(BasLiftService.class);
+        for (LiftSlave liftSlave : slaveProperties.getLift()) {
+            BasLift basLift = liftService.selectById(liftSlave.getId());
+            if (basLift == null) {
+                continue;
+            }
+            if (basLift.getPoint().equals(shuttleProtocol.getPoint())) {
+                //灏忚溅鍦ㄦ彁鍗囨満鍐�
+                //鍒ゆ柇鎻愬崌鏈烘槸鍚︾┖闂�
+                LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
+                if (liftThread == null) {
+                    return false;
+                }
+                LiftProtocol liftProtocol = liftThread.getLiftProtocol();
+                if (liftProtocol == null) {
+                    return false;
+                }
+                if (liftProtocol.isIdle()) {
+                    //鎻愬崌鏈哄浜庣┖闂诧紝鏀捐
+                    return true;
+                }
+            }
+        }
+        return false;//榛樿涓嶆斁琛�
+    }
+
+    /**
+     * 妫�娴嬭矾寰勬槸鍚﹀彲琛岃蛋
+     * 濡傛灉璺緞涓虹洰鏍囧簱浣嶏紝浣嗕笉鍙璧帮紝绯荤粺灏嗗皾璇曢噸鏂拌绠楄矾寰�
+     */
+    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;//鍙璧�
+        }
+
+        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