From 23b3e8cdd6cef0a48d053e3281fbc5a286ec003c Mon Sep 17 00:00:00 2001
From: yy <yy123>
Date: 星期二, 30 十二月 2025 13:14:03 +0800
Subject: [PATCH] 添加50入站判断

---
 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java |   37 ++++++++++++++++++++++++++++++++++++-
 1 files changed, 36 insertions(+), 1 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 20100cf..5e4ff05 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
@@ -842,7 +842,18 @@
                                                 agvId,    // AGV
                                                 now    // 宸ヤ綔鏃堕棿
                                         ));
+                                        log.info("1TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}",
+                                                Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())),
+                                                lastCode.getData(),
+                                                lastCode.getCornerBool(),
+                                                nextDirection,
+                                                180);
                                     } else {
+                                        List<String> list = Arrays.asList("00000051", "00000052", "00000053", "00000054");
+                                        Double turnDirection = nextDirection;
+                                        if (list.contains(nextCode.getData()) && lastCode.getData().equals("00000050")) {
+                                            turnDirection = 180.0;
+                                        }
                                         // turn
                                         actionList.add(new Action(
                                                 null,    // 缂栧彿s
@@ -853,12 +864,18 @@
                                                 ActionTypeType.TurnCorner.desc,    // 鍚嶇О
                                                 mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
                                                 lastCode.getData(),    // 鍦伴潰鐮�
-                                                String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
+                                                String.valueOf(turnDirection),   // 鍔ㄤ綔鍙傛暟
                                                 ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
                                                 actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                                 agvId,    // AGV
                                                 now    // 宸ヤ綔鏃堕棿
                                         ));
+                                        log.info("2TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}",
+                                                Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())),
+                                                lastCode.getData(),
+                                                lastCode.getCornerBool(),
+                                                nextDirection,
+                                                nextDirection);
                                     }
                                     lastDirection = nextDirection;
                                 }
@@ -883,6 +900,12 @@
                                             agvId,    // AGV
                                             now    // 宸ヤ綔鏃堕棿
                                     ));
+                                    log.info("3TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}",
+                                            Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())),
+                                            lastCode.getData(),
+                                            lastCode.getCornerBool(),
+                                            nextDirection,
+                                            180);
                                 }
                             }
                         }
@@ -905,6 +928,12 @@
                                     agvId,    // AGV
                                     now    // 宸ヤ綔鏃堕棿
                             ));
+                            log.info("4TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}",
+                                    Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())),
+                                    lastCode.getData(),
+                                    lastCode.getCornerBool(),
+                                    nextDirection,
+                                    nextDirection);
 
                             lastDirection = nextDirection;
                         }
@@ -963,6 +992,12 @@
                                     agvId,    // AGV
                                     now    // 宸ヤ綔鏃堕棿
                             ));
+                            log.info("5TurnCorner posType={}, code={}, corner={}, nextDirection={}, finalAngle={}",
+                                    Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())),
+                                    lastCode.getData(),
+                                    lastCode.getCornerBool(),
+                                    null,
+                                    turnDirection);
                             lastDirection = workDirection;
                         }
                     }

--
Gitblit v1.9.1