新增1.0和2.0两种协议车型车型

2026-07-17 13:36:01 +08:00
parent a0dc1e6cd0
commit a28bc68e23
62 changed files with 12638 additions and 203 deletions
@@ -0,0 +1,90 @@
+using SimpleCore;
+using System.Collections.Generic;
+
+namespace StandardScene.Magnetic.Tasking
+{
+    internal static class Fass2PathFinder
+    {
+        public static List<int> GetSitesBetween(int startSiteId, int endSiteId)
+        {
+            if (startSiteId == endSiteId)
+            {
+                return new List<int> { startSiteId };
+            }
+
+            var adjacency = BuildSiteAdjacency();
+            var visited = new HashSet<int> { startSiteId };
+            var queue = new Queue<List<int>>();
+            queue.Enqueue(new List<int> { startSiteId });
+
+            while (queue.Count > 0)
+            {
+                var path = queue.Dequeue();
+                var current = path[path.Count - 1];
+                if (current == endSiteId)
+                {
+                    return path;
+                }
+
+                if (!adjacency.TryGetValue(current, out var neighbors))
+                {
+                    continue;
+                }
+
+                foreach (var neighbor in neighbors)
+                {
+                    if (visited.Contains(neighbor))
+                    {
+                        continue;
+                    }
+
+                    visited.Add(neighbor);
+                    var nextPath = new List<int>(path) { neighbor };
+                    queue.Enqueue(nextPath);
+                }
+            }
+
+            return new List<int>();
+        }
+
+        private static Dictionary<int, HashSet<int>> BuildSiteAdjacency()
+        {
+            var adjacency = new Dictionary<int, HashSet<int>>();
+            foreach (var track in SimpleLib.GetAllTracks())
+            {
+                var siteA = track.siteA;
+                var siteB = track.siteB;
+                switch (track.direction)
+                {
+                    case 0:
+                        AddAdjacency(adjacency, siteA, siteB);
+                        AddAdjacency(adjacency, siteB, siteA);
+                        break;
+                    case 1:
+                        AddAdjacency(adjacency, siteA, siteB);
+                        break;
+                    case 2:
+                        AddAdjacency(adjacency, siteB, siteA);
+                        break;
+                    default:
+                        AddAdjacency(adjacency, siteA, siteB);
+                        AddAdjacency(adjacency, siteB, siteA);
+                        break;
+                }
+            }
+
+            return adjacency;
+        }
+
+        private static void AddAdjacency(Dictionary<int, HashSet<int>> adjacency, int from, int to)
+        {
+            if (!adjacency.TryGetValue(from, out var set))
+            {
+                set = new HashSet<int>();
+                adjacency[from] = set;
+            }
+
+            set.Add(to);
+        }
+    }
+}