From 583b31d46bb8abbee7410d29ca229120ee589cba Mon Sep 17 00:00:00 2001
From: vincentlu <t1341870251@gmail.com>
Date: 星期一, 05 一月 2026 10:10:08 +0800
Subject: [PATCH] # version merge

---
 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java |   48 +++++++++++++++++++++++++++++++++++++-----------
 1 files changed, 37 insertions(+), 11 deletions(-)

diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java
index 9b3886e..e33f1f6 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java
@@ -10,10 +10,7 @@
 import com.zy.acs.common.domain.BaseResult;
 import com.zy.acs.common.domain.protocol.*;
 import com.zy.acs.common.domain.protocol.action.*;
-import com.zy.acs.common.enums.AgvBackpackType;
-import com.zy.acs.common.enums.AgvCompleteType;
-import com.zy.acs.common.enums.AgvDirectionType;
-import com.zy.acs.common.enums.AgvSpeedType;
+import com.zy.acs.common.enums.*;
 import com.zy.acs.common.utils.GsonUtils;
 import com.zy.acs.common.utils.RedisSupport;
 import com.zy.acs.common.utils.Utils;
@@ -950,7 +947,7 @@
                         if (!lastCode.getCornerBool()) {
                             // 濡傛灉鏄綔涓氭柟鍚戯紝浣嗘槸灏忚溅鍦ㄥ贩閬撳唴鏂瑰悜閿欒锛屽垯鍋滄
                             if (reverse && !lastDirection.equals(nextDirection)) {
-//                                throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
+                                throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
                             }
                             // 濡傛灉涓嶆槸浣滀笟鏂瑰悜锛屽垽鏂槸鍚︾浉鍙嶆柟鍚戯紝濡傛灉鍙嶆柟鍚戝垯鍊掗��琛岃蛋
                             if (nextDirection.equals((lastDirection + 180) % 360)) {
@@ -972,7 +969,7 @@
                                             null,    // 鍔ㄤ綔鍙�
                                             null,    // 浼樺厛绾�
                                             ActionTypeType.TurnCorner.desc,    // 鍚嶇О
-                                            mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                            (double) mapService.spinDirection(lastCode).val,     // 灞炴�у��
                                             lastCode.getData(),    // 鍦伴潰鐮�
                                             String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
                                             ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
@@ -996,7 +993,7 @@
                                     null,    // 鍔ㄤ綔鍙�
                                     null,    // 浼樺厛绾�
                                     ActionTypeType.TurnCorner.desc,    // 鍚嶇О
-                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                    (double) mapService.spinDirection(lastCode).val,    // 灞炴�у��
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
@@ -1047,7 +1044,7 @@
                                 null,    // 鍔ㄤ綔鍙�
                                 null,    // 浼樺厛绾�
                                 ActionTypeType.TurnCorner.desc,    // 鍚嶇О
-                                mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                (double) mapService.spinDirection(lastCode).val,    // 灞炴�у��
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 String.valueOf(workDirection),   // 鍔ㄤ綔鍙傛暟
                                 ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
@@ -1066,6 +1063,7 @@
                 AgvDirectionType agvDirectionType;
                 Double staWorkDirection;
                 AgvBackpackType backpackType = AgvBackpackType.query(segment.getBackpack());
+                // todo agvModel backpackAction ?
                 switch (Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))) {
                     case ORI_LOC:
                         assert backpackType != null;
@@ -1169,7 +1167,7 @@
                                     null,    // 鍔ㄤ綔鍙�
                                     null,    // 浼樺厛绾�
                                     ActionTypeType.TurnCorner.desc,    // 鍚嶇О
-                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                    (double) mapService.spinDirection(lastCode).val,   // 灞炴�у��
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(oriStaWorkDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
@@ -1231,7 +1229,7 @@
                                     null,    // 鍔ㄤ綔鍙�
                                     null,    // 浼樺厛绾�
                                     ActionTypeType.TurnCorner.desc,    // 鍚嶇О
-                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                    (double) mapService.spinDirection(lastCode).val,    // 灞炴�у��
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(destStaWorkDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
@@ -1288,7 +1286,7 @@
                                     null,    // 鍔ㄤ綔鍙�
                                     null,    // 浼樺厛绾�
                                     ActionTypeType.TurnCorner.desc,    // 鍚嶇О
-                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                    (double) mapService.spinDirection(lastCode).val,    // 灞炴�у��
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(chargeDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
@@ -1363,6 +1361,28 @@
 
             }
 
+            // 濡傛灉鍏呯數涓紝鍒欏厛鏂紑鍏呯數
+            // todo agvModel backpackAction ?
+            if (agvModel.getNeedUndockingBool() && agvDetail.getAgvStatus().equals(AgvStatusType.CHARGE)) {
+                String undockingCode = Cools.isEmpty(actionList) ? lastCode.getData() : actionList.get(0).getCode();
+                // undocking charge
+                actionList.add(0, new Action(
+                        null,    // 缂栧彿
+                        null,    // 鎬荤嚎
+                        null,    // 浠诲姟
+                        null,    // 鍔ㄤ綔鍙�
+                        null,    // 浼樺厛绾�
+                        ActionTypeType.UndockingCharge.desc,    // 鍚嶇О
+                        null,    // 灞炴�у��
+                        undockingCode,    // 鍦伴潰鐮�
+                        null,   // 鍔ㄤ綔鍙傛暟
+                        ActionTypeType.UndockingCharge.val(),    // 鍔ㄤ綔绫诲瀷
+                        actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                        agvId,    // AGV
+                        now    // 宸ヤ綔鏃堕棿
+                ));
+            }
+
             // finish
             actionList.add(new Action(
                     null,    // 缂栧彿
@@ -1380,6 +1400,7 @@
                     now    // 宸ヤ綔鏃堕棿
             ));
 
+            // todo asr need optimize sort ?
             List<Action> newActionList = actionSorter.optimizeSort(actionList);
             String groupId = String.valueOf(snowflakeIdWorker.nextId()).substring(3);
 
@@ -1574,6 +1595,11 @@
                                 .setQrCode(action.getCode())
                         );
                         break;
+                    case UndockingCharge:
+                        agvAction.add(new AgvActionItem<>(UndockingChargeAction.class)
+                                .setQrCode(action.getCode())
+                        );
+                        break;
                     default:
                         break;
                 }

--
Gitblit v1.9.1