added DistToStart, isBetterRoute, but not using it