From 25f276990df41cc8bc03a9427874f70776b04bea Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期三, 08 一月 2025 16:18:48 +0800
Subject: [PATCH] #
---
zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/MainService.java | 53 ++++++++++++++++++++++++++++-------------------------
1 files changed, 28 insertions(+), 25 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 a71e6f0..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;
@@ -646,28 +645,31 @@
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);
+ 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,7 +691,7 @@
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)) {
@@ -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 // 宸ヤ綔鏃堕棿
));
@@ -1018,7 +1021,7 @@
}
}
- log.info(agv.getUuid() + "鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細" + newActionList.size());
+ log.info(agvNo + "鍙稟gv鍔ㄤ綔缁勮瀹屾垚锛屾寚浠ゆ暟閲忥細" + newActionList.size());
} catch (Exception e) {
log.error("mainService.generateAction", e);
TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
--
Gitblit v1.9.1