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 |  352 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++--
 1 files changed, 340 insertions(+), 12 deletions(-)

diff --git a/src/main/java/com/zy/asrs/utils/Utils.java b/src/main/java/com/zy/asrs/utils/Utils.java
index 36a0324..2a8ed5e 100644
--- a/src/main/java/com/zy/asrs/utils/Utils.java
+++ b/src/main/java/com/zy/asrs/utils/Utils.java
@@ -1,17 +1,52 @@
 package com.zy.asrs.utils;
 
+import com.alibaba.fastjson.JSON;
 import com.core.common.Arith;
 import com.core.common.Cools;
+import com.core.common.SpringUtils;
+import com.zy.asrs.entity.LocMast;
+import com.zy.asrs.service.LocMastService;
+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;
+import java.util.Arrays;
+import java.util.Collections;
 import java.util.List;
 
 /**
  * Created by vincent on 2020/8/27
  */
 public class Utils {
+
+    public static final List<Integer> FIRST_GROUP_ROW_LIST = new ArrayList<Integer>() {{
+        add(1);add(2);add(3);add(4);
+    }};
+    public static final List<Integer> SECOND_GROUP_ROW_LIST = new ArrayList<Integer>() {{
+        add(5);add(6);add(7);add(8);add(9);add(10);add(11);
+    }};
 
     private static final DecimalFormat fmt = new DecimalFormat("##0.00");
 
@@ -35,6 +70,70 @@
             return msgBuilder.toString();
         }
     }
+
+    public static Integer getGroupRow(String locNo, Boolean pakin){
+        int row = getRow(locNo);
+        return getGroupRow(row, pakin);
+    }
+
+    public static List<String> getGroupLocNo(String locNo){
+        int row = getRow(locNo);
+        List<String> result = new ArrayList<>();
+        if (FIRST_GROUP_ROW_LIST.contains(row)) {
+            for (Integer groupRow : FIRST_GROUP_ROW_LIST) {
+                result.add(zerofill(String.valueOf(groupRow), 2) + locNo.substring(2));
+            }
+        } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
+            for (Integer groupRow : SECOND_GROUP_ROW_LIST) {
+                result.add(zerofill(String.valueOf(groupRow), 2) + locNo.substring(2));
+            }
+        }
+        return result;
+    }
+
+    public static Integer getGroupRow(Integer row, Boolean pakin) {
+        if (FIRST_GROUP_ROW_LIST.contains(row)) {
+            return 4;
+        } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
+            return 5;
+        } else {
+            return 0;
+        }
+//        if (pakin) {
+//            if (FIRST_GROUP_ROW_LIST.contains(row)) {
+//                return 2;
+//            } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
+//                return 18;
+//            } else {
+//                return 0;
+//            }
+//        } else {
+//            if (FIRST_GROUP_ROW_LIST.contains(row)) {
+//                return 12;
+//            } else if (SECOND_GROUP_ROW_LIST.contains(row)) {
+//                return 30;
+//            } else {
+//                return 0;
+//            }
+//        }
+    }
+
+    /**
+     * 鍒ゆ柇搴撲綅鏄惁涓虹┛姊簱浣�
+     * @param locNo
+     * @return
+     */
+    public static Boolean isShuttle(String locNo) {
+        int row = Utils.getRow(locNo);
+        if (row >= 2 && row <= 12) {
+            return Boolean.TRUE;
+        }
+        return Boolean.FALSE;
+    }
+
+    // -------------------------------------------------------------------------------------------------------------------
+
+
 
     /**
      * 鍒ゆ柇鏄惁涓烘繁搴撲綅
@@ -92,6 +191,7 @@
         return zerofill(String.valueOf(shallowRow), 2) + deepLoc.substring(2);
     }
 
+
     /**
      * 鑾峰彇 娣卞簱浣嶆帓瀵瑰簲鐨勬祬搴撲綅鎺�
      */
@@ -109,7 +209,7 @@
         int targetRow;
         if (remainder == 2) {
             targetRow = row - 1;
-        } else if (remainder == 3) {
+        } else if (remainder == 1) {
             targetRow = row + 1;
         } else {
             throw new RuntimeException(shallowLoc + "涓嶆槸娴呭簱浣嶏紝绯荤粺绻佸繖");
@@ -125,7 +225,7 @@
         int targetRow;
         if (remainder == 2) {
             targetRow = shallowRow - 1;
-        } else if (remainder == 3) {
+        } else if (remainder == 1) {
             targetRow = shallowRow + 1;
         } else {
             throw new RuntimeException(shallowRow + "涓嶆槸娴呭簱浣嶆帓锛岀郴缁熺箒蹇�");
@@ -142,6 +242,34 @@
         }
         throw new RuntimeException("搴撲綅瑙f瀽寮傚父");
     }
+
+    /**
+     * 閫氳繃搴撲綅鍙疯幏鍙� 鍒�
+     */
+    public static int getBay(String locNo) {
+        if (!Cools.isEmpty(locNo)) {
+            return Integer.parseInt(locNo.substring(2, 5));
+        }
+        throw new RuntimeException("搴撲綅瑙f瀽寮傚父");
+    }
+
+    /**
+     * 閫氳繃搴撲綅鍙疯幏鍙� 灞�
+     */
+    public static int getLev(String locNo) {
+        if (!Cools.isEmpty(locNo)) {
+            return Integer.parseInt(locNo.substring(5, 7));
+        }
+        throw new RuntimeException("搴撲綅瑙f瀽寮傚父");
+    }
+
+    /**
+     * 閫氳繃鎺掑垪灞傛嫾鎺ュ嚭搴撲綅鍙�
+     */
+    public static String append(int row, int bay, int lev) {
+        return zerofill(String.valueOf(row), 2) + zerofill(String.valueOf(bay), 3) + zerofill(String.valueOf(lev), 2);
+    }
+
 
     /**
      * 褰撴绱㈠埌鍙屾繁搴撲綅鐨勬祬搴撲綅鏃讹紝濡傛灉娣卞簱浣嶆棤璐э紝鍒欐斁鍏ュ搴旂殑娣卞簱浣�
@@ -161,15 +289,215 @@
 
     }
 
-    public static void main(String[] args) {
-        SlaveProperties slaveProperties = new SlaveProperties();
-        slaveProperties.setDoubleDeep(true);
-        List<Integer> list = new ArrayList<>();
-        list.add(1);list.add(4);list.add(5);list.add(8);list.add(9);list.add(12);
-        slaveProperties.setDoubleLocs(list);
-        slaveProperties.setGroupCount(4);
-        Integer deepRow = getDeepRow(slaveProperties, 6);
-        System.out.println(deepRow);
-
+    public static String getLocNo(Number row, Number bay, Number lev) {
+        return zerofill(String.valueOf(row), 2) + zerofill(String.valueOf(bay), 3) + zerofill(String.valueOf(lev), 2);
     }
+
+    //鍑哄叆搴撶珯鐐瑰彿杞崲瀵瑰簲妤煎眰
+    public static Integer outInStaNoToLev(Integer distSta) {
+        Integer distLev = 1;//鐩爣妤煎眰
+        switch (distSta) {
+            case 102:
+                distLev = 2;//杈撻�佺嚎妤煎眰
+            case 105:
+                distLev = 1;//涓�妤�
+            case 106:
+                distLev = 3;//浜屾ゼ
+            case 107:
+                distLev = 4;//涓夋ゼ
+            case 108:
+                distLev = 5;//鍥涙ゼ
+        }
+        return distLev;
+    }
+
+    //妤煎眰杞崲瀵瑰簲鍑哄叆搴撶珯鐐瑰彿
+    public static Integer levToOutInStaNo(Integer lev) {
+        Integer staNo = null;//绔欑偣鍙�
+        switch (lev) {
+            case 1:
+                staNo = 105;
+                break;
+            case 2://杈撻�佺嚎灞�
+                staNo = 105;
+                break;
+            case 3:
+                staNo = 106;
+                break;
+            case 4:
+                staNo = 107;
+                break;
+            case 5:
+                staNo = 108;
+                break;
+        }
+        return staNo;
+    }
+
+    //鎻愬崌鏈轰綅缃弽棣堣浆鎹㈠嚭鍏ュ簱绔欑偣搴撲綅鍙�
+    public static String liftArrivalToOutInStaLocNo(Short liftArrival) {
+        String locNo = null;
+        switch (liftArrival) {
+            case 1:
+                locNo = "1800201";
+                break;
+            case 4:
+                locNo = "1800202";
+                break;
+            case 8:
+                locNo = "1800203";
+                break;
+            case 16:
+                locNo = "1800204";
+                break;
+        }
+        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")));
+    }
+
+    // 澶栦晶鏂瑰悜鐨勮揣浣�  浼樺厛鍏ュ簱鏂瑰悜/浼樺厛鍑哄簱鏂瑰悜 ===>> 鍙嶄箣
+    public static List<String> getGroupOutsideLoc(String locNo){
+        int row = getRow(locNo);
+        List<String> result = new ArrayList<>();
+        if (SECOND_GROUP_ROW_LIST.contains(row)) {
+            for (Integer integer : SECOND_GROUP_ROW_LIST) {
+                if (integer < row) {
+                    result.add(zerofill(String.valueOf(integer), 2) + locNo.substring(2));
+                } else {
+                    break;
+                }
+            }
+        } else if (FIRST_GROUP_ROW_LIST.contains(row)) {
+            List<Integer> clone = Arrays.asList(new Integer[FIRST_GROUP_ROW_LIST.size()]);
+            Collections.copy(clone, FIRST_GROUP_ROW_LIST);
+            Collections.reverse(clone);
+            for (Integer integer : clone) {
+                if (integer > row) {
+                    result.add(zerofill(String.valueOf(integer), 2) + locNo.substring(2));
+                } else {
+                    break;
+                }
+            }
+        } else {
+//            throw new RuntimeException("搴撲綅瑙f瀽寮傚父");
+        }
+        if (!Cools.isEmpty(result)) {
+            Collections.reverse(result);
+        }
+        return result;
+    }
+
+    //鑾峰彇闄ょ櫧鍚嶅崟澶栫殑鎸囧畾妤煎眰鍏ㄩ儴绌挎杞y鍧愭爣鐐�
+    public static List<int[]> getShuttlePoints(Integer whiteShuttle, Integer lev) {
+        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;
+            }
+
+            if (shuttleProtocol.getCurrentLocNo() == null) {
+                continue;
+            }
+
+            if (lev != Utils.getLev(shuttleProtocol.getCurrentLocNo())) {
+                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);
+        MainServiceImpl mainServiceImpl = SpringUtils.getBean(MainServiceImpl.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;
+        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;
+                break;
+            }
+        }
+
+        if (distY != -1) {
+
+            //鑾峰彇閬胯搴撲綅
+            String distLocNo = NavigatePositionConvert.xyzToLocNo(distX, distY, distZ);
+            LocMast distLocMast = locMastService.queryByLoc(distLocNo);
+            if (distLocMast == null) {
+                return false;
+            }
+
+            //璋冨害灏忚溅鍒伴伩璁╀綅缃�
+            return shuttleDispatchUtils.dispatchShuttle(commonService.getWorkNo(7), distLocNo, shuttleProtocol.getShuttleNo().intValue());
+        }
+        return false;
+    }
+
 }

--
Gitblit v1.9.1