Added pathfinding for units