From 0f5a5a759221bde50ace126eae797326837f5f72 Mon Sep 17 00:00:00 2001
From: Junjie <xjj@123>
Date: 星期三, 16 十月 2024 16:15:12 +0800
Subject: [PATCH] #

---
 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/ShuttleDispatcher.java |  204 ++++++++++++++++++++++++++++++++++++++++++++------
 1 files changed, 177 insertions(+), 27 deletions(-)

diff --git a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/ShuttleDispatcher.java b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/ShuttleDispatcher.java
index 93b8596..820c458 100644
--- a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/ShuttleDispatcher.java
+++ b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/ShuttleDispatcher.java
@@ -4,23 +4,24 @@
 import com.alibaba.fastjson.JSONArray;
 import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper;
 import com.zy.asrs.framework.common.Cools;
-import com.zy.asrs.framework.common.R;
 import com.zy.asrs.framework.common.SnowflakeIdWorker;
 import com.zy.asrs.framework.exception.CoolException;
 import com.zy.asrs.wcs.core.entity.*;
 import com.zy.asrs.wcs.core.kernel.AnalyzeService;
 import com.zy.asrs.wcs.core.model.NavigateNode;
-import com.zy.asrs.wcs.core.model.enums.DeviceCtgType;
-import com.zy.asrs.wcs.core.model.enums.NavigationMapType;
-import com.zy.asrs.wcs.core.model.enums.TaskStsType;
+import com.zy.asrs.wcs.core.model.enums.*;
 import com.zy.asrs.wcs.core.service.*;
 import com.zy.asrs.wcs.rcs.News;
 import com.zy.asrs.wcs.rcs.cache.SlaveConnection;
 import com.zy.asrs.wcs.rcs.entity.Device;
+import com.zy.asrs.wcs.rcs.model.enums.ShuttleProtocolStatusType;
 import com.zy.asrs.wcs.rcs.model.enums.SlaveType;
 import com.zy.asrs.wcs.rcs.model.protocol.ShuttleProtocol;
 import com.zy.asrs.wcs.rcs.service.DeviceService;
+import com.zy.asrs.wcs.rcs.thread.LiftThread;
 import com.zy.asrs.wcs.rcs.thread.ShuttleThread;
+import com.zy.asrs.wcs.system.entity.Dict;
+import com.zy.asrs.wcs.system.service.DictService;
 import org.springframework.beans.factory.annotation.Autowired;
 import org.springframework.stereotype.Service;
 
@@ -53,11 +54,16 @@
     private TaskCtgService taskCtgService;
     @Autowired
     private ShuttleStandbyService shuttleStandbyService;
+    @Autowired
+    private DictService dictService;
 
     public synchronized ShuttleThread searchIdleShuttle(Task task) {
         String locNo = taskService.judgeInbound(task) ? task.getDestLoc() : task.getOriginLoc();
         ShuttleThread resThread = null;
         Integer finalDistance = ShuttleDispatcher.INF;
+
+        //妫�娴嬬洰鏍囨ゼ灞傝溅鏁伴噺鏄惁灏忎簬鍏佽鐨勬渶澶ф暟閲�
+        boolean checkDispatchMaxNum = checkDispatchMaxNum(Utils.getLev(locNo), task.getHostId());
 
         List<Device> list = deviceService.list(new LambdaQueryWrapper<Device>()
                 .eq(Device::getDeviceType, DeviceCtgType.SHUTTLE.val())
@@ -77,6 +83,21 @@
 
             if (!shuttleThread.isIdle()) {
                 continue;
+            }
+
+            BasShuttle basShuttle = basShuttleService.getOne(new LambdaQueryWrapper<BasShuttle>()
+                    .eq(BasShuttle::getShuttleNo, device.getDeviceNo())
+                    .eq(BasShuttle::getHostId, device.getHostId()));
+            if (basShuttle == null) {
+                continue;//灏忚溅鍩虹鏁版嵁涓嶅瓨鍦�
+            }
+
+            if (!Cools.isEmpty(basShuttle.getDisableLev())) {
+                List<Integer> disableLev = JSON.parseArray(basShuttle.getDisableLev(), Integer.class);
+                //妫�鏌ュ皬杞︽槸鍚︾鐢ㄨ妤煎眰
+                if (disableLev.contains(Utils.getLev(locNo))) {
+                    continue;//灏忚溅绂佺敤璇ユゼ灞傝烦杩囪杞�
+                }
             }
 
             //妫�娴嬫槸鍚﹀瓨鍦ㄥ厖鐢典换鍔�
@@ -99,10 +120,17 @@
             if (currentLev == Utils.getLev(locNo)) {
                 targetLocNo = locNo;
             }else {
-                Device recentTransferLift = Utils.getRecentTransferLift(locNo, Integer.parseInt(device.getDeviceNo()));
-                if (recentTransferLift == null) {
+                if (!checkDispatchMaxNum) {
+                    News.info("{}浠诲姟锛寋}灞傦紝宸茬粡杈惧埌褰撳墠妤煎眰璋冨害杞﹁締鏈�澶у��", task.getTaskNo(), Utils.getLev(locNo));
                     continue;
                 }
+
+                //鑾峰彇璺濈鐩爣浣嶇疆鏈�杩戠殑绌洪棽鍙崲灞傛彁鍗囨満
+                LiftThread liftThread = liftDispatcher.searchIdleLift(locNo, task.getHostId(), true);
+                if (liftThread == null) {
+                    continue;
+                }
+                Device recentTransferLift = liftThread.getDevice();
 
                 //鑾峰彇灏忚溅妤煎眰鎻愬崌鏈哄緟鏈轰綅
                 ShuttleStandby shuttleStandby = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
@@ -131,7 +159,7 @@
             }
 
             // 鎸傝浇浠诲姟鏉冮噸
-            List<Task> tasks = taskService.selectWorkingByShuttle(Integer.valueOf(device.getDeviceNo()));
+            List<Task> tasks = taskService.selectWorkingByShuttle(Integer.valueOf(device.getDeviceNo()), null);
             if (!Cools.isEmpty(tasks)) {
                 currDistance += tasks.size() * WEIGHT;
             }
@@ -154,7 +182,7 @@
 
         //鑾峰彇杩佺Щ浠诲姟绫诲瀷
         TaskCtg taskCtg = taskCtgService.getOne(new LambdaQueryWrapper<TaskCtg>()
-                .eq(TaskCtg::getFlag, "MOVE")
+                .eq(TaskCtg::getFlag, String.valueOf(TaskCtgType.MOVE))
                 .eq(TaskCtg::getStatus, 1));
         if (taskCtg == null) {
             return null;
@@ -208,7 +236,7 @@
 
         //鑾峰彇鎵嬪姩浠诲姟绫诲瀷
         TaskCtg taskCtg = taskCtgService.getOne(new LambdaQueryWrapper<TaskCtg>()
-                .eq(TaskCtg::getFlag, "MANUAL")
+                .eq(TaskCtg::getFlag, String.valueOf(TaskCtgType.MANUAL))
                 .eq(TaskCtg::getStatus, 1));
         if (taskCtg == null) {
             return null;
@@ -235,6 +263,7 @@
         task.setMemo("manual");
         task.setShuttleNo(Integer.valueOf(device.getDeviceNo()));
         task.setRecordLoc("Y");//璁板綍搴撳瓨淇℃伅
+        task.setHostId(device.getHostId());
 
         // generate motion list
         List<Motion> motionList = analyzeService.generateShuttleManualMotion(task);
@@ -255,9 +284,9 @@
     }
 
     /**
-     * 鎼滅储閬胯搴撲綅锛岄�氳繃灏忚溅鍙峰拰鐩爣搴撲綅
+     * 鎼滅储鍙敤搴撲綅锛岄�氳繃灏忚溅鍙峰拰鐩爣搴撲綅
      */
-    public String searchStandByLocNo(Integer shuttleNo, Long hostId, String locNo) {
+    public String searchAvailableLocNo(Integer shuttleNo, Long hostId, String currentLocNo, List<String> locNos) {
         BasShuttle basShuttle = basShuttleService.getOne(new LambdaQueryWrapper<BasShuttle>()
                 .eq(BasShuttle::getShuttleNo, shuttleNo)
                 .eq(BasShuttle::getHostId, hostId));
@@ -265,29 +294,18 @@
             throw new CoolException("灏忚溅鍩虹鏁版嵁涓嶅瓨鍦�");
         }
 
-        String idleLoc = basShuttle.getIdleLoc();
-        if (Cools.isEmpty(idleLoc)) {
-            throw new CoolException("灏忚溅閬胯鏁版嵁涓嶅瓨鍦�");
+        if (locNos.isEmpty()) {
+            throw new CoolException("褰撳墠灞傛棤閬胯浣嶇疆");
         }
 
-        int lev = Utils.getLev(locNo);//褰撳墠妤煎眰
-        JSONArray standbyLoc = JSON.parseArray(idleLoc);
-        if (lev > standbyLoc.size()) {
-            throw new CoolException("閬胯鏁版嵁寮傚父");
-        }
-
-        Object object = standbyLoc.get(lev - 1);
-        List<String> locs = JSON.parseArray(object.toString(), String.class);
-        if (locs.isEmpty()) {
-            throw new CoolException("閬胯鏁版嵁涓虹┖");
-        }
+        int lev = Utils.getLev(currentLocNo);
 
         Integer finalDistance = ShuttleDispatcher.INF;
         String recentLoc = null;
-        for (String loc : locs) {
+        for (String loc : locNos) {
             //褰撳墠绌挎杞﹀埌閬胯浣嶈绠�
             List<NavigateNode> currentShuttlePath = NavigateUtils.calc(
-                    locNo
+                    currentLocNo
                     , loc
                     , NavigationMapType.NORMAL.id
                     , Utils.getShuttlePoints(shuttleNo, lev)
@@ -310,5 +328,137 @@
         return recentLoc;
     }
 
+    /**
+     * 妫�娴嬬洰鏍囨ゼ灞傝溅鏁伴噺鏄惁灏忎簬鍏佽鐨勬渶澶ф暟閲�
+     * true: 灏忎簬鏈�澶ф暟閲�  false: 澶т簬鎴栫瓑浜庢渶澶ф暟閲�
+     */
+    public boolean checkDispatchMaxNum(Integer lev, Long hostId) {
+        Dict dict = dictService.getOne(new LambdaQueryWrapper<Dict>().eq(Dict::getFlag, "dispatchShuttleMaxNum"));
+        if (dict == null) {
+            return false;
+        }
+
+        int levCount = 0;//鐩爣妤煎眰杞﹁締鏁伴噺
+        List<Device> list = deviceService.list(new LambdaQueryWrapper<Device>()
+                .eq(Device::getDeviceType, DeviceCtgType.SHUTTLE.val())
+                .eq(Device::getHostId, hostId)
+                .eq(Device::getStatus, 1));
+
+        for (Device device : list) {
+            //鑾峰彇鍥涘悜绌挎杞︾嚎绋�
+            ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getId().intValue());
+            if (shuttleThread == null) {
+                continue;
+            }
+
+            ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
+            if (shuttleProtocol == null) {
+                continue;
+            }
+
+            if (shuttleProtocol.getProtocolStatusType().equals(ShuttleProtocolStatusType.OFFLINE)) {
+                continue;
+            }
+
+            if(!shuttleThread.isDeviceIdle()) {
+                continue;
+            }
+
+            if(shuttleProtocol.getCurrentLocNo() == null) {
+                continue;
+            }
+
+            if (Utils.getLev(shuttleProtocol.getCurrentLocNo()) == lev) {
+                if (shuttleProtocol.getHasCharge()) {
+                    continue;//鍏呯數涓�
+                }
+
+                levCount++;//鐩爣妤煎眰鏈夎溅锛屾暟閲忓鍔�
+            }
+        }
+
+        //鎼滅储鏄惁瀛樺湪鍓嶅線鐩爣妤煎眰鐨勫皬杞︾Щ鍔ㄥ伐浣滄。
+        for (Task task : taskService.list(new LambdaQueryWrapper<Task>()
+                .in(Task::getTaskSts, TaskStsType.NEW_MOVE.sts, TaskStsType.ANALYZE_MOVE.sts, TaskStsType.EXECUTE_MOVE.sts, TaskStsType.COMPLETE_MOVE.sts))) {
+            if (task.getOriginLoc() == null || task.getDestLoc() == null) {
+                continue;
+            }
+
+            int sourceLev = Utils.getLev(task.getOriginLoc());//宸ヤ綔妗f簮妤煎眰
+            int targetLev = Utils.getLev(task.getDestLoc());//宸ヤ綔妗g洰鏍囨ゼ灞�
+            if (sourceLev == targetLev) {
+                continue;//宸ヤ綔妗fゼ灞傚拰鐩爣妤煎眰鐩稿悓锛岃烦杩�
+            }
+
+            if (targetLev == lev) {
+                levCount++;//宸ヤ綔妗g洰鏍囨ゼ灞傚拰瀹為檯妤煎眰鐩稿悓锛屾暟閲忓鍔�
+                continue;
+            }
+
+        }
+
+        //鎼滅储鏄惁瀛樺湪鍓嶅線鐩爣妤煎眰鐨勫皬杞﹀伐浣滄。
+        for (Task task : taskService.list(new LambdaQueryWrapper<Task>()
+                .in(Task::getTaskSts, TaskStsType.NEW_INBOUND.sts, TaskStsType.ANALYZE_INBOUND.sts, TaskStsType.EXECUTE_INBOUND.sts, TaskStsType.COMPLETE_INBOUND.sts
+                        , TaskStsType.NEW_OUTBOUND.sts, TaskStsType.ANALYZE_OUTBOUND.sts, TaskStsType.EXECUTE_OUTBOUND.sts, TaskStsType.COMPLETE_OUTBOUND.sts))) {
+
+            List<Motion> motions = motionService.list(new LambdaQueryWrapper<Motion>()
+                    .eq(Motion::getTaskNo, task.getTaskNo())
+                    .in(Motion::getMotionCtg, MotionCtgType.SHUTTLE_MOVE
+                            , MotionCtgType.SHUTTLE_MOVE_LIFT_PALLET
+                            , MotionCtgType.SHUTTLE_MOVE_DOWN_PALLET
+                            , MotionCtgType.SHUTTLE_MOVE_FROM_LIFT
+                            , MotionCtgType.SHUTTLE_MOVE_TO_LIFT
+                            , MotionCtgType.SHUTTLE_MOVE_FROM_CONVEYOR
+                            , MotionCtgType.SHUTTLE_MOVE_TO_CONVEYOR
+                            , MotionCtgType.SHUTTLE_MOVE_FROM_LIFT_TO_CONVEYOR
+                    ));
+
+            boolean isUpdateLev = false;
+            for (Motion motion : motions) {
+                if (motion.getOrigin() == null || motion.getTarget() == null) {
+                    continue;
+                }
+
+                int sourceLev = Utils.getLev(motion.getOrigin());//鍔ㄤ綔婧愭ゼ灞�
+                int targetLev = Utils.getLev(motion.getTarget());//鍔ㄤ綔鐩爣妤煎眰
+                if (sourceLev != targetLev) {
+                    isUpdateLev = true;
+                    break;
+                }
+            }
+
+            if(isUpdateLev) {
+                levCount++;//宸ヤ綔妗e睘浜庤法灞備换鍔★紝灏忚溅褰掑睘浜庣洰鏍囨ゼ灞�
+                continue;
+            }
+
+        }
+
+
+        return levCount < Integer.parseInt(dict.getValue());
+    }
+
+    //鍒嗘瀽鍑哄簱璺緞寰呮満搴撲綅
+    public String analyzeOutPathWaitLoc(String startLoc, String targetLoc, Device shuttleDevice) {
+        //璁$畻璺緞骞跺垎瑙f垚涓ゆ鍔ㄤ綔
+        List<NavigateNode> nodeList = NavigateUtils.calc(startLoc, targetLoc, NavigationMapType.DFX.id, Utils.getShuttlePoints(Integer.parseInt(shuttleDevice.getDeviceNo()), Utils.getLev(startLoc)));
+        if (nodeList == null) {
+            News.error("{} dash {} can't find navigate path!", startLoc, targetLoc);
+            return null;
+        }
+        //鑾峰彇鍒嗘璺緞
+        ArrayList<ArrayList<NavigateNode>> data = NavigateUtils.getSectionPath(nodeList);
+        if (data.size() <= 1) {
+            return null;//涓ょ偣涔嬮棿鍙湁涓�娈佃矾寰�
+        }
+
+        //鍙栧嚭鍊掓暟绗簩娈佃矾寰�
+        ArrayList<NavigateNode> navigateNodes = data.get(data.size() - 2);
+        NavigateNode startNode = navigateNodes.get(0);
+        String lastPathStartLoc = Utils.getLocNo(startNode.getX(), startNode.getY(), startNode.getZ());
+        return lastPathStartLoc;
+    }
+
 
 }

--
Gitblit v1.9.1