From 507d28f90ec6772b3e4d73a57aad59263031112b Mon Sep 17 00:00:00 2001 From: vincentlu <t1341870251@gmail.com> Date: 星期五, 21 三月 2025 08:13:51 +0800 Subject: [PATCH] Merge remote-tracking branch 'origin/jbly' into jbly --- zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java | 53 +++++++++++++++++++++++++++++++++++++++++++++++------ 1 files changed, 47 insertions(+), 6 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 8b08e91..060eea6 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 @@ -667,7 +667,7 @@ List<Action> actionList = new ArrayList<>(); // start node Code lastCode = codeService.getCacheById(agvDetail.getRecentCode()); - Double lastDirection = agvDetail.getAgvAngle(); + Double lastDirection = MapService.mapToNearest(agvDetail.getAgvAngle()); if (!lastCode.getData().equals(pathList.get(0))) { throw new CoolException("AGV[" + agvNo + "]瀹氫綅鍋忕Щ..."); } @@ -696,12 +696,54 @@ Code nextCode = codeService.getCacheByData(next); Double nextDirection = mapService.calculateDirection(lastCode, nextCode, angleOffsetVal); + // 绗竴姝ワ細濡傛灉涓嬩竴涓柟鍚戞濂芥槸浣滀笟鏂瑰悜鐨勭浉鍙嶆柟鍚戯紝鍒欓噸缃笅涓�涓柟鍚戜负浣滀笟鏂瑰悜锛屾爣璁� reverse = true boolean reverse = false; if (nextDirection.equals((workDirection + 180) % 360)) { nextDirection = workDirection; reverse = true; } - if (!lastDirection.equals(nextDirection) || actionList.isEmpty()) { + + // 绗簩姝ワ細鍒ゆ柇褰撳墠鑺傜偣鏄惁鍙互鏃嬭浆 + 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)) { + if (nextDirection.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()) { // turn actionList.add(new Action( null, // 缂栧彿 @@ -720,7 +762,6 @@ )); lastDirection = nextDirection; - } // run @@ -1050,9 +1091,9 @@ action.setStartTime(now); action.setIoTime(now); action.setUpdateTime(now); - if (!actionService.updateById(action)) { - throw new BusinessException(action.getPriority() + " - " + action.getName() + "鍔ㄤ綔鏇存柊澶辫触"); - } + } + if (!actionService.updateBatchById(actionList)) { + throw new BusinessException("failed to update action batch !!!"); } // task -- Gitblit v1.9.1