From 36dcec12994c82fffe2a86a6acf12ecbd071fffb Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期三, 08 一月 2025 16:26:18 +0800
Subject: [PATCH] #
---
zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java | 65 ++++++++++++++++++--------------
1 files changed, 36 insertions(+), 29 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 5ba0403..3046cc6 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() + "浠诲姟鏇存柊澶辫触");
@@ -641,33 +641,35 @@
* 鏍规嵁鍒嗙墖鐢熸垚鍔ㄤ綔 ( 杞﹁締鍙兘宸茬粡鍋氳繃涓�浜涗换鍔′簡,姝ｅ湪绛夊緟涓嬩竴娈典换鍔� )
*/
@Transactional
- public synchronized void generateAction(Long agvId, List<Segment> segmentList, List<String> pathList) {
+ public synchronized void generateAction(Long agvId, List<Segment> segmentList, List<String> pathList, Date algoStartTime) {
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;
+ long startTime = System.currentTimeMillis();
for (Segment segment : segmentList) {
// 鍒嗘鎵�灞炵殑Task
@@ -689,14 +691,14 @@
String next = pathListPart.get(i);
Code nextCode = codeService.selectByData(next);
- Double nextDirection = mapService.calculateDirection(lastCode, nextCode);
+ 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 +711,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(nextDirection), // 鍔ㄤ綔鍙傛暟
ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -735,7 +737,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(gap.getDistance()), // 鍔ㄤ綔鍙傛暟
actionType.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -761,7 +763,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(workDirection), // 鍔ㄤ綔鍙傛暟
ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -792,7 +794,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(workDirection), // 鍔ㄤ綔鍙傛暟
ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -801,7 +803,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 +815,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(oriLoc.getOffset()), // 鍔ㄤ綔鍙傛暟
ActionTypeType.ReadyTakeFromShelvesLoc.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -829,7 +831,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(backpackType.height), // 鍔ㄤ綔鍙傛暟
ActionTypeType.ReadyReleaseToAgvSite.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -850,7 +852,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(workDirection), // 鍔ㄤ綔鍙傛暟
ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -868,7 +870,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(backpackType.height), // 鍔ㄤ綔鍙傛暟
ActionTypeType.ReadyTakeFromAgvSite.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -876,7 +878,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 +890,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(destLoc.getOffset()), // 鍔ㄤ綔鍙傛暟
ActionTypeType.ReadyReleaseToShelvesLoc.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -913,7 +915,7 @@
lastCode.getData(), // 鍦伴潰鐮�
String.valueOf(chargeDirection), // 鍔ㄤ綔鍙傛暟
ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -932,7 +934,7 @@
lastCode.getData(), // 鍦伴潰鐮�
null, // 鍔ㄤ綔鍙傛暟
ActionTypeType.DockingCharge.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -952,7 +954,7 @@
// lastCode.getData(), // 鍦伴潰鐮�
// String.valueOf(standByDirection), // 鍔ㄤ綔鍙傛暟
// ActionTypeType.TurnCorner.val(), // 鍔ㄤ綔绫诲瀷
-// ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+// actionPrepareSts, // 鍔ㄤ綔杩涘害
// agvId, // AGV
// now // 宸ヤ綔鏃堕棿
// ));
@@ -966,6 +968,7 @@
}
}
+ System.out.println("save data: " + (System.currentTimeMillis() - startTime));
// finish
actionList.add(new Action(
@@ -979,7 +982,7 @@
lastCode.getData(), // 鍦伴潰鐮�
null, // 鍔ㄤ綔鍙傛暟
ActionTypeType.FinishPath.val(), // 鍔ㄤ綔绫诲瀷
- ActionStsType.PREPARE.val(), // 鍔ㄤ綔杩涘害
+ actionPrepareSts, // 鍔ㄤ綔杩涘害
agvId, // AGV
now // 宸ヤ綔鏃堕棿
));
@@ -1010,19 +1013,23 @@
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(agv.getUuid() + "鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細" + newActionList.size());
+ log.info(agvNo + "鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細" + 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