From ce7cab3f73e46f76b10efd7f8ff8dd5ce712482b Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期二, 12 十一月 2024 14:39:43 +0800
Subject: [PATCH] #
---
zy-acs-manager/src/main/java/com/zy/acs/manager/fake/AgvSimulatorTask.java | 59 ++++++++++++++++++++++++++++++++++++-----------------------
1 files changed, 36 insertions(+), 23 deletions(-)
diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/fake/AgvSimulatorTask.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/fake/AgvSimulatorTask.java
index 1b2b688..55028a4 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/fake/AgvSimulatorTask.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/fake/AgvSimulatorTask.java
@@ -5,6 +5,7 @@
import com.zy.acs.common.domain.protocol.AGV_11_UP;
import com.zy.acs.common.enums.AgvCompleteType;
import com.zy.acs.common.utils.RedisSupport;
+import com.zy.acs.manager.core.service.MapService;
import com.zy.acs.manager.manager.entity.Action;
import com.zy.acs.manager.manager.entity.Agv;
import com.zy.acs.manager.manager.entity.AgvDetail;
@@ -14,6 +15,7 @@
import com.zy.acs.manager.manager.service.ActionService;
import com.zy.acs.manager.manager.service.AgvDetailService;
import com.zy.acs.manager.manager.service.CodeService;
+import com.zy.acs.manager.manager.service.JamService;
import lombok.extern.slf4j.Slf4j;
import java.util.List;
@@ -29,6 +31,8 @@
private final AgvDetailService agvDetailService;
private final ActionService actionService;
private final CodeService codeService;
+ private final MapService mapService;
+ private final JamService jamService;
private final List<Action> actionList;
private final RedisSupport redis;
@@ -41,6 +45,8 @@
, AgvDetailService agvDetailService
, ActionService actionService
, CodeService codeService
+ , MapService mapService
+ , JamService jamService
, List<Action> actionList
) {
this.agv = agv;
@@ -48,6 +54,8 @@
this.agvDetailService = agvDetailService;
this.actionService = actionService;
this.codeService = codeService;
+ this.mapService = mapService;
+ this.jamService = jamService;
this.actionList = actionList;
this.groupId = actionList.get(0).getGroupId();
@@ -108,13 +116,15 @@
// 妯℃嫙鐢甸噺娑堣��
// agvDetail.setVol(agvDetail.getVol() - 0.1 * distanceToMove); // 鏍规嵁璺濈娑堣�楃數閲�
+ Thread.sleep(1000);
+
agvDetailService.updateById(agvDetail);
- Thread.sleep(1000);
+ mapService.unlockPath(agv.getUuid(), code.getData());
+ jamService.checkIfFinish(agv.getId(), code.getData());
action.setActionSts(ActionStsType.FINISH.val());
actionService.updateById(action);
-
}
@@ -126,34 +136,37 @@
* @param action 褰撳墠鍔ㄤ綔
*/
private void simulateRotating(Agv agv, AgvDetail agvDetail, Action action) throws InterruptedException {
-// Double agvAngle = agvDetail.getAgvAngle();
-// double actionAngle = Double.parseDouble(action.getParams());
+// double totalAngle = Double.parseDouble(action.getParams());
+// double stepAngle = 90.0;
+// double actionProgress = 0.0;
+//
+// while (actionProgress < totalAngle) {
+// double angleToRotate = Math.min(stepAngle, totalAngle - actionProgress);
+// // 鏇存柊AGV鐨勮搴�
+// double newAngle = (agvDetail.getAgvAngle() + angleToRotate) % 360;
+// agvDetail.setAgvAngle(newAngle);
+//
+// // 妯℃嫙鐢甸噺娑堣��
+//// agvDetail.setVol(agvDetail.getVol() - 0.05 * (angleToRotate / 15.0)); // 鏍规嵁瑙掑害娑堣�楃數閲�
+//
+// agvDetailService.updateById(agvDetail);
+//
+// Thread.sleep(1000);
+//
+// actionProgress += angleToRotate;
+// }
+ double actionAngle = Double.parseDouble(action.getParams());
- double totalAngle = Double.parseDouble(action.getParams()); // 鍋囪Action鏈塧ngle灞炴��
- double stepAngle = 45.0; // 姣忕鏃嬭浆15搴︼紝鍏蜂綋鍊兼牴鎹渶姹傝皟鏁�
- double actionProgress = 0.0;
+ double newAngle = (agvDetail.getAgvAngle() + actionAngle) % 360;
- while (actionProgress < totalAngle) {
- double angleToRotate = Math.min(stepAngle, totalAngle - actionProgress);
- // 鏇存柊AGV鐨勮搴�
- double newAngle = (agvDetail.getAgvAngle() + angleToRotate) % 360;
- agvDetail.setAgvAngle(newAngle);
+ agvDetail.setAgvAngle(newAngle);
- // 妯℃嫙鐢甸噺娑堣��
-// agvDetail.setVol(agvDetail.getVol() - 0.05 * (angleToRotate / 15.0)); // 鏍规嵁瑙掑害娑堣�楃數閲�
+ Thread.sleep(1000);
- // 鏇存柊AGV璇︾粏淇℃伅
- agvDetailService.updateById(agvDetail);
+ agvDetailService.updateById(agvDetail);
- // 妯℃嫙瀹為檯鎵ц鏃堕棿
- Thread.sleep(1000); // 姣忕鎵ц涓�娆�
-
- actionProgress += angleToRotate;
- }
-
- // 鍔ㄤ綔瀹屾垚锛屾洿鏂扮姸鎬�
action.setActionSts(ActionStsType.FINISH.val());
actionService.updateById(action);
}
--
Gitblit v1.9.1