From 9aedfea0f2ea46b5400e1d0232c1654f3d96ed5a Mon Sep 17 00:00:00 2001
From: zjj <3272660260@qq.com>
Date: 星期一, 17 二月 2025 14:39:03 +0800
Subject: [PATCH] #移库任务

---
 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/AnalyzeService.java |  364 ++++++++++++++++++++++++++++++++++++++++++++++++---
 1 files changed, 337 insertions(+), 27 deletions(-)

diff --git a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/AnalyzeService.java b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/AnalyzeService.java
index a04b0ba..353b2ae 100644
--- a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/AnalyzeService.java
+++ b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/AnalyzeService.java
@@ -1618,6 +1618,7 @@
         // locNo 鐩爣搴撲綅
         String locNo = task.getDestLoc();
 
+        // shuttle
         Device shuttleDevice = deviceService.getOne(new LambdaQueryWrapper<Device>()
                 .eq(Device::getDeviceNo, task.getShuttleNo())
                 .eq(Device::getDeviceType, DeviceCtgType.SHUTTLE.val())
@@ -1626,24 +1627,104 @@
         if (shuttleDevice == null) {
             return motionList;
         }
-
         ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleDevice.getId().intValue());
-        if (shuttleThread == null) {
-            return motionList;
-        }
-
         ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
         if (shuttleProtocol == null || shuttleProtocol.getShuttleNo() == null) {
+            return motionList;
+        }
+        if (!shuttleThread.isIdle()) {
             return motionList;
         }
 
         String shuttleLocNo = shuttleProtocol.getCurrentLocNo();
 
-        // 鍒ゆ柇绌挎杞︽槸鍚﹀湪鐩爣灞�
-        if (Utils.getLev(shuttleLocNo) == Utils.getLev(locNo)) {
+        //鑾峰彇璺濈鐩爣浣嶇疆鏈�杩戠殑绌洪棽鍙崲灞傛彁鍗囨満
+        LiftThread liftThread = liftDispatcher.searchIdleLift(shuttleLocNo, task.getHostId(), true);
+        if (liftThread == null) {
+            return motionList;
+        }
+        Device transferLiftDevice = liftThread.getDevice();
 
-            if (!shuttleLocNo.equals(locNo)) {//灏忚溅涓嶅湪鐩爣搴撲綅
-                // 绌挎杞﹁蛋琛岃嚦婧愬簱浣�
+        LiftProtocol liftProtocol = liftThread.getStatus();
+        if (liftProtocol == null || liftProtocol.getLiftNo() == null) {
+            return motionList;
+        }
+
+        BasConveyorSta basConveyorStaOrigin = basConveyorStaService.selectBySiteNo(task.getOriginSite());
+        if (basConveyorStaOrigin == null) {
+            return motionList;
+        }
+
+        //妫�娴嬬┛姊溅鏄惁鏈変换鍔$粦瀹�
+        boolean shuttleResult = Utils.checkShuttleHasBinding(shuttleDevice, task.getTaskNo());
+        if (shuttleResult) {
+            //瀛樺湪浠诲姟锛岀姝㈣В鏋�
+            return motionList;
+        }
+
+        //鑾峰彇灏忚溅寰呮満搴撲綅 ==> 杩涙彁鍗囨満
+        ShuttleStandby shuttleStandbyTo = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
+                .eq(ShuttleStandby::getDeviceId, transferLiftDevice.getId())
+                .eq(ShuttleStandby::getDeviceLev, Utils.getLev(shuttleLocNo))
+                .eq(ShuttleStandby::getStatus, 1));
+
+        //鑾峰彇灏忚溅寰呮満搴撲綅 ==> 鍑烘彁鍗囨満
+        ShuttleStandby shuttleStandbyFrom = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
+                .eq(ShuttleStandby::getDeviceId, transferLiftDevice.getId())
+                .eq(ShuttleStandby::getDeviceLev, Utils.getLev(originLoc))
+                .eq(ShuttleStandby::getStatus, 1));
+        if (shuttleStandbyTo == null || shuttleStandbyFrom == null) {
+            return motionList;
+        }
+
+        //绌挎杞﹁繘鎻愬崌鏈哄簱浣嶅彿
+        String liftLocNoTo = shuttleStandbyTo.getDeviceLoc();
+
+        //绌挎杞﹀嚭鎻愬崌鏈哄簱浣嶅彿
+        String liftLocNoFrom = shuttleStandbyFrom.getDeviceLoc();
+
+        //绌挎杞﹁繘鎻愬崌鏈哄緟鏈轰綅搴撲綅鍙�
+        String standbyLocNoTo = shuttleStandbyTo.getDeviceStandbyLoc();
+
+        //绌挎杞﹀嚭鎻愬崌鏈哄緟鏈轰綅搴撲綅鍙�
+        String standbyLocNoFrom = shuttleStandbyFrom.getDeviceStandbyLoc();
+
+        //绌挎杞﹀嚭鎻愬崌鏈哄悗鍏ㄩ儴寰呮満浣�
+        String standbyLocs = shuttleStandbyFrom.getStandbyLoc();//鑾峰彇鍏ㄩ儴寰呮満浣�
+
+        //鎹㈠眰闇�瑕侀攣瀹氱殑璺緞
+        List<String> lockPath = shuttleStandbyFrom.getLockPath$();
+
+        //鑾峰彇鍑哄簱浠诲姟绫诲瀷
+        TaskCtg taskCtg = taskCtgService.getOne(new LambdaQueryWrapper<TaskCtg>()
+                .eq(TaskCtg::getFlag, String.valueOf(TaskCtgType.OUT))
+                .eq(TaskCtg::getStatus, 1));
+        if (taskCtg == null) {
+            return motionList;
+        }
+        //鑾峰彇杈撻�佺嚎璺緞
+        BasConveyorPath basConveyorPath = basConveyorPathService.getOne(new LambdaQueryWrapper<BasConveyorPath>()
+                .eq(BasConveyorPath::getDeviceStn, task.getOriginSite())
+                .eq(BasConveyorPath::getDeviceNo, liftProtocol.getLiftNo())
+                .eq(BasConveyorPath::getTypeNo, taskCtg.getId()));
+        if (basConveyorPath == null) {
+            return motionList;
+        }
+
+        //鍒嗘瀽鍑哄簱璺緞寰呮満搴撲綅
+        String lastPathStartLoc = shuttleDispatcher.analyzeOutPathWaitLoc(originLoc, standbyLocNoTo, shuttleDevice);
+        if (lastPathStartLoc == null) {
+            return motionList;//鏈垎鏋愭垚鍔�
+        }
+
+        /**
+         * 鍑哄簱
+         */
+        if (Utils.getLev(shuttleLocNo) == Utils.getLev(originLoc)) {
+
+            //绌挎杞︿笉鍦ㄥ嚭搴撳簱浣�
+            if (!shuttleLocNo.equals(task.getOriginLoc())) {
+                // 绌挎杞﹁蛋琛岃嚦鍑哄簱搴撲綅
                 motionList.addAll(kernelService.shuttleMove(
                         MotionDto.build((dto -> {
                             dto.setShuttleNo(shuttleDevice.getId().intValue());
@@ -1651,19 +1732,24 @@
                         })),
                         MotionDto.build((dto -> {
                             dto.setShuttleNo(shuttleDevice.getId().intValue());
+                            dto.setShuttleDevice(shuttleDevice);
                             dto.setLocNo(originLoc);
                         })),
                         MotionCtgType.SHUTTLE_MOVE
                 ));
+            }
 
-                // 绌挎杞﹂《鍗�
-                motionList.add(Motion.build(motion -> {
-                    motion.setDeviceCtg(DeviceCtgType.SHUTTLE.val());
-                    motion.setDevice(String.valueOf(shuttleDevice.getId()));
-                    motion.setMotionCtg(MotionCtgType.SHUTTLE_PALLET_LIFT.val());
-                }));
+            // 绌挎杞﹀嚭搴撻《鍗�
+            motionList.addAll(kernelService.shuttleAction(
+                    null,
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                    })),
+                    MotionCtgType.SHUTTLE_PALLET_LIFT
+            ));
 
-                // 绌挎杞﹁蛋琛岃嚦鐩爣搴撲綅
+            if (!originLoc.equals(lastPathStartLoc)) {
+                // 绌挎杞﹁浇璐у嚭搴撹嚦鏈�鍚庝竴娈佃矾寰勭瓑寰�
                 motionList.addAll(kernelService.shuttleMove(
                         MotionDto.build((dto -> {
                             dto.setShuttleNo(shuttleDevice.getId().intValue());
@@ -1671,22 +1757,246 @@
                         })),
                         MotionDto.build((dto -> {
                             dto.setShuttleNo(shuttleDevice.getId().intValue());
-                            dto.setLocNo(locNo);
+                            dto.setShuttleDevice(shuttleDevice);
+                            dto.setLocNo(lastPathStartLoc);
                         })),
-                        MotionCtgType.SHUTTLE_MOVE
+                        MotionCtgType.SHUTTLE_TRANSPORT
                 ));
-
-                //绌挎杞︽墭鐩樹笅闄�
-                motionList.add(Motion.build(motion -> {
-                    motion.setDeviceCtg(DeviceCtgType.SHUTTLE.val());
-                    motion.setDevice(String.valueOf(shuttleDevice.getId()));
-                    motion.setMotionCtg(MotionCtgType.SHUTTLE_PALLET_DOWN.val());
-                }));
-
             }
 
+//            // 绌挎杞﹁浇璐ц嚦鎻愬崌鏈哄緟鏈轰綅
+//            motionList.addAll(kernelService.shuttleMove(
+//                    MotionDto.build((dto -> {
+//                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+//                        dto.setLocNo(lastPathStartLoc);
+//                    })),
+//                    MotionDto.build((dto -> {
+//                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+//                        dto.setShuttleDevice(shuttleDevice);
+//                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+//                        dto.setLocNo(standbyLocNoTo);
+//                        dto.setStaNo(getStaByLev(Utils.getLev(task.getOriginLoc())));//杈撻�佺珯
+//                    })),
+//                    MotionCtgType.SHUTTLE_TRANSPORT_TO_CONVEYOR
+//            ));
+
+            // 绌挎杞﹁蛋琛岃嚦鐩爣搴撲綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(lastPathStartLoc);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(locNo);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE
+            ));
+
+            // 绌挎杞﹀嚭搴撴墭鐩樹笅闄�
+            motionList.addAll(kernelService.shuttleAction(
+                    null,
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                    })),
+                    MotionCtgType.SHUTTLE_PALLET_DOWN
+            ));
+
+
+
+            /**
+             * 浜屻�佸嚭搴撹捣濮嬪眰娌℃湁绌挎杞�
+             */
         } else {
-            //灏忚溅璺ㄥ眰
+
+            // 绌挎杞﹁蛋琛岃嚦鎻愬崌鏈哄簱浣嶅緟鏈轰綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(shuttleLocNo);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setShuttleDevice(shuttleDevice);
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setLocNo(standbyLocNoTo);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE
+            ));
+
+            // 閿佸畾鎹㈠眰璺緞
+            motionList.addAll(kernelService.mapLockPath(
+                    null,
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(JSON.toJSONString(lockPath));
+                    }))
+            ));
+
+            // 鎻愬崌鏈虹┖杞界Щ鍔ㄥ埌绌挎杞﹀眰
+            motionList.addAll(kernelService.liftMove(
+                    null
+                    , MotionDto.build((dto -> {
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setLev(Utils.getLev(shuttleLocNo));
+                    }))
+            ));
+
+            // 閿佸畾鎻愬崌鏈�
+            motionList.addAll(kernelService.liftLock(
+                    null
+                    , MotionDto.build((dto -> {
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                    }))
+            ));
+
+            // 绌挎杞﹀緟鏈轰綅鑷虫彁鍗囨満
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(standbyLocNoTo);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setShuttleDevice(shuttleDevice);
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setLocNo(liftLocNoTo);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE_TO_LIFT
+            ));
+
+            // 瑙i攣鎻愬崌鏈�
+            motionList.addAll(kernelService.liftUnlock(
+                    null
+                    , MotionDto.build((dto -> {
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                    }))
+            ));
+
+            // 鎻愬崌鏈烘惉杞� 鑷� 鐩爣浣嶇疆灞�
+            motionList.addAll(kernelService.liftMoveShuttle(
+                    MotionDto.build((dto -> {
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setLev(Utils.getLev(shuttleLocNo));
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setLev(Utils.getLev(liftLocNoFrom));
+                    }))
+            ));
+
+            // 閿佸畾鎻愬崌鏈�
+            motionList.addAll(kernelService.liftLock(
+                    null
+                    , MotionDto.build((dto -> {
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                    }))
+            ));
+
+            // 鏇存柊灏忚溅鍧愭爣
+            motionList.addAll(kernelService.shuttleUpdateLocation(
+                    null
+                    , MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(liftLocNoFrom);
+                    }))
+            ));
+
+            // 绌挎杞﹁蛋琛岃嚦鎻愬崌鏈哄緟鏈轰綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setLocNo(liftLocNoFrom);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setShuttleDevice(shuttleDevice);
+                        dto.setLocNo(standbyLocNoFrom);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE_FROM_LIFT
+            ));
+
+            // 瑙i攣鎻愬崌鏈�
+            motionList.addAll(kernelService.liftUnlock(
+                    null
+                    , MotionDto.build((dto -> {
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setReleaseLift(1);//鎵ц瀹屾垚鍚庨噴鏀炬彁鍗囨満
+                    }))
+            ));
+
+            // 瑙i攣鎹㈠眰璺緞
+            motionList.addAll(kernelService.mapUnlockPath(
+                    null,
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(JSON.toJSONString(lockPath));
+                    }))
+            ));
+
+            // 绌挎杞︽彁鍗囨満寰呮満浣嶈嚦鍑哄簱搴撲綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLiftNo(transferLiftDevice.getId().intValue());
+                        dto.setLocNo(standbyLocNoFrom);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setShuttleDevice(shuttleDevice);
+                        dto.setLocNo(originLoc);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE
+            ));
+
+            // 绌挎杞﹀嚭搴撻《鍗�
+            motionList.addAll(kernelService.shuttleAction(
+                    null,
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                    })),
+                    MotionCtgType.SHUTTLE_PALLET_LIFT
+            ));
+
+            if (!originLoc.equals(lastPathStartLoc)) {
+                // 绌挎杞﹁浇璐у嚭搴撹嚦鏈�鍚庝竴娈佃矾寰勭瓑寰�
+                motionList.addAll(kernelService.shuttleMove(
+                        MotionDto.build((dto -> {
+                            dto.setShuttleNo(shuttleDevice.getId().intValue());
+                            dto.setLocNo(originLoc);
+                        })),
+                        MotionDto.build((dto -> {
+                            dto.setShuttleNo(shuttleDevice.getId().intValue());
+                            dto.setShuttleDevice(shuttleDevice);
+                            dto.setLocNo(lastPathStartLoc);
+                        })),
+                        MotionCtgType.SHUTTLE_TRANSPORT
+                ));
+            }
+
+            // 绌挎杞﹁蛋琛岃嚦鐩爣搴撲綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(lastPathStartLoc);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(locNo);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE
+            ));
+
+            // 绌挎杞﹀嚭搴撴墭鐩樹笅闄�
+            motionList.addAll(kernelService.shuttleAction(
+                    null,
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                    })),
+                    MotionCtgType.SHUTTLE_PALLET_DOWN
+            ));
+
         }
         return motionList;
     }

--
Gitblit v1.9.1