Add iter_distance_compare and move distance_compare to distance.hpp
Update tests for distance_compare