From 82cb51c355dae174dc29361d2b0c11bc2665147a Mon Sep 17 00:00:00 2001
From: zc <zyzc>
Date: 星期六, 08 十一月 2025 14:50:33 +0800
Subject: [PATCH] 希日多任务出库问题优化

---
 zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java |  984 ++++++++++++++++++++++++++++++++++++++++++++++++++++-----
 1 files changed, 886 insertions(+), 98 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 0370dc5..26789de 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,6 +1,7 @@
 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;
@@ -26,6 +27,7 @@
 import com.zy.acs.manager.core.domain.Lane;
 import com.zy.acs.manager.core.domain.TaskPosDto;
 import com.zy.acs.manager.core.service.astart.MapDataDispatcher;
+import com.zy.acs.manager.core.utils.HttpHandler;
 import com.zy.acs.manager.manager.controller.param.OpenBusSubmitParam;
 import com.zy.acs.manager.manager.entity.*;
 import com.zy.acs.manager.manager.enums.*;
@@ -40,7 +42,9 @@
 import org.springframework.transaction.annotation.Transactional;
 import org.springframework.transaction.interceptor.TransactionAspectSupport;
 
+import java.io.IOException;
 import java.util.*;
+import java.util.concurrent.TimeUnit;
 import java.util.stream.Collectors;
 
 /**
@@ -132,6 +136,9 @@
         if (!busService.save(bus)) {
             throw new BusinessException("Internal Server Error!");
         }
+        Boolean locStaStatusCheck = configService.getVal("LOC_STA_STATUS_CHECK", Boolean.class, true);
+        Integer locStaTaskNum = configService.getVal("LOC_STA_TASK_NUM", Integer.class, 2);
+
 
         // 淇濆瓨浠诲姟
         for (Task task : taskList) {
@@ -149,7 +156,7 @@
             switch (TaskTypeType.get(task.getTaskTypeEl())) {
                 case LOC_TO_LOC:
                     oriLoc = locService.getById(task.getOriLoc());
-                    if (!oriLoc.getLocSts().equals(LocStsType.STOCK.val())) {
+                    if (locStaStatusCheck && !oriLoc.getLocSts().equals(LocStsType.STOCK.val())) {
                         throw new BusinessException("oriLoc锛�" + task.getOriLoc$() + " is not in STOCK status");
                     }
                     oriLoc.setLocSts(LocStsType.PAKOUT.val());
@@ -159,7 +166,7 @@
                     }
 
                     destLoc = locService.getById(task.getDestLoc());
-                    if (!destLoc.getLocSts().equals(LocStsType.IDLE.val())) {
+                    if (locStaStatusCheck && !destLoc.getLocSts().equals(LocStsType.IDLE.val())) {
                         throw new BusinessException("destLoc锛�" + task.getDestLoc$() + " is not in IDLE status");
                     }
                     destLoc.setLocSts(LocStsType.PAKIN.val());
@@ -170,7 +177,7 @@
                     break;
                 case LOC_TO_STA:
                     oriLoc = locService.getById(task.getOriLoc());
-                    if (!oriLoc.getLocSts().equals(LocStsType.STOCK.val())) {
+                    if (locStaStatusCheck && !oriLoc.getLocSts().equals(LocStsType.STOCK.val())) {
                         throw new BusinessException("oriLoc锛�" + task.getOriLoc$() + " is not in STOCK status");
                     }
                     oriLoc.setLocSts(LocStsType.PAKOUT.val());
@@ -180,8 +187,15 @@
                     }
 
                     destSta = staService.getById(task.getDestSta());
-                    if (!destSta.getStaSts().equals(StaStsType.IDLE.val())) {
-                        throw new BusinessException("destSta锛�" + task.getDestSta$() + " is not in IDLE status");
+                    if (destSta.getStaTypeIsCheck() != 1) {
+                        if (locStaStatusCheck && !destSta.getStaSts().equals(StaStsType.IDLE.val())) {
+                            throw new BusinessException("destSta锛�" + task.getDestSta$() + " is not in IDLE status");
+                        }
+                    } else {
+                        List<Task> list = taskService.list(new LambdaQueryWrapper<Task>().eq(Task::getDestSta, destSta.getId()).in(Task::getTaskSts, TaskStsType.INIT.val(), TaskStsType.WAITING.val(), TaskStsType.ASSIGN.val(), TaskStsType.PROGRESS.val()));
+                        if (!Cools.isEmpty(list) && list.size() >= locStaTaskNum) {
+                            throw new BusinessException("destSta锛�" + task.getDestSta$() + " task more");
+                        }
                     }
                     destSta.setStaSts(StaStsType.READY_RELEASE.val());
                     destSta.setUpdateTime(now);
@@ -191,9 +205,11 @@
                     break;
                 case STA_TO_LOC:
                     oriSta = staService.getById(task.getOriSta());
-                    if (!oriSta.getStaSts().equals(StaStsType.STOCK.val())) {
-                        throw new BusinessException("oriSta锛�" + task.getOriSta$() + " is not in STOCK status");
-                    }
+//                    if (oriSta.getStaTypeIsCheck() != 1) {
+//                        if (locStaStatusCheck && !oriSta.getStaSts().equals(StaStsType.STOCK.val())) {
+//                            throw new BusinessException("oriSta锛�" + task.getOriSta$() + " is not in STOCK status");
+//                        }
+//                    }
                     oriSta.setStaSts(StaStsType.READY_TAKE.val());
                     oriSta.setUpdateTime(now);
                     if (!staService.updateById(oriSta)) {
@@ -201,7 +217,7 @@
                     }
 
                     destLoc = locService.getById(task.getDestLoc());
-                    if (!destLoc.getLocSts().equals(LocStsType.IDLE.val())) {
+                    if (locStaStatusCheck && !destLoc.getLocSts().equals(LocStsType.IDLE.val())) {
                         throw new BusinessException("destLoc锛�" + task.getDestLoc$() + " is not in IDLE status");
                     }
                     destLoc.setLocSts(LocStsType.PAKIN.val());
@@ -212,8 +228,10 @@
                     break;
                 case STA_TO_STA:
                     oriSta = staService.getById(task.getOriSta());
-                    if (!oriSta.getStaSts().equals(StaStsType.STOCK.val())) {
-                        throw new BusinessException("oriSta锛�" + task.getOriSta$() + " is not in STOCK status");
+                    if (oriSta.getStaTypeIsCheck() != 1) {
+                        if (locStaStatusCheck && !oriSta.getStaSts().equals(StaStsType.STOCK.val())) {
+                            throw new BusinessException("oriSta锛�" + task.getOriSta$() + " is not in STOCK status");
+                        }
                     }
                     oriSta.setStaSts(StaStsType.READY_TAKE.val());
                     oriSta.setUpdateTime(now);
@@ -222,8 +240,15 @@
                     }
 
                     destSta = staService.getById(task.getDestSta());
-                    if (!destSta.getStaSts().equals(StaStsType.IDLE.val())) {
-                        throw new BusinessException("destSta锛�" + task.getDestSta$() + " is not in IDLE status");
+                    if (destSta.getStaTypeIsCheck() != 1) {
+                        if (locStaStatusCheck && !destSta.getStaSts().equals(StaStsType.IDLE.val())) {
+                            throw new BusinessException("destSta锛�" + task.getDestSta$() + " is not in IDLE status");
+                        }
+                    } else {
+                        List<Task> list = taskService.list(new LambdaQueryWrapper<Task>().eq(Task::getDestSta, destSta.getId()).in(Task::getTaskSts, TaskStsType.INIT.val(), TaskStsType.WAITING.val(), TaskStsType.ASSIGN.val(), TaskStsType.PROGRESS.val()));
+                        if (!Cools.isEmpty(list) && list.size() >= locStaTaskNum) {
+                            throw new BusinessException("destSta锛�" + task.getDestSta$() + " task more");
+                        }
                     }
                     destSta.setStaSts(StaStsType.READY_RELEASE.val());
                     destSta.setUpdateTime(now);
@@ -277,6 +302,7 @@
                 if (!taskService.updateById(task)) {
                     throw new BusinessException("seqNum: " + task.getSeqNum() + " failed to update");
                 }
+                report(task, null, TaskReportStsType.START);
             }
         } catch (Exception e) {
             log.error("mainService.infuseAgvForTask", e);
@@ -744,7 +770,6 @@
 
                 // 闇�瑕佽蛋琛�
                 if (!lastCode.getData().equals(code.getData())) {
-
                     // 璧拌璺緞鑺傜偣
 //                    List<String> pathList = mapService.checkoutPath(agv.getUuid(), lastCode, code);
                     List<String> pathListPart = pathList.subList(pathList.indexOf(lastCode.getData()), pathList.indexOf(code.getData()) + 1);
@@ -762,8 +787,16 @@
                         // 绗竴姝ワ細濡傛灉涓嬩竴涓柟鍚戞濂芥槸浣滀笟鏂瑰悜鐨勭浉鍙嶆柟鍚戯紝鍒欓噸缃笅涓�涓柟鍚戜负浣滀笟鏂瑰悜锛屾爣璁� reverse = true
                         boolean reverse = false;
                         if (nextDirection.equals((workDirection + 180) % 360)) {
-                            nextDirection = workDirection;
-                            reverse = true;
+                            List<String> list = Arrays.asList("00000050", "00000051", "00000052", "00000053", "00000054");
+                            if ((Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())).equals(TaskPosDto.PosType.ORI_STA)
+                                    || Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))
+                                    .equals(TaskPosDto.PosType.DEST_STA)) && list.contains(lastCode.getData())) {
+                                reverse = false;
+                                lastDirection = nextDirection;
+                            } else {
+                                nextDirection = workDirection;
+                                reverse = true;
+                            }
                         }
 
                         // 绗簩姝ワ細鍒ゆ柇褰撳墠鑺傜偣鏄惁鍙互鏃嬭浆
@@ -784,7 +817,52 @@
                                     nextDirection = lastDirection;
                                     reverse = true;
                                 } else {
+                                    if ((Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))
+                                            .equals(TaskPosDto.PosType.ORI_STA) || Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))
+                                            .equals(TaskPosDto.PosType.DEST_STA)) && lastCode.getData().equals("00000050")) {
+                                        // turn
+                                        reverse = false;
+                                        actionList.add(new Action(
+                                                null,    // 缂栧彿s
+                                                task.getBusId(),    // 鎬荤嚎
+                                                task.getId(),    // 浠诲姟
+                                                null,    // 鍔ㄤ綔鍙�
+                                                null,    // 浼樺厛绾�
+                                                ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+                                                mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                                lastCode.getData(),    // 鍦伴潰鐮�
+                                                String.valueOf(180),   // 鍔ㄤ綔鍙傛暟
+                                                ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+                                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                                agvId,    // AGV
+                                                now    // 宸ヤ綔鏃堕棿
+                                        ));
+                                    } else {
+                                        // turn
+                                        actionList.add(new Action(
+                                                null,    // 缂栧彿s
+                                                task.getBusId(),    // 鎬荤嚎
+                                                task.getId(),    // 浠诲姟
+                                                null,    // 鍔ㄤ綔鍙�
+                                                null,    // 浼樺厛绾�
+                                                ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+                                                mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                                lastCode.getData(),    // 鍦伴潰鐮�
+                                                String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
+                                                ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+                                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                                agvId,    // AGV
+                                                now    // 宸ヤ綔鏃堕棿
+                                        ));
+                                    }
+                                    lastDirection = nextDirection;
+                                }
+                            } else {
+                                if ((Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))
+                                        .equals(TaskPosDto.PosType.ORI_STA) || Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))
+                                        .equals(TaskPosDto.PosType.DEST_STA)) && lastCode.getData().equals("00000050")) {
                                     // turn
+                                    reverse = false;
                                     actionList.add(new Action(
                                             null,    // 缂栧彿s
                                             task.getBusId(),    // 鎬荤嚎
@@ -794,17 +872,620 @@
                                             ActionTypeType.TurnCorner.desc,    // 鍚嶇О
                                             mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
                                             lastCode.getData(),    // 鍦伴潰鐮�
-                                            String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
+                                            String.valueOf(180),   // 鍔ㄤ綔鍙傛暟
                                             ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
                                             actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                             agvId,    // AGV
                                             now    // 宸ヤ綔鏃堕棿
                                     ));
-
-                                    lastDirection = nextDirection;
                                 }
                             }
                         }
+
+                        // 绗竴涓姩浣滀竴瀹氭槸 turn
+                        if (actionList.isEmpty() && lastCode.getCornerBool()) {
+                            // turn
+                            actionList.add(new Action(
+                                    null,    // 缂栧彿
+                                    task.getBusId(),    // 鎬荤嚎
+                                    task.getId(),    // 浠诲姟
+                                    null,    // 鍔ㄤ綔鍙�
+                                    null,    // 浼樺厛绾�
+                                    ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                    lastCode.getData(),    // 鍦伴潰鐮�
+                                    String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
+                                    ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                    agvId,    // AGV
+                                    now    // 宸ヤ綔鏃堕棿
+                            ));
+
+                            lastDirection = nextDirection;
+                        }
+
+                        // run
+                        ActionTypeType actionType = ActionTypeType.StraightAheadTurnable;
+                        if (reverse) {
+                            actionType = ActionTypeType.StraightBackTurnable;
+                        }
+                        CodeGap gap = codeGapService.findByCodeOfBoth(lastCode.getId(), nextCode.getId());
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                actionType.desc,    // 鍚嶇О
+                                (double) agvSpeedType.val,    // 灞炴�у��
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(gap.getDistance()),   // 鍔ㄤ綔鍙傛暟
+                                actionType.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+                        ));
+
+                        lastCode = nextCode;
+
+                    }
+                }
+
+                // 鍒濆鏂瑰悜鍊艰ˉ涓�
+                if (first) {
+                    if (Cools.isEmpty(actionList) || !actionList.get(0).getActionType().equals(ActionTypeType.TurnCorner.val())) {
+                        Double turnDirection = workDirection;
+                        List<String> list = Arrays.asList("00000051", "00000052", "00000053", "00000054");
+                        if ((Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType())).equals(TaskPosDto.PosType.ORI_STA)
+                                || Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))
+                                .equals(TaskPosDto.PosType.DEST_STA)) && list.contains(lastCode.getData())) {
+                            turnDirection = workDirection + 180.0;
+                        }
+                        if (lastCode.getCornerBool()) {
+                            // turn
+                            actionList.add(new Action(
+                                    null,    // 缂栧彿
+                                    task.getBusId(),    // 鎬荤嚎
+                                    task.getId(),    // 浠诲姟
+                                    null,    // 鍔ㄤ綔鍙�
+                                    null,    // 浼樺厛绾�
+                                    ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                    lastCode.getData(),    // 鍦伴潰鐮�
+                                    String.valueOf(turnDirection),   // 鍔ㄤ綔鍙傛暟
+                                    ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                    agvId,    // AGV
+                                    now    // 宸ヤ綔鏃堕棿
+                            ));
+                            lastDirection = workDirection;
+                        }
+                    }
+                    first = false;
+                }
+
+                // 浣滀笟鐐瑰姩浣�
+                AgvDirectionType agvDirectionType;
+                Double staWorkDirection;
+                AgvBackpackType backpackType = AgvBackpackType.query(segment.getBackpack());
+                switch (Objects.requireNonNull(TaskPosDto.queryPosType(segment.getPosType()))) {
+                    case ORI_LOC:
+                        assert backpackType != null;
+                        // 妫�楠屾柟鍚�
+                        if (!lastDirection.equals(workDirection)) {
+                            throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
+                        }
+                        // 璐ф灦鍙栬揣
+                        Loc oriLoc = locService.getById(task.getOriLoc());
+                        // 璁$畻宸﹀彸鏂瑰悜
+                        agvDirectionType = mapService.calculateAgvWorkDirectionByShelf(oriLoc, lastCode);
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyTakeFromShelvesLoc.desc,    // 鍚嶇О
+                                (double) agvDirectionType.val,    // 灞炴�у��
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(oriLoc.getOffset()),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyTakeFromShelvesLoc.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+                        ));
+                        // 鏆傚瓨鐐规斁璐�
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyReleaseToAgvSite.desc,    // 鍚嶇О
+                                (double) backpackType.lev,    // 灞炴�у��
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(backpackType.height),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyReleaseToAgvSite.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+                        ));
+                        break;
+                    case DEST_LOC:
+                        assert backpackType != null;
+                        // 妫�楠屾柟鍚�
+                        if (!lastDirection.equals(workDirection)) {
+                            throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
+                        }
+                        // 鏆傚瓨鐐瑰彇璐ц揣
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyTakeFromAgvSite.desc,    // 鍚嶇О
+                                (double) backpackType.lev,    // 灞炴�у��
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(backpackType.height),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyTakeFromAgvSite.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+                        ));
+
+                        // 璐ф灦鏀捐揣
+                        Loc destLoc = locService.getById(task.getDestLoc());
+                        // 璁$畻宸﹀彸鏂瑰悜
+                        agvDirectionType = mapService.calculateAgvWorkDirectionByShelf(destLoc, lastCode);
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyReleaseToShelvesLoc.desc,    // 鍚嶇О
+                                (double) agvDirectionType.val,    // 灞炴�у��
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(destLoc.getOffset()),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyReleaseToShelvesLoc.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+                        ));
+                        break;
+                    case ORI_STA:
+                        // 绔欑偣鍙栬揣
+                        Sta oriSta = staService.getById(task.getOriSta());
+                        Double oriStaWorkDirection = mapService.getStaAngle(oriSta, workDirection);
+                        // 妫�楠屾柟鍚�
+//                        if (!lastDirection.equals(oriStaWorkDirection)) {
+//                            if (!lastCode.getCornerBool()) {
+//                                throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
+//                            }
+//                            // turn
+//                            actionList.add(new Action(
+//                                    null,    // 缂栧彿
+//                                    task.getBusId(),    // 鎬荤嚎
+//                                    task.getId(),    // 浠诲姟
+//                                    null,    // 鍔ㄤ綔鍙�
+//                                    null,    // 浼樺厛绾�
+//                                    ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+//                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�ш皰
+//                                    lastCode.getData(),    // 鍦伴潰鐮�
+//                                    String.valueOf(oriStaWorkDirection),   // 鍔ㄤ綔鍙傛暟
+//                                    ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+//                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+//                                    agvId,    // AGV
+//                                    now    // 宸ヤ綔鏃堕棿
+//                            ));
+//                            lastDirection = oriStaWorkDirection;
+//                        }
+                        // 璁$畻璐у弶宸ヤ綔鏂瑰悜
+                        staWorkDirection = mapService.calculateAgvWorkDirectionByStation(oriStaWorkDirection, lastDirection);
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyTakeFromShelvesLoc.desc,    // 鍚嶇О
+                                Double.parseDouble("0"),    // 灞炴�у��
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(oriSta.getOffset()),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyTakeFromShelvesLoc.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now,    // 宸ヤ綔鏃堕棿
+                                oriSta.getStaTypeIsCheck() == 1 ? 1 : 0,
+                                oriSta.getStaNo()
+                        ));
+                        // 鏆傚瓨鐐规斁璐�
+                        assert backpackType != null;
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyReleaseToAgvSite.desc,    // 鍚嶇О
+                                (double) backpackType.lev,    // 灞炴�ш皰
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(backpackType.height),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyReleaseToAgvSite.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+                        ));
+                        break;
+                    case DEST_STA:
+                        // 绔欑偣鏀捐揣
+                        Sta destSta = staService.getById(task.getDestSta());
+                        Double destStaWorkDirection = mapService.getStaAngle(destSta, workDirection);
+//                        CodeGap gap = codeGapService.findByCodeOfBoth(lastCode.getId(), nextCode.getId());
+
+                        // 妫�楠屾柟鍚�
+//                        if (!lastDirection.equals(destStaWorkDirection)) {
+//                            if (!lastCode.getCornerBool()) {
+//                                throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
+//                            }
+//
+//                            actionList.add(new Action(
+//                                    null,    // 缂栧彿
+//                                    task.getBusId(),    // 鎬荤嚎
+//                                    task.getId(),    // 浠诲姟
+//                                    null,    // 鍔ㄤ綔鍙�
+//                                    null,    // 浼樺厛绾�
+//                                    actionType.desc,    // 鍚嶇О
+//                                    (double) agvSpeedType.val,    // 灞炴�у��
+//                                    lastCode.getData(),    // 鍦伴潰鐮�
+//                                    String.valueOf(gap.getDistance()),   // 鍔ㄤ綔鍙傛暟
+//                                    actionType.val(),    // 鍔ㄤ綔绫诲瀷
+//                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+//                                    agvId,    // AGV
+//                                    now    // 宸ヤ綔鏃堕棿
+//                            ));
+//                            // turn
+//                            actionList.add(new Action(
+//                                    null,    // 缂栧彿
+//                                    task.getBusId(),    // 鎬荤嚎
+//                                    task.getId(),    // 浠诲姟
+//                                    null,    // 鍔ㄤ綔鍙�
+//                                    null,    // 浼樺厛绾�
+//                                    ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+//                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�ш皰
+//                                    lastCode.getData(),    // 鍦伴潰鐮�
+//                                    String.valueOf(destStaWorkDirection),   // 鍔ㄤ綔鍙傛暟
+//                                    ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+//                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+//                                    agvId,    // AGV
+//                                    now   // 宸ヤ綔鏃堕棿
+//                            ));
+//                            lastDirection = destStaWorkDirection;
+//                        }
+                        // 鏆傚瓨鐐瑰彇璐�
+                        assert backpackType != null;
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyTakeFromAgvSite.desc,    // 鍚嶇О
+                                (double) backpackType.lev,    // 灞炴�ш皰
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(backpackType.height),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyTakeFromAgvSite.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+
+                        ));
+                        // 璁$畻璐у弶宸ヤ綔鏂瑰悜
+                        staWorkDirection = mapService.calculateAgvWorkDirectionByStation(destStaWorkDirection, lastDirection);
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                task.getBusId(),    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.ReadyReleaseToShelvesLoc.desc,    // 鍚嶇О
+                                Double.parseDouble("0"),    // 灞炴�у��
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                String.valueOf(destSta.getOffset()),   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.ReadyReleaseToShelvesLoc.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now,    // 宸ヤ綔鏃堕棿
+                                destSta.getStaTypeIsCheck() == 1 ? 2 : 0,
+                                destSta.getStaNo()
+                        ));
+                        break;
+                    case TO_CHARGE:
+                        // 妫�楠屾柟鍚�
+                        FuncSta chargeFuncSta = funcStaService.query(lastCode.getId(), FuncStaType.CHARGE.toString());
+                        Double chargeDirection = Double.parseDouble(chargeFuncSta.getAngle());
+                        if (!lastDirection.equals(chargeDirection) && lastCode.getCornerBool()) {
+                            actionList.add(new Action(
+                                    null,    // 缂栧彿
+                                    null,    // 鎬荤嚎
+                                    task.getId(),    // 浠诲姟
+                                    null,    // 鍔ㄤ綔鍙�
+                                    null,    // 浼樺厛绾�
+                                    ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+                                    mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�ш皰
+                                    lastCode.getData(),    // 鍦伴潰鐮�
+                                    String.valueOf(chargeDirection),   // 鍔ㄤ綔鍙傛暟
+                                    ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                    agvId,    // AGV
+                                    now    // 宸ヤ綔鏃堕棿
+                            ));
+                            lastDirection = chargeDirection;
+                        }
+
+                        // charge
+                        actionList.add(new Action(
+                                null,    // 缂栧彿
+                                null,    // 鎬荤嚎
+                                task.getId(),    // 浠诲姟
+                                null,    // 鍔ㄤ綔鍙�
+                                null,    // 浼樺厛绾�
+                                ActionTypeType.DockingCharge.desc,    // 鍚嶇О
+                                null,    // 灞炴�ш皰
+                                lastCode.getData(),    // 鍦伴潰鐮�
+                                null,   // 鍔ㄤ綔鍙傛暟
+                                ActionTypeType.DockingCharge.val(),    // 鍔ㄤ綔绫诲瀷
+                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                agvId,    // AGV
+                                now    // 宸ヤ綔鏃堕棿
+                        ));
+                        break;
+                    case TO_STANDBY:
+//                        FuncSta standByFuncSta = funcStaService.query(agvId, lastCode.getId(), 2);
+//                        Double standByDirection = Double.parseDouble(standByFuncSta.getAngle());
+//                        if (!lastDirection.equals(standByDirection)) {
+//                            actionList.add(new Action(
+//                                    null,    // 缂栧彿
+//                                    null,    // 鎬荤嚎
+//                                    task.getId(),    // 浠诲姟
+//                                    null,    // 鍔ㄤ綔鍙�
+//                                    null,    // 浼樺厛绾�
+//                                    ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+//                                    null,    // 灞炴�ш皰
+//                                    lastCode.getData(),    // 鍦伴潰鐮�
+//                                    String.valueOf(standByDirection),   // 鍔ㄤ綔鍙傛暟
+//                                    ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+//                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+//                                    agvId,    // AGV
+//                                    now    // 宸ヤ綔鏃堕棿
+//                            ));
+//                            lastDirection = standByDirection;
+//                        }
+                        String runToWaitHeightFlag = configService.getVal("RunToWaitHeightFlag", String.class);
+                        if (!Cools.isEmpty(runToWaitHeightFlag) && runToWaitHeightFlag.contains(agvId.toString())) {
+                            String runToWaitHeight = configService.getVal("RunToWaitHeight", String.class);
+                            if (Cools.isEmpty(runToWaitHeight)) {
+                                runToWaitHeight = "800";
+                            }
+                            Double runToWaitHeightValue = configService.getVal("RunToWaitHeightValue", Double.class);
+                            if (runToWaitHeightValue == 0) {
+                                runToWaitHeightValue = 1D;
+                            }
+                            // 淇绌烘寚閽堝紓甯革細妫�鏌astCode鏄惁涓簄ull
+                            if (lastCode == null) {
+                                throw new BusinessException("AGV瀹氫綅淇℃伅寮傚父锛屾棤娉曠敓鎴愬緟鏈哄姩浣�");
+                            }
+                            actionList.add(new Action(
+                                    null,    // 缂栧彿
+                                    task.getBusId(),    // 鎬荤嚎
+                                    task.getId(),    // 浠诲姟
+                                    null,    // 鍔ㄤ綔鍙�
+                                    null,    // 浼樺厛绾�
+                                    ActionTypeType.RunToWaitHeight.desc,    // 鍚嶇О
+                                    runToWaitHeightValue,    // 灞炴�ш皰
+                                    lastCode.getData(),    // 鍦伴潰鐮�
+                                    runToWaitHeight,   // 鍔ㄤ綔鍙傛暟
+                                    ActionTypeType.RunToWaitHeight.val(),    // 鍔ㄤ綔绫诲瀷
+                                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                    agvId,    // AGV
+                                    now    // 宸ヤ綔鏃堕棿
+                            ));
+                        }
+                        break;
+                    case MOVE:
+                        break;
+                    default:
+                        break;
+                }
+
+            }
+
+            // finish
+            actionList.add(new Action(
+                    null,    // 缂栧彿
+                    null,    // 鎬荤嚎
+                    null,    // 浠诲姟
+                    null,    // 鍔ㄤ綔鍙�
+                    null,    // 浼樺厛绾�
+                    ActionTypeType.FinishPath.desc,    // 鍚嶇О
+                    null,    // 灞炴�у��
+                    lastCode.getData(),    // 鍦伴潰鐮�
+                    null,   // 鍔ㄤ綔鍙傛暟
+                    ActionTypeType.FinishPath.val(),    // 鍔ㄤ綔绫诲瀷
+                    actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                    agvId,    // AGV
+                    now    // 宸ヤ綔鏃堕棿
+            ));
+
+            List<Action> newActionList = actionSorter.optimizeSort(actionList);
+            String groupId = String.valueOf(snowflakeIdWorker.nextId()).substring(3);
+
+            // save action
+            int i = newActionList.size();
+            for (Action action : newActionList) {
+//                action.setUuid(String.valueOf(snowflakeIdWorker.nextId()).substring(3));
+                action.setGroupId(groupId);
+                action.setPriority(i);
+                i -= 1;
+            }
+            if (!actionService.saveBatch(newActionList)) {
+                throw new BusinessException("group[" + groupId + "] 鍔ㄤ綔淇濆瓨澶辫触");
+            }
+
+            // update segment
+            for (Segment item : segmentList) {
+                item.setGroupId(groupId);
+                item.setState(SegmentStateType.RUNNING.toString());
+                item.setUpdateTime(now);
+                if (null != algoStartTime) {
+                    item.setAlgoTime((int) (now.getTime() - algoStartTime.getTime()));
+                }
+                if (!segmentService.updateById(item)) {
+                    throw new CoolException("鏇存柊Segment澶辫触");
+                }
+            }
+
+            log.info("{}鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細{}", agvNo, newActionList.size());
+        } catch (Exception e) {
+            log.error("mainService.generateAction", e);
+            TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
+
+            if (!Cools.isEmpty(pathList)) {
+                pathList.remove(0);
+                List<int[]> codeMatrixIdxList = mapDataDispatcher.getCodeMatrixIdxList(null, pathList);
+                mapDataDispatcher.clearDynamicMatrixByCodeList(null, codeMatrixIdxList);
+            }
+
+            throw new RuntimeException("generateAction method caught an exception, rolling back transaction.", e);
+        }
+    }
+
+
+    /**
+     * 鏍规嵁鍒嗙墖鐢熸垚鍔ㄤ綔 ( 杞﹁締鍙兘宸茬粡鍋氳繃涓�浜涗换鍔′簡,姝e湪绛夊緟涓嬩竴娈典换鍔� )
+     */
+    @Transactional
+    public synchronized void generateActionV2(Long agvId, List<Segment> segmentList, List<String> pathList, Date algoStartTime) {
+        try {
+            if (Cools.isEmpty(agvId, segmentList)) {
+                return;
+            }
+            Date now = new Date();
+            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.getByAgvId(agvId);
+            Double workDirection = agvModel.getWorkDirection();
+            AgvSpeedType agvSpeedType = AgvSpeedType.query(agvModel.getTravelSpeed());
+            assert agvSpeedType != null;
+
+            AgvDetail agvDetail = agvDetailService.selectMajorByAgvId(agvId);
+
+            List<Action> actionList = new ArrayList<>();
+            // start node
+            Code lastCode = codeService.getCacheById(agvDetail.getRecentCode());
+            Double lastDirection = MapService.mapToNearest(agvDetail.getAgvAngle());
+            if (!lastCode.getData().equals(pathList.get(0))) {
+                throw new CoolException("AGV[" + agvNo + "]瀹氫綅鍋忕Щ...");
+            }
+
+            //String lastCorner = null;
+            Integer index = -1;
+            boolean corner = false;
+            for (int i = pathList.size(); i < 0; i++) {
+                Code nextCode = codeService.getCacheByData(pathList.get(i));
+                if (nextCode != null && nextCode.getCornerBool()) {
+                    //lastCorner = pathList.get(i);
+                    index = i;
+                }
+            }
+
+            boolean first = true;
+            for (Segment segment : segmentList) {
+
+                // 鍒嗘鎵�灞炵殑Task
+                Task task = taskService.getById(segment.getTaskId());
+
+                // 鑺傜偣鏉$爜
+                Code code = codeService.getCacheById(segment.getEndNode());
+
+                // 闇�瑕佽蛋琛�
+                if (!lastCode.getData().equals(code.getData())) {
+
+                    // 璧拌璺緞鑺傜偣
+//                    List<String> pathList = mapService.checkoutPath(agv.getUuid(), lastCode, code);
+                    List<String> pathListPart = pathList.subList(pathList.indexOf(lastCode.getData()), pathList.indexOf(code.getData()) + 1);
+
+                    for (int i = 0; i < pathListPart.size(); i++) {
+                        if (i == 0) {
+                            continue;
+                        }
+                        String next = pathListPart.get(i);
+                        Code nextCode = codeService.getCacheByData(next);
+                        Double nextDirection;
+
+                        boolean reverse = false;
+                        if (index >= i) {
+                            // DOTO 娣诲姞杞集
+                            Code endCode = codeService.getCacheByData(pathList.get(pathList.size() - 1));
+                            nextDirection = mapService.calculateDirection(lastCode, endCode, angleOffsetVal);
+                            reverse = true;
+                        } else {
+                            nextDirection = mapService.calculateDirection(lastCode, nextCode, angleOffsetVal);
+
+                            // 绗竴姝ワ細濡傛灉涓嬩竴涓柟鍚戞濂芥槸浣滀笟鏂瑰悜鐨勭浉鍙嶆柟鍚戯紝鍒欓噸缃笅涓�涓柟鍚戜负浣滀笟鏂瑰悜锛屾爣璁� reverse = true
+                            if (!nextDirection.equals((workDirection + 180) % 360)) {
+                                nextDirection = workDirection;
+                                reverse = true;
+                            }
+
+                            // 绗簩姝ワ細鍒ゆ柇褰撳墠鑺傜偣鏄惁鍙互鏃嬭浆
+                            if (!lastCode.getCornerBool()) {
+                                // 濡傛灉鏄綔涓氭柟鍚戯紝浣嗘槸灏忚溅鍦ㄥ贩閬撳唴鏂瑰悜閿欒锛屽垯鍋滄
+                                if (reverse && !lastDirection.equals(nextDirection)) {
+//                                throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
+                                }
+                                // 濡傛灉涓嶆槸浣滀笟鏂瑰悜锛屽垽鏂槸鍚︾浉鍙嶆柟鍚戯紝濡傛灉鍙嶆柟鍚戝垯鍊掗��琛岃蛋
+                                if (nextDirection.equals((lastDirection + 180) % 360)) {
+                                    nextDirection = lastDirection;
+                                    reverse = true;
+                                }
+                            } else {
+                                if (!lastDirection.equals(nextDirection)) {
+                                    // 濡傛灉涓嬩釜鑺傜偣鏂瑰悜涓庡綋鍓峚gv鏂瑰悜鐩稿弽锛屽垯鍊掗��琛岃蛋锛屼絾鏄鏋滃綋鍓峚gv鏂瑰悜姝eソ涓庡伐浣滄柟鍚戠浉鍙嶏紝鍒欐棆杞嚦宸ヤ綔鏂瑰悜
+                                    if (nextDirection.equals((lastDirection + 180) % 360) && !workDirection.equals((lastDirection + 180) % 360)) {
+                                        nextDirection = lastDirection;
+                                        reverse = true;
+                                    } else {
+                                        // turn
+                                        actionList.add(new Action(
+                                                null,    // 缂栧彿s
+                                                task.getBusId(),    // 鎬荤嚎
+                                                task.getId(),    // 浠诲姟
+                                                null,    // 鍔ㄤ綔鍙�
+                                                null,    // 浼樺厛绾�
+                                                ActionTypeType.TurnCorner.desc,    // 鍚嶇О
+                                                mapService.isTurnCorner(lastCode.getData()) ? 1D : 0D,    // 灞炴�у��
+                                                lastCode.getData(),    // 鍦伴潰鐮�
+                                                String.valueOf(nextDirection),   // 鍔ㄤ綔鍙傛暟
+                                                ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
+                                                actionPrepareSts,    // 鍔ㄤ綔杩涘害
+                                                agvId,    // AGV
+                                                now    // 宸ヤ綔鏃堕棿
+                                        ));
+
+                                        lastDirection = nextDirection;
+                                    }
+                                }
+                            }
+                        }
+
 
                         // 绗竴涓姩浣滀竴瀹氭槸 turn
                         if (actionList.isEmpty()) {
@@ -1014,7 +1695,9 @@
                                 ActionTypeType.ReadyTakeFromConveyorSta.val(),    // 鍔ㄤ綔绫诲瀷
                                 actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
-                                now    // 宸ヤ綔鏃堕棿
+                                now,    // 宸ヤ綔鏃堕棿
+                                oriSta.getStaTypeIsCheck() == 1 ? 1 : 0,
+                                oriSta.getStaNo()
                         ));
                         // 鏆傚瓨鐐规斁璐�
                         assert backpackType != null;
@@ -1057,7 +1740,7 @@
                                     ActionTypeType.TurnCorner.val(),    // 鍔ㄤ綔绫诲瀷
                                     actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                     agvId,    // AGV
-                                    now    // 宸ヤ綔鏃堕棿
+                                    now   // 宸ヤ綔鏃堕棿
                             ));
                             lastDirection = destStaWorkDirection;
                         }
@@ -1077,6 +1760,7 @@
                                 actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
                                 now    // 宸ヤ綔鏃堕棿
+
                         ));
                         // 璁$畻璐у弶宸ヤ綔鏂瑰悜
                         staWorkDirection = mapService.calculateAgvWorkDirectionByStation(destStaWorkDirection, lastDirection);
@@ -1093,14 +1777,16 @@
                                 ActionTypeType.ReadyReleaseToConveyorSta.val(),    // 鍔ㄤ綔绫诲瀷
                                 actionPrepareSts,    // 鍔ㄤ綔杩涘害
                                 agvId,    // AGV
-                                now    // 宸ヤ綔鏃堕棿
+                                now,    // 宸ヤ綔鏃堕棿
+                                destSta.getStaTypeIsCheck() == 1 ? 2 : 0,
+                                destSta.getStaNo()
                         ));
                         break;
                     case TO_CHARGE:
                         // 妫�楠屾柟鍚�
                         FuncSta chargeFuncSta = funcStaService.query(lastCode.getId(), FuncStaType.CHARGE.toString());
                         Double chargeDirection = Double.parseDouble(chargeFuncSta.getAngle());
-                        if (!lastDirection.equals(chargeDirection)) {
+                        if (!lastDirection.equals(chargeDirection) && lastCode.getCornerBool()) {
                             actionList.add(new Action(
                                     null,    // 缂栧彿
                                     null,    // 鎬荤嚎
@@ -1164,7 +1850,7 @@
                                 runToWaitHeight = "800";
                             }
                             Double runToWaitHeightValue = configService.getVal("RunToWaitHeightValue", Double.class);
-                            if (Cools.isEmpty(runToWaitHeight) || runToWaitHeightValue == 0) {
+                            if (runToWaitHeightValue == 0) {
                                 runToWaitHeightValue = 1D;
                             }
                             // 淇绌烘寚閽堝紓甯革細妫�鏌astCode鏄惁涓簄ull
@@ -1243,7 +1929,7 @@
 
             log.info("{}鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細{}", agvNo, newActionList.size());
         } catch (Exception e) {
-            log.error("mainService.generateAction", e);
+            log.error("mainService.generateActionV2", e);
             TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
 
             if (!Cools.isEmpty(pathList)) {
@@ -1252,15 +1938,16 @@
                 mapDataDispatcher.clearDynamicMatrixByCodeList(null, codeMatrixIdxList);
             }
 
-            throw new RuntimeException("generateAction method caught an exception, rolling back transaction.", e);
+            throw new RuntimeException("generateActionV2 method caught an exception, rolling back transaction.", e);
         }
     }
+
 
     @Transactional
     public void publishAction(String actionGroupId) {
         try {
             Date now = new Date();
-
+            boolean flag = true;
             // action
             List<Action> actionList = actionService.list(new LambdaQueryWrapper<Action>()
                     .eq(Action::getGroupId, actionGroupId).eq(Action::getActionSts, ActionStsType.PREPARE.val())
@@ -1342,6 +2029,9 @@
                                 .setQrCode(action.getCode())
                                 .bodySync(body -> body.setHeight((short) Double.parseDouble(action.getParams())))
                         );
+                        if (!Cools.isEmpty(action.getAskType()) && (action.getAskType() == 1 || action.getAskType() == 2)) {
+                            flag = askSta(action.getAskType(), action.getAskSta());
+                        }
                         break;
                     case ReadyTakeFromAgvSite:
                         agvAction.add(new AgvActionItem<>(ReadyTakeFromAgvSite.class)
@@ -1363,6 +2053,9 @@
                                 .setQrCode(action.getCode())
                                 .bodySync(body -> body.setHeight((short) Double.parseDouble(action.getParams())))
                         );
+                        if (!Cools.isEmpty(action.getAskType()) && (action.getAskType() == 1 || action.getAskType() == 2)) {
+                            flag = askSta(action.getAskType(), action.getAskSta());
+                        }
                         break;
                     case ReadyReleaseToAgvSite:
                         agvAction.add(new AgvActionItem<>(ReadyReleaseToAgvSite.class)
@@ -1393,7 +2086,10 @@
                 }
 
             }
-
+            if (!flag) {
+                log.error("浠诲姟缁� [{}] 鍔ㄤ綔鎸囦护涓嬪彂澶辫触 ,鍚戣緭閫佺嚎璇㈤棶鎶ラ敊锛侊紒锛�", actionGroupId);
+                throw new CoolException("浠诲姟缁� [{" + actionGroupId + "}] 鍔ㄤ綔鎸囦护涓嬪彂澶辫触 锛侊紒锛�");
+            }
             BaseResult<?> result = agvCmdService.executeAgvActionCmd(agvAction);
             if (result.success()) {
                 log.info("浠诲姟缁� [{}] 鍔ㄤ綔鎸囦护宸蹭笅鍙� ===>> 鎸囦护鏁伴噺锛歿}", actionGroupId, actionList.size());
@@ -1432,66 +2128,98 @@
             if (agv_11_up.getCompleteType().equals(AgvCompleteType.RELEASE_FROM_SHELVES_COMPLETE)) {
                 WebsocketServiceImpl.taskShelfBarcode = agv_11_up.getLocCode();
 
-                Loc loc = locService.getOne(new LambdaQueryWrapper<Loc>().eq(Loc::getBarcode, String.valueOf(Integer.parseInt(agv_11_up.getLocCode()))));
-                if (null == loc) {
-                    log.warn("Agv [{}] 涓婃姤寰�璐ф灦鏀捐揣瀹屾垚鏃讹紝搴撲綅鐮乕{}]鏃犳晥銆�", protocol.getAgvNo(), agv_11_up.getLocCode());
-                } else {
-                    List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
-                    for (Long taskId : taskIds) {
-                        Task task = taskService.getById(taskId);
-                        if (task.getDestLoc().equals(loc.getId())) {
+//                Loc loc = locService.getOne(new LambdaQueryWrapper<Loc>().eq(Loc::getBarcode, String.valueOf(Integer.parseInt(agv_11_up.getLocCode()))));
+//                if (null == loc) {
+//                    log.warn("Agv [{}] 涓婃姤寰�璐ф灦鏀捐揣瀹屾垚鏃讹紝搴撲綅鐮乕{}]鏃犳晥銆�", protocol.getAgvNo(), agv_11_up.getLocCode());
+//                } else {
+//                    List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
+//                    for (Long taskId : taskIds) {
+//                        Task task = taskService.getById(taskId);
+//                        if (task.getDestLoc().equals(loc.getId())) {
+//
+//                            Action action = actionService.getOne(new LambdaQueryWrapper<Action>()
+//                                    .eq(Action::getTaskId, task.getId())
+//                                    .eq(Action::getActionType, ActionTypeType.ReadyReleaseToShelvesLoc.val())
+//                                    .eq(Action::getActionSts, ActionStsType.ISSUED.val())
+//                            );
+//
+//                            if (null != action) {
+//                                action.setActionSts(ActionStsType.FINISH.val());
+//                                action.setEndTime(now);
+//                                action.setUpdateTime(now);
+//                                if (!actionService.updateById(action)) {
+//                                    log.error("Action [{}] 鏇存柊澶辫触 锛侊紒锛�", action.getPriority() + " - " + action.getName());
+//                                }
+//                            }
+//                            //鎻掑叆涓�鏉�
+//                            report(task, TaskReportStsType.END);
+//                        }
+//                    }
+//                }
 
-                            Action action = actionService.getOne(new LambdaQueryWrapper<Action>()
-                                    .eq(Action::getTaskId, task.getId())
-                                    .eq(Action::getActionType, ActionTypeType.ReadyReleaseToShelvesLoc.val())
-                                    .eq(Action::getActionSts, ActionStsType.ISSUED.val())
-                            );
-
-                            if (null != action) {
-                                action.setActionSts(ActionStsType.FINISH.val());
-                                action.setEndTime(now);
-                                action.setUpdateTime(now);
-                                if (!actionService.updateById(action)) {
-                                    log.error("Action [{}] 鏇存柊澶辫触 锛侊紒锛�", action.getPriority() + " - " + action.getName());
-                                }
-                            }
-
-                        }
-                    }
-                }
+//                List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
+//                for (Long taskId : taskIds) {
+//                    Task task = taskService.getById(taskId);
+//                    report(task, agv_11_up.getQrCode(), TaskReportStsType.END);
+//                }
             }
 
             // 鍑哄簱鍙栬揣
             if (agv_11_up.getCompleteType().equals(AgvCompleteType.TAKE_FROM_SHELVES_COMPLETE)) {
                 WebsocketServiceImpl.taskShelfBarcode = agv_11_up.getLocCode();
 
-                Loc loc = locService.getOne(new LambdaQueryWrapper<Loc>().eq(Loc::getBarcode, String.valueOf(Integer.parseInt(agv_11_up.getLocCode()))));
-                if (null == loc) {
-                    log.warn("Agv [{}] 涓婃姤浠庤揣鏋跺彇璐у畬鎴愶紝搴撲綅鐮乕{}]鏃犳晥銆�", protocol.getAgvNo(), agv_11_up.getLocCode());
-                } else {
+//                Loc loc = locService.getOne(new LambdaQueryWrapper<Loc>().eq(Loc::getBarcode, String.valueOf(Integer.parseInt(agv_11_up.getLocCode()))));
+//                if (null == loc) {
+//                    log.warn("Agv [{}] 涓婃姤浠庤揣鏋跺彇璐у畬鎴愶紝搴撲綅鐮乕{}]鏃犳晥銆�", protocol.getAgvNo(), agv_11_up.getLocCode());
+//                } else {
+//
+//                    List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
+//                    for (Long taskId : taskIds) {
+//                        Task task = taskService.getById(taskId);
+//                        if (task.getOriLoc().equals(loc.getId())) {
+//
+//                            Action action = actionService.getOne(new LambdaQueryWrapper<Action>()
+//                                    .eq(Action::getTaskId, task.getId())
+//                                    .eq(Action::getActionType, ActionTypeType.ReadyTakeFromShelvesLoc.val())
+//                                    .eq(Action::getActionSts, ActionStsType.ISSUED.val())
+//                            );
+//                            if (null != action) {
+//                                action.setActionSts(ActionStsType.FINISH.val());
+//                                action.setEndTime(now);
+//                                action.setUpdateTime(now);
+//                                if (!actionService.updateById(action)) {
+//                                    log.error("Action [{}] 鏇存柊澶辫触 锛侊紒锛�", action.getPriority() + " - " + action.getName());
+//                                }
+//                            }
+//                            report(task, TaskReportStsType.OTBIN);
+//                        }
+//                    }
+//                }
+//                List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
+//                for (Long taskId : taskIds) {
+//                    Task task = taskService.getById(taskId);
+//                    report(task, agv_11_up.getQrCode(), TaskReportStsType.OTBIN);
+//                }
 
-                    List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
-                    for (Long taskId : taskIds) {
-                        Task task = taskService.getById(taskId);
-                        if (task.getOriLoc().equals(loc.getId())) {
-
-                            Action action = actionService.getOne(new LambdaQueryWrapper<Action>()
-                                    .eq(Action::getTaskId, task.getId())
-                                    .eq(Action::getActionType, ActionTypeType.ReadyTakeFromShelvesLoc.val())
-                                    .eq(Action::getActionSts, ActionStsType.ISSUED.val())
-                            );
-                            if (null != action) {
-                                action.setActionSts(ActionStsType.FINISH.val());
-                                action.setEndTime(now);
-                                action.setUpdateTime(now);
-                                if (!actionService.updateById(action)) {
-                                    log.error("Action [{}] 鏇存柊澶辫触 锛侊紒锛�", action.getPriority() + " - " + action.getName());
-                                }
-                            }
-                        }
-                    }
-                }
             }
+            //浠庤緭閫佺嚎鍙栬揣瀹屾垚
+//            if (agv_11_up.getCompleteType().equals(AgvCompleteType.TAKE_FROM_STA_COMPLETE)) {
+//                WebsocketServiceImpl.taskShelfBarcode = agv_11_up.getLocCode();
+//                List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
+//                for (Long taskId : taskIds) {
+//                    Task task = taskService.getById(taskId);
+//                    report(task, agv_11_up.getQrCode(), TaskReportStsType.OTBIN);
+//                }
+//            }
+            //寰�杈撻�佺嚎鏀捐揣瀹屾垚
+//            if (agv_11_up.getCompleteType().equals(AgvCompleteType.RELEASE_FROM_STA_COMPLETE)) {
+//                WebsocketServiceImpl.taskShelfBarcode = agv_11_up.getLocCode();
+//                List<Long> taskIds = actionService.selectTaskIdsByGroupId(serialNo);
+//                for (Long taskId : taskIds) {
+//                    Task task = taskService.getById(taskId);
+//                    report(task, agv_11_up.getQrCode(), TaskReportStsType.END);
+//                }
+//            }
 
             // 璺緞瀹屾垚 || 鍏呯數瀹屾垚
             if (agv_11_up.getCompleteType().equals(AgvCompleteType.ENTIRE_PATH_COMPLETE)
@@ -1520,6 +2248,7 @@
         }
     }
 
+
     @Transactional
     public void settleSegmentList(List<Segment> segmentList, String serialNo) {
         if (Cools.isEmpty(segmentList)) {
@@ -1530,6 +2259,8 @@
         // task
         for (Segment segment : segmentList) {
             boolean taskComplete = false;
+            boolean otbin = false;
+
 
             Task task = taskService.getById(segment.getTaskId());
             assert null != task;
@@ -1540,6 +2271,7 @@
             switch (Objects.requireNonNull(posType)) {
                 case ORI_STA:
                 case ORI_LOC:
+                    otbin = true;
                     break;
                 case DEST_STA:
                 case DEST_LOC:
@@ -1560,33 +2292,25 @@
                     break;
             }
 
+            if (otbin) {
+                locService.taskCallBackOtbin(task);
+                report(task, null, TaskReportStsType.OTBIN);
+            }
+
+
             if (taskComplete) {
-                locService.taskCallBack(task);
+                locService.taskCallBackEnd(task);
 
                 task.setTaskSts(TaskStsType.COMPLETE.val());
                 task.setEndTime(now);
                 task.setUpdateTime(now);
                 if (!taskService.updateById(task)) {
                     log.error("Task [{}] 鏇存柊澶辫触 锛侊紒锛�", task.getSeqNum());
-                } else {
-                    log.info("Task [{}] 浣滀笟瀹屾瘯 ==========>> ", task.getSeqNum());
-                    // TODO 鎻掑叆涓�鏉′笂鎶ヨ褰�
-                    TaskReport taskReport = new TaskReport();
-                    taskReport.setAgvId(task.getAgvId());
-                    taskReport.setBusNo(task.getBusId$());
-                    taskReport.setCreateTime(new Date());
-                    taskReport.setDestLoc(task.getDestLoc());
-                    taskReport.setDestSta(task.getDestSta());
-                    taskReport.setSeqNum(task.getSeqNum());
-                    taskReport.setTaskSts(task.getTaskSts());
-                    taskReport.setOriLoc(task.getOriLoc());
-                    taskReport.setOriSta(task.getOriSta());
-                    taskReport.setZpallet(task.getZpallet());
-                    if (!taskReportService.save(taskReport)) {
-                        log.info("TaskReport [{}] 鎻掑叆澶辫触 ==========>> ", JSON.toJSONString(taskReport));
-                    }
                 }
-
+                report(task, null, TaskReportStsType.END);
+                if (task.getSeqNum() != null && task.getSeqNum().contains("SSX-CK")) {
+                    report(task, "1001", TaskReportStsType.COMPLETED);
+                }
             }
         }
 
@@ -1619,4 +2343,68 @@
         segmentService.processNext(segmentList);
     }
 
+    /**
+     * 涓婃姤缁欎笂娓哥郴缁燂紝灏辨槸鎻掑叆涓�鏉℃暟鎹埌涓婃姤琛�
+     */
+    private void report(Task task, String qrCode, TaskReportStsType taskReportStsType) {
+        // TODO 鎻掑叆涓�鏉′笂鎶ヨ褰�
+        if (task.getBusId() == null) {
+            return;
+        }
+        List<TaskReport> list = taskReportService.list(new LambdaQueryWrapper<TaskReport>().eq(TaskReport::getSeqNum, task.getSeqNum()).eq(TaskReport::getBusNo, task.getBusId$()).eq(TaskReport::getTaskSts, taskReportStsType.status));
+        if (!Cools.isEmpty(list)) {
+            log.info("TaskReport [{},{}] 宸查噸澶嶏紝涓嶅啀鎻掑叆 ==========>> ", taskReportStsType, JSON.toJSONString(task));
+            return;
+        }
+        TaskReport taskReport = new TaskReport();
+        taskReport.setAgvId(task.getAgvId());
+        taskReport.setAgvNo(task.getAgvId$());
+        taskReport.setBusNo(task.getBusId$());
+        taskReport.setCreateTime(new Date());
+        taskReport.setCompleted(0);
+        taskReport.setQrCode(qrCode);
+        taskReport.setReportTimes(0);
+        taskReport.setTaskSts(taskReportStsType.status);
+        taskReport.setEventType(taskReportStsType.name);
+        taskReport.setSeqNum(task.getSeqNum());
+        taskReport.setZpallet(task.getZpallet());
+
+        if (!taskReportService.save(taskReport)) {
+            log.info("TaskReport [{}] 鎻掑叆澶辫触 ==========>> ", JSON.toJSONString(taskReport));
+        } else {
+            log.info("Task [{}] 鐘舵�佽褰曟彃鍏ユ暟鎹簱 ==========>> ", task.getSeqNum());
+        }
+    }
+
+    private boolean askSta(Integer askType, String askSta) {
+        log.info("鏉ヨ闂緭閫佺嚎浜嗭紝{}锛寋}", askType, askSta);
+        String wmsUrl = configService.getVal("WCS_URL", String.class);
+        String wmsPath = configService.getVal("WMS_STA", String.class);
+        if (Cools.isEmpty(wmsPath) || Cools.isEmpty(wmsUrl)) {
+            return false;
+        }
+        Integer time = configService.getVal("TIMEOUT", Integer.class, 5);
+        //Integer times = configService.getVal("REPORT_TIMES", Integer.class, 2);
+        Map<String, Object> data = new HashMap<>();
+        data.put("askType", askType);
+        data.put("askSta", askSta);
+        String response = null;
+        try {
+            response = new HttpHandler.Builder()
+                    .setUri(wmsUrl)
+                    .setPath(wmsPath)
+                    .setTimeout(time, TimeUnit.SECONDS)
+                    .setJson(JSON.toJSONString(data))
+                    .build()
+                    .doPost();
+            log.info("杩斿洖鍙傛暟锛歿}", response);
+            JSONObject jsonObject = JSON.parseObject(response);
+            if (jsonObject.getInteger("code").equals(200)) {
+                return true;
+            }
+        } catch (IOException e) {
+            log.info("鎶ラ敊浜嗭紝{}", e);
+        }
+        return false;
+    }
 }

--
Gitblit v1.9.1