public List <Vector3> FindPath(Vector3 startWorldPosition, Vector3 endWorldPosition) { grid.GetXZ(startWorldPosition, out int startX, out int startY); grid.GetXZ(endWorldPosition, out int endX, out int endY); List <PathNode> path = FindPath(startX, startY, endX, endY); if (path == null) { return(null); } else { List <Vector3> vectorPath = new List <Vector3>(); foreach (PathNode node in path) { vectorPath.Add(grid.GetWorldPosition(node.x, node.z)); } return(vectorPath); } }