From 1bdaf9be340892e1654caea9ed4082b6c61beb3b Mon Sep 17 00:00:00 2001
From: vincentlu <t1341870251@gmail.com>
Date: 星期一, 09 三月 2026 15:54:02 +0800
Subject: [PATCH] #
---
zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java | 51 ++++++++++++++++++++++++++++++++-------------------
1 files changed, 32 insertions(+), 19 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 7597586..d4acffc 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
@@ -20,10 +20,11 @@
import com.zy.acs.manager.common.exception.BusinessException;
import com.zy.acs.manager.core.domain.AgvBackpackDto;
import com.zy.acs.manager.core.domain.LaneDto;
+import com.zy.acs.manager.core.domain.PathDto;
import com.zy.acs.manager.core.domain.TaskPosDto;
import com.zy.acs.manager.core.integrate.conveyor.ConveyorStationService;
-import com.zy.acs.manager.core.service.astart.MapDataDispatcher;
import com.zy.acs.manager.core.integrate.dto.OpenBusSubmitParam;
+import com.zy.acs.manager.core.service.astart.MapDataDispatcher;
import com.zy.acs.manager.manager.entity.*;
import com.zy.acs.manager.manager.enums.*;
import com.zy.acs.manager.manager.service.*;
@@ -383,7 +384,7 @@
int idx = -1;
for (int i = 0; i < destPosList.size(); i++) {
if (Objects.equals(destPosList.get(i).getTaskId(), newDto.getTaskId())
- && Objects.equals(destPosList.get(i).getCodeId(), newDto.getCodeId())) {
+ && Objects.equals(destPosList.get(i).getCodeId(), newDto.getCodeId())) {
idx = i;
break;
}
@@ -893,9 +894,10 @@
* 鏍规嵁鍒嗙墖鐢熸垚鍔ㄤ綔 ( 杞﹁締鍙兘宸茬粡鍋氳繃涓�浜涗换鍔′簡,姝ｅ湪绛夊緟涓嬩竴娈典换鍔� )
*/
@Transactional
- public synchronized void generateAction(Long agvId, List<Segment> segmentList, List<String> pathList, Date algoStartTime) {
+ public synchronized List<PathDto> generateAction(Long agvId, List<Segment> segmentList, List<String> pathList, Date algoStartTime) {
+ List<PathDto> pathTrace = new ArrayList<>();
try {
- if (Cools.isEmpty(agvId, segmentList)) { return; }
+ if (Cools.isEmpty(agvId, segmentList)) { return pathTrace; }
Date now = new Date();
long actionPrepareSts = ActionStsType.PREPARE.val();
// JSONObject storeDirection = configService.getVal("storeDirection", JSONObject.class);
@@ -924,6 +926,7 @@
if (!lastCode.getData().equals(pathList.get(0))) {
throw new CoolException("AGV[" + agvNo + "]瀹氫綅鍋忕Щ...");
}
+ pathTrace.add(new PathDto(lastCode.getData(), lastDirection, false));
boolean first = true;
for (Segment segment : segmentList) {
@@ -989,6 +992,7 @@
now // 宸ヤ綔鏃堕棿
));
lastDirection = nextLaneDir;
+ PathDto.markTurn(pathTrace, lastDirection);
}
if (nextDirection.equals(oppNextLaneDir)) {
@@ -1057,6 +1061,7 @@
));
lastDirection = nextDirection;
+ PathDto.markTurn(pathTrace, lastDirection);
}
}
}
@@ -1082,6 +1087,7 @@
));
lastDirection = nextDirection;
+ PathDto.markTurn(pathTrace, lastDirection);
}
// run
@@ -1104,6 +1110,7 @@
));
lastCode = nextCode;
+ pathTrace.add(new PathDto(lastCode.getData(), lastDirection, false));
}
@@ -1149,6 +1156,7 @@
));
lastDirection = firstTurnDir;
+ PathDto.markTurn(pathTrace, lastDirection);
}
first = false;
@@ -1239,7 +1247,7 @@
task.getBusId(), // 鎬荤嚎
task.getId(), // 浠诲姟
null, // 鍔ㄤ綔鍙�
- null, // 浼樺厛绾�
+ null, // 浼樺厛绾�
ActionTypeType.ReadyReleaseToShelvesLoc.desc, // 鍚嶇О
(double) actuatorDirectionType.val, // 灞炴�у��
lastCode.getData(), // 鍦伴潰鐮�
@@ -1253,9 +1261,9 @@
case ORI_STA:
// 绔欑偣鍙栬揣
Sta oriSta = staService.getById(task.getOriSta());
- Double angle = oriSta.getAngle() == null ? mapService.getStaAngle(oriSta, workDirection) : Double.valueOf(oriSta.getAngle());
+ Double oriStaWorkDirection = mapService.getStaAngle(oriSta);
// 妫�楠屾柟鍚�
- if (!lastDirection.equals(Double.valueOf(angle))) {
+ if (!lastDirection.equals(oriStaWorkDirection)) {
if (!lastCode.getCornerBool()) {
throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
}
@@ -1267,15 +1275,16 @@
null, // 鍔ㄤ綔鍙�
null, // 浼樺厛绾�
ActionTypeType.TurnCorner.desc, // 鍚嶇О
- (double) MapService.calcSpinDirection(lastCode, lastDirection, angle).val, // 灞炴�у��
+ (double) MapService.calcSpinDirection(lastCode, lastDirection, oriStaWorkDirection).val, // 灞炴�у��
lastCode.getData(), // 鍦伴潰鐮�
- String.valueOf(angle), // 鍔ㄤ綔鍙傛暟
+ String.valueOf(oriStaWorkDirection), // 鍔ㄤ綔鍙傛暟
ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
- lastDirection = angle;
+ lastDirection = oriStaWorkDirection;
+ PathDto.markTurn(pathTrace, lastDirection);
}
// 璁＄畻璐у弶宸ヤ綔鏂瑰悜
actuatorDirectionType = ActuatorDirectionType.fromVal(oriSta.getActDir());
@@ -1318,9 +1327,9 @@
case DEST_STA:
// 绔欑偣鏀捐揣
Sta destSta = staService.getById(task.getDestSta());
- angle = destSta.getAngle() == null ? mapService.getStaAngle(destSta, workDirection) : Double.valueOf(destSta.getAngle());
+ Double destStaWorkDirection = mapService.getStaAngle(destSta);
// 妫�楠屾柟鍚�
- if (!lastDirection.equals(angle)) {
+ if (!lastDirection.equals(destStaWorkDirection)) {
if (!lastCode.getCornerBool()) {
throw new CoolException(agvNo + "鍙峰皬杞︽柟鍚戦敊璇紝璇锋帹鑷宠浆寮偣鎵嬪姩璋冩暣");
}
@@ -1332,15 +1341,16 @@
null, // 鍔ㄤ綔鍙�
null, // 浼樺厛绾�
ActionTypeType.TurnCorner.desc, // 鍚嶇О
- (double) MapService.calcSpinDirection(lastCode, lastDirection, angle).val, // 灞炴�у��
+ (double) MapService.calcSpinDirection(lastCode, lastDirection, destStaWorkDirection).val, // 灞炴�у��
lastCode.getData(), // 鍦伴潰鐮�
- String.valueOf(angle), // 鍔ㄤ綔鍙傛暟
+ String.valueOf(destStaWorkDirection), // 鍔ㄤ綔鍙傛暟
ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
- lastDirection = angle;
+ lastDirection = destStaWorkDirection;
+ PathDto.markTurn(pathTrace, lastDirection);
}
// 鑳岀瘬鍙栬揣
if (backupAction) {
@@ -1401,6 +1411,7 @@
now // 宸ヤ綔鏃堕棿
));
lastDirection = chargeDirection;
+ PathDto.markTurn(pathTrace, lastDirection);
}
// charge
@@ -1555,6 +1566,7 @@
}
log.info("{}鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細{}", agvNo, newActionList.size());
+ return pathTrace;
} catch (Exception e) {
log.error("mainService.generateAction", e);
TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
@@ -1610,8 +1622,9 @@
task.setUpdateTime(now);
if (!taskService.updateById(task)) {
throw new BusinessException(task.getSeqNum() + "浠诲姟鏇存柊澶辫触");
- }
- }
+ }
+
+}
}
AgvAction agvAction = new AgvAction(agvNo, actionGroupId);
@@ -1833,9 +1846,9 @@
// segment list
List<Segment> segmentList = segmentService.list(new LambdaQueryWrapper<Segment>()
- .eq(Segment::getGroupId, serialNo)
+ .eq(Segment::getGroupId, serialNo)
// .eq(Segment::getState, SegmentStateType.RUNNING.toString())
- .orderByAsc(Segment::getSerial)
+ .orderByAsc(Segment::getSerial)
);
// settlement
--
Gitblit v1.9.1