tbd-station-14/Content.Server/AI/Operators/Movement/MoveToGridOperator.cs

using Content.Server.GameObjects.EntitySystems.JobQueues;
using Robust.Shared.Interfaces.GameObjects;
using Robust.Shared.Interfaces.Map;
using Robust.Shared.IoC;
using Robust.Shared.Map;

namespace Content.Server.AI.Operators.Movement
{
    public class MoveToGridOperator : BaseMover
    {
        private IMapManager _mapManager;
        private float _desiredRange;

        public MoveToGridOperator(
            IEntity owner,
            GridCoordinates gridPosition,
            float desiredRange = 1.5f)
        {
            Setup(owner);
            TargetGrid = gridPosition;
            _mapManager = IoCManager.Resolve<IMapManager>();
            PathfindingProximity = 0.2f; // Accept no substitutes
            _desiredRange = desiredRange;
        }

        public void UpdateTarget(GridCoordinates newTarget)
        {
            TargetGrid = newTarget;
            HaveArrived();
            GetRoute();
        }

        public override Outcome Execute(float frameTime)
        {
            var baseOutcome = base.Execute(frameTime);

            if (baseOutcome == Outcome.Failed ||
                TargetGrid.GridID != Owner.Transform.GridID)
            {
                HaveArrived();
                return Outcome.Failed;
            }

            if (RouteJob != null)
            {
                if (RouteJob.Status != JobStatus.Finished)
                {
                    return Outcome.Continuing;
                }
                ReceivedRoute();
                return Route.Count == 0 ? Outcome.Failed : Outcome.Continuing;
            }

            var targetRange = (TargetGrid.Position - Owner.Transform.GridPosition.Position).Length;

            // We there
            if (targetRange <= _desiredRange)
            {
                HaveArrived();
                return Outcome.Success;
            }

            // No route
            if (Route.Count == 0 && RouteJob == null)
            {
                GetRoute();
                return Outcome.Continuing;
            }

            AntiStuck(frameTime);

            if (IsStuck)
            {
                return Outcome.Continuing;
            }

            if (TryMove())
            {
                return Outcome.Continuing;
            }

            if (Route.Count == 0 && targetRange > 1.5f)
            {
                HaveArrived();
                return Outcome.Failed;
            }

            var nextTile = Route.Dequeue();
            NextTile();
            NextGrid = _mapManager.GetGrid(nextTile.GridIndex).GridTileToLocal(nextTile.GridIndices);
            return Outcome.Continuing;
        }
    }
}