feat: add pathfinding

Client/Infrastructure/Service/L2jGeoDataPathfinder.cs

@@ -0,0 +1,95 @@
+using Client.Domain.DTO;
+using Client.Domain.Service;
+using Client.Domain.ValueObjects;
+using System;
+using System.Collections.Generic;
+using System.Linq;
+using System.Runtime.InteropServices;
+using System.Text;
+using System.Threading.Tasks;
+
+namespace Client.Infrastructure.Service
+{
+    public class L2jGeoDataPathfinder : PathfinderInterface
+    {
+        [DllImport("L2JGeoDataPathFinder.dll", CallingConvention = CallingConvention.Cdecl)]
+        private static extern uint FindPath(out IntPtr arrayPtr, string geoDataDirectory, float startX, float startY, float startZ, float endX, float endY, ushort maxPassableHeight);
+        [DllImport("L2JGeoDataPathFinder.dll", CallingConvention = CallingConvention.Cdecl)]
+        private static extern uint ReleasePath(IntPtr arrayPtr);
+
+        public L2jGeoDataPathfinder(string geodataDirectory, ushort maxPassableHeight)
+        {
+            this.geodataDirectory = geodataDirectory;
+            this.maxPassableHeight = maxPassableHeight;
+        }
+
+        public List<PathSegment> FindPath(Vector3 start, Vector3 end)
+        {
+            var arrayPtr = IntPtr.Zero;
+            var size = FindPath(out arrayPtr, GetGeodataFullpath(), start.X, start.Y, start.Z, end.X, end.Y, maxPassableHeight);
+            var originalArrayPtr = arrayPtr;
+
+            var nodes = new List<PathNode>();
+            if (size > 0)
+            {
+                var entrySize = Marshal.SizeOf(typeof(PathNode));
+                for (var i = 0; i < size; i++)
+                {
+                    var node = Marshal.PtrToStructure(arrayPtr, typeof(PathNode));
+                    if (node != null)
+                    {
+                        nodes.Add((PathNode)node);
+                    }
+                    arrayPtr = new IntPtr(arrayPtr.ToInt32() + entrySize);
+                }
+                ReleasePath(originalArrayPtr);
+            }
+
+            return BuildPath(nodes);
+        }
+
+        private List<PathSegment> BuildPath(List<PathNode> nodes)
+        {
+            var result = new List<PathSegment>();
+
+            var points = new List<Vector3>();
+            foreach (var node in nodes)
+            {
+                points.Add(NodeToVector(node));
+            }
+
+            for (var i = 0; i < points.Count - 1; i++)
+            {
+                var point = points[i];
+                var nextPoint = points[i + 1];
+
+                result.Add(new PathSegment
+                {
+                    From = point,
+                    To = nextPoint
+                });
+            }
+
+            return result;
+        }
+
+        private Vector3 NodeToVector(PathNode node)
+        {
+            var rnd = new Random();
+
+            return new Vector3(
+                rnd.Next((int)node.minX, (int)node.maxX + 1),
+                rnd.Next((int)node.minY, (int)node.maxY + 1),
+                node.height
+            );
+        }
+
+        private string GetGeodataFullpath()
+        {
+            return System.IO.Directory.GetCurrentDirectory() + "/Assets/" + geodataDirectory + "/";
+        }
+
+        private readonly string geodataDirectory;
+        private readonly ushort maxPassableHeight;
+    }
+}