From 2d07710d47f88a1d76e12cda1144cb2f288bf5ae Mon Sep 17 00:00:00 2001
From: Junjie <xjj@123>
Date: 星期二, 23 四月 2024 13:14:15 +0800
Subject: [PATCH] #

---
 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/entity/ShuttleStandby.java |    4 
 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/AnalyzeService.java |  110 ++++++++++++++++++++++++++-
 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/LiftDispatcher.java  |  102 ++++++++++++++++++++++++-
 3 files changed, 205 insertions(+), 11 deletions(-)

diff --git a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/entity/ShuttleStandby.java b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/entity/ShuttleStandby.java
index 1c71373..c7c1e4e 100644
--- a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/entity/ShuttleStandby.java
+++ b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/entity/ShuttleStandby.java
@@ -132,9 +132,9 @@
     private String deviceStandbyLoc;
 
     /**
-     * 寰呮満浣嶅簱浣嶅彿
+     * 灏忚溅寰呮満浣嶅簱浣嶅彿
      */
-    @ApiModelProperty(value= "寰呮満浣嶅簱浣嶅彿")
+    @ApiModelProperty(value= "灏忚溅寰呮満浣嶅簱浣嶅彿")
     private String standbyLoc;
 
     public ShuttleStandby() {}
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 ad43d4e..e3ef211 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
@@ -972,16 +972,16 @@
         // locNo
         String locNo = task.getDestLoc();
 
-        Device device = deviceService.getOne(new LambdaQueryWrapper<Device>()
+        Device shuttleDevice = deviceService.getOne(new LambdaQueryWrapper<Device>()
                 .eq(Device::getDeviceNo, task.getShuttleNo())
                 .eq(Device::getDeviceType, DeviceCtgType.SHUTTLE.val())
                 .eq(Device::getHostId, task.getHostId())
                 .eq(Device::getStatus, 1));
-        if (device == null) {
+        if (shuttleDevice == null) {
             return motionList;
         }
 
-        ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getId().intValue());
+        ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleDevice.getId().intValue());
         if (shuttleThread == null) {
             return motionList;
         }
@@ -999,11 +999,111 @@
             // 绌挎杞﹁蛋琛岃嚦鐩爣搴撲綅
             motionList.addAll(kernelService.shuttleMove(
                     MotionDto.build((dto -> {
-                        dto.setShuttleNo(device.getId().intValue());
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
                         dto.setLocNo(shuttleLocNo);
                     })),
                     MotionDto.build((dto -> {
-                        dto.setShuttleNo(device.getId().intValue());
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(locNo);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE
+            ));
+
+        } else {
+            //灏忚溅璺ㄥ眰
+
+            //鑾峰彇璺濈鐩爣浣嶇疆鏈�杩戠殑绌洪棽鎻愬崌鏈�
+            LiftThread liftThread = liftDispatcher.searchIdleLift(locNo, task.getHostId());
+            if (liftThread == null) {
+                return motionList;
+            }
+            Device liftDevice = liftThread.getDevice();
+
+            //绌挎杞﹀埌鎻愬崌鏈哄簱浣嶅彿
+            String liftLocNoTo = liftDispatcher.getLiftLocNo(liftThread, Utils.getLev(shuttleLocNo));
+
+            //绌挎杞﹀嚭鎻愬崌鏈哄簱浣嶅彿
+            String liftLocNoFrom = liftDispatcher.getLiftLocNo(liftThread, Utils.getLev(task.getDestLoc()));
+
+            //绌挎杞﹀埌鎻愬崌鏈哄緟鏈轰綅搴撲綅鍙�
+            String standbyLocNoTo = liftDispatcher.getLiftStandByLocNo(liftThread, Utils.getLev(shuttleLocNo));
+
+            //绌挎杞﹀嚭鎻愬崌鏈哄緟鏈轰綅搴撲綅鍙�
+            String standbyLocNoFrom = liftDispatcher.getLiftStandByLocNo(liftThread, Utils.getLev(task.getDestLoc()));
+
+
+            // 绌挎杞﹁蛋琛岃嚦鎻愬崌鏈哄簱浣嶅緟鏈轰綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(shuttleLocNo);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLiftNo(liftDevice.getId().intValue());
+                        dto.setLocNo(standbyLocNoTo);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE
+            ));
+
+            // 鎻愬崌鏈虹┖杞界Щ鍔ㄥ埌绌挎杞﹀眰
+            motionList.addAll(kernelService.liftMove(
+                    null
+                    , MotionDto.build((dto -> {
+                        dto.setLiftNo(liftDevice.getId().intValue());
+                        dto.setLev(Utils.getLev(shuttleLocNo));
+                    }))
+            ));
+
+            // 绌挎杞﹀緟鏈轰綅鑷虫彁鍗囨満搴撲綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(standbyLocNoTo);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLiftNo(liftDevice.getId().intValue());
+                        dto.setLocNo(liftLocNoTo);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE_TO_LIFT
+            ));
+
+            // 鎻愬崌鏈烘惉杞� 鑷� 鐩爣浣嶇疆灞�
+            motionList.addAll(kernelService.liftMoveShuttle(
+                    MotionDto.build((dto -> {
+                        dto.setLiftNo(liftDevice.getId().intValue());
+                        dto.setLev(Utils.getLev(shuttleLocNo));
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setLiftNo(liftDevice.getId().intValue());
+                        dto.setLev(Utils.getLev(locNo));
+                    }))
+            ));
+
+            // 绌挎杞﹁蛋琛岃嚦鎻愬崌鏈哄緟鏈轰綅
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLiftNo(liftDevice.getId().intValue());
+                        dto.setLocNo(liftLocNoFrom);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLocNo(standbyLocNoFrom);
+                    })),
+                    MotionCtgType.SHUTTLE_MOVE_FROM_LIFT
+            ));
+
+            // 绌挎杞︽彁鍗囨満寰呮満浣嶈嚦鐩爣浣嶇疆
+            motionList.addAll(kernelService.shuttleMove(
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
+                        dto.setLiftNo(liftDevice.getId().intValue());
+                        dto.setLocNo(standbyLocNoFrom);
+                    })),
+                    MotionDto.build((dto -> {
+                        dto.setShuttleNo(shuttleDevice.getId().intValue());
                         dto.setLocNo(locNo);
                     })),
                     MotionCtgType.SHUTTLE_MOVE
diff --git a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/LiftDispatcher.java b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/LiftDispatcher.java
index f849ab6..928c2e7 100644
--- a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/LiftDispatcher.java
+++ b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/utils/LiftDispatcher.java
@@ -1,10 +1,24 @@
 package com.zy.asrs.wcs.core.utils;
 
+import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper;
+import com.zy.asrs.wcs.core.entity.BasLift;
+import com.zy.asrs.wcs.core.entity.ShuttleStandby;
+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.WorkZoneType;
+import com.zy.asrs.wcs.core.service.BasLiftService;
+import com.zy.asrs.wcs.core.service.ShuttleStandbyService;
 import com.zy.asrs.wcs.rcs.cache.SlaveConnection;
+import com.zy.asrs.wcs.rcs.entity.Device;
 import com.zy.asrs.wcs.rcs.model.enums.SlaveType;
+import com.zy.asrs.wcs.rcs.model.protocol.LiftProtocol;
+import com.zy.asrs.wcs.rcs.service.DeviceService;
 import com.zy.asrs.wcs.rcs.thread.LiftThread;
+import org.springframework.beans.factory.annotation.Autowired;
 import org.springframework.stereotype.Service;
+
+import java.util.List;
 
 /**
  * Created by vincent on 2023/10/16
@@ -12,10 +26,90 @@
 @Service
 public class LiftDispatcher {
 
-    public LiftThread queryLiftForTransport(String staNo) {
-        WorkZoneType zoneType = WorkZoneType.query(staNo);
-        LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, zoneType.liftNo);
-        return liftThread;
+    @Autowired
+    private DeviceService deviceService;
+    @Autowired
+    private BasLiftService basLiftService;
+    @Autowired
+    private ShuttleStandbyService shuttleStandbyService;
+
+    /**
+     * 鏍规嵁鐩爣浣嶇疆鎼滅储绌洪棽鎻愬崌鏈�
+     */
+    public LiftThread searchIdleLift(String locNo, Long hostId) {
+        LiftThread recentLiftThread = null;
+        Integer finalDistance = Integer.MAX_VALUE;
+        List<Device> list = deviceService.list(new LambdaQueryWrapper<Device>()
+                .eq(Device::getDeviceType, DeviceCtgType.LIFT.val())
+                .eq(Device::getHostId, hostId)
+                .eq(Device::getStatus, 1));
+        for (Device device : list) {
+            LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, device.getId().intValue());
+            if (liftThread == null) {
+                continue;
+            }
+
+            LiftProtocol liftProtocol = liftThread.getStatus();
+            if (liftProtocol == null) {
+                continue;
+            }
+
+            if (!liftThread.isIdle()) {
+                continue;
+            }
+
+            ShuttleStandby standby = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
+                    .eq(ShuttleStandby::getDeviceId, device.getId())
+                    .eq(ShuttleStandby::getDeviceLev, Utils.getLev(locNo))
+                    .eq(ShuttleStandby::getStatus, 1));
+            if (standby == null) {
+                continue;
+            }
+
+            String liftLocNo = Utils.getLocNo(Utils.getRow(standby.getDeviceStandbyLoc()), Utils.getBay(standby.getDeviceStandbyLoc()), Utils.getLev(locNo));
+            List<NavigateNode> nodeList = NavigateUtils.calc(locNo, liftLocNo, NavigationMapType.NONE.id, null);
+            Integer originPathAllDistance = NavigateUtils.getOriginPathAllDistance(nodeList);//鎬昏窛绂�
+            if (originPathAllDistance < finalDistance) {
+                finalDistance = originPathAllDistance;
+                recentLiftThread = liftThread;
+            }
+        }
+
+        return recentLiftThread;
+    }
+
+    /**
+     * 鑾峰彇鎻愬崌鏈轰綅缃�
+     */
+    public String getLiftLocNo(LiftThread liftThread, Integer lev) {
+        Device device = liftThread.getDevice();
+        ShuttleStandby standby = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
+                .eq(ShuttleStandby::getDeviceId, device.getId())
+                .eq(ShuttleStandby::getDeviceLev, lev)
+                .eq(ShuttleStandby::getStatus, 1));
+        if (standby == null) {
+            return null;
+        }
+
+        String liftLocNo = Utils.getLocNo(Utils.getRow(standby.getDeviceLoc()), Utils.getBay(standby.getDeviceLoc()), lev);
+        return liftLocNo;
+    }
+
+    /**
+     * 鑾峰彇鎻愬崌鏈哄緟鏈轰綅浣嶇疆
+     */
+    public String getLiftStandByLocNo(LiftThread liftThread, Integer lev) {
+        Device device = liftThread.getDevice();
+        ShuttleStandby standby = shuttleStandbyService.getOne(new LambdaQueryWrapper<ShuttleStandby>()
+                .eq(ShuttleStandby::getDeviceId, device.getId())
+                .eq(ShuttleStandby::getDeviceLev, lev)
+                .eq(ShuttleStandby::getStatus, 1));
+        if (standby == null) {
+            return null;
+        }
+
+        String liftLocNo = Utils.getLocNo(Utils.getRow(standby.getDeviceStandbyLoc()), Utils.getBay(standby.getDeviceStandbyLoc()), lev);
+        return liftLocNo;
     }
 
 }

--
Gitblit v1.9.1