Looks at total path rather than just new path

Now subtract the distance of the path that would be removed from the
optimal calculation.