From 96f987b030f4c961a985f07079ba12abd865fdb2 Mon Sep 17 00:00:00 2001
From: Junjie <DELL@qq.com>
Date: 星期三, 17 十二月 2025 08:12:24 +0800
Subject: [PATCH] #
---
src/main/java/com/zy/common/utils/NavigateUtils.java | 231 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++-
1 files changed, 226 insertions(+), 5 deletions(-)
diff --git a/src/main/java/com/zy/common/utils/NavigateUtils.java b/src/main/java/com/zy/common/utils/NavigateUtils.java
index b0ff36d..1a20b54 100644
--- a/src/main/java/com/zy/common/utils/NavigateUtils.java
+++ b/src/main/java/com/zy/common/utils/NavigateUtils.java
@@ -2,21 +2,35 @@
import java.util.ArrayList;
import java.util.Collections;
+import java.util.HashMap;
import java.util.HashSet;
import java.util.List;
+import java.util.Map;
+
+import com.zy.core.News;
import org.springframework.stereotype.Component;
import com.alibaba.fastjson.JSON;
import com.alibaba.fastjson.JSONObject;
+import com.baomidou.mybatisplus.mapper.EntityWrapper;
+import com.core.common.SpringUtils;
import com.core.exception.CoolException;
import com.zy.common.model.NavigateNode;
+import com.zy.asrs.entity.DeviceConfig;
+import com.zy.asrs.service.DeviceConfigService;
+import com.zy.core.cache.SlaveConnection;
+import com.zy.core.enums.SlaveType;
+import com.zy.core.model.protocol.StationProtocol;
+import com.zy.core.thread.StationThread;
+import com.zy.system.entity.Config;
+import com.zy.system.service.ConfigService;
@Component
public class NavigateUtils {
- public synchronized List<NavigateNode> calcByStationId(Integer startStationId, Integer endStationId) {
+ public synchronized List<NavigateNode> calcByStationId(int lev, Integer startStationId, Integer endStationId) {
NavigateSolution navigateSolution = new NavigateSolution();
- List<List<NavigateNode>> stationMap = navigateSolution.getStationMap();
+ List<List<NavigateNode>> stationMap = navigateSolution.getStationMap(lev);
NavigateNode startNode = navigateSolution.findStationNavigateNode(stationMap, startStationId);
if (startNode == null){
@@ -28,15 +42,61 @@
throw new CoolException("鏈壘鍒拌 缁堢偣 瀵瑰簲鐨勮妭鐐�");
}
- NavigateNode res_node = navigateSolution.astarSearchJava(stationMap, startNode, endNode);
+ long startTime = System.currentTimeMillis();
+ News.info("[WCS Debug] 绔欑偣璺緞寮�濮嬭绠�,startStationId={},endStationId={}", startStationId, endStationId);
+ List<List<NavigateNode>> allList = navigateSolution.allSimplePaths(stationMap, startNode, endNode, 120, 500, 300);
+ if (allList.isEmpty()) {
+ throw new CoolException("鏈壘鍒拌璺緞");
+ }
+ News.info("[WCS Debug] 绔欑偣璺緞璁＄畻瀹屾垚锛岃�楁椂锛歿}ms", System.currentTimeMillis() - startTime);
+
+ if (allList.size() > 1) {
+ System.out.println(JSON.toJSONString(allList));
+ }
+
+ News.info("[WCS Debug] 绔欑偣璺緞鏉冮噸寮�濮嬪垎鏋�,startStationId={},endStationId={}", startStationId, endStationId);
+ List<NavigateNode> list = findStationBestPath(allList);
+ News.info("[WCS Debug] 绔欑偣璺緞鏉冮噸鍒嗘瀽缁撴潫,startStationId={},endStationId={}", startStationId, endStationId);
+
+ //鍘婚噸
+ HashSet<Integer> set = new HashSet<>();
+ List<NavigateNode> fitlerList = new ArrayList<>();
+ for(NavigateNode navigateNode : list){
+ JSONObject valuObject = JSON.parseObject(navigateNode.getNodeValue());
+ if(set.add(valuObject.getInteger("stationId"))){
+ fitlerList.add(navigateNode);
+ }
+ }
+
+ return fitlerList;
+ }
+
+ public synchronized List<NavigateNode> calcByTrackSiteNo(int lev, Integer startTrackSiteNo, Integer endTrackSiteNo) {
+ NavigateSolution navigateSolution = new NavigateSolution();
+ List<List<NavigateNode>> rgvTrackMap = navigateSolution.getRgvTrackMap(lev);
+
+ NavigateNode startNode = navigateSolution.findTrackSiteNoNavigateNode(rgvTrackMap, startTrackSiteNo);
+ if (startNode == null){
+ throw new CoolException("鏈壘鍒拌 璧风偣 瀵瑰簲鐨勮妭鐐�");
+ }
+
+ NavigateNode endNode = navigateSolution.findTrackSiteNoNavigateNode(rgvTrackMap, endTrackSiteNo);
+ if (endNode == null){
+ throw new CoolException("鏈壘鍒拌 缁堢偣 瀵瑰簲鐨勮妭鐐�");
+ }
+
+ long startTime = System.currentTimeMillis();
+ News.info("[WCS Debug] RGV璺緞寮�濮嬭绠�,startTrackSiteNo:{},endTrackSiteNo={}", startTrackSiteNo, endTrackSiteNo);
+ NavigateNode res_node = navigateSolution.astarSearchJava(rgvTrackMap, startNode, endNode);
if (res_node == null) {
throw new CoolException("鏈壘鍒拌璺緞");
}
+ News.info("[WCS Debug] RGV璺緞璁＄畻瀹屾垚锛岃�楁椂锛歿}ms", System.currentTimeMillis() - startTime);
ArrayList<NavigateNode> list = new ArrayList<>();
// 浣跨敤 visited 闆嗗悎闃叉鐖堕摼鍑虹幇鐜鑷存寰幆锛屽悓鏃惰缃畨鍏ㄦ鏁颁笂闄�
HashSet<NavigateNode> visited = new HashSet<>();
- int maxSteps = stationMap.size() * stationMap.get(0).size() + 5; // 瀹夊叏涓婇檺
+ int maxSteps = rgvTrackMap.size() * rgvTrackMap.get(0).size() + 5; // 瀹夊叏涓婇檺
int steps = 0;
while (res_node != null && visited.add(res_node) && steps++ < maxSteps) {
list.add(res_node);
@@ -58,7 +118,7 @@
List<NavigateNode> fitlerList = new ArrayList<>();
for(NavigateNode navigateNode : list){
JSONObject valuObject = JSON.parseObject(navigateNode.getNodeValue());
- if(set.add(valuObject.getInteger("stationId"))){
+ if(set.add(valuObject.getInteger("trackSiteNo"))){
fitlerList.add(navigateNode);
}
}
@@ -66,4 +126,165 @@
return fitlerList;
}
+ public synchronized List<NavigateNode> findLiftStationList(int lev) {
+ NavigateSolution navigateSolution = new NavigateSolution();
+ List<List<NavigateNode>> stationMap = navigateSolution.getStationMap(lev);
+
+ List<NavigateNode> liftStationList = new ArrayList<>();
+ for (List<NavigateNode> navigateNodes : stationMap) {
+ for (NavigateNode navigateNode : navigateNodes) {
+ String nodeType = navigateNode.getNodeType();
+ if(nodeType == null){
+ continue;
+ }
+ if(!nodeType.equals("devp")){
+ continue;
+ }
+ JSONObject valuObject = JSON.parseObject(navigateNode.getNodeValue());
+ if(valuObject == null){
+ continue;
+ }
+ if (valuObject.containsKey("liftNo")) {
+ liftStationList.add(navigateNode);
+ }
+ }
+ }
+
+ return liftStationList;
+ }
+
+ public synchronized List<NavigateNode> findStationBestPath(List<List<NavigateNode>> allList) {
+ if (allList == null || allList.isEmpty()) {
+ return new ArrayList<>();
+ }
+
+ Map<Integer, StationProtocol> statusMap = new HashMap<>();
+ try {
+ DeviceConfigService deviceConfigService = SpringUtils.getBean(DeviceConfigService.class);
+ if (deviceConfigService != null) {
+ List<DeviceConfig> devpList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>()
+ .eq("device_type", String.valueOf(SlaveType.Devp)));
+ for (DeviceConfig deviceConfig : devpList) {
+ StationThread stationThread = (StationThread) SlaveConnection.get(SlaveType.Devp, deviceConfig.getDeviceNo());
+ if (stationThread == null) {
+ continue;
+ }
+ Map<Integer, StationProtocol> m = stationThread.getStatusMap();
+ if (m != null && !m.isEmpty()) {
+ statusMap.putAll(m);
+ }
+ }
+ }
+ } catch (Exception ignore) {}
+
+ List<List<NavigateNode>> candidates = new ArrayList<>();
+ List<Integer> lens = new ArrayList<>();
+ List<Integer> tasksList = new ArrayList<>();
+ List<Double> congs = new ArrayList<>();
+
+ for (List<NavigateNode> path : allList) {
+ if (path == null || path.isEmpty()) {
+ continue;
+ }
+ int len = path.size();
+ int tasks = 0;
+ HashSet<Integer> stationIdSet = new HashSet<>();
+ for (NavigateNode node : path) {
+ JSONObject value = null;
+ try {
+ value = JSON.parseObject(node.getNodeValue());
+ } catch (Exception ignore) {}
+ if (value == null) {
+ continue;
+ }
+ Integer stationId = value.getInteger("stationId");
+ if (stationId == null) {
+ continue;
+ }
+ if (!stationIdSet.add(stationId)) {
+ continue;
+ }
+ StationProtocol protocol = statusMap.get(stationId);
+ if (protocol != null && protocol.getTaskNo() != null && protocol.getTaskNo() > 0) {
+ tasks++;
+ }
+ }
+ double cong = len <= 0 ? 0.0 : (double) tasks / (double) len;
+ candidates.add(path);
+ lens.add(len);
+ tasksList.add(tasks);
+ congs.add(cong);
+ }
+
+ if (candidates.isEmpty()) {
+ return allList.get(0);
+ }
+
+ int minLen = Integer.MAX_VALUE;
+ int maxLen = Integer.MIN_VALUE;
+ double minCong = Double.MAX_VALUE;
+ double maxCong = -Double.MAX_VALUE;
+ for (int i = 0; i < candidates.size(); i++) {
+ int l = lens.get(i);
+ double c = congs.get(i);
+ if (l < minLen) minLen = l;
+ if (l > maxLen) maxLen = l;
+ if (c < minCong) minCong = c;
+ if (c > maxCong) maxCong = c;
+ }
+
+ //闀垮害鏉冮噸鐧惧垎姣�
+ double lenWeightPercent = 50.0;
+ //鎷ュ牭鏉冮噸鐧惧垎姣�
+ double congWeightPercent = 50.0;
+ try {
+ ConfigService configService = SpringUtils.getBean(ConfigService.class);
+ if (configService != null) {
+ Config cfgLen = configService.selectOne(new EntityWrapper<Config>().eq("code", "stationPathLenWeightPercent"));
+ if (cfgLen != null && cfgLen.getValue() != null) {
+ String v = cfgLen.getValue().trim();
+ if (v.endsWith("%")) v = v.substring(0, v.length() - 1);
+ try { lenWeightPercent = Double.parseDouble(v); } catch (Exception ignore) {}
+ }
+ Config cfgCong = configService.selectOne(new EntityWrapper<Config>().eq("code", "stationPathCongWeightPercent"));
+ if (cfgCong != null && cfgCong.getValue() != null) {
+ String v = cfgCong.getValue().trim();
+ if (v.endsWith("%")) v = v.substring(0, v.length() - 1);
+ try { congWeightPercent = Double.parseDouble(v); } catch (Exception ignore) {}
+ }
+ }
+ } catch (Exception ignore) {}
+
+ double weightSum = lenWeightPercent + congWeightPercent;
+ double lenW = weightSum <= 0 ? 0.5 : lenWeightPercent / weightSum;
+ double congW = weightSum <= 0 ? 0.5 : congWeightPercent / weightSum;
+
+ List<NavigateNode> best = null;
+ double bestCost = Double.MAX_VALUE;
+ int bestTasks = Integer.MAX_VALUE;
+ int bestLen = Integer.MAX_VALUE;
+ for (int i = 0; i < candidates.size(); i++) {
+ int l = lens.get(i);
+ int t = tasksList.get(i);
+ double c = congs.get(i);
+ //褰掍竴鍖�
+ double lenNorm = (maxLen - minLen) <= 0 ? 0.0 : (l - minLen) / (double) (maxLen - minLen);
+ double congNorm = (maxCong - minCong) <= 0 ? 0.0 : (c - minCong) / (double) (maxCong - minCong);
+ //鑾峰彇鏉冮噸
+ double cost = lenNorm * lenW + congNorm * congW;
+ if (cost < bestCost
+ || (cost == bestCost && t < bestTasks)
+ || (cost == bestCost && t == bestTasks && l < bestLen)) {
+ best = candidates.get(i);
+ bestCost = cost;
+ bestTasks = t;
+ bestLen = l;
+ }
+ }
+
+ if (best == null) {
+ return allList.get(0);
+ }
+ return best;
+ }
}
--
Gitblit v1.9.1