From d6201c37c34681b11d6eeb5d3fa2008991d9f370 Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期五, 12 四月 2024 15:26:21 +0800
Subject: [PATCH] #

---
 zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/ShuttleCommandService.java |   51 +++++++++++++--------------------------------------
 1 files changed, 13 insertions(+), 38 deletions(-)

diff --git a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/ShuttleCommandService.java b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/ShuttleCommandService.java
index e276f9a..7eef25c 100644
--- a/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/ShuttleCommandService.java
+++ b/zy-asrs-wcs/src/main/java/com/zy/asrs/wcs/core/kernel/command/ShuttleCommandService.java
@@ -5,6 +5,7 @@
 import com.zy.asrs.framework.exception.CoolException;
 import com.zy.asrs.wcs.core.action.LiftAction;
 import com.zy.asrs.wcs.core.action.ShuttleAction;
+import com.zy.asrs.wcs.core.entity.BasShuttle;
 import com.zy.asrs.wcs.core.entity.Loc;
 import com.zy.asrs.wcs.core.model.NavigateNode;
 import com.zy.asrs.wcs.core.model.command.ShuttleAssignCommand;
@@ -63,14 +64,14 @@
     public Boolean accept(Motion motion) {
         Integer deviceNo = Integer.parseInt(motion.getDevice());
         ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, deviceNo);
+        if (shuttleThread == null) {
+            return false;
+        }
         ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
         if (null == shuttleProtocol) {
             return false;
         }
-        if (!shuttleProtocol.getIdle()) {//璁惧涓嶇┖闂�
-            return false;
-        }
-        if (!shuttleProtocol.getPakMk()) {
+        if (!shuttleThread.isIdle()) {//璁惧涓嶇┖闂�
             return false;
         }
         if (motionService.count(new LambdaQueryWrapper<Motion>()
@@ -85,20 +86,13 @@
         assignCommand.setTaskNo(motion.getWrkNo());
         assignCommand.setSourceLocNo(motion.getOrigin());
         assignCommand.setLocNo(motion.getTarget());
+        assignCommand.setDeviceId(Integer.parseInt(motion.getDevice()));
 
         List<ShuttleCommand> shuttleCommands = new ArrayList<>();
         ShuttleTaskModeType shuttleTaskModeType = null;
 
         LiftThread liftThread = null;
         LiftProtocol liftProtocol = null;
-
-        //鍒ゆ柇灏忚溅鐘舵��
-        if (shuttleProtocol.getIdle()
-                && shuttleProtocol.getProtocolStatusType().equals(ShuttleProtocolStatusType.IDLE)
-                && shuttleProtocol.getTaskNo() != 0
-        ) {
-            return false;
-        }
 
         switch (Objects.requireNonNull(MotionCtgType.get(motion.getMotionCtgEl()))){
             case SHUTTLE_MOVE:
@@ -266,11 +260,11 @@
             return true;
         }
 
-        if (!shuttleProtocol.getProtocolStatusType().equals(ShuttleProtocolStatusType.WAITING)
-            && !shuttleProtocol.getProtocolStatusType().equals(ShuttleProtocolStatusType.CHARGING_WAITING)
-        ) {
-            return false;
-        }
+//        if (!shuttleProtocol.getProtocolStatusType().equals(ShuttleProtocolStatusType.WAITING)
+//            && !shuttleProtocol.getProtocolStatusType().equals(ShuttleProtocolStatusType.CHARGING_WAITING)
+//        ) {
+//            return false;
+//        }
 
         //鍒ゆ柇璁惧鏄惁绌洪棽
         if (!shuttleThread.isIdle()) {
@@ -340,7 +334,7 @@
 
     public synchronized List<ShuttleCommand> shuttleAssignCommand(String startLocNo, String endLocNo, Integer mapType, ShuttleAssignCommand assignCommand, ShuttleThread shuttleThread) {
         //鑾峰彇灏忚溅绉诲姩閫熷害
-        Integer runSpeed = Optional.ofNullable(basShuttleService.getById(assignCommand.getShuttleNo()).getRunSpeed()).orElse(1000);
+        Integer runSpeed = Optional.ofNullable(basShuttleService.getOne(new LambdaQueryWrapper<BasShuttle>().eq(BasShuttle::getDeviceId, assignCommand.getDeviceId())).getRunSpeed()).orElse(1000);
         Long hostId = shuttleThread.getDevice().getHostId();
         List<NavigateNode> nodeList = NavigateUtils.calc(startLocNo, endLocNo, mapType, Utils.getShuttlePoints(Integer.parseInt(shuttleThread.getDevice().getDeviceNo()), Utils.getLev(startLocNo)));
         if (nodeList == null) {
@@ -357,25 +351,6 @@
             //寮�濮嬭矾寰�
             NavigateNode startPath = nodes.get(0);
 
-            //涓棿璺緞
-            NavigateNode middlePath = null;
-            //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮�
-            String middleCodeNum = null;
-            Integer middleToDistDistance = null;//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂�
-            if (nodes.size() > 10) {//涓鐮佷紶鍊掓暟绗笁涓�
-                //涓棿璺緞
-                middlePath = nodes.get(nodes.size() - 3);
-                //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮�
-                middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ(), hostId);
-                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, middlePath);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂�
-            } else if (nodes.size() > 5) {//涓鐮佷紶鍊掓暟绗簩涓�
-                //涓棿璺緞
-                middlePath = nodes.get(nodes.size() - 2);
-                //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮�
-                middleCodeNum = NavigatePositionConvert.xyToPosition(middlePath.getX(), middlePath.getY(), middlePath.getZ(), hostId);
-                middleToDistDistance = NavigateUtils.getMiddleToDistDistance(nodes, middlePath);//璁$畻涓棿鐐瑰埌鐩爣鐐硅璧拌窛绂�
-            }
-
             //鐩爣璺緞
             NavigateNode endPath = nodes.get(nodes.size() - 1);
             Integer allDistance = NavigateUtils.getCurrentPathAllDistance(nodes);//璁$畻褰撳墠璺緞琛岃蛋鎬昏窛绂�
@@ -384,7 +359,7 @@
             //閫氳繃xy鍧愭爣灏忚溅浜岀淮鐮�
             String distCodeNum = NavigatePositionConvert.xyToPosition(endPath.getX(), endPath.getY(), endPath.getZ(), hostId);
             //鑾峰彇绉诲姩鍛戒护
-            ShuttleCommand command = shuttleThread.getMoveCommand(assignCommand.getTaskNo().intValue(), startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id.intValue(), runSpeed);
+            ShuttleCommand command = shuttleThread.getMoveCommand(assignCommand.getTaskNo(), startCodeNum, distCodeNum, allDistance, ShuttleRunDirection.get(startPath.getDirection()).id.intValue(), runSpeed);
             command.setNodes(nodes);//灏嗚璧拌妭鐐规坊鍔犲埌姣忎竴姝ュ懡浠や腑
             commands.add(command);
         }

--
Gitblit v1.9.1