DistanceFunctor.h Node1 DistanceFunctor.h Node2 math.h Node1->Node2