WIP pathfinding AI navigator, Level class refactoring

2015-11-15 19:14:08 +02:00
parent 24ed95cd68
commit ef9d7ef0d4
11 changed files with 199 additions and 107 deletions
@@ -0,0 +1,62 @@
+using System;
+using System.Collections.Generic;
+using System.Linq;
+using System.Text;
+using Microsoft.Xna.Framework;
+using FarseerPhysics;
+
+namespace Barotrauma
+{
+    class PathSteeringManager : SteeringManager
+    {
+        private PathFinder pathFinder;
+        private SteeringPath currentPath;
+
+        private Vector2 currentTarget;
+
+        private float findPathTimer;
+
+        public PathSteeringManager(ISteerable host)
+            : base(host)
+        {}
+
+        public override void Update(float speed = 1)
+        {
+            base.Update(speed);
+
+            findPathTimer -= 1.0f / 60.0f;
+        }
+
+
+        protected override Vector2 DoSteeringSeek(Vector2 target, float speed = 1)
+        {
+            //find a new path if one hasn't been found yet or the target is different from the current target
+            if (currentPath == null || Vector2.DistanceSquared(target, currentTarget)>10.0f)
+            {
+                if (findPathTimer > 0.0f) return Vector2.Zero;
+
+                currentTarget = target;
+                currentPath = pathFinder.FindPath(ConvertUnits.ToDisplayUnits(host.SimPosition), target);
+
+                findPathTimer = 1.0f;
+
+                return DiffToCurrentNode();
+            }
+            
+            Vector2 diff = DiffToCurrentNode();
+
+            return (diff == Vector2.Zero) ? Vector2.Zero : Vector2.Normalize(diff)*speed;            
+        }
+
+        private Vector2 DiffToCurrentNode()
+        {
+            if (currentPath == null) return Vector2.Zero;
+
+            currentPath.CheckProgress(host.SimPosition, 0.1f);
+
+            if (currentPath.CurrentNode == null) return Vector2.Zero;
+
+            return currentPath.CurrentNode.SimPosition - host.SimPosition;
+        }
+    }
+}