Path finding with multiple points are working