From ae0d613e60b2308d23b2760d514d0ff3356bfa48 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期六, 14 十月 2023 09:06:23 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/asrs/utils/Utils.java |  190 +++++++++++++++++++++++++++++++++++++++++-----
 1 files changed, 167 insertions(+), 23 deletions(-)

diff --git a/src/main/java/com/zy/asrs/utils/Utils.java b/src/main/java/com/zy/asrs/utils/Utils.java
index 3ef6d92..1ef6d12 100644
--- a/src/main/java/com/zy/asrs/utils/Utils.java
+++ b/src/main/java/com/zy/asrs/utils/Utils.java
@@ -1,9 +1,40 @@
 package com.zy.asrs.utils;
 
 import com.alibaba.fastjson.JSON;
+import com.baomidou.mybatisplus.mapper.EntityWrapper;
 import com.core.common.Arith;
 import com.core.common.Cools;
+import com.core.common.SpringUtils;
+import com.zy.asrs.entity.BasShuttle;
+import com.zy.asrs.entity.LocMast;
+import com.zy.asrs.entity.WrkMast;
+import com.zy.asrs.mapper.WrkMastMapper;
+import com.zy.asrs.service.BasShuttleService;
+import com.zy.asrs.service.LocMastService;
+import com.zy.asrs.service.WrkMastService;
+import com.zy.asrs.service.impl.MainServiceImpl;
+import com.zy.common.model.NavigateNode;
+import com.zy.common.model.enums.NavigationMapType;
+import com.zy.common.service.CommonService;
+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;
+import com.zy.core.enums.ShuttleRunDirection;
+import com.zy.core.enums.ShuttleTaskModeType;
+import com.zy.core.enums.SlaveType;
+import com.zy.core.model.ShuttleSlave;
+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;
 import java.util.ArrayList;
@@ -329,29 +360,6 @@
         return locNo;
     }
 
-    //妤煎眰杞崲瀵瑰簲鍑哄叆搴撶珯鐐瑰簱浣嶅彿
-    public static String levToOutInStaLocNo(Integer lev) {
-        String locNo = null;
-        if (lev >= 2) {
-            lev++;
-        }
-        switch (lev) {
-            case 1:
-                locNo = "1800201";
-                break;
-            case 3:
-                locNo = "1800202";
-                break;
-            case 4:
-                locNo = "1800203";
-                break;
-            case 5:
-                locNo = "1800204";
-                break;
-        }
-        return locNo;
-    }
-
     public static void main(String[] args) {
         System.out.println(JSON.toJSONString(getGroupOutsideLoc("0200101")));
     }
@@ -388,4 +396,140 @@
         return result;
     }
 
+    //鑾峰彇闄ょ櫧鍚嶅崟澶栫殑鎸囧畾妤煎眰鍏ㄩ儴绌挎杞y鍧愭爣鐐�
+    public static List<int[]> getShuttlePoints(Integer whiteShuttle, Integer lev) {
+        BasShuttleService basShuttleService = SpringUtils.getBean(BasShuttleService.class);
+        SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class);
+        ArrayList<int[]> list = new ArrayList<>();
+        for (ShuttleSlave slave : slaveProperties.getShuttle()) {
+            if (slave.getId().intValue() == whiteShuttle) {
+                continue;//璺宠繃鐧藉悕鍗�
+            }
+
+            //鑾峰彇绌挎杞︽墍鍦ㄨ妭鐐逛綅缃�
+            NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, slave.getId());
+            if (shuttleThread == null) {
+                continue;
+            }
+            NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+            if (shuttleProtocol == null) {
+                continue;
+            }
+
+            String currentLocNo = shuttleProtocol.getCurrentLocNo();
+
+            if (currentLocNo == null) {
+                //灏忚溅娌℃湁搴撲綅鍙锋暟鎹紝浠庢暟鎹簱涓彇
+                BasShuttle basShuttle = basShuttleService.selectById(slave.getId());
+                if (basShuttle == null || basShuttle.getPoint() == null) {
+                    continue;
+                }
+                NyShuttleProtocol.NyShuttlePointClass shuttlePoint = JSON.parseObject(basShuttle.getPoint(), NyShuttleProtocol.NyShuttlePointClass.class);
+                currentLocNo = NavigatePositionConvert.nyXyzToLocNo(shuttlePoint.getX(), shuttlePoint.getY(), shuttlePoint.getZ());
+            }
+
+            if (lev != Utils.getLev(currentLocNo)) {
+                continue;//妤煎眰涓嶅悓
+            }
+
+            if (shuttleProtocol.getCurrentLocNo() == null) {
+                continue;
+            }
+            int[] xyPosition = NavigatePositionConvert.positionToXY(shuttleProtocol.getCurrentLocNo());//閫氳繃搴撲綅鍙疯幏鍙杧y鍧愭爣
+            list.add(xyPosition);
+        }
+        return list;
+    }
+
+    //鎼滅储涓�鏉℃病鏈夊皬杞︾殑绌哄贩閬擄紝骞惰皟搴﹀皬杞�
+    public static boolean searchEmptyGroupToMoveShuttle(int z, Integer currentShuttleId, NyShuttleThread shuttleThread) {
+        LocMastService locMastService = SpringUtils.getBean(LocMastService.class);
+        WrkMastService wrkMastService = SpringUtils.getBean(WrkMastService.class);
+        CommonService commonService = SpringUtils.getBean(CommonService.class);
+        ShuttleDispatchUtils shuttleDispatchUtils = SpringUtils.getBean(ShuttleDispatchUtils.class);
+
+        if (shuttleThread == null) {
+            return false;
+        }
+        NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+        if (shuttleProtocol == null) {
+            return false;
+        }
+
+        NavigateMapData mapData = new NavigateMapData(z);//鑾峰彇鍦板浘鏁版嵁
+        int[][] data = mapData.getData(-1, null, currentShuttleId == null ? null : Utils.getShuttlePoints(0, z));//杞藉叆鍏ㄩ儴杞﹁締
+
+        int distY = -1;
+        int distX = -1;
+        int distZ = -1;
+        //鑾峰彇閬胯搴撲綅
+        String distLocNo = null;
+        for (int y = 20; y <= 56; y++) {
+            boolean searchFlag = true;
+            for (int x = 10; x <= 11; x++) {
+                if (data[x][y] < 0 || data[x][y] == 66) {
+                    searchFlag = false;//璇ュ贩閬撴湁绂佺敤鑺傜偣鎴栨湁灏忚溅
+                    break;
+                }
+            }
+
+            if (searchFlag) {
+                //鎼滅储鍑虹┖宸烽亾
+                distY = y;
+                distX = 11;
+                distZ = z;
+
+                //鑾峰彇閬胯搴撲綅
+                String locNo = NavigatePositionConvert.xyzToLocNo(distX, distY, distZ);
+                LocMast distLocMast = locMastService.queryByLoc(locNo);
+                if (distLocMast == null) {
+                    continue;
+                }
+
+                //鍒ゆ柇璇ュ簱浣嶆槸鍚﹀瓨鍦ㄥ伐浣滄。
+                EntityWrapper<WrkMast> wrapper = new EntityWrapper<>();
+                wrapper.eq("loc_no", locNo);
+                WrkMast wrkMast = wrkMastService.selectOne(wrapper);
+                if (wrkMast != null) {
+                    continue;//瀛樺湪宸ヤ綔妗h烦杩囪搴撲綅
+                }
+
+                distLocNo = locNo;
+                break;
+            }
+        }
+
+        if (distLocNo != null) {
+            //璋冨害灏忚溅鍒伴伩璁╀綅缃�
+            return shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(7), distLocNo, shuttleProtocol.getShuttleNo().intValue());
+        }
+        return false;
+    }
+
+    //妫�娴嬫ゼ灞傛槸鍚︽湁绌挎杞�
+    public static boolean checkLevHasShuttle(Integer lev) {
+        SlaveProperties slaveProperties = SpringUtils.getBean(SlaveProperties.class);
+        for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
+            //鑾峰彇鍥涘悜绌挎杞︾嚎绋�
+            NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
+            if (shuttleThread == null) {
+                continue;
+            }
+            NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
+            if (shuttleProtocol == null) {
+                continue;
+            }
+            String currentLocNo = shuttleProtocol.getCurrentLocNo();
+            if (currentLocNo == null) {
+                continue;
+            }
+
+            if (lev == Utils.getLev(currentLocNo)) {
+                return true;//鎸囧畾妤煎眰鏈夌┛姊溅
+            }
+        }
+
+        return false;//鎸囧畾妤煎眰娌℃湁绌挎杞�
+    }
+
 }

--
Gitblit v1.9.1