From c83b3ad4e7d3fc8da48eafcd45dd46de0262f138 Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期三, 08 一月 2025 16:51:50 +0800
Subject: [PATCH] #

---
 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java |   62 ++++++++++++++++---------------
 1 files changed, 32 insertions(+), 30 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 1241b83..b1652e5 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
@@ -1,7 +1,6 @@
 package com.zy.acs.manager.core.service;
 
 import com.alibaba.fastjson.JSON;
-import com.alibaba.fastjson.JSONObject;
 import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper;
 import com.zy.acs.common.domain.AgvAction;
 import com.zy.acs.common.domain.AgvActionItem;
@@ -472,6 +471,7 @@
             // task
             for (Task task : taskList) {
                 task.setTaskSts(TaskStsType.ASSIGN.val());
+                task.setStartTime(now);
                 task.setUpdateTime(now);
                 if (!taskService.updateById(task)) {
                     throw new BusinessException(task.getUuid() + "浠诲姟鏇存柊澶辫触");
@@ -520,7 +520,7 @@
                     }
                     break;
                 case MOVE:
-                    endCode = codeService.selectByData(destination);
+                    endCode = codeService.getCacheByData(destination);
                     break;
                 default:
                     return false;
@@ -645,26 +645,27 @@
         try {
             if (Cools.isEmpty(agvId, segmentList)) { return; }
             Date now = new Date();
-            JSONObject storeDirection = configService.getVal("storeDirection", JSONObject.class);
-            Agv agv = agvService.getById(agvId);
-            if (!agvService.judgeEnable(agv.getId())) {
-                throw new CoolException("AGV[" + agv.getUuid() + "]褰撳墠涓嶅彲鐢�...");
+            long actionPrepareSts = ActionStsType.PREPARE.val();
+//            JSONObject storeDirection = configService.getVal("storeDirection", JSONObject.class);
+            int angleOffsetVal = configService.getVal("mapAngleOffsetVal", Integer.class);
+            String agvNo = agvService.getAgvNo(agvId);
+            if (!agvService.judgeEnable(agvId)) {
+                throw new CoolException("AGV[" + agvNo + "]褰撳墠涓嶅彲鐢�...");
             }
 
-            AgvModel agvModel = agvModelService.getById(agv.getAgvModel());
+            AgvModel agvModel = agvModelService.getByAgvId(agvId);
             Double workDirection = agvModel.getWorkDirection();
             AgvSpeedType agvSpeedType = AgvSpeedType.query(agvModel.getTravelSpeed());
             assert agvSpeedType != null;
 
-            AgvDetail agvDetail = agvDetailService.selectByAgvId(agvId);
-            assert agvDetail != null;
+            AgvDetail agvDetail = agvDetailService.selectMajorByAgvId(agvId);
 
             List<Action> actionList = new ArrayList<>();
             // start node
             Code lastCode = codeService.getById(agvDetail.getRecentCode());
             Double lastDirection = agvDetail.getAgvAngle();
             if (!lastCode.getData().equals(pathList.get(0))) {
-                throw new CoolException("AGV[" + agv.getUuid() + "]瀹氫綅鍋忕Щ...");
+                throw new CoolException("AGV[" + agvNo + "]瀹氫綅鍋忕Щ...");
             }
 
             boolean first = true;
@@ -688,15 +689,15 @@
 
                         String next = pathListPart.get(i);
 
-                        Code nextCode = codeService.selectByData(next);
-                        Double nextDirection = mapService.calculateDirection(lastCode, nextCode);
+                        Code nextCode = codeService.getCacheByData(next);
+                        Double nextDirection = mapService.calculateDirection(lastCode, nextCode, angleOffsetVal);
 
                         boolean reverse = false;
                         if (nextDirection.equals((workDirection + 180) % 360)) {
                             nextDirection = workDirection;
                             reverse = true;
                         }
-                        if (!lastDirection.equals(nextDirection) || actionList.size() == 0) {
+                        if (!lastDirection.equals(nextDirection) || actionList.isEmpty()) {
                             // turn
                             actionList.add(new Action(
                                     null,    // 缂栧彿
@@ -709,7 +710,7 @@
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
-                                    ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                     agvId,    // AGV
                                     now    // 宸ヤ綔鏃堕棿
                             ));
@@ -735,7 +736,7 @@
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 String.valueOf(gap.getDistance()),   // 鍔ㄤ綔鍙傛暟
                                 actionType.val(),    // 鍔ㄤ綔绫诲瀷
-                                ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
                         ));
@@ -761,7 +762,7 @@
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 String.valueOf(workDirection),   // 鍔ㄤ綔鍙傛暟
                                 ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
-                                ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
                         ));
@@ -792,7 +793,7 @@
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(workDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
-                                    ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                     agvId,    // AGV
                                     now    // 宸ヤ綔鏃堕棿
                             ));
@@ -801,7 +802,7 @@
                         // 璐ф灦鍙栬揣
                         Loc oriLoc = locService.getById(task.getOriLoc());
                         // 璁$畻宸﹀彸鏂瑰悜
-                        agvDirectionType = mapService.calculateAgvWorkDirection(storeDirection, oriLoc, lastCode);
+                        agvDirectionType = mapService.calculateAgvWorkDirection(oriLoc, lastCode);
                         actionList.add(new Action(
                                 null,    // 缂栧彿
                                 task.getBusId(),    // 鎬荤嚎
@@ -813,7 +814,7 @@
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 String.valueOf(oriLoc.getOffset()),   // 鍔ㄤ綔鍙傛暟
                                 ActionTypeType.ReadyTakeFromShelvesLoc.val(),    // 鍔ㄤ綔绫诲瀷
-                                ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
                         ));
@@ -829,7 +830,7 @@
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 String.valueOf(backpackType.height),   // 鍔ㄤ綔鍙傛暟
                                 ActionTypeType.ReadyReleaseToAgvSite.val(),    // 鍔ㄤ綔绫诲瀷
-                                ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
                         ));
@@ -850,7 +851,7 @@
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(workDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
-                                    ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                     agvId,    // AGV
                                     now    // 宸ヤ綔鏃堕棿
                             ));
@@ -868,7 +869,7 @@
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 String.valueOf(backpackType.height),   // 鍔ㄤ綔鍙傛暟
                                 ActionTypeType.ReadyTakeFromAgvSite.val(),    // 鍔ㄤ綔绫诲瀷
-                                ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
                         ));
@@ -876,7 +877,7 @@
                         // 璐ф灦鏀捐揣
                         Loc destLoc = locService.getById(task.getDestLoc());
                         // 璁$畻宸﹀彸鏂瑰悜
-                        agvDirectionType = mapService.calculateAgvWorkDirection(storeDirection, destLoc, lastCode);
+                        agvDirectionType = mapService.calculateAgvWorkDirection(destLoc, lastCode);
                         actionList.add(new Action(
                                 null,    // 缂栧彿
                                 task.getBusId(),    // 鎬荤嚎
@@ -888,7 +889,7 @@
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 String.valueOf(destLoc.getOffset()),   // 鍔ㄤ綔鍙傛暟
                                 ActionTypeType.ReadyReleaseToShelvesLoc.val(),    // 鍔ㄤ綔绫诲瀷
-                                ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
                         ));
@@ -913,7 +914,7 @@
                                     lastCode.getData(),    // 鍦伴潰鐮�
                                     String.valueOf(chargeDirection),   // 鍔ㄤ綔鍙傛暟
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
-                                    ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                     agvId,    // AGV
                                     now    // 宸ヤ綔鏃堕棿
                             ));
@@ -932,7 +933,7 @@
                                 lastCode.getData(),    // 鍦伴潰鐮�
                                 null,   // 鍔ㄤ綔鍙傛暟
                                 ActionTypeType.DockingCharge.val(),    // 鍔ㄤ綔绫诲瀷
-                                ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
                         ));
@@ -952,7 +953,7 @@
 //                                    lastCode.getData(),    // 鍦伴潰鐮�
 //                                    String.valueOf(standByDirection),   // 鍔ㄤ綔鍙傛暟
 //                                    ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
-//                                    ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+//                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
 //                                    agvId,    // AGV
 //                                    now    // 宸ヤ綔鏃堕棿
 //                            ));
@@ -979,7 +980,7 @@
                     lastCode.getData(),    // 鍦伴潰鐮�
                     null,   // 鍔ㄤ綔鍙傛暟
                     ActionTypeType.FinishPath.val(),    // 鍔ㄤ綔绫诲瀷
-                    ActionStsType.PREPARE.val(),    // 鍔ㄤ綔杩涘害
+                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
                     agvId,    // AGV
                     now    // 宸ヤ綔鏃堕棿
             ));
@@ -1018,14 +1019,15 @@
                 }
             }
 
-            log.info(agv.getUuid() + "鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細" + newActionList.size());
+            log.info("{}鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細{}", agvNo, newActionList.size());
         } catch (Exception e) {
             log.error("mainService.generateAction", e);
             TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
 
             if (!Cools.isEmpty(pathList)) {
                 pathList.remove(0);
-                mapDataDispatcher.clearDynamicMatrixByCodeList(null, pathList);
+                List<int[]> codeMatrixIdxList = mapDataDispatcher.getCodeMatrixIdxList(null, pathList);
+                mapDataDispatcher.clearDynamicMatrixByCodeList(null, codeMatrixIdxList);
             }
 
             throw new RuntimeException("generateAction method caught an exception, rolling back transaction.", e);

--
Gitblit v1.9.1