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/astart/MapDataDispatcher.java | 66 +++++++++++++++++++++++---------
1 files changed, 47 insertions(+), 19 deletions(-)
diff --git a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/astart/MapDataDispatcher.java b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/astart/MapDataDispatcher.java
index 0a2285c..5bcba6d 100644
--- a/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/astart/MapDataDispatcher.java
+++ b/zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/astart/MapDataDispatcher.java
@@ -6,6 +6,8 @@
import com.zy.acs.common.utils.RedisSupport;
import com.zy.acs.framework.common.Cools;
import com.zy.acs.framework.exception.CoolException;
+import com.zy.acs.manager.common.utils.MapDataUtils;
+import com.zy.acs.manager.core.domain.PathDto;
import com.zy.acs.manager.core.service.astart.domain.DynamicNode;
import com.zy.acs.manager.core.utils.RouteGenerator;
import com.zy.acs.manager.manager.entity.Code;
@@ -14,13 +16,17 @@
import com.zy.acs.manager.manager.service.CodeService;
import com.zy.acs.manager.manager.service.RouteService;
import lombok.extern.slf4j.Slf4j;
+import org.springframework.beans.factory.annotation.Autowired;
+import org.springframework.stereotype.Service;
+import javax.annotation.PostConstruct;
import java.util.*;
/**
* Created by vincent on 6/6/2024
*/
@Slf4j
+@Service
public class MapDataDispatcher {
public static final Integer MAP_DEFAULT_LEV = 1;
@@ -36,17 +42,26 @@
private int[][] turnMatrix;
- private String[][] cdaMatrix;
+ private Double[][][] cdaMatrix;
public Map<String, Boolean> routeCdaMap = new HashMap<>();
- private final CodeService codeService;
+ @Autowired
+ private CodeService codeService;
- private final RouteService routeService;
+ @Autowired
+ private RouteService routeService;
- public MapDataDispatcher(CodeService codeService, RouteService routeService) {
- this.codeService = codeService;
- this.routeService = routeService;
+ @PostConstruct
+ public void init() {
+ String[][] codeMatrix = this.getCodeMatrix(null);
+ this.initRouteMap(null);
+ if (codeMatrix.length > 0) {
+ this.getMapMatrix(null, null);
+ this.getTurnMatrix(null);
+ this.getCdaMatrix(null);
+ this.getDynamicMatrix(null);
+ }
}
public String[][] getWaveMatrix(Integer lev) {
@@ -89,13 +104,14 @@
redis.setValue(RedisConstant.AGV_MAP_ASTAR_DYNAMIC_FLAG, String.valueOf(lev), JSON.toJSONString(dynamicMatrix));
}
- public String[][] getCdaMatrix(Integer lev) {
+ public Double[][][] getCdaMatrix(Integer lev) {
lev = Optional.ofNullable(lev).orElse(MAP_DEFAULT_LEV);
// redis
if (null == this.cdaMatrix) {
String cdaMatrixStr = redis.getValue(RedisConstant.AGV_MAP_ASTAR_CDA_FLAG, String.valueOf(lev));
if (!Cools.isEmpty(cdaMatrixStr)) {
- this.cdaMatrix = JSON.parseObject(cdaMatrixStr, String[][].class);
+ String[][] cdaStrMatrix = JSON.parseObject(cdaMatrixStr, String[][].class);
+ this.cdaMatrix = MapDataUtils.preComputeCdaMatrix(cdaStrMatrix);
}
}
// init
@@ -110,9 +126,9 @@
return this.cdaMatrix;
}
- public void setCdaMatrix(Integer lev, String[][] cdaMatrix) {
- redis.setValue(RedisConstant.AGV_MAP_ASTAR_CDA_FLAG, String.valueOf(lev), JSON.toJSONString(cdaMatrix));
- this.cdaMatrix = cdaMatrix;
+ public void setCdaMatrix(Integer lev, String[][] cdaStrMatrix) {
+ redis.setValue(RedisConstant.AGV_MAP_ASTAR_CDA_FLAG, String.valueOf(lev), JSON.toJSONString(cdaStrMatrix));
+ this.cdaMatrix = MapDataUtils.preComputeCdaMatrix(cdaStrMatrix);
}
public int[][] getTurnMatrix(Integer lev) {
@@ -217,6 +233,9 @@
lev = Optional.ofNullable(lev).orElse(MAP_DEFAULT_LEV);
String[][] codeMatrix = getCodeMatrix(lev);
+ if (null == codeMatrix || codeMatrix.length == 0) {
+ return new DynamicNode[0][0];
+ }
DynamicNode[][] dynamicMatrix = new DynamicNode[codeMatrix.length][codeMatrix[0].length];
for (int i = 0; i < codeMatrix.length; i++) {
@@ -364,9 +383,9 @@
return;
}
for (Route route : routeList) {
- Code startCode = codeService.getById(route.getStartCode());
+ Code startCode = codeService.getCacheById(route.getStartCode());
int[] startCodeIdx = getCodeMatrixIdx(lev, startCode.getData());
- Code endCode = codeService.getById(route.getEndCode());
+ Code endCode = codeService.getCacheById(route.getEndCode());
int[] codeMatrixIdx = getCodeMatrixIdx(lev, endCode.getData());
String routeKey = RouteGenerator.generateRouteKey(startCode.getData(), endCode.getData());
@@ -479,11 +498,15 @@
return codeMatrixIdxList;
}
- public void modifyDynamicMatrix(Integer lev, List<int[]> codeIdxList, String vehicle) {
- this.modifyDynamicMatrix(lev, codeIdxList, vehicle, false);
+ public void modifyDynamicMatrix(Integer lev, List<int[]> codeIdxList, String vehicle, List<PathDto> pathTrace) {
+ this.modifyDynamicMatrix(lev, codeIdxList, vehicle, false, pathTrace);
}
public synchronized void modifyDynamicMatrix(Integer lev, List<int[]> codeIdxList, String vehicle, boolean reset) {
+ this.modifyDynamicMatrix(lev, codeIdxList, vehicle, reset, null);
+ }
+
+ private synchronized void modifyDynamicMatrix(Integer lev, List<int[]> codeIdxList, String vehicle, boolean reset, List<PathDto> pathTrace) {
if (Cools.isEmpty(vehicle)) {
return;
}
@@ -491,10 +514,15 @@
DynamicNode[][] dynamicMatrix = getDynamicMatrix(lev);
if (!reset) {
-// long time = System.currentTimeMillis() / 1000;
int serial = 1;
- for (int[] codeMatrixIdx : codeIdxList) {
- dynamicMatrix[codeMatrixIdx[0]][codeMatrixIdx[1]] = new DynamicNode(vehicle, serial);
+ for (int i = 0; i < codeIdxList.size(); i++) {
+ int[] codeMatrixIdx = codeIdxList.get(i);
+
+ PathDto pathDto = (pathTrace != null && i < pathTrace.size()) ? pathTrace.get(i) : null;
+ Double direction = pathDto == null ? null : pathDto.getDirection();
+ boolean turn = pathDto != null && pathDto.isTurn();
+
+ dynamicMatrix[codeMatrixIdx[0]][codeMatrixIdx[1]] = new DynamicNode(vehicle, serial, direction, turn);
serial++;
}
} else {
@@ -512,7 +540,7 @@
}
public void clearDynamicMatrixByCodeList(Integer lev, List<int[]> codeIdxList) {
- this.modifyDynamicMatrix(lev, codeIdxList, DynamicNodeType.ACCESS.val);
+ this.modifyDynamicMatrix(lev, codeIdxList, DynamicNodeType.ACCESS.val, false, null);
}
public int[][] filterMapData(int[][] mapMatrix, Integer lev, List<String> lockNodes) {
--
Gitblit v1.9.1