From 1ce8c694a364916fa45c60cabedb7a9215003055 Mon Sep 17 00:00:00 2001
From: vincentlu <t1341870251@gmail.com>
Date: 星期四, 19 三月 2026 13:41:31 +0800
Subject: [PATCH] #
---
zy-acs-manager/src/main/java/com/zy/acs/manager/core/service/astart/MapDataDispatcher.java | 77 ++++++++++++++++++++++++++------------
1 files changed, 53 insertions(+), 24 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 72b5182..c0bf873 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,18 @@
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 com.zy.acs.common.utils.News;
+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 +43,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 +105,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 +127,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) {
@@ -213,10 +230,13 @@
}
public synchronized DynamicNode[][] initDynamicMatrix(Integer lev) {
- log.info("There is initializing Dynamic Matrix......");
+ News.info("There is initializing Dynamic Matrix......");
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++) {
@@ -233,7 +253,7 @@
}
public synchronized String[][] initCdaMatrix(Integer lev) {
- log.info("There is initializing Cda Matrix......");
+ News.info("There is initializing Cda Matrix......");
lev = Optional.ofNullable(lev).orElse(MAP_DEFAULT_LEV);
if (Cools.isEmpty(xIdxList, yIdxList)) {
@@ -269,7 +289,7 @@
}
public synchronized int[][] initTurnMatrix(Integer lev) {
- log.info("There is initializing Turn Matrix......");
+ News.info("There is initializing Turn Matrix......");
lev = Optional.ofNullable(lev).orElse(MAP_DEFAULT_LEV);
String[][] codeMatrix = getCodeMatrix(lev);
@@ -318,7 +338,7 @@
public synchronized int[][] initMapMatrix(Integer lev) {
- log.info("There is initializing Map Matrix......");
+ News.info("There is initializing Map Matrix......");
lev = Optional.ofNullable(lev).orElse(MAP_DEFAULT_LEV);
String[][] codeMatrix = getCodeMatrix(lev);
@@ -351,7 +371,7 @@
}
public synchronized void initRouteMap(Integer lev) {
- log.info("There is initializing Route Map......");
+ News.info("There is initializing Route Map......");
lev = Optional.ofNullable(lev).orElse(MAP_DEFAULT_LEV);
Set<String> routeKeys = redis.getMapKeys(RedisConstant.AGV_MAP_ROUTE_HASH_FLAG);
Set<String> routeCdaKeys = redis.getMapKeys(RedisConstant.AGV_MAP_ROUTE_CDA_HASH_FLAG);
@@ -385,7 +405,7 @@
}
public synchronized String[][] initCodeMatrix(Integer lev) {
- log.info("There is initializing Code Matrix......");
+ News.info("There is initializing Code Matrix......");
lev = Optional.ofNullable(lev).orElse(MAP_DEFAULT_LEV);
List<Code> codeList = codeService.list(new LambdaQueryWrapper<Code>()
.eq(Code::getStatus, 1)
@@ -479,11 +499,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 +515,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 +541,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) {
@@ -546,4 +575,4 @@
}
}
-}
+}
\ No newline at end of file
--
Gitblit v1.9.1