From fffbf0c777f1189c7eed623b15660dbcbe50d2a1 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期三, 02 八月 2023 13:29:03 +0800
Subject: [PATCH] 库位移转

---
 src/main/java/com/zy/asrs/utils/Utils.java |  155 ++++++++-------------------------------------------
 1 files changed, 24 insertions(+), 131 deletions(-)

diff --git a/src/main/java/com/zy/asrs/utils/Utils.java b/src/main/java/com/zy/asrs/utils/Utils.java
index 3471267..2a8ed5e 100644
--- a/src/main/java/com/zy/asrs/utils/Utils.java
+++ b/src/main/java/com/zy/asrs/utils/Utils.java
@@ -13,6 +13,7 @@
 import com.zy.common.utils.NavigateMapData;
 import com.zy.common.utils.NavigatePositionConvert;
 import com.zy.common.utils.NavigateUtils;
+import com.zy.common.utils.ShuttleDispatchUtils;
 import com.zy.core.Slave;
 import com.zy.core.cache.MessageQueue;
 import com.zy.core.cache.SlaveConnection;
@@ -23,8 +24,10 @@
 import com.zy.core.model.Task;
 import com.zy.core.model.command.ShuttleAssignCommand;
 import com.zy.core.model.command.ShuttleCommand;
+import com.zy.core.model.protocol.NyShuttleProtocol;
 import com.zy.core.model.protocol.ShuttleProtocol;
 import com.zy.core.properties.SlaveProperties;
+import com.zy.core.thread.NyShuttleThread;
 import com.zy.core.thread.ShuttleThread;
 
 import java.text.DecimalFormat;
@@ -420,125 +423,42 @@
             }
 
             //鑾峰彇绌挎杞︽墍鍦ㄨ妭鐐逛綅缃�
-            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId());
+            NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId());
             if (shuttleThread == null) {
                 continue;
             }
-            ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+            NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
             if (shuttleProtocol == null) {
                 continue;
             }
 
-            if (shuttleProtocol.getLocNo() == null) {
+            if (shuttleProtocol.getCurrentLocNo() == null) {
                 continue;
             }
 
-            if (lev != Utils.getLev(shuttleProtocol.getLocNo())) {
+            if (lev != Utils.getLev(shuttleProtocol.getCurrentLocNo())) {
                 continue;//妤煎眰涓嶅悓
             }
 
-            int[] xyPosition = NavigatePositionConvert.positionToXY(shuttleProtocol.getLocNo());//閫氳繃搴撲綅鍙疯幏鍙杧y鍧愭爣
+            int[] xyPosition = NavigatePositionConvert.positionToXY(shuttleProtocol.getCurrentLocNo());//閫氳繃搴撲綅鍙疯幏鍙杧y鍧愭爣
             list.add(xyPosition);
         }
         return list;
     }
 
-    //妫�娴嬬┛姊溅琛岃蛋璺緞锛屾槸鍚﹀瓨鍦ㄥ叾浠栧皬杞︼紝濡傛湁鍏朵粬灏忚溅鍒欒繘琛岃皟绂�
-    public static boolean checkShuttlePath(List<NavigateNode> nodes, Integer shuttleId) {
-        boolean flag = false;
-        int shuttleX = -1;
-        int shuttleY = -1;
-        int shuttleZ = -1;
-
-        LocMastService locMastService = SpringUtils.getBean(LocMastService.class);
-
-        if (nodes == null) {
-            return false;
-        }
-        if (nodes.size() == 0) {
-            return false;
-        }
-        NavigateMapData mapData = new NavigateMapData(nodes.get(0).getZ());//鑾峰彇鍦板浘鏁版嵁
-        int[][] data = mapData.getData(-1, null, Utils.getShuttlePoints(shuttleId, nodes.get(0).getZ()));
-        for (NavigateNode node : nodes) {
-            int x = node.getX();
-            int y = node.getY();
-            if (data[x][y] == 66) {//鍒ゆ柇璇ヨ矾寰勬槸鍚︽湁灏忚溅
-                flag = true;//瀛樺湪灏忚溅
-                shuttleX = x;
-                shuttleY = y;
-                shuttleZ = node.getZ();
-                break;
-            }
-        }
-
-        if (flag) {
-            //妫�娴嬪埌璺緞瀛樺湪鍏朵粬灏忚溅
-            //鎼滅储涓�鏉℃病鏈夊皬杞︾殑绌哄贩閬�
-
-            //鑾峰彇灏忚溅鍧愭爣浜岀淮鐮�
-            Short shuttlePosition = NavigatePositionConvert.xyToPosition(shuttleX, shuttleY, shuttleZ);
-            LocMast shuttleLocMast = locMastService.queryByQrCode(String.valueOf(shuttlePosition));
-
-            //鑾峰彇灏忚溅绾跨▼
-            SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class);
-            ShuttleThread currentShuttleThread = null;
-            for (ShuttleSlave slave : slaveProperties.getShuttle()) {
-                //鑾峰彇绌挎杞︽墍鍦ㄨ妭鐐逛綅缃�
-                ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId());
-                if (shuttleThread == null) {
-                    continue;
-                }
-                ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
-                if (shuttleProtocol == null) {
-                    continue;
-                }
-
-                if (shuttleProtocol.getCurrentCode().intValue() == Integer.parseInt(shuttleLocMast.getQrCodeValue())) {
-                    //灏忚溅鍧愭爣鍜岀嚎绋嬭幏鍙栫殑灏忚溅鍧愭爣涓�鑷�
-                    currentShuttleThread = shuttleThread;
-                    break;
-                }
-            }
-
-            if (currentShuttleThread == null) {
-                //娌℃壘鍒板皬杞�
-                return false;
-            }
-
-            ShuttleProtocol shuttleProtocol = currentShuttleThread.getShuttleProtocol();
-            if (!shuttleProtocol.isIdle()) {
-                return false;//琚皟搴︾殑灏忚溅澶勪簬宸ヤ綔鐘舵�侊紝绂佹瑙﹀彂閬胯浠诲姟
-            }
-
-            //鎼滅储涓�鏉℃病鏈夊皬杞︾殑绌哄贩閬擄紝骞惰皟搴﹀皬杞�
-            ShuttleAssignCommand assignCommand = Utils.searchEmptyGroupToMoveShuttle(shuttleZ, shuttleId, currentShuttleThread, null);//shuttleId鎼滅储鏃堕渶瑕佹帓闄ょ殑杞﹁締id锛宑urrentShuttleThread鏄渶瑕佽璋冨害鐨勮溅杈嗙嚎绋�
-
-            if (assignCommand == null) {
-                return false;
-            }
-
-            //涓嬪彂浠诲姟
-            MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
-
-            return false;
-        }
-
-        return true;
-    }
-
-    //鎼滅储涓�鏉℃病鏈夊皬杞︾殑绌哄贩閬擄紝骞惰繑鍥炵Щ鍔ㄥ皬杞︾殑鍛戒护
-    public static ShuttleAssignCommand searchEmptyGroupToMoveShuttle(int z, Integer currentShuttleId, ShuttleThread shuttleThread, String startLocNo) {
+    //鎼滅储涓�鏉℃病鏈夊皬杞︾殑绌哄贩閬擄紝骞惰皟搴﹀皬杞�
+    public static boolean searchEmptyGroupToMoveShuttle(int z, Integer currentShuttleId, NyShuttleThread shuttleThread) {
         LocMastService locMastService = SpringUtils.getBean(LocMastService.class);
         MainServiceImpl mainServiceImpl = SpringUtils.getBean(MainServiceImpl.class);
         CommonService commonService = SpringUtils.getBean(CommonService.class);
+        ShuttleDispatchUtils shuttleDispatchUtils = SpringUtils.getBean(ShuttleDispatchUtils.class);
 
         if (shuttleThread == null) {
-            return null;
+            return false;
         }
-        ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+        NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
         if (shuttleProtocol == null) {
-            return null;
+            return false;
         }
 
         NavigateMapData mapData = new NavigateMapData(z);//鑾峰彇鍦板浘鏁版嵁
@@ -547,9 +467,9 @@
         int distY = -1;
         int distX = -1;
         int distZ = -1;
-        for (int y = 3; y <= 25; y++) {
+        for (int y = 20; y <= 56; y++) {
             boolean searchFlag = true;
-            for (int x = 20; x <= 23; x++) {
+            for (int x = 10; x <= 11; x++) {
                 if (data[x][y] < 0 || data[x][y] == 66) {
                     searchFlag = false;//璇ュ贩閬撴湁绂佺敤鑺傜偣鎴栨湁灏忚溅
                     break;
@@ -559,7 +479,7 @@
             if (searchFlag) {
                 //鎼滅储鍑虹┖宸烽亾
                 distY = y;
-                distX = 20;
+                distX = 11;
                 distZ = z;
                 break;
             }
@@ -567,44 +487,17 @@
 
         if (distY != -1) {
 
-            //鑾峰彇閬胯鍧愭爣浜岀淮鐮�
-            Short distPosition = NavigatePositionConvert.xyToPosition(distX, distY, distZ);
-            LocMast distLocMast = locMastService.queryByQrCode(String.valueOf(distPosition));
+            //鑾峰彇閬胯搴撲綅
+            String distLocNo = NavigatePositionConvert.xyzToLocNo(distX, distY, distZ);
+            LocMast distLocMast = locMastService.queryByLoc(distLocNo);
             if (distLocMast == null) {
-                return null;
+                return false;
             }
 
-            if (startLocNo == null) {
-                //鑾峰彇灏忚溅鍧愭爣浜岀淮鐮�
-                LocMast shuttleLocMast = locMastService.queryByQrCode(String.valueOf(shuttleProtocol.getCurrentCode()));
-                if (shuttleLocMast == null) {
-                    return null;
-                }
-                startLocNo = shuttleLocMast.getLocNo();
-            }
-
-            //鍒涘缓鍒嗛厤鍛戒护
-            ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
-            assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//鍥涘悜绌挎杞﹀彿
-            assignCommand.setTaskNo((short) commonService.getWorkNo(7));//浠诲姟鍙�
-            assignCommand.setTaskMode(ShuttleTaskModeType.AVOID.id.shortValue());//閬胯浠诲姟
-            assignCommand.setSourceLocNo(startLocNo);//婧愬簱浣�
-
-            //鍒嗛厤鐩爣搴撲綅
-            shuttleProtocol.setLocNo(distLocMast.getLocNo());
-            //鐩爣搴撲綅
-            assignCommand.setLocNo(distLocMast.getLocNo());
-
-            //灏忚溅绉诲姩鍒扮洰鏍囦綅缃�
-            List<ShuttleCommand> commands = mainServiceImpl.shuttleAssignCommand(startLocNo, distLocMast.getLocNo(), NavigationMapType.NORMAL.id, assignCommand, shuttleThread);
-            if (commands == null) {
-                return null;
-            }
-
-            assignCommand.setCommands(commands);
-            return assignCommand;
+            //璋冨害灏忚溅鍒伴伩璁╀綅缃�
+            return shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(7), distLocNo, shuttleProtocol.getShuttleNo().intValue());
         }
-        return null;
+        return false;
     }
 
 }

--
Gitblit v1.9.1