From 4e005e4936039fca16bfd1679942daa416a21986 Mon Sep 17 00:00:00 2001
From: Junjie <fallin.jie@qq.com>
Date: 星期四, 20 十一月 2025 14:27:47 +0800
Subject: [PATCH] #

---
 src/main/java/com/zy/common/utils/NavigateUtils.java |   52 ++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 files changed, 52 insertions(+), 0 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..e324def 100644
--- a/src/main/java/com/zy/common/utils/NavigateUtils.java
+++ b/src/main/java/com/zy/common/utils/NavigateUtils.java
@@ -66,4 +66,56 @@
         return fitlerList;
     }
 
+    public synchronized List<NavigateNode> calcByTrackSiteNo(Integer startTrackSiteNo, Integer endTrackSiteNo) {
+        NavigateSolution navigateSolution = new NavigateSolution();
+        List<List<NavigateNode>> rgvTrackMap = navigateSolution.getRgvTrackMap();
+
+        NavigateNode startNode = navigateSolution.findTrackSiteNoNavigateNode(rgvTrackMap, startTrackSiteNo);
+        if (startNode == null){
+            throw new CoolException("鏈壘鍒拌 璧风偣 瀵瑰簲鐨勮妭鐐�");
+        }
+
+        NavigateNode endNode = navigateSolution.findTrackSiteNoNavigateNode(rgvTrackMap, endTrackSiteNo);
+        if (endNode == null){
+            throw new CoolException("鏈壘鍒拌 缁堢偣 瀵瑰簲鐨勮妭鐐�");
+        }
+
+        NavigateNode res_node = navigateSolution.astarSearchJava(rgvTrackMap, startNode, endNode);
+        if (res_node == null) {
+            throw new CoolException("鏈壘鍒拌璺緞");
+        }
+
+        ArrayList<NavigateNode> list = new ArrayList<>();
+        // 浣跨敤 visited 闆嗗悎闃叉鐖堕摼鍑虹幇鐜鑷存寰幆锛屽悓鏃惰缃畨鍏ㄦ鏁颁笂闄�
+        HashSet<NavigateNode> visited = new HashSet<>();
+        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);
+            res_node = res_node.getFather();//杩唬鎿嶄綔
+        }
+        if (steps >= maxSteps) {
+            throw new CoolException("璺緞鍥炴函瓒呭嚭瀹夊叏涓婇檺锛岀枒浼煎瓨鍦ㄧ埗閾惧惊鐜�");
+        }
+        Collections.reverse(list);
+        //灏嗘瘡涓妭鐐归噷闈㈢殑fatherNode鑷充负null(鏂逛究鍚庣画璁$畻鏃剁埗鑺傜偣杩囧瀵艰嚧鏄剧ず鐨勮妭鐐瑰お澶�)
+        for (NavigateNode navigateNode : list) {
+            //鐖惰妭鐐硅缃负null锛屼笉褰卞搷璁$畻缁撴灉锛屼笉褰卞搷鍚庣画鎿嶄綔銆�
+            //姝ゆ搷浣滀粎涓哄悗缁帓鏌ュ鐞嗘彁渚涜瑙夋柟渚裤��
+            navigateNode.setFather(null);
+        }
+
+        //鍘婚噸
+        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("trackSiteNo"))){
+                fitlerList.add(navigateNode);
+            }
+        }
+
+        return fitlerList;
+    }
+
 }

--
Gitblit v1.9.1