A* pathfinding timeout and stuck drone fix